Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * | |
3 | * Hardware accelerated Matrox Millennium I, II, Mystique, G100, G200 and G400 | |
4 | * | |
5 | * (c) 1998-2002 Petr Vandrovec <vandrove@vc.cvut.cz> | |
6 | * | |
7 | * Version: 1.65 2002/08/14 | |
8 | * | |
9 | * MTRR stuff: 1998 Tom Rini <trini@kernel.crashing.org> | |
10 | * | |
11 | * Contributors: "menion?" <menion@mindless.com> | |
12 | * Betatesting, fixes, ideas | |
13 | * | |
14 | * "Kurt Garloff" <garloff@suse.de> | |
15 | * Betatesting, fixes, ideas, videomodes, videomodes timmings | |
16 | * | |
17 | * "Tom Rini" <trini@kernel.crashing.org> | |
18 | * MTRR stuff, PPC cleanups, betatesting, fixes, ideas | |
19 | * | |
20 | * "Bibek Sahu" <scorpio@dodds.net> | |
21 | * Access device through readb|w|l and write b|w|l | |
22 | * Extensive debugging stuff | |
23 | * | |
24 | * "Daniel Haun" <haund@usa.net> | |
25 | * Testing, hardware cursor fixes | |
26 | * | |
27 | * "Scott Wood" <sawst46+@pitt.edu> | |
28 | * Fixes | |
29 | * | |
30 | * "Gerd Knorr" <kraxel@goldbach.isdn.cs.tu-berlin.de> | |
31 | * Betatesting | |
32 | * | |
33 | * "Kelly French" <targon@hazmat.com> | |
34 | * "Fernando Herrera" <fherrera@eurielec.etsit.upm.es> | |
35 | * Betatesting, bug reporting | |
36 | * | |
37 | * "Pablo Bianucci" <pbian@pccp.com.ar> | |
38 | * Fixes, ideas, betatesting | |
39 | * | |
40 | * "Inaky Perez Gonzalez" <inaky@peloncho.fis.ucm.es> | |
41 | * Fixes, enhandcements, ideas, betatesting | |
42 | * | |
43 | * "Ryuichi Oikawa" <roikawa@rr.iiij4u.or.jp> | |
44 | * PPC betatesting, PPC support, backward compatibility | |
45 | * | |
46 | * "Paul Womar" <Paul@pwomar.demon.co.uk> | |
47 | * "Owen Waller" <O.Waller@ee.qub.ac.uk> | |
48 | * PPC betatesting | |
49 | * | |
50 | * "Thomas Pornin" <pornin@bolet.ens.fr> | |
51 | * Alpha betatesting | |
52 | * | |
53 | * "Pieter van Leuven" <pvl@iae.nl> | |
54 | * "Ulf Jaenicke-Roessler" <ujr@physik.phy.tu-dresden.de> | |
55 | * G100 testing | |
56 | * | |
57 | * "H. Peter Arvin" <hpa@transmeta.com> | |
58 | * Ideas | |
59 | * | |
60 | * "Cort Dougan" <cort@cs.nmt.edu> | |
61 | * CHRP fixes and PReP cleanup | |
62 | * | |
63 | * "Mark Vojkovich" <mvojkovi@ucsd.edu> | |
64 | * G400 support | |
65 | * | |
66 | * (following author is not in any relation with this code, but his code | |
67 | * is included in this driver) | |
68 | * | |
69 | * Based on framebuffer driver for VBE 2.0 compliant graphic boards | |
70 | * (c) 1998 Gerd Knorr <kraxel@cs.tu-berlin.de> | |
71 | * | |
72 | * (following author is not in any relation with this code, but his ideas | |
beb7dd86 | 73 | * were used when writing this driver) |
1da177e4 LT |
74 | * |
75 | * FreeVBE/AF (Matrox), "Shawn Hargreaves" <shawn@talula.demon.co.uk> | |
76 | * | |
77 | */ | |
78 | ||
79 | #include "matroxfb_accel.h" | |
80 | #include "matroxfb_DAC1064.h" | |
81 | #include "matroxfb_Ti3026.h" | |
82 | #include "matroxfb_misc.h" | |
83 | ||
fc2d10dd | 84 | #define curr_ydstorg(x) ((x)->curr.ydstorg.pixels) |
1da177e4 LT |
85 | |
86 | #define mga_ydstlen(y,l) mga_outl(M_YDSTLEN | M_EXEC, ((y) << 16) | (l)) | |
87 | ||
88 | static inline void matrox_cfb4_pal(u_int32_t* pal) { | |
89 | unsigned int i; | |
90 | ||
91 | for (i = 0; i < 16; i++) { | |
92 | pal[i] = i * 0x11111111U; | |
93 | } | |
1da177e4 LT |
94 | } |
95 | ||
96 | static inline void matrox_cfb8_pal(u_int32_t* pal) { | |
97 | unsigned int i; | |
98 | ||
99 | for (i = 0; i < 16; i++) { | |
100 | pal[i] = i * 0x01010101U; | |
101 | } | |
1da177e4 LT |
102 | } |
103 | ||
104 | static void matroxfb_copyarea(struct fb_info* info, const struct fb_copyarea* area); | |
105 | static void matroxfb_fillrect(struct fb_info* info, const struct fb_fillrect* rect); | |
106 | static void matroxfb_imageblit(struct fb_info* info, const struct fb_image* image); | |
107 | static void matroxfb_cfb4_fillrect(struct fb_info* info, const struct fb_fillrect* rect); | |
108 | static void matroxfb_cfb4_copyarea(struct fb_info* info, const struct fb_copyarea* area); | |
109 | ||
316b4d64 JD |
110 | void matrox_cfbX_init(struct matrox_fb_info *minfo) |
111 | { | |
1da177e4 LT |
112 | u_int32_t maccess; |
113 | u_int32_t mpitch; | |
114 | u_int32_t mopmode; | |
115 | int accel; | |
116 | ||
5ae12170 | 117 | DBG(__func__) |
1da177e4 | 118 | |
fc2d10dd | 119 | mpitch = minfo->fbcon.var.xres_virtual; |
1da177e4 | 120 | |
fc2d10dd JD |
121 | minfo->fbops.fb_copyarea = cfb_copyarea; |
122 | minfo->fbops.fb_fillrect = cfb_fillrect; | |
123 | minfo->fbops.fb_imageblit = cfb_imageblit; | |
124 | minfo->fbops.fb_cursor = NULL; | |
1da177e4 | 125 | |
fc2d10dd | 126 | accel = (minfo->fbcon.var.accel_flags & FB_ACCELF_TEXT) == FB_ACCELF_TEXT; |
1da177e4 | 127 | |
fc2d10dd | 128 | switch (minfo->fbcon.var.bits_per_pixel) { |
1da177e4 LT |
129 | case 4: maccess = 0x00000000; /* accelerate as 8bpp video */ |
130 | mpitch = (mpitch >> 1) | 0x8000; /* disable linearization */ | |
131 | mopmode = M_OPMODE_4BPP; | |
fc2d10dd | 132 | matrox_cfb4_pal(minfo->cmap); |
1da177e4 | 133 | if (accel && !(mpitch & 1)) { |
fc2d10dd JD |
134 | minfo->fbops.fb_copyarea = matroxfb_cfb4_copyarea; |
135 | minfo->fbops.fb_fillrect = matroxfb_cfb4_fillrect; | |
1da177e4 LT |
136 | } |
137 | break; | |
138 | case 8: maccess = 0x00000000; | |
139 | mopmode = M_OPMODE_8BPP; | |
fc2d10dd | 140 | matrox_cfb8_pal(minfo->cmap); |
1da177e4 | 141 | if (accel) { |
fc2d10dd JD |
142 | minfo->fbops.fb_copyarea = matroxfb_copyarea; |
143 | minfo->fbops.fb_fillrect = matroxfb_fillrect; | |
144 | minfo->fbops.fb_imageblit = matroxfb_imageblit; | |
1da177e4 LT |
145 | } |
146 | break; | |
fc2d10dd | 147 | case 16: if (minfo->fbcon.var.green.length == 5) |
1da177e4 | 148 | maccess = 0xC0000001; |
08a498de | 149 | else |
1da177e4 | 150 | maccess = 0x40000001; |
1da177e4 LT |
151 | mopmode = M_OPMODE_16BPP; |
152 | if (accel) { | |
fc2d10dd JD |
153 | minfo->fbops.fb_copyarea = matroxfb_copyarea; |
154 | minfo->fbops.fb_fillrect = matroxfb_fillrect; | |
155 | minfo->fbops.fb_imageblit = matroxfb_imageblit; | |
1da177e4 LT |
156 | } |
157 | break; | |
158 | case 24: maccess = 0x00000003; | |
159 | mopmode = M_OPMODE_24BPP; | |
1da177e4 | 160 | if (accel) { |
fc2d10dd JD |
161 | minfo->fbops.fb_copyarea = matroxfb_copyarea; |
162 | minfo->fbops.fb_fillrect = matroxfb_fillrect; | |
163 | minfo->fbops.fb_imageblit = matroxfb_imageblit; | |
1da177e4 LT |
164 | } |
165 | break; | |
166 | case 32: maccess = 0x00000002; | |
167 | mopmode = M_OPMODE_32BPP; | |
1da177e4 | 168 | if (accel) { |
fc2d10dd JD |
169 | minfo->fbops.fb_copyarea = matroxfb_copyarea; |
170 | minfo->fbops.fb_fillrect = matroxfb_fillrect; | |
171 | minfo->fbops.fb_imageblit = matroxfb_imageblit; | |
1da177e4 LT |
172 | } |
173 | break; | |
174 | default: maccess = 0x00000000; | |
175 | mopmode = 0x00000000; | |
176 | break; /* turn off acceleration!!! */ | |
177 | } | |
178 | mga_fifo(8); | |
179 | mga_outl(M_PITCH, mpitch); | |
fc2d10dd JD |
180 | mga_outl(M_YDSTORG, curr_ydstorg(minfo)); |
181 | if (minfo->capable.plnwt) | |
1da177e4 | 182 | mga_outl(M_PLNWT, -1); |
fc2d10dd | 183 | if (minfo->capable.srcorg) { |
1da177e4 LT |
184 | mga_outl(M_SRCORG, 0); |
185 | mga_outl(M_DSTORG, 0); | |
186 | } | |
187 | mga_outl(M_OPMODE, mopmode); | |
188 | mga_outl(M_CXBNDRY, 0xFFFF0000); | |
189 | mga_outl(M_YTOP, 0); | |
190 | mga_outl(M_YBOT, 0x01FFFFFF); | |
191 | mga_outl(M_MACCESS, maccess); | |
fc2d10dd JD |
192 | minfo->accel.m_dwg_rect = M_DWG_TRAP | M_DWG_SOLID | M_DWG_ARZERO | M_DWG_SGNZERO | M_DWG_SHIFTZERO; |
193 | if (isMilleniumII(minfo)) minfo->accel.m_dwg_rect |= M_DWG_TRANSC; | |
194 | minfo->accel.m_opmode = mopmode; | |
a772d473 MP |
195 | minfo->accel.m_access = maccess; |
196 | minfo->accel.m_pitch = mpitch; | |
1da177e4 LT |
197 | } |
198 | ||
199 | EXPORT_SYMBOL(matrox_cfbX_init); | |
200 | ||
a772d473 MP |
201 | static void matrox_accel_restore_maccess(struct matrox_fb_info *minfo) |
202 | { | |
203 | mga_outl(M_MACCESS, minfo->accel.m_access); | |
204 | mga_outl(M_PITCH, minfo->accel.m_pitch); | |
205 | } | |
206 | ||
316b4d64 JD |
207 | static void matrox_accel_bmove(struct matrox_fb_info *minfo, int vxres, int sy, |
208 | int sx, int dy, int dx, int height, int width) | |
209 | { | |
1da177e4 LT |
210 | int start, end; |
211 | CRITFLAGS | |
212 | ||
5ae12170 | 213 | DBG(__func__) |
1da177e4 LT |
214 | |
215 | CRITBEGIN | |
216 | ||
217 | if ((dy < sy) || ((dy == sy) && (dx <= sx))) { | |
a772d473 MP |
218 | mga_fifo(4); |
219 | matrox_accel_restore_maccess(minfo); | |
1da177e4 LT |
220 | mga_outl(M_DWGCTL, M_DWG_BITBLT | M_DWG_SHIFTZERO | M_DWG_SGNZERO | |
221 | M_DWG_BFCOL | M_DWG_REPLACE); | |
222 | mga_outl(M_AR5, vxres); | |
223 | width--; | |
fc2d10dd | 224 | start = sy*vxres+sx+curr_ydstorg(minfo); |
1da177e4 LT |
225 | end = start+width; |
226 | } else { | |
a772d473 MP |
227 | mga_fifo(5); |
228 | matrox_accel_restore_maccess(minfo); | |
1da177e4 LT |
229 | mga_outl(M_DWGCTL, M_DWG_BITBLT | M_DWG_SHIFTZERO | M_DWG_BFCOL | M_DWG_REPLACE); |
230 | mga_outl(M_SGN, 5); | |
231 | mga_outl(M_AR5, -vxres); | |
232 | width--; | |
fc2d10dd | 233 | end = (sy+height-1)*vxres+sx+curr_ydstorg(minfo); |
1da177e4 LT |
234 | start = end+width; |
235 | dy += height-1; | |
236 | } | |
a772d473 MP |
237 | mga_fifo(6); |
238 | matrox_accel_restore_maccess(minfo); | |
1da177e4 LT |
239 | mga_outl(M_AR0, end); |
240 | mga_outl(M_AR3, start); | |
241 | mga_outl(M_FXBNDRY, ((dx+width)<<16) | dx); | |
242 | mga_ydstlen(dy, height); | |
243 | WaitTillIdle(); | |
244 | ||
245 | CRITEND | |
246 | } | |
247 | ||
316b4d64 JD |
248 | static void matrox_accel_bmove_lin(struct matrox_fb_info *minfo, int vxres, |
249 | int sy, int sx, int dy, int dx, int height, | |
250 | int width) | |
251 | { | |
1da177e4 LT |
252 | int start, end; |
253 | CRITFLAGS | |
254 | ||
5ae12170 | 255 | DBG(__func__) |
1da177e4 LT |
256 | |
257 | CRITBEGIN | |
258 | ||
259 | if ((dy < sy) || ((dy == sy) && (dx <= sx))) { | |
a772d473 MP |
260 | mga_fifo(4); |
261 | matrox_accel_restore_maccess(minfo); | |
1da177e4 LT |
262 | mga_outl(M_DWGCTL, M_DWG_BITBLT | M_DWG_SHIFTZERO | M_DWG_SGNZERO | |
263 | M_DWG_BFCOL | M_DWG_REPLACE); | |
264 | mga_outl(M_AR5, vxres); | |
265 | width--; | |
fc2d10dd | 266 | start = sy*vxres+sx+curr_ydstorg(minfo); |
1da177e4 LT |
267 | end = start+width; |
268 | } else { | |
a772d473 MP |
269 | mga_fifo(5); |
270 | matrox_accel_restore_maccess(minfo); | |
1da177e4 LT |
271 | mga_outl(M_DWGCTL, M_DWG_BITBLT | M_DWG_SHIFTZERO | M_DWG_BFCOL | M_DWG_REPLACE); |
272 | mga_outl(M_SGN, 5); | |
273 | mga_outl(M_AR5, -vxres); | |
274 | width--; | |
fc2d10dd | 275 | end = (sy+height-1)*vxres+sx+curr_ydstorg(minfo); |
1da177e4 LT |
276 | start = end+width; |
277 | dy += height-1; | |
278 | } | |
a772d473 MP |
279 | mga_fifo(7); |
280 | matrox_accel_restore_maccess(minfo); | |
1da177e4 LT |
281 | mga_outl(M_AR0, end); |
282 | mga_outl(M_AR3, start); | |
283 | mga_outl(M_FXBNDRY, ((dx+width)<<16) | dx); | |
284 | mga_outl(M_YDST, dy*vxres >> 5); | |
285 | mga_outl(M_LEN | M_EXEC, height); | |
286 | WaitTillIdle(); | |
287 | ||
288 | CRITEND | |
289 | } | |
290 | ||
291 | static void matroxfb_cfb4_copyarea(struct fb_info* info, const struct fb_copyarea* area) { | |
ee5a2749 | 292 | struct matrox_fb_info *minfo = info2minfo(info); |
1da177e4 LT |
293 | |
294 | if ((area->sx | area->dx | area->width) & 1) | |
295 | cfb_copyarea(info, area); | |
296 | else | |
316b4d64 | 297 | matrox_accel_bmove_lin(minfo, minfo->fbcon.var.xres_virtual >> 1, area->sy, area->sx >> 1, area->dy, area->dx >> 1, area->height, area->width >> 1); |
1da177e4 LT |
298 | } |
299 | ||
300 | static void matroxfb_copyarea(struct fb_info* info, const struct fb_copyarea* area) { | |
ee5a2749 | 301 | struct matrox_fb_info *minfo = info2minfo(info); |
1da177e4 | 302 | |
316b4d64 | 303 | matrox_accel_bmove(minfo, minfo->fbcon.var.xres_virtual, area->sy, area->sx, area->dy, area->dx, area->height, area->width); |
1da177e4 LT |
304 | } |
305 | ||
316b4d64 JD |
306 | static void matroxfb_accel_clear(struct matrox_fb_info *minfo, u_int32_t color, |
307 | int sy, int sx, int height, int width) | |
308 | { | |
1da177e4 LT |
309 | CRITFLAGS |
310 | ||
5ae12170 | 311 | DBG(__func__) |
1da177e4 LT |
312 | |
313 | CRITBEGIN | |
314 | ||
a772d473 MP |
315 | mga_fifo(7); |
316 | matrox_accel_restore_maccess(minfo); | |
fc2d10dd | 317 | mga_outl(M_DWGCTL, minfo->accel.m_dwg_rect | M_DWG_REPLACE); |
1da177e4 LT |
318 | mga_outl(M_FCOL, color); |
319 | mga_outl(M_FXBNDRY, ((sx + width) << 16) | sx); | |
320 | mga_ydstlen(sy, height); | |
321 | WaitTillIdle(); | |
322 | ||
323 | CRITEND | |
324 | } | |
325 | ||
326 | static void matroxfb_fillrect(struct fb_info* info, const struct fb_fillrect* rect) { | |
ee5a2749 | 327 | struct matrox_fb_info *minfo = info2minfo(info); |
1da177e4 LT |
328 | |
329 | switch (rect->rop) { | |
330 | case ROP_COPY: | |
316b4d64 | 331 | matroxfb_accel_clear(minfo, ((u_int32_t *)info->pseudo_palette)[rect->color], rect->dy, rect->dx, rect->height, rect->width); |
1da177e4 LT |
332 | break; |
333 | } | |
334 | } | |
335 | ||
316b4d64 JD |
336 | static void matroxfb_cfb4_clear(struct matrox_fb_info *minfo, u_int32_t bgx, |
337 | int sy, int sx, int height, int width) | |
338 | { | |
1da177e4 LT |
339 | int whattodo; |
340 | CRITFLAGS | |
341 | ||
5ae12170 | 342 | DBG(__func__) |
1da177e4 LT |
343 | |
344 | CRITBEGIN | |
345 | ||
346 | whattodo = 0; | |
347 | if (sx & 1) { | |
348 | sx ++; | |
349 | if (!width) return; | |
350 | width --; | |
351 | whattodo = 1; | |
352 | } | |
353 | if (width & 1) { | |
354 | whattodo |= 2; | |
355 | } | |
356 | width >>= 1; | |
357 | sx >>= 1; | |
358 | if (width) { | |
a772d473 MP |
359 | mga_fifo(7); |
360 | matrox_accel_restore_maccess(minfo); | |
fc2d10dd | 361 | mga_outl(M_DWGCTL, minfo->accel.m_dwg_rect | M_DWG_REPLACE2); |
1da177e4 LT |
362 | mga_outl(M_FCOL, bgx); |
363 | mga_outl(M_FXBNDRY, ((sx + width) << 16) | sx); | |
fc2d10dd | 364 | mga_outl(M_YDST, sy * minfo->fbcon.var.xres_virtual >> 6); |
1da177e4 LT |
365 | mga_outl(M_LEN | M_EXEC, height); |
366 | WaitTillIdle(); | |
367 | } | |
368 | if (whattodo) { | |
fc2d10dd JD |
369 | u_int32_t step = minfo->fbcon.var.xres_virtual >> 1; |
370 | vaddr_t vbase = minfo->video.vbase; | |
1da177e4 LT |
371 | if (whattodo & 1) { |
372 | unsigned int uaddr = sy * step + sx - 1; | |
373 | u_int32_t loop; | |
374 | u_int8_t bgx2 = bgx & 0xF0; | |
375 | for (loop = height; loop > 0; loop --) { | |
376 | mga_writeb(vbase, uaddr, (mga_readb(vbase, uaddr) & 0x0F) | bgx2); | |
377 | uaddr += step; | |
378 | } | |
379 | } | |
380 | if (whattodo & 2) { | |
381 | unsigned int uaddr = sy * step + sx + width; | |
382 | u_int32_t loop; | |
383 | u_int8_t bgx2 = bgx & 0x0F; | |
384 | for (loop = height; loop > 0; loop --) { | |
385 | mga_writeb(vbase, uaddr, (mga_readb(vbase, uaddr) & 0xF0) | bgx2); | |
386 | uaddr += step; | |
387 | } | |
388 | } | |
389 | } | |
390 | ||
391 | CRITEND | |
392 | } | |
393 | ||
394 | static void matroxfb_cfb4_fillrect(struct fb_info* info, const struct fb_fillrect* rect) { | |
ee5a2749 | 395 | struct matrox_fb_info *minfo = info2minfo(info); |
1da177e4 LT |
396 | |
397 | switch (rect->rop) { | |
398 | case ROP_COPY: | |
316b4d64 | 399 | matroxfb_cfb4_clear(minfo, ((u_int32_t *)info->pseudo_palette)[rect->color], rect->dy, rect->dx, rect->height, rect->width); |
1da177e4 LT |
400 | break; |
401 | } | |
402 | } | |
403 | ||
316b4d64 JD |
404 | static void matroxfb_1bpp_imageblit(struct matrox_fb_info *minfo, u_int32_t fgx, |
405 | u_int32_t bgx, const u_int8_t *chardata, | |
406 | int width, int height, int yy, int xx) | |
407 | { | |
1da177e4 LT |
408 | u_int32_t step; |
409 | u_int32_t ydstlen; | |
410 | u_int32_t xlen; | |
411 | u_int32_t ar0; | |
412 | u_int32_t charcell; | |
413 | u_int32_t fxbndry; | |
414 | vaddr_t mmio; | |
415 | int easy; | |
416 | CRITFLAGS | |
417 | ||
5ae12170 | 418 | DBG_HEAVY(__func__); |
1da177e4 LT |
419 | |
420 | step = (width + 7) >> 3; | |
421 | charcell = height * step; | |
422 | xlen = (charcell + 3) & ~3; | |
423 | ydstlen = (yy << 16) | height; | |
424 | if (width == step << 3) { | |
425 | ar0 = height * width - 1; | |
426 | easy = 1; | |
427 | } else { | |
428 | ar0 = width - 1; | |
429 | easy = 0; | |
430 | } | |
431 | ||
432 | CRITBEGIN | |
433 | ||
a772d473 MP |
434 | mga_fifo(5); |
435 | matrox_accel_restore_maccess(minfo); | |
1da177e4 LT |
436 | if (easy) |
437 | mga_outl(M_DWGCTL, M_DWG_ILOAD | M_DWG_SGNZERO | M_DWG_SHIFTZERO | M_DWG_BMONOWF | M_DWG_LINEAR | M_DWG_REPLACE); | |
438 | else | |
439 | mga_outl(M_DWGCTL, M_DWG_ILOAD | M_DWG_SGNZERO | M_DWG_SHIFTZERO | M_DWG_BMONOWF | M_DWG_REPLACE); | |
440 | mga_outl(M_FCOL, fgx); | |
441 | mga_outl(M_BCOL, bgx); | |
442 | fxbndry = ((xx + width - 1) << 16) | xx; | |
fc2d10dd | 443 | mmio = minfo->mmio.vbase; |
1da177e4 | 444 | |
a772d473 MP |
445 | mga_fifo(8); |
446 | matrox_accel_restore_maccess(minfo); | |
1da177e4 LT |
447 | mga_writel(mmio, M_FXBNDRY, fxbndry); |
448 | mga_writel(mmio, M_AR0, ar0); | |
449 | mga_writel(mmio, M_AR3, 0); | |
450 | if (easy) { | |
451 | mga_writel(mmio, M_YDSTLEN | M_EXEC, ydstlen); | |
452 | mga_memcpy_toio(mmio, chardata, xlen); | |
453 | } else { | |
454 | mga_writel(mmio, M_AR5, 0); | |
455 | mga_writel(mmio, M_YDSTLEN | M_EXEC, ydstlen); | |
456 | if ((step & 3) == 0) { | |
457 | /* Great. Source has 32bit aligned lines, so we can feed them | |
458 | directly to the accelerator. */ | |
459 | mga_memcpy_toio(mmio, chardata, charcell); | |
460 | } else if (step == 1) { | |
461 | /* Special case for 1..8bit widths */ | |
462 | while (height--) { | |
463 | #if defined(__BIG_ENDIAN) | |
464 | fb_writel((*chardata) << 24, mmio.vaddr); | |
465 | #else | |
466 | fb_writel(*chardata, mmio.vaddr); | |
467 | #endif | |
468 | chardata++; | |
469 | } | |
470 | } else if (step == 2) { | |
471 | /* Special case for 9..15bit widths */ | |
472 | while (height--) { | |
473 | #if defined(__BIG_ENDIAN) | |
474 | fb_writel((*(u_int16_t*)chardata) << 16, mmio.vaddr); | |
475 | #else | |
476 | fb_writel(*(u_int16_t*)chardata, mmio.vaddr); | |
477 | #endif | |
478 | chardata += 2; | |
479 | } | |
480 | } else { | |
481 | /* Tell... well, why bother... */ | |
482 | while (height--) { | |
483 | size_t i; | |
484 | ||
485 | for (i = 0; i < step; i += 4) { | |
486 | /* Hope that there are at least three readable bytes beyond the end of bitmap */ | |
487 | fb_writel(get_unaligned((u_int32_t*)(chardata + i)),mmio.vaddr); | |
488 | } | |
489 | chardata += step; | |
490 | } | |
491 | } | |
492 | } | |
493 | WaitTillIdle(); | |
494 | CRITEND | |
495 | } | |
496 | ||
497 | ||
498 | static void matroxfb_imageblit(struct fb_info* info, const struct fb_image* image) { | |
ee5a2749 | 499 | struct matrox_fb_info *minfo = info2minfo(info); |
1da177e4 | 500 | |
5ae12170 | 501 | DBG_HEAVY(__func__); |
1da177e4 LT |
502 | |
503 | if (image->depth == 1) { | |
504 | u_int32_t fgx, bgx; | |
505 | ||
506 | fgx = ((u_int32_t*)info->pseudo_palette)[image->fg_color]; | |
507 | bgx = ((u_int32_t*)info->pseudo_palette)[image->bg_color]; | |
316b4d64 | 508 | matroxfb_1bpp_imageblit(minfo, fgx, bgx, image->data, image->width, image->height, image->dy, image->dx); |
1da177e4 LT |
509 | } else { |
510 | /* Danger! image->depth is useless: logo painting code always | |
511 | passes framebuffer color depth here, although logo data are | |
512 | always 8bpp and info->pseudo_palette is changed to contain | |
513 | logo palette to be used (but only for true/direct-color... sic...). | |
514 | So do it completely in software... */ | |
515 | cfb_imageblit(info, image); | |
516 | } | |
517 | } | |
518 | ||
519 | MODULE_LICENSE("GPL"); |