SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/video/matrox/matroxfb_accel.c

   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
  73  *  were used when writting this driver)
  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
  84 #define curr_ydstorg(x) ACCESS_FBINFO2(x, curr.ydstorg.pixels)
  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         }
  94         pal[i] = 0xFFFFFFFF;
  95 }
  96
  97 static inline void matrox_cfb8_pal(u_int32_t* pal) {
  98         unsigned int i;
  99
 100         for (i = 0; i < 16; i++) {
 101                 pal[i] = i * 0x01010101U;
 102         }
 103         pal[i] = 0x0F0F0F0F;
 104 }
 105
 106 static void matroxfb_copyarea(struct fb_info* info, const struct fb_copyarea* area);
 107 static void matroxfb_fillrect(struct fb_info* info, const struct fb_fillrect* rect);
 108 static void matroxfb_imageblit(struct fb_info* info, const struct fb_image* image);
 109 static void matroxfb_cfb4_fillrect(struct fb_info* info, const struct fb_fillrect* rect);
 110 static void matroxfb_cfb4_copyarea(struct fb_info* info, const struct fb_copyarea* area);
 111
 112 void matrox_cfbX_init(WPMINFO2) {
 113         u_int32_t maccess;
 114         u_int32_t mpitch;
 115         u_int32_t mopmode;
 116         int accel;
 117
 118         DBG(__FUNCTION__)
 119
 120         mpitch = ACCESS_FBINFO(fbcon).var.xres_virtual;
 121
 122         ACCESS_FBINFO(fbops).fb_copyarea = cfb_copyarea;
 123         ACCESS_FBINFO(fbops).fb_fillrect = cfb_fillrect;
 124         ACCESS_FBINFO(fbops).fb_imageblit = cfb_imageblit;
 125         ACCESS_FBINFO(fbops).fb_cursor = soft_cursor;
 126
 127         accel = (ACCESS_FBINFO(fbcon).var.accel_flags & FB_ACCELF_TEXT) == FB_ACCELF_TEXT;
 128
 129         switch (ACCESS_FBINFO(fbcon).var.bits_per_pixel) {
 130                 case 4:         maccess = 0x00000000;   /* accelerate as 8bpp video */
 131                                 mpitch = (mpitch >> 1) | 0x8000; /* disable linearization */
 132                                 mopmode = M_OPMODE_4BPP;
 133                                 matrox_cfb4_pal(ACCESS_FBINFO(cmap));
 134                                 if (accel && !(mpitch & 1)) {
 135                                         ACCESS_FBINFO(fbops).fb_copyarea = matroxfb_cfb4_copyarea;
 136                                         ACCESS_FBINFO(fbops).fb_fillrect = matroxfb_cfb4_fillrect;
 137                                 }
 138                                 break;
 139                 case 8:         maccess = 0x00000000;
 140                                 mopmode = M_OPMODE_8BPP;
 141                                 matrox_cfb8_pal(ACCESS_FBINFO(cmap));
 142                                 if (accel) {
 143                                         ACCESS_FBINFO(fbops).fb_copyarea = matroxfb_copyarea;
 144                                         ACCESS_FBINFO(fbops).fb_fillrect = matroxfb_fillrect;
 145                                         ACCESS_FBINFO(fbops).fb_imageblit = matroxfb_imageblit;
 146                                 }
 147                                 break;
 148                 case 16:        if (ACCESS_FBINFO(fbcon).var.green.length == 5) {
 149                                         maccess = 0xC0000001;
 150                                         ACCESS_FBINFO(cmap[16]) = 0x7FFF7FFF;
 151                                 } else {
 152                                         maccess = 0x40000001;
 153                                         ACCESS_FBINFO(cmap[16]) = 0xFFFFFFFF;
 154                                 }
 155                                 mopmode = M_OPMODE_16BPP;
 156                                 if (accel) {
 157                                         ACCESS_FBINFO(fbops).fb_copyarea = matroxfb_copyarea;
 158                                         ACCESS_FBINFO(fbops).fb_fillrect = matroxfb_fillrect;
 159                                         ACCESS_FBINFO(fbops).fb_imageblit = matroxfb_imageblit;
 160                                 }
 161                                 break;
 162                 case 24:        maccess = 0x00000003;
 163                                 mopmode = M_OPMODE_24BPP;
 164                                 ACCESS_FBINFO(cmap[16]) = 0xFFFFFFFF;
 165                                 if (accel) {
 166                                         ACCESS_FBINFO(fbops).fb_copyarea = matroxfb_copyarea;
 167                                         ACCESS_FBINFO(fbops).fb_fillrect = matroxfb_fillrect;
 168                                         ACCESS_FBINFO(fbops).fb_imageblit = matroxfb_imageblit;
 169                                 }
 170                                 break;
 171                 case 32:        maccess = 0x00000002;
 172                                 mopmode = M_OPMODE_32BPP;
 173                                 ACCESS_FBINFO(cmap[16]) = 0xFFFFFFFF;
 174                                 if (accel) {
 175                                         ACCESS_FBINFO(fbops).fb_copyarea = matroxfb_copyarea;
 176                                         ACCESS_FBINFO(fbops).fb_fillrect = matroxfb_fillrect;
 177                                         ACCESS_FBINFO(fbops).fb_imageblit = matroxfb_imageblit;
 178                                 }
 179                                 break;
 180                 default:        maccess = 0x00000000;
 181                                 mopmode = 0x00000000;
 182                                 break;  /* turn off acceleration!!! */
 183         }
 184         mga_fifo(8);
 185         mga_outl(M_PITCH, mpitch);
 186         mga_outl(M_YDSTORG, curr_ydstorg(MINFO));
 187         if (ACCESS_FBINFO(capable.plnwt))
 188                 mga_outl(M_PLNWT, -1);
 189         if (ACCESS_FBINFO(capable.srcorg)) {
 190                 mga_outl(M_SRCORG, 0);
 191                 mga_outl(M_DSTORG, 0);
 192         }
 193         mga_outl(M_OPMODE, mopmode);
 194         mga_outl(M_CXBNDRY, 0xFFFF0000);
 195         mga_outl(M_YTOP, 0);
 196         mga_outl(M_YBOT, 0x01FFFFFF);
 197         mga_outl(M_MACCESS, maccess);
 198         ACCESS_FBINFO(accel.m_dwg_rect) = M_DWG_TRAP | M_DWG_SOLID | M_DWG_ARZERO | M_DWG_SGNZERO | M_DWG_SHIFTZERO;
 199         if (isMilleniumII(MINFO)) ACCESS_FBINFO(accel.m_dwg_rect) |= M_DWG_TRANSC;
 200         ACCESS_FBINFO(accel.m_opmode) = mopmode;
 201 }
 202
 203 EXPORT_SYMBOL(matrox_cfbX_init);
 204
 205 static void matrox_accel_bmove(WPMINFO int vxres, int sy, int sx, int dy, int dx, int height, int width) {
 206         int start, end;
 207         CRITFLAGS
 208
 209         DBG(__FUNCTION__)
 210
 211         CRITBEGIN
 212
 213         if ((dy < sy) || ((dy == sy) && (dx <= sx))) {
 214                 mga_fifo(2);
 215                 mga_outl(M_DWGCTL, M_DWG_BITBLT | M_DWG_SHIFTZERO | M_DWG_SGNZERO |
 216                          M_DWG_BFCOL | M_DWG_REPLACE);
 217                 mga_outl(M_AR5, vxres);
 218                 width--;
 219                 start = sy*vxres+sx+curr_ydstorg(MINFO);
 220                 end = start+width;
 221         } else {
 222                 mga_fifo(3);
 223                 mga_outl(M_DWGCTL, M_DWG_BITBLT | M_DWG_SHIFTZERO | M_DWG_BFCOL | M_DWG_REPLACE);
 224                 mga_outl(M_SGN, 5);
 225                 mga_outl(M_AR5, -vxres);
 226                 width--;
 227                 end = (sy+height-1)*vxres+sx+curr_ydstorg(MINFO);
 228                 start = end+width;
 229                 dy += height-1;
 230         }
 231         mga_fifo(4);
 232         mga_outl(M_AR0, end);
 233         mga_outl(M_AR3, start);
 234         mga_outl(M_FXBNDRY, ((dx+width)<<16) | dx);
 235         mga_ydstlen(dy, height);
 236         WaitTillIdle();
 237
 238         CRITEND
 239 }
 240
 241 static void matrox_accel_bmove_lin(WPMINFO int vxres, int sy, int sx, int dy, int dx, int height, int width) {
 242         int start, end;
 243         CRITFLAGS
 244
 245         DBG(__FUNCTION__)
 246
 247         CRITBEGIN
 248
 249         if ((dy < sy) || ((dy == sy) && (dx <= sx))) {
 250                 mga_fifo(2);
 251                 mga_outl(M_DWGCTL, M_DWG_BITBLT | M_DWG_SHIFTZERO | M_DWG_SGNZERO |
 252                         M_DWG_BFCOL | M_DWG_REPLACE);
 253                 mga_outl(M_AR5, vxres);
 254                 width--;
 255                 start = sy*vxres+sx+curr_ydstorg(MINFO);
 256                 end = start+width;
 257         } else {
 258                 mga_fifo(3);
 259                 mga_outl(M_DWGCTL, M_DWG_BITBLT | M_DWG_SHIFTZERO | M_DWG_BFCOL | M_DWG_REPLACE);
 260                 mga_outl(M_SGN, 5);
 261                 mga_outl(M_AR5, -vxres);
 262                 width--;
 263                 end = (sy+height-1)*vxres+sx+curr_ydstorg(MINFO);
 264                 start = end+width;
 265                 dy += height-1;
 266         }
 267         mga_fifo(5);
 268         mga_outl(M_AR0, end);
 269         mga_outl(M_AR3, start);
 270         mga_outl(M_FXBNDRY, ((dx+width)<<16) | dx);
 271         mga_outl(M_YDST, dy*vxres >> 5);
 272         mga_outl(M_LEN | M_EXEC, height);
 273         WaitTillIdle();
 274
 275         CRITEND
 276 }
 277
 278 static void matroxfb_cfb4_copyarea(struct fb_info* info, const struct fb_copyarea* area) {
 279         MINFO_FROM_INFO(info);
 280
 281         if ((area->sx | area->dx | area->width) & 1)
 282                 cfb_copyarea(info, area);
 283         else
 284                 matrox_accel_bmove_lin(PMINFO ACCESS_FBINFO(fbcon.var.xres_virtual) >> 1, area->sy, area->sx >> 1, area->dy, area->dx >> 1, area->height, area->width >> 1);
 285 }
 286
 287 static void matroxfb_copyarea(struct fb_info* info, const struct fb_copyarea* area) {
 288         MINFO_FROM_INFO(info);
 289
 290         matrox_accel_bmove(PMINFO ACCESS_FBINFO(fbcon.var.xres_virtual), area->sy, area->sx, area->dy, area->dx, area->height, area->width);
 291 }
 292
 293 static void matroxfb_accel_clear(WPMINFO u_int32_t color, int sy, int sx, int height,
 294                 int width) {
 295         CRITFLAGS
 296
 297         DBG(__FUNCTION__)
 298
 299         CRITBEGIN
 300
 301         mga_fifo(5);
 302         mga_outl(M_DWGCTL, ACCESS_FBINFO(accel.m_dwg_rect) | M_DWG_REPLACE);
 303         mga_outl(M_FCOL, color);
 304         mga_outl(M_FXBNDRY, ((sx + width) << 16) | sx);
 305         mga_ydstlen(sy, height);
 306         WaitTillIdle();
 307
 308         CRITEND
 309 }
 310
 311 static void matroxfb_fillrect(struct fb_info* info, const struct fb_fillrect* rect) {
 312         MINFO_FROM_INFO(info);
 313
 314         switch (rect->rop) {
 315                 case ROP_COPY:
 316                         matroxfb_accel_clear(PMINFO ((u_int32_t*)info->pseudo_palette)[rect->color], rect->dy, rect->dx, rect->height, rect->width);
 317                         break;
 318         }
 319 }
 320
 321 static void matroxfb_cfb4_clear(WPMINFO u_int32_t bgx, int sy, int sx, int height, int width) {
 322         int whattodo;
 323         CRITFLAGS
 324
 325         DBG(__FUNCTION__)
 326
 327         CRITBEGIN
 328
 329         whattodo = 0;
 330         if (sx & 1) {
 331                 sx ++;
 332                 if (!width) return;
 333                 width --;
 334                 whattodo = 1;
 335         }
 336         if (width & 1) {
 337                 whattodo |= 2;
 338         }
 339         width >>= 1;
 340         sx >>= 1;
 341         if (width) {
 342                 mga_fifo(5);
 343                 mga_outl(M_DWGCTL, ACCESS_FBINFO(accel.m_dwg_rect) | M_DWG_REPLACE2);
 344                 mga_outl(M_FCOL, bgx);
 345                 mga_outl(M_FXBNDRY, ((sx + width) << 16) | sx);
 346                 mga_outl(M_YDST, sy * ACCESS_FBINFO(fbcon).var.xres_virtual >> 6);
 347                 mga_outl(M_LEN | M_EXEC, height);
 348                 WaitTillIdle();
 349         }
 350         if (whattodo) {
 351                 u_int32_t step = ACCESS_FBINFO(fbcon).var.xres_virtual >> 1;
 352                 vaddr_t vbase = ACCESS_FBINFO(video.vbase);
 353                 if (whattodo & 1) {
 354                         unsigned int uaddr = sy * step + sx - 1;
 355                         u_int32_t loop;
 356                         u_int8_t bgx2 = bgx & 0xF0;
 357                         for (loop = height; loop > 0; loop --) {
 358                                 mga_writeb(vbase, uaddr, (mga_readb(vbase, uaddr) & 0x0F) | bgx2);
 359                                 uaddr += step;
 360                         }
 361                 }
 362                 if (whattodo & 2) {
 363                         unsigned int uaddr = sy * step + sx + width;
 364                         u_int32_t loop;
 365                         u_int8_t bgx2 = bgx & 0x0F;
 366                         for (loop = height; loop > 0; loop --) {
 367                                 mga_writeb(vbase, uaddr, (mga_readb(vbase, uaddr) & 0xF0) | bgx2);
 368                                 uaddr += step;
 369                         }
 370                 }
 371         }
 372
 373         CRITEND
 374 }
 375
 376 static void matroxfb_cfb4_fillrect(struct fb_info* info, const struct fb_fillrect* rect) {
 377         MINFO_FROM_INFO(info);
 378
 379         switch (rect->rop) {
 380                 case ROP_COPY:
 381                         matroxfb_cfb4_clear(PMINFO ((u_int32_t*)info->pseudo_palette)[rect->color], rect->dy, rect->dx, rect->height, rect->width);
 382                         break;
 383         }
 384 }
 385
 386 static void matroxfb_1bpp_imageblit(WPMINFO u_int32_t fgx, u_int32_t bgx,
 387                 const u_int8_t* chardata, int width, int height, int yy, int xx) {
 388         u_int32_t step;
 389         u_int32_t ydstlen;
 390         u_int32_t xlen;
 391         u_int32_t ar0;
 392         u_int32_t charcell;
 393         u_int32_t fxbndry;
 394         vaddr_t mmio;
 395         int easy;
 396         CRITFLAGS
 397
 398         DBG_HEAVY(__FUNCTION__);
 399
 400         step = (width + 7) >> 3;
 401         charcell = height * step;
 402         xlen = (charcell + 3) & ~3;
 403         ydstlen = (yy << 16) | height;
 404         if (width == step << 3) {
 405                 ar0 = height * width - 1;
 406                 easy = 1;
 407         } else {
 408                 ar0 = width - 1;
 409                 easy = 0;
 410         }
 411
 412         CRITBEGIN
 413
 414         mga_fifo(3);
 415         if (easy)
 416                 mga_outl(M_DWGCTL, M_DWG_ILOAD | M_DWG_SGNZERO | M_DWG_SHIFTZERO | M_DWG_BMONOWF | M_DWG_LINEAR | M_DWG_REPLACE);
 417         else
 418                 mga_outl(M_DWGCTL, M_DWG_ILOAD | M_DWG_SGNZERO | M_DWG_SHIFTZERO | M_DWG_BMONOWF | M_DWG_REPLACE);
 419         mga_outl(M_FCOL, fgx);
 420         mga_outl(M_BCOL, bgx);
 421         fxbndry = ((xx + width - 1) << 16) | xx;
 422         mmio = ACCESS_FBINFO(mmio.vbase);
 423
 424         mga_fifo(6);
 425         mga_writel(mmio, M_FXBNDRY, fxbndry);
 426         mga_writel(mmio, M_AR0, ar0);
 427         mga_writel(mmio, M_AR3, 0);
 428         if (easy) {
 429                 mga_writel(mmio, M_YDSTLEN | M_EXEC, ydstlen);
 430                 mga_memcpy_toio(mmio, chardata, xlen);
 431         } else {
 432                 mga_writel(mmio, M_AR5, 0);
 433                 mga_writel(mmio, M_YDSTLEN | M_EXEC, ydstlen);
 434                 if ((step & 3) == 0) {
 435                         /* Great. Source has 32bit aligned lines, so we can feed them
 436                            directly to the accelerator. */
 437                         mga_memcpy_toio(mmio, chardata, charcell);
 438                 } else if (step == 1) {
 439                         /* Special case for 1..8bit widths */
 440                         while (height--) {
 441 #if defined(__BIG_ENDIAN)
 442                                 fb_writel((*chardata) << 24, mmio.vaddr);
 443 #else
 444                                 fb_writel(*chardata, mmio.vaddr);
 445 #endif
 446                                 chardata++;
 447                         }
 448                 } else if (step == 2) {
 449                         /* Special case for 9..15bit widths */
 450                         while (height--) {
 451 #if defined(__BIG_ENDIAN)
 452                                 fb_writel((*(u_int16_t*)chardata) << 16, mmio.vaddr);
 453 #else
 454                                 fb_writel(*(u_int16_t*)chardata, mmio.vaddr);
 455 #endif
 456                                 chardata += 2;
 457                         }
 458                 } else {
 459                         /* Tell... well, why bother... */
 460                         while (height--) {
 461                                 size_t i;
 462
 463                                 for (i = 0; i < step; i += 4) {
 464                                         /* Hope that there are at least three readable bytes beyond the end of bitmap */
 465                                         fb_writel(get_unaligned((u_int32_t*)(chardata + i)),mmio.vaddr);
 466                                 }
 467                                 chardata += step;
 468                         }
 469                 }
 470         }
 471         WaitTillIdle();
 472         CRITEND
 473 }
 474
 475
 476 static void matroxfb_imageblit(struct fb_info* info, const struct fb_image* image) {
 477         MINFO_FROM_INFO(info);
 478
 479         DBG_HEAVY(__FUNCTION__);
 480
 481         if (image->depth == 1) {
 482                 u_int32_t fgx, bgx;
 483
 484                 fgx = ((u_int32_t*)info->pseudo_palette)[image->fg_color];
 485                 bgx = ((u_int32_t*)info->pseudo_palette)[image->bg_color];
 486                 matroxfb_1bpp_imageblit(PMINFO fgx, bgx, image->data, image->width, image->height, image->dy, image->dx);
 487         } else {
 488                 /* Danger! image->depth is useless: logo painting code always
 489                    passes framebuffer color depth here, although logo data are
 490                    always 8bpp and info->pseudo_palette is changed to contain
 491                    logo palette to be used (but only for true/direct-color... sic...).
 492                    So do it completely in software... */
 493                 cfb_imageblit(info, image);
 494         }
 495 }
 496
 497 MODULE_LICENSE("GPL");