Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /*-*- linux-c -*- |
2 | * linux/drivers/video/i810_accel.c -- Hardware Acceleration | |
3 | * | |
4 | * Copyright (C) 2001 Antonino Daplas<adaplas@pol.net> | |
5 | * All Rights Reserved | |
6 | * | |
7 | * This file is subject to the terms and conditions of the GNU General Public | |
8 | * License. See the file COPYING in the main directory of this archive for | |
9 | * more details. | |
10 | */ | |
11 | #include <linux/kernel.h> | |
12 | #include <linux/string.h> | |
13 | #include <linux/fb.h> | |
14 | ||
15 | #include "i810_regs.h" | |
16 | #include "i810.h" | |
a0aa7d06 | 17 | #include "i810_main.h" |
1da177e4 LT |
18 | |
19 | static u32 i810fb_rop[] = { | |
20 | COLOR_COPY_ROP, /* ROP_COPY */ | |
21 | XOR_ROP /* ROP_XOR */ | |
22 | }; | |
23 | ||
24 | /* Macros */ | |
25 | #define PUT_RING(n) { \ | |
26 | i810_writel(par->cur_tail, par->iring.virtual, n); \ | |
27 | par->cur_tail += 4; \ | |
28 | par->cur_tail &= RING_SIZE_MASK; \ | |
29 | } | |
30 | ||
31 | extern void flush_cache(void); | |
32 | ||
33 | /************************************************************/ | |
34 | ||
35 | /* BLT Engine Routines */ | |
36 | static inline void i810_report_error(u8 __iomem *mmio) | |
37 | { | |
38 | printk("IIR : 0x%04x\n" | |
39 | "EIR : 0x%04x\n" | |
40 | "PGTBL_ER: 0x%04x\n" | |
41 | "IPEIR : 0x%04x\n" | |
42 | "IPEHR : 0x%04x\n", | |
43 | i810_readw(IIR, mmio), | |
44 | i810_readb(EIR, mmio), | |
45 | i810_readl(PGTBL_ER, mmio), | |
46 | i810_readl(IPEIR, mmio), | |
47 | i810_readl(IPEHR, mmio)); | |
48 | } | |
49 | ||
50 | /** | |
51 | * wait_for_space - check ring buffer free space | |
52 | * @space: amount of ringbuffer space needed in bytes | |
53 | * @par: pointer to i810fb_par structure | |
54 | * | |
55 | * DESCRIPTION: | |
56 | * The function waits until a free space from the ringbuffer | |
57 | * is available | |
58 | */ | |
59 | static inline int wait_for_space(struct fb_info *info, u32 space) | |
60 | { | |
c019c0ec | 61 | struct i810fb_par *par = info->par; |
1da177e4 LT |
62 | u32 head, count = WAIT_COUNT, tail; |
63 | u8 __iomem *mmio = par->mmio_start_virtual; | |
64 | ||
65 | tail = par->cur_tail; | |
66 | while (count--) { | |
67 | head = i810_readl(IRING + 4, mmio) & RBUFFER_HEAD_MASK; | |
68 | if ((tail == head) || | |
69 | (tail > head && | |
70 | (par->iring.size - tail + head) >= space) || | |
71 | (tail < head && (head - tail) >= space)) { | |
72 | return 0; | |
73 | } | |
74 | } | |
75 | printk("ringbuffer lockup!!!\n"); | |
76 | i810_report_error(mmio); | |
77 | par->dev_flags |= LOCKUP; | |
78 | info->pixmap.scan_align = 1; | |
79 | return 1; | |
80 | } | |
81 | ||
82 | /** | |
83 | * wait_for_engine_idle - waits for all hardware engines to finish | |
84 | * @par: pointer to i810fb_par structure | |
85 | * | |
86 | * DESCRIPTION: | |
87 | * This waits for lring(0), iring(1), and batch(3), etc to finish and | |
88 | * waits until ringbuffer is empty. | |
89 | */ | |
90 | static inline int wait_for_engine_idle(struct fb_info *info) | |
91 | { | |
c019c0ec | 92 | struct i810fb_par *par = info->par; |
1da177e4 LT |
93 | u8 __iomem *mmio = par->mmio_start_virtual; |
94 | int count = WAIT_COUNT; | |
95 | ||
96 | if (wait_for_space(info, par->iring.size)) /* flush */ | |
97 | return 1; | |
98 | ||
99 | while((i810_readw(INSTDONE, mmio) & 0x7B) != 0x7B && --count); | |
100 | if (count) return 0; | |
101 | ||
102 | printk("accel engine lockup!!!\n"); | |
103 | printk("INSTDONE: 0x%04x\n", i810_readl(INSTDONE, mmio)); | |
104 | i810_report_error(mmio); | |
105 | par->dev_flags |= LOCKUP; | |
106 | info->pixmap.scan_align = 1; | |
107 | return 1; | |
108 | } | |
109 | ||
110 | /* begin_iring - prepares the ringbuffer | |
111 | * @space: length of sequence in dwords | |
112 | * @par: pointer to i810fb_par structure | |
113 | * | |
114 | * DESCRIPTION: | |
115 | * Checks/waits for sufficent space in ringbuffer of size | |
116 | * space. Returns the tail of the buffer | |
117 | */ | |
118 | static inline u32 begin_iring(struct fb_info *info, u32 space) | |
119 | { | |
c019c0ec | 120 | struct i810fb_par *par = info->par; |
1da177e4 LT |
121 | |
122 | if (par->dev_flags & ALWAYS_SYNC) | |
123 | wait_for_engine_idle(info); | |
124 | return wait_for_space(info, space); | |
125 | } | |
126 | ||
127 | /** | |
128 | * end_iring - advances the buffer | |
129 | * @par: pointer to i810fb_par structure | |
130 | * | |
131 | * DESCRIPTION: | |
132 | * This advances the tail of the ringbuffer, effectively | |
133 | * beginning the execution of the graphics instruction sequence. | |
134 | */ | |
135 | static inline void end_iring(struct i810fb_par *par) | |
136 | { | |
137 | u8 __iomem *mmio = par->mmio_start_virtual; | |
138 | ||
139 | i810_writel(IRING, mmio, par->cur_tail); | |
140 | } | |
141 | ||
142 | /** | |
143 | * source_copy_blit - BLIT transfer operation | |
144 | * @dwidth: width of rectangular graphics data | |
145 | * @dheight: height of rectangular graphics data | |
146 | * @dpitch: bytes per line of destination buffer | |
147 | * @xdir: direction of copy (left to right or right to left) | |
148 | * @src: address of first pixel to read from | |
149 | * @dest: address of first pixel to write to | |
150 | * @from: source address | |
151 | * @where: destination address | |
152 | * @rop: raster operation | |
153 | * @blit_bpp: pixel format which can be different from the | |
154 | * framebuffer's pixelformat | |
155 | * @par: pointer to i810fb_par structure | |
156 | * | |
157 | * DESCRIPTION: | |
158 | * This is a BLIT operation typically used when doing | |
159 | * a 'Copy and Paste' | |
160 | */ | |
161 | static inline void source_copy_blit(int dwidth, int dheight, int dpitch, | |
162 | int xdir, int src, int dest, int rop, | |
163 | int blit_bpp, struct fb_info *info) | |
164 | { | |
c019c0ec | 165 | struct i810fb_par *par = info->par; |
1da177e4 LT |
166 | |
167 | if (begin_iring(info, 24 + IRING_PAD)) return; | |
168 | ||
169 | PUT_RING(BLIT | SOURCE_COPY_BLIT | 4); | |
170 | PUT_RING(xdir | rop << 16 | dpitch | DYN_COLOR_EN | blit_bpp); | |
171 | PUT_RING(dheight << 16 | dwidth); | |
172 | PUT_RING(dest); | |
173 | PUT_RING(dpitch); | |
174 | PUT_RING(src); | |
175 | ||
176 | end_iring(par); | |
177 | } | |
178 | ||
179 | /** | |
180 | * color_blit - solid color BLIT operation | |
181 | * @width: width of destination | |
182 | * @height: height of destination | |
183 | * @pitch: pixels per line of the buffer | |
184 | * @dest: address of first pixel to write to | |
185 | * @where: destination | |
186 | * @rop: raster operation | |
187 | * @what: color to transfer | |
188 | * @blit_bpp: pixel format which can be different from the | |
189 | * framebuffer's pixelformat | |
190 | * @par: pointer to i810fb_par structure | |
191 | * | |
192 | * DESCRIPTION: | |
193 | * A BLIT operation which can be used for color fill/rectangular fill | |
194 | */ | |
195 | static inline void color_blit(int width, int height, int pitch, int dest, | |
196 | int rop, int what, int blit_bpp, | |
197 | struct fb_info *info) | |
198 | { | |
c019c0ec | 199 | struct i810fb_par *par = info->par; |
1da177e4 LT |
200 | |
201 | if (begin_iring(info, 24 + IRING_PAD)) return; | |
202 | ||
203 | PUT_RING(BLIT | COLOR_BLT | 3); | |
204 | PUT_RING(rop << 16 | pitch | SOLIDPATTERN | DYN_COLOR_EN | blit_bpp); | |
205 | PUT_RING(height << 16 | width); | |
206 | PUT_RING(dest); | |
207 | PUT_RING(what); | |
208 | PUT_RING(NOP); | |
209 | ||
210 | end_iring(par); | |
211 | } | |
212 | ||
213 | /** | |
214 | * mono_src_copy_imm_blit - color expand from system memory to framebuffer | |
215 | * @dwidth: width of destination | |
216 | * @dheight: height of destination | |
217 | * @dpitch: pixels per line of the buffer | |
218 | * @dsize: size of bitmap in double words | |
219 | * @dest: address of first byte of pixel; | |
220 | * @rop: raster operation | |
221 | * @blit_bpp: pixelformat to use which can be different from the | |
222 | * framebuffer's pixelformat | |
223 | * @src: address of image data | |
224 | * @bg: backgound color | |
225 | * @fg: forground color | |
226 | * @par: pointer to i810fb_par structure | |
227 | * | |
228 | * DESCRIPTION: | |
229 | * A color expand operation where the source data is placed in the | |
230 | * ringbuffer itself. Useful for drawing text. | |
231 | * | |
232 | * REQUIREMENT: | |
233 | * The end of a scanline must be padded to the next word. | |
234 | */ | |
235 | static inline void mono_src_copy_imm_blit(int dwidth, int dheight, int dpitch, | |
236 | int dsize, int blit_bpp, int rop, | |
237 | int dest, const u32 *src, int bg, | |
238 | int fg, struct fb_info *info) | |
239 | { | |
c019c0ec | 240 | struct i810fb_par *par = info->par; |
1da177e4 LT |
241 | |
242 | if (begin_iring(info, 24 + (dsize << 2) + IRING_PAD)) return; | |
243 | ||
244 | PUT_RING(BLIT | MONO_SOURCE_COPY_IMMEDIATE | (4 + dsize)); | |
245 | PUT_RING(DYN_COLOR_EN | blit_bpp | rop << 16 | dpitch); | |
246 | PUT_RING(dheight << 16 | dwidth); | |
247 | PUT_RING(dest); | |
248 | PUT_RING(bg); | |
249 | PUT_RING(fg); | |
250 | while (dsize--) | |
251 | PUT_RING(*src++); | |
252 | ||
253 | end_iring(par); | |
254 | } | |
255 | ||
256 | static inline void load_front(int offset, struct fb_info *info) | |
257 | { | |
c019c0ec | 258 | struct i810fb_par *par = info->par; |
1da177e4 LT |
259 | |
260 | if (begin_iring(info, 8 + IRING_PAD)) return; | |
261 | ||
262 | PUT_RING(PARSER | FLUSH); | |
263 | PUT_RING(NOP); | |
264 | ||
265 | end_iring(par); | |
266 | ||
267 | if (begin_iring(info, 8 + IRING_PAD)) return; | |
268 | ||
269 | PUT_RING(PARSER | FRONT_BUFFER | ((par->pitch >> 3) << 8)); | |
270 | PUT_RING((par->fb.offset << 12) + offset); | |
271 | ||
272 | end_iring(par); | |
273 | } | |
274 | ||
275 | /** | |
276 | * i810fb_iring_enable - enables/disables the ringbuffer | |
277 | * @mode: enable or disable | |
278 | * @par: pointer to i810fb_par structure | |
279 | * | |
280 | * DESCRIPTION: | |
281 | * Enables or disables the ringbuffer, effectively enabling or | |
282 | * disabling the instruction/acceleration engine. | |
283 | */ | |
284 | static inline void i810fb_iring_enable(struct i810fb_par *par, u32 mode) | |
285 | { | |
286 | u32 tmp; | |
287 | u8 __iomem *mmio = par->mmio_start_virtual; | |
288 | ||
289 | tmp = i810_readl(IRING + 12, mmio); | |
290 | if (mode == OFF) | |
291 | tmp &= ~1; | |
292 | else | |
293 | tmp |= 1; | |
294 | flush_cache(); | |
295 | i810_writel(IRING + 12, mmio, tmp); | |
296 | } | |
297 | ||
298 | void i810fb_fillrect(struct fb_info *info, const struct fb_fillrect *rect) | |
299 | { | |
c019c0ec | 300 | struct i810fb_par *par = info->par; |
1da177e4 LT |
301 | u32 dx, dy, width, height, dest, rop = 0, color = 0; |
302 | ||
303 | if (!info->var.accel_flags || par->dev_flags & LOCKUP || | |
304 | par->depth == 4) | |
305 | return cfb_fillrect(info, rect); | |
306 | ||
307 | if (par->depth == 1) | |
308 | color = rect->color; | |
309 | else | |
310 | color = ((u32 *) (info->pseudo_palette))[rect->color]; | |
311 | ||
312 | rop = i810fb_rop[rect->rop]; | |
313 | ||
314 | dx = rect->dx * par->depth; | |
315 | width = rect->width * par->depth; | |
316 | dy = rect->dy; | |
317 | height = rect->height; | |
318 | ||
319 | dest = info->fix.smem_start + (dy * info->fix.line_length) + dx; | |
320 | color_blit(width, height, info->fix.line_length, dest, rop, color, | |
321 | par->blit_bpp, info); | |
322 | } | |
323 | ||
324 | void i810fb_copyarea(struct fb_info *info, const struct fb_copyarea *region) | |
325 | { | |
c019c0ec | 326 | struct i810fb_par *par = info->par; |
1da177e4 LT |
327 | u32 sx, sy, dx, dy, pitch, width, height, src, dest, xdir; |
328 | ||
329 | if (!info->var.accel_flags || par->dev_flags & LOCKUP || | |
330 | par->depth == 4) | |
331 | return cfb_copyarea(info, region); | |
332 | ||
333 | dx = region->dx * par->depth; | |
334 | sx = region->sx * par->depth; | |
335 | width = region->width * par->depth; | |
336 | sy = region->sy; | |
337 | dy = region->dy; | |
338 | height = region->height; | |
339 | ||
340 | if (dx <= sx) { | |
341 | xdir = INCREMENT; | |
342 | } | |
343 | else { | |
344 | xdir = DECREMENT; | |
345 | sx += width - 1; | |
346 | dx += width - 1; | |
347 | } | |
348 | if (dy <= sy) { | |
349 | pitch = info->fix.line_length; | |
350 | } | |
351 | else { | |
352 | pitch = (-(info->fix.line_length)) & 0xFFFF; | |
353 | sy += height - 1; | |
354 | dy += height - 1; | |
355 | } | |
356 | src = info->fix.smem_start + (sy * info->fix.line_length) + sx; | |
357 | dest = info->fix.smem_start + (dy * info->fix.line_length) + dx; | |
358 | ||
359 | source_copy_blit(width, height, pitch, xdir, src, dest, | |
360 | PAT_COPY_ROP, par->blit_bpp, info); | |
361 | } | |
362 | ||
363 | void i810fb_imageblit(struct fb_info *info, const struct fb_image *image) | |
364 | { | |
c019c0ec | 365 | struct i810fb_par *par = info->par; |
1da177e4 LT |
366 | u32 fg = 0, bg = 0, size, dst; |
367 | ||
368 | if (!info->var.accel_flags || par->dev_flags & LOCKUP || | |
369 | par->depth == 4 || image->depth != 1) | |
370 | return cfb_imageblit(info, image); | |
371 | ||
372 | switch (info->var.bits_per_pixel) { | |
373 | case 8: | |
374 | fg = image->fg_color; | |
375 | bg = image->bg_color; | |
376 | break; | |
377 | case 16: | |
378 | case 24: | |
379 | fg = ((u32 *)(info->pseudo_palette))[image->fg_color]; | |
380 | bg = ((u32 *)(info->pseudo_palette))[image->bg_color]; | |
381 | break; | |
382 | } | |
383 | ||
384 | dst = info->fix.smem_start + (image->dy * info->fix.line_length) + | |
385 | (image->dx * par->depth); | |
386 | ||
387 | size = (image->width+7)/8 + 1; | |
388 | size &= ~1; | |
389 | size *= image->height; | |
390 | size += 7; | |
391 | size &= ~7; | |
392 | mono_src_copy_imm_blit(image->width * par->depth, | |
393 | image->height, info->fix.line_length, | |
394 | size/4, par->blit_bpp, | |
395 | PAT_COPY_ROP, dst, (u32 *) image->data, | |
396 | bg, fg, info); | |
397 | } | |
398 | ||
399 | int i810fb_sync(struct fb_info *info) | |
400 | { | |
c019c0ec | 401 | struct i810fb_par *par = info->par; |
1da177e4 LT |
402 | |
403 | if (!info->var.accel_flags || par->dev_flags & LOCKUP) | |
404 | return 0; | |
405 | ||
406 | return wait_for_engine_idle(info); | |
407 | } | |
408 | ||
409 | void i810fb_load_front(u32 offset, struct fb_info *info) | |
410 | { | |
c019c0ec | 411 | struct i810fb_par *par = info->par; |
1da177e4 LT |
412 | u8 __iomem *mmio = par->mmio_start_virtual; |
413 | ||
414 | if (!info->var.accel_flags || par->dev_flags & LOCKUP) | |
415 | i810_writel(DPLYBASE, mmio, par->fb.physical + offset); | |
416 | else | |
417 | load_front(offset, info); | |
418 | } | |
419 | ||
420 | /** | |
421 | * i810fb_init_ringbuffer - initialize the ringbuffer | |
422 | * @par: pointer to i810fb_par structure | |
423 | * | |
424 | * DESCRIPTION: | |
425 | * Initializes the ringbuffer by telling the device the | |
426 | * size and location of the ringbuffer. It also sets | |
427 | * the head and tail pointers = 0 | |
428 | */ | |
429 | void i810fb_init_ringbuffer(struct fb_info *info) | |
430 | { | |
c019c0ec | 431 | struct i810fb_par *par = info->par; |
1da177e4 LT |
432 | u32 tmp1, tmp2; |
433 | u8 __iomem *mmio = par->mmio_start_virtual; | |
434 | ||
435 | wait_for_engine_idle(info); | |
436 | i810fb_iring_enable(par, OFF); | |
437 | i810_writel(IRING, mmio, 0); | |
438 | i810_writel(IRING + 4, mmio, 0); | |
439 | par->cur_tail = 0; | |
440 | ||
441 | tmp2 = i810_readl(IRING + 8, mmio) & ~RBUFFER_START_MASK; | |
442 | tmp1 = par->iring.physical; | |
443 | i810_writel(IRING + 8, mmio, tmp2 | tmp1); | |
444 | ||
445 | tmp1 = i810_readl(IRING + 12, mmio); | |
446 | tmp1 &= ~RBUFFER_SIZE_MASK; | |
447 | tmp2 = (par->iring.size - I810_PAGESIZE) & RBUFFER_SIZE_MASK; | |
448 | i810_writel(IRING + 12, mmio, tmp1 | tmp2); | |
449 | i810fb_iring_enable(par, ON); | |
450 | } |