drivers/staging/sm750fb/sm750.c

   1 #include<linux/kernel.h>
   2 #include<linux/module.h>
   3 #include<linux/errno.h>
   4 #include<linux/string.h>
   5 #include<linux/mm.h>
   6 #include<linux/slab.h>
   7 #include<linux/delay.h>
   8 #include<linux/fb.h>
   9 #include<linux/ioport.h>
  10 #include<linux/init.h>
  11 #include<linux/pci.h>
  12 #include<linux/mm_types.h>
  13 #include<linux/vmalloc.h>
  14 #include<linux/pagemap.h>
  15 #include<linux/screen_info.h>
  16 #include<linux/vmalloc.h>
  17 #include<linux/pagemap.h>
  18 #include <linux/console.h>
  19 #include <asm/fb.h>
  20 #include "sm750.h"
  21 #include "sm750_hw.h"
  22 #include "sm750_accel.h"
  23 #include "sm750_cursor.h"
  24
  25 #include "modedb.h"
  26
  27 int smi_indent = 0;
  28
  29
  30 /*
  31  * #ifdef __BIG_ENDIAN
  32  * ssize_t lynxfb_ops_write(struct fb_info *info, const char __user *buf,
  33  * size_t count, loff_t *ppos);
  34  * ssize_t lynxfb_ops_read(struct fb_info *info, char __user *buf,
  35  * size_t count, loff_t *ppos);
  36  * #endif
  37  */
  38
  39 typedef void (*PROC_SPEC_SETUP)(struct lynx_share*, char *);
  40 typedef int (*PROC_SPEC_MAP)(struct lynx_share*, struct pci_dev*);
  41 typedef int (*PROC_SPEC_INITHW)(struct lynx_share*, struct pci_dev*);
  42
  43
  44 /* common var for all device */
  45 static int g_hwcursor = 1;
  46 static int g_noaccel;
  47 static int g_nomtrr;
  48 static const char *g_fbmode[] = {NULL, NULL};
  49 static const char *g_def_fbmode = "800x600-16@60";
  50 static char *g_settings = NULL;
  51 static int g_dualview;
  52 static char *g_option = NULL;
  53
  54
  55 static const struct fb_videomode lynx750_ext[] = {
  56         /*      1024x600-60 VESA        [1.71:1] */
  57         {NULL,  60, 1024, 600, 20423, 144,  40, 18, 1, 104, 3,
  58          FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  59          FB_VMODE_NONINTERLACED},
  60
  61         /*      1024x600-70 VESA */
  62         {NULL,  70, 1024, 600, 17211, 152,  48, 21, 1, 104, 3,
  63          FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  64          FB_VMODE_NONINTERLACED},
  65
  66         /*      1024x600-75 VESA */
  67         {NULL,  75, 1024, 600, 15822, 160,  56, 23, 1, 104, 3,
  68          FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  69          FB_VMODE_NONINTERLACED},
  70
  71         /*      1024x600-85 VESA */
  72         {NULL,  85, 1024, 600, 13730, 168,  56, 26, 1, 112, 3,
  73          FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  74          FB_VMODE_NONINTERLACED},
  75
  76         /*      720x480 */
  77         {NULL, 60,  720,  480,  37427, 88,   16, 13, 1,   72,  3,
  78          FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  79          FB_VMODE_NONINTERLACED},
  80
  81         /*      1280x720                [1.78:1]        */
  82         {NULL, 60,  1280,  720,  13426, 162, 86, 22, 1,  136, 3,
  83          FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  84          FB_VMODE_NONINTERLACED},
  85
  86         /*      1280x768@60 */
  87         {NULL, 60, 1280, 768, 12579, 192, 64, 20, 3, 128, 7,
  88          FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  89          FB_VMODE_NONINTERLACED},
  90
  91         {NULL, 60, 1360, 768, 11804, 208, 64, 23, 1, 144, 3,
  92          FB_SYNC_HOR_HIGH_ACT|FB_VMODE_NONINTERLACED},
  93
  94         /*      1360 x 768      [1.77083:1]     */
  95         {NULL,  60, 1360, 768, 11804, 208,  64, 23, 1, 144, 3,
  96          FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  97          FB_VMODE_NONINTERLACED},
  98
  99         /*      1368 x 768      [1.78:1]        */
 100         {NULL, 60,  1368,  768,  11647, 216, 72, 23, 1,  144, 3,
 101          FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 102          FB_VMODE_NONINTERLACED},
 103
 104         /*      1440 x 900              [16:10] */
 105         {NULL, 60, 1440, 900, 9392, 232, 80, 28, 1, 152, 3,
 106          FB_SYNC_VERT_HIGH_ACT,
 107          FB_VMODE_NONINTERLACED},
 108
 109         /*      1440x960                [15:10] */
 110         {NULL, 60, 1440, 960, 8733, 240, 88, 30, 1, 152, 3,
 111          FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
 112          FB_VMODE_NONINTERLACED},
 113
 114         /*      1920x1080       [16:9]  */
 115         {NULL, 60, 1920, 1080, 6734, 148, 88, 41, 1, 44, 3,
 116          FB_SYNC_VERT_HIGH_ACT,
 117          FB_VMODE_NONINTERLACED},
 118 };
 119
 120
 121
 122
 123 /* no hardware cursor supported under version 2.6.10, kernel bug */
 124 static int lynxfb_ops_cursor(struct fb_info *info, struct fb_cursor *fbcursor)
 125 {
 126         struct lynxfb_par *par;
 127         struct lynxfb_crtc *crtc;
 128         struct lynx_cursor *cursor;
 129
 130         par = info->par;
 131         crtc = &par->crtc;
 132         cursor = &crtc->cursor;
 133
 134         if (fbcursor->image.width > cursor->maxW ||
 135            fbcursor->image.height > cursor->maxH ||
 136            fbcursor->image.depth > 1) {
 137                 return -ENXIO;
 138         }
 139
 140         cursor->disable(cursor);
 141         if (fbcursor->set & FB_CUR_SETSIZE)
 142                 cursor->setSize(cursor,
 143                                 fbcursor->image.width,
 144                                 fbcursor->image.height);
 145
 146         if (fbcursor->set & FB_CUR_SETPOS)
 147                 cursor->setPos(cursor,
 148                                fbcursor->image.dx - info->var.xoffset,
 149                                fbcursor->image.dy - info->var.yoffset);
 150
 151         if (fbcursor->set & FB_CUR_SETCMAP) {
 152                 /* get the 16bit color of kernel means */
 153                 u16 fg, bg;
 154
 155                 fg = ((info->cmap.red[fbcursor->image.fg_color] & 0xf800))|
 156                       ((info->cmap.green[fbcursor->image.fg_color] & 0xfc00) >> 5)|
 157                       ((info->cmap.blue[fbcursor->image.fg_color] & 0xf800) >> 11);
 158
 159                 bg = ((info->cmap.red[fbcursor->image.bg_color] & 0xf800))|
 160                       ((info->cmap.green[fbcursor->image.bg_color] & 0xfc00) >> 5)|
 161                       ((info->cmap.blue[fbcursor->image.bg_color] & 0xf800) >> 11);
 162
 163                 cursor->setColor(cursor, fg, bg);
 164         }
 165
 166
 167         if (fbcursor->set & (FB_CUR_SETSHAPE | FB_CUR_SETIMAGE)) {
 168                 cursor->setData(cursor,
 169                                 fbcursor->rop,
 170                                 fbcursor->image.data,
 171                                 fbcursor->mask);
 172         }
 173
 174         if (fbcursor->enable)
 175                 cursor->enable(cursor);
 176
 177         return 0;
 178 }
 179
 180 static void lynxfb_ops_fillrect(struct fb_info *info,
 181                                 const struct fb_fillrect *region)
 182 {
 183         struct lynxfb_par *par;
 184         struct lynx_share *share;
 185         unsigned int base, pitch, Bpp, rop;
 186         u32 color;
 187
 188         if (info->state != FBINFO_STATE_RUNNING)
 189                 return;
 190
 191         par = info->par;
 192         share = par->share;
 193
 194         /* each time 2d function begin to work,below three variable always need
 195          * be set, seems we can put them together in some place  */
 196         base = par->crtc.oScreen;
 197         pitch = info->fix.line_length;
 198         Bpp = info->var.bits_per_pixel >> 3;
 199
 200         color = (Bpp == 1)?region->color:((u32 *)info->pseudo_palette)[region->color];
 201         rop = (region->rop != ROP_COPY) ? HW_ROP2_XOR:HW_ROP2_COPY;
 202
 203         /*
 204          * If not use spin_lock,system will die if user load driver
 205          * and immediately unload driver frequently (dual)
 206          */
 207         if (share->dual)
 208                 spin_lock(&share->slock);
 209
 210         share->accel.de_fillrect(&share->accel,
 211                                  base, pitch, Bpp,
 212                                  region->dx, region->dy,
 213                                  region->width, region->height,
 214                                  color, rop);
 215         if (share->dual)
 216                 spin_unlock(&share->slock);
 217 }
 218
 219 static void lynxfb_ops_copyarea(struct fb_info *info,
 220                                 const struct fb_copyarea *region)
 221 {
 222         struct lynxfb_par *par;
 223         struct lynx_share *share;
 224         unsigned int base, pitch, Bpp;
 225
 226         par = info->par;
 227         share = par->share;
 228
 229         /* each time 2d function begin to work,below three variable always need
 230          * be set, seems we can put them together in some place  */
 231         base = par->crtc.oScreen;
 232         pitch = info->fix.line_length;
 233         Bpp = info->var.bits_per_pixel >> 3;
 234
 235         /*
 236          * If not use spin_lock, system will die if user load driver
 237          * and immediately unload driver frequently (dual)
 238          */
 239         if (share->dual)
 240                 spin_lock(&share->slock);
 241
 242         share->accel.de_copyarea(&share->accel,
 243                                  base, pitch, region->sx, region->sy,
 244                                  base, pitch, Bpp, region->dx, region->dy,
 245                                  region->width, region->height, HW_ROP2_COPY);
 246         if (share->dual)
 247                 spin_unlock(&share->slock);
 248 }
 249
 250 static void lynxfb_ops_imageblit(struct fb_info *info,
 251                                  const struct fb_image *image)
 252 {
 253         unsigned int base, pitch, Bpp;
 254         unsigned int fgcol, bgcol;
 255         struct lynxfb_par *par;
 256         struct lynx_share *share;
 257
 258         par = info->par;
 259         share = par->share;
 260         /* each time 2d function begin to work,below three variable always need
 261          * be set, seems we can put them together in some place  */
 262         base = par->crtc.oScreen;
 263         pitch = info->fix.line_length;
 264         Bpp = info->var.bits_per_pixel >> 3;
 265
 266         if (image->depth == 1) {
 267                 if (info->fix.visual == FB_VISUAL_TRUECOLOR ||
 268                     info->fix.visual == FB_VISUAL_DIRECTCOLOR) {
 269                         fgcol = ((u32 *)info->pseudo_palette)[image->fg_color];
 270                         bgcol = ((u32 *)info->pseudo_palette)[image->bg_color];
 271                 } else {
 272                         fgcol = image->fg_color;
 273                         bgcol = image->bg_color;
 274                 }
 275                 goto _do_work;
 276         }
 277         /* TODO: Implement hardware acceleration for image->depth > 1 */
 278         cfb_imageblit(info, image);
 279         return;
 280
 281 _do_work:
 282         /*
 283          * If not use spin_lock, system will die if user load driver
 284          * and immediately unload driver frequently (dual)
 285          */
 286         if (share->dual)
 287                 spin_lock(&share->slock);
 288
 289         share->accel.de_imageblit(&share->accel,
 290                                   image->data, image->width>>3, 0,
 291                                   base, pitch, Bpp,
 292                                   image->dx, image->dy,
 293                                   image->width, image->height,
 294                                   fgcol, bgcol, HW_ROP2_COPY);
 295         if (share->dual)
 296                 spin_unlock(&share->slock);
 297 }
 298
 299 static int lynxfb_ops_pan_display(struct fb_var_screeninfo *var,
 300                                   struct fb_info *info)
 301 {
 302         struct lynxfb_par *par;
 303         struct lynxfb_crtc *crtc;
 304         int ret;
 305
 306
 307         if (!info)
 308                 return -EINVAL;
 309
 310         ret = 0;
 311         par = info->par;
 312         crtc = &par->crtc;
 313         ret = crtc->proc_panDisplay(crtc, var, info);
 314
 315         return ret;
 316 }
 317
 318 static int lynxfb_ops_set_par(struct fb_info *info)
 319 {
 320         struct lynxfb_par *par;
 321         struct lynx_share *share;
 322         struct lynxfb_crtc *crtc;
 323         struct lynxfb_output *output;
 324         struct fb_var_screeninfo *var;
 325         struct fb_fix_screeninfo *fix;
 326         int ret;
 327         unsigned int line_length;
 328
 329         if (!info)
 330                 return -EINVAL;
 331
 332         ret = 0;
 333         par = info->par;
 334         share = par->share;
 335         crtc = &par->crtc;
 336         output = &par->output;
 337         var = &info->var;
 338         fix = &info->fix;
 339
 340         /* fix structur is not so FIX ... */
 341         line_length = var->xres_virtual * var->bits_per_pixel / 8;
 342         line_length = PADDING(crtc->line_pad, line_length);
 343         fix->line_length = line_length;
 344         pr_err("fix->line_length = %d\n", fix->line_length);
 345
 346         /* var->red,green,blue,transp are need to be set by driver
 347          * and these data should be set before setcolreg routine
 348          * */
 349
 350         switch (var->bits_per_pixel) {
 351         case 8:
 352                 fix->visual = FB_VISUAL_PSEUDOCOLOR;
 353                 var->red.offset = 0;
 354                 var->red.length = 8;
 355                 var->green.offset = 0;
 356                 var->green.length = 8;
 357                 var->blue.offset = 0;
 358                 var->blue.length = 8;
 359                 var->transp.length = 0;
 360                 var->transp.offset = 0;
 361                 break;
 362         case 16:
 363                 var->red.offset = 11;
 364                 var->red.length = 5;
 365                 var->green.offset = 5;
 366                 var->green.length = 6;
 367                 var->blue.offset = 0;
 368                 var->blue.length = 5;
 369                 var->transp.length = 0;
 370                 var->transp.offset = 0;
 371                 fix->visual = FB_VISUAL_TRUECOLOR;
 372                 break;
 373         case 24:
 374         case 32:
 375                 var->red.offset = 16;
 376                 var->red.length = 8;
 377                 var->green.offset = 8;
 378                 var->green.length = 8;
 379                 var->blue.offset = 0;
 380                 var->blue.length = 8;
 381                 fix->visual = FB_VISUAL_TRUECOLOR;
 382                 break;
 383         default:
 384                 ret = -EINVAL;
 385                 break;
 386         }
 387         var->height = var->width = -1;
 388         var->accel_flags = 0;/*FB_ACCELF_TEXT;*/
 389
 390         if (ret) {
 391                 pr_err("pixel bpp format not satisfied\n.");
 392                 return ret;
 393         }
 394         ret = crtc->proc_setMode(crtc, var, fix);
 395         if (!ret)
 396                 ret = output->proc_setMode(output, var, fix);
 397         return ret;
 398 }
 399
 400 static inline unsigned int chan_to_field(unsigned int chan,
 401                                          struct fb_bitfield *bf)
 402 {
 403         chan &= 0xffff;
 404         chan >>= 16 - bf->length;
 405         return chan << bf->offset;
 406 }
 407
 408 #ifdef CONFIG_PM
 409 static int lynxfb_suspend(struct pci_dev *pdev, pm_message_t mesg)
 410 {
 411         struct fb_info *info;
 412         struct lynx_share *share;
 413         int ret;
 414
 415         if (mesg.event == pdev->dev.power.power_state.event)
 416                 return 0;
 417
 418         ret = 0;
 419         share = pci_get_drvdata(pdev);
 420         switch (mesg.event) {
 421         case PM_EVENT_FREEZE:
 422         case PM_EVENT_PRETHAW:
 423                 pdev->dev.power.power_state = mesg;
 424                 return 0;
 425         }
 426
 427         console_lock();
 428         if (mesg.event & PM_EVENT_SLEEP) {
 429                 info = share->fbinfo[0];
 430                 if (info)
 431                         /* 1 means do suspend */
 432                         fb_set_suspend(info, 1);
 433                 info = share->fbinfo[1];
 434                 if (info)
 435                         /* 1 means do suspend */
 436                         fb_set_suspend(info, 1);
 437
 438                 ret = pci_save_state(pdev);
 439                 if (ret) {
 440                         pr_err("error:%d occurred in pci_save_state\n", ret);
 441                         return ret;
 442                 }
 443
 444                 /* set chip to sleep mode */
 445                 if (share->suspend)
 446                         (*share->suspend)(share);
 447
 448                 pci_disable_device(pdev);
 449                 ret = pci_set_power_state(pdev, pci_choose_state(pdev, mesg));
 450                 if (ret) {
 451                         pr_err("error:%d occurred in pci_set_power_state\n", ret);
 452                         return ret;
 453                 }
 454         }
 455
 456         pdev->dev.power.power_state = mesg;
 457         console_unlock();
 458         return ret;
 459 }
 460
 461 static int lynxfb_resume(struct pci_dev *pdev)
 462 {
 463         struct fb_info *info;
 464         struct lynx_share *share;
 465
 466         struct lynxfb_par *par;
 467         struct lynxfb_crtc *crtc;
 468         struct lynx_cursor *cursor;
 469
 470         int ret;
 471
 472
 473         ret = 0;
 474         share = pci_get_drvdata(pdev);
 475
 476         console_lock();
 477
 478         ret = pci_set_power_state(pdev, PCI_D0);
 479         if (ret) {
 480                 pr_err("error:%d occurred in pci_set_power_state\n", ret);
 481                 return ret;
 482         }
 483
 484
 485         if (pdev->dev.power.power_state.event != PM_EVENT_FREEZE) {
 486                 pci_restore_state(pdev);
 487                 ret = pci_enable_device(pdev);
 488                 if (ret) {
 489                         pr_err("error:%d occurred in pci_enable_device\n", ret);
 490                         return ret;
 491                 }
 492                 pci_set_master(pdev);
 493         }
 494         if (share->resume)
 495                 (*share->resume)(share);
 496
 497         hw_sm750_inithw(share, pdev);
 498
 499
 500         info = share->fbinfo[0];
 501
 502         if (info) {
 503                 par = info->par;
 504                 crtc = &par->crtc;
 505                 cursor = &crtc->cursor;
 506                 memset_io(cursor->vstart, 0x0, cursor->size);
 507                 memset_io(crtc->vScreen, 0x0, crtc->vidmem_size);
 508                 lynxfb_ops_set_par(info);
 509                 fb_set_suspend(info, 0);
 510         }
 511
 512         info = share->fbinfo[1];
 513
 514         if (info) {
 515                 par = info->par;
 516                 crtc = &par->crtc;
 517                 cursor = &crtc->cursor;
 518                 memset_io(cursor->vstart, 0x0, cursor->size);
 519                 memset_io(crtc->vScreen, 0x0, crtc->vidmem_size);
 520                 lynxfb_ops_set_par(info);
 521                 fb_set_suspend(info, 0);
 522         }
 523
 524
 525         console_unlock();
 526         return ret;
 527 }
 528 #endif
 529
 530 static int lynxfb_ops_check_var(struct fb_var_screeninfo *var,
 531                                 struct fb_info *info)
 532 {
 533         struct lynxfb_par *par;
 534         struct lynxfb_crtc *crtc;
 535         struct lynxfb_output *output;
 536         struct lynx_share *share;
 537         int ret;
 538         resource_size_t request;
 539
 540
 541         par = info->par;
 542         crtc = &par->crtc;
 543         output = &par->output;
 544         share = par->share;
 545         ret = 0;
 546
 547         pr_debug("check var:%dx%d-%d\n",
 548                  var->xres,
 549                  var->yres,
 550                  var->bits_per_pixel);
 551
 552
 553         switch (var->bits_per_pixel) {
 554         case 8:
 555         case 16:
 556         case 24: /* support 24 bpp for only lynx712/722/720 */
 557         case 32:
 558                 break;
 559         default:
 560                 pr_err("bpp %d not supported\n", var->bits_per_pixel);
 561                 ret = -EINVAL;
 562                 goto exit;
 563         }
 564
 565         switch (var->bits_per_pixel) {
 566         case 8:
 567                 info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
 568                 var->red.offset = 0;
 569                 var->red.length = 8;
 570                 var->green.offset = 0;
 571                 var->green.length = 8;
 572                 var->blue.offset = 0;
 573                 var->blue.length = 8;
 574                 var->transp.length = 0;
 575                 var->transp.offset = 0;
 576                 break;
 577         case 16:
 578                 var->red.offset = 11;
 579                 var->red.length = 5;
 580                 var->green.offset = 5;
 581                 var->green.length = 6;
 582                 var->blue.offset = 0;
 583                 var->blue.length = 5;
 584                 var->transp.length = 0;
 585                 var->transp.offset = 0;
 586                 info->fix.visual = FB_VISUAL_TRUECOLOR;
 587                 break;
 588         case 24:
 589         case 32:
 590                 var->red.offset = 16;
 591                 var->red.length = 8;
 592                 var->green.offset = 8;
 593                 var->green.length = 8;
 594                 var->blue.offset = 0;
 595                 var->blue.length = 8;
 596                 info->fix.visual = FB_VISUAL_TRUECOLOR;
 597                 break;
 598         default:
 599                 ret = -EINVAL;
 600                 break;
 601         }
 602         var->height = var->width = -1;
 603         var->accel_flags = 0;/* FB_ACCELF_TEXT; */
 604
 605         /* check if current fb's video memory big enought to hold the onscreen*/
 606         request = var->xres_virtual * (var->bits_per_pixel >> 3);
 607         /* defaulty crtc->channel go with par->index */
 608
 609         request = PADDING(crtc->line_pad, request);
 610         request = request * var->yres_virtual;
 611         if (crtc->vidmem_size < request) {
 612                 pr_err("not enough video memory for mode\n");
 613                 return -ENOMEM;
 614         }
 615
 616         ret = output->proc_checkMode(output, var);
 617         if (!ret)
 618                 ret = crtc->proc_checkMode(crtc, var);
 619 exit:
 620         return ret;
 621 }
 622
 623
 624 static int lynxfb_ops_setcolreg(unsigned regno,
 625                                 unsigned red,
 626                                 unsigned green,
 627                                 unsigned blue,
 628                                 unsigned transp,
 629                                 struct fb_info *info)
 630 {
 631         struct lynxfb_par *par;
 632         struct lynxfb_crtc *crtc;
 633         struct fb_var_screeninfo *var;
 634         int ret;
 635
 636         par = info->par;
 637         crtc = &par->crtc;
 638         var = &info->var;
 639         ret = 0;
 640
 641         if (regno > 256) {
 642                 pr_err("regno = %d\n", regno);
 643                 return -EINVAL;
 644         }
 645
 646         if (info->var.grayscale)
 647                 red = green = blue = (red * 77 + green * 151 + blue * 28) >> 8;
 648
 649         if (var->bits_per_pixel == 8 &&
 650             info->fix.visual == FB_VISUAL_PSEUDOCOLOR) {
 651                 red >>= 8;
 652                 green >>= 8;
 653                 blue >>= 8;
 654                 ret = crtc->proc_setColReg(crtc, regno, red, green, blue);
 655                 goto exit;
 656         }
 657
 658
 659         if (info->fix.visual == FB_VISUAL_TRUECOLOR && regno < 256) {
 660                 u32 val;
 661
 662                 if (var->bits_per_pixel == 16 ||
 663                     var->bits_per_pixel == 32 ||
 664                     var->bits_per_pixel == 24) {
 665                         val = chan_to_field(red, &var->red);
 666                         val |= chan_to_field(green, &var->green);
 667                         val |= chan_to_field(blue, &var->blue);
 668                         par->pseudo_palette[regno] = val;
 669                         goto exit;
 670                 }
 671         }
 672
 673         ret = -EINVAL;
 674
 675 exit:
 676         return ret;
 677 }
 678
 679 static int lynxfb_ops_blank(int blank, struct fb_info *info)
 680 {
 681         struct lynxfb_par *par;
 682         struct lynxfb_output *output;
 683
 684         pr_debug("blank = %d.\n", blank);
 685         par = info->par;
 686         output = &par->output;
 687         return output->proc_setBLANK(output, blank);
 688 }
 689
 690 static int sm750fb_set_drv(struct lynxfb_par *par)
 691 {
 692         int ret;
 693         struct lynx_share *share;
 694         struct sm750_share *spec_share;
 695         struct lynxfb_output *output;
 696         struct lynxfb_crtc *crtc;
 697
 698         ret = 0;
 699
 700         share = par->share;
 701         spec_share = container_of(share, struct sm750_share, share);
 702         output = &par->output;
 703         crtc = &par->crtc;
 704
 705         crtc->vidmem_size = (share->dual)?share->vidmem_size>>1:share->vidmem_size;
 706         /* setup crtc and output member */
 707         spec_share->hwCursor = g_hwcursor;
 708
 709         crtc->proc_setMode = hw_sm750_crtc_setMode;
 710         crtc->proc_checkMode = hw_sm750_crtc_checkMode;
 711         crtc->proc_setColReg = hw_sm750_setColReg;
 712         crtc->proc_panDisplay = hw_sm750_pan_display;
 713         crtc->clear = hw_sm750_crtc_clear;
 714         crtc->line_pad = 16;
 715         crtc->xpanstep = 8;
 716         crtc->ypanstep = 1;
 717         crtc->ywrapstep = 0;
 718
 719         output->proc_setMode = hw_sm750_output_setMode;
 720         output->proc_checkMode = hw_sm750_output_checkMode;
 721
 722         output->proc_setBLANK = (share->revid == SM750LE_REVISION_ID)?hw_sm750le_setBLANK:hw_sm750_setBLANK;
 723         output->clear = hw_sm750_output_clear;
 724         /* chip specific phase */
 725         share->accel.de_wait = (share->revid == SM750LE_REVISION_ID)?hw_sm750le_deWait : hw_sm750_deWait;
 726         switch (spec_share->state.dataflow) {
 727         case sm750_simul_pri:
 728                 output->paths = sm750_pnc;
 729                 crtc->channel = sm750_primary;
 730                 crtc->oScreen = 0;
 731                 crtc->vScreen = share->pvMem;
 732                 pr_info("use simul primary mode\n");
 733                 break;
 734         case sm750_simul_sec:
 735                 output->paths = sm750_pnc;
 736                 crtc->channel = sm750_secondary;
 737                 crtc->oScreen = 0;
 738                 crtc->vScreen = share->pvMem;
 739                 break;
 740         case sm750_dual_normal:
 741                 if (par->index == 0) {
 742                         output->paths = sm750_panel;
 743                         crtc->channel = sm750_primary;
 744                         crtc->oScreen = 0;
 745                         crtc->vScreen = share->pvMem;
 746                 } else {
 747                         output->paths = sm750_crt;
 748                         crtc->channel = sm750_secondary;
 749                         /* not consider of padding stuffs for oScreen,need fix */
 750                         crtc->oScreen = (share->vidmem_size >> 1);
 751                         crtc->vScreen = share->pvMem + crtc->oScreen;
 752                 }
 753                 break;
 754         case sm750_dual_swap:
 755                 if (par->index == 0) {
 756                         output->paths = sm750_panel;
 757                         crtc->channel = sm750_secondary;
 758                         crtc->oScreen = 0;
 759                         crtc->vScreen = share->pvMem;
 760                 } else {
 761                         output->paths = sm750_crt;
 762                         crtc->channel = sm750_primary;
 763                         /* not consider of padding stuffs for oScreen,need fix */
 764                         crtc->oScreen = (share->vidmem_size >> 1);
 765                         crtc->vScreen = share->pvMem + crtc->oScreen;
 766                 }
 767                 break;
 768         default:
 769                 ret = -EINVAL;
 770         }
 771
 772         return ret;
 773 }
 774
 775 static struct fb_ops lynxfb_ops = {
 776         .owner = THIS_MODULE,
 777         .fb_check_var =  lynxfb_ops_check_var,
 778         .fb_set_par = lynxfb_ops_set_par,
 779         .fb_setcolreg = lynxfb_ops_setcolreg,
 780         .fb_blank = lynxfb_ops_blank,
 781         .fb_fillrect = cfb_fillrect,
 782         .fb_imageblit = cfb_imageblit,
 783         .fb_copyarea = cfb_copyarea,
 784         /* cursor */
 785         .fb_cursor = lynxfb_ops_cursor,
 786 };
 787
 788
 789 static int lynxfb_set_fbinfo(struct fb_info *info, int index)
 790 {
 791         int i;
 792         struct lynxfb_par *par;
 793         struct lynx_share *share;
 794         struct lynxfb_crtc *crtc;
 795         struct lynxfb_output *output;
 796         struct fb_var_screeninfo *var;
 797         struct fb_fix_screeninfo *fix;
 798
 799         const struct fb_videomode *pdb[] = {
 800                 lynx750_ext, NULL, vesa_modes,
 801         };
 802         int cdb[] = {ARRAY_SIZE(lynx750_ext), 0, VESA_MODEDB_SIZE};
 803         static const char *mdb_desc[] = {
 804                 "driver prepared modes",
 805                 "kernel prepared default modedb",
 806                 "kernel HELPERS prepared vesa_modes",
 807         };
 808
 809
 810         static const char *fixId[2] = {
 811                 "sm750_fb1", "sm750_fb2",
 812         };
 813
 814         int ret, line_length;
 815
 816         ret = 0;
 817         par = (struct lynxfb_par *)info->par;
 818         share = par->share;
 819         crtc = &par->crtc;
 820         output = &par->output;
 821         var = &info->var;
 822         fix = &info->fix;
 823
 824         /* set index */
 825         par->index = index;
 826         output->channel = &crtc->channel;
 827         sm750fb_set_drv(par);
 828         lynxfb_ops.fb_pan_display = lynxfb_ops_pan_display;
 829
 830
 831         /* set current cursor variable and proc pointer,
 832          * must be set after crtc member initialized */
 833         crtc->cursor.offset = crtc->oScreen + crtc->vidmem_size - 1024;
 834         crtc->cursor.mmio = share->pvReg + 0x800f0 + (int)crtc->channel * 0x140;
 835
 836         pr_info("crtc->cursor.mmio = %p\n", crtc->cursor.mmio);
 837         crtc->cursor.maxH = crtc->cursor.maxW = 64;
 838         crtc->cursor.size = crtc->cursor.maxH*crtc->cursor.maxW*2/8;
 839         crtc->cursor.disable = hw_cursor_disable;
 840         crtc->cursor.enable = hw_cursor_enable;
 841         crtc->cursor.setColor = hw_cursor_setColor;
 842         crtc->cursor.setPos = hw_cursor_setPos;
 843         crtc->cursor.setSize = hw_cursor_setSize;
 844         crtc->cursor.setData = hw_cursor_setData;
 845         crtc->cursor.vstart = share->pvMem + crtc->cursor.offset;
 846
 847
 848         crtc->cursor.share = share;
 849                 memset_io(crtc->cursor.vstart, 0, crtc->cursor.size);
 850         if (!g_hwcursor) {
 851                 lynxfb_ops.fb_cursor = NULL;
 852                 crtc->cursor.disable(&crtc->cursor);
 853         }
 854
 855
 856         /* set info->fbops, must be set before fb_find_mode */
 857         if (!share->accel_off) {
 858                 /* use 2d acceleration */
 859                 lynxfb_ops.fb_fillrect = lynxfb_ops_fillrect;
 860                 lynxfb_ops.fb_copyarea = lynxfb_ops_copyarea;
 861                 lynxfb_ops.fb_imageblit = lynxfb_ops_imageblit;
 862         }
 863         info->fbops = &lynxfb_ops;
 864
 865         if (!g_fbmode[index]) {
 866                 g_fbmode[index] = g_def_fbmode;
 867                 if (index)
 868                         g_fbmode[index] = g_fbmode[0];
 869         }
 870
 871
 872         for (i = 0; i < 3; i++) {
 873
 874                 ret = fb_find_mode(var, info, g_fbmode[index],
 875                                    pdb[i], cdb[i], NULL, 8);
 876
 877                 if (ret == 1) {
 878                         pr_info("success! use specified mode:%s in %s\n",
 879                                 g_fbmode[index],
 880                                 mdb_desc[i]);
 881                         break;
 882                 } else if (ret == 2) {
 883                         pr_warn("use specified mode:%s in %s,with an ignored refresh rate\n",
 884                                 g_fbmode[index],
 885                                 mdb_desc[i]);
 886                         break;
 887                 } else if (ret == 3) {
 888                         pr_warn("wanna use default mode\n");
 889                         /*break;*/
 890                 } else if (ret == 4) {
 891                         pr_warn("fall back to any valid mode\n");
 892                 } else {
 893                         pr_warn("ret = %d,fb_find_mode failed,with %s\n",
 894                                 ret,
 895                                 mdb_desc[i]);
 896                 }
 897         }
 898
 899         /* some member of info->var had been set by fb_find_mode */
 900
 901         pr_info("Member of info->var is :\n\
 902                 xres=%d\n\
 903                 yres=%d\n\
 904                 xres_virtual=%d\n\
 905                 yres_virtual=%d\n\
 906                 xoffset=%d\n\
 907                 yoffset=%d\n\
 908                 bits_per_pixel=%d\n \
 909                 ...\n",
 910                 var->xres,
 911                 var->yres,
 912                 var->xres_virtual,
 913                 var->yres_virtual,
 914                 var->xoffset,
 915                 var->yoffset,
 916                 var->bits_per_pixel);
 917
 918         /* set par */
 919         par->info = info;
 920
 921         /* set info */
 922         line_length = PADDING(crtc->line_pad,
 923                               (var->xres_virtual * var->bits_per_pixel/8));
 924
 925         info->pseudo_palette = &par->pseudo_palette[0];
 926         info->screen_base = crtc->vScreen;
 927         pr_debug("screen_base vaddr = %p\n", info->screen_base);
 928         info->screen_size = line_length * var->yres_virtual;
 929         info->flags = FBINFO_FLAG_DEFAULT|0;
 930
 931         /* set info->fix */
 932         fix->type = FB_TYPE_PACKED_PIXELS;
 933         fix->type_aux = 0;
 934         fix->xpanstep = crtc->xpanstep;
 935         fix->ypanstep = crtc->ypanstep;
 936         fix->ywrapstep = crtc->ywrapstep;
 937         fix->accel = FB_ACCEL_SMI;
 938
 939         strlcpy(fix->id, fixId[index], sizeof(fix->id));
 940
 941
 942         fix->smem_start = crtc->oScreen + share->vidmem_start;
 943         pr_info("fix->smem_start = %lx\n", fix->smem_start);
 944         /* according to mmap experiment from user space application,
 945          * fix->mmio_len should not larger than virtual size
 946          * (xres_virtual x yres_virtual x ByPP)
 947          * Below line maybe buggy when user mmap fb dev node and write
 948          * data into the bound over virtual size
 949          * */
 950         fix->smem_len = crtc->vidmem_size;
 951         pr_info("fix->smem_len = %x\n", fix->smem_len);
 952         info->screen_size = fix->smem_len;
 953         fix->line_length = line_length;
 954         fix->mmio_start = share->vidreg_start;
 955         pr_info("fix->mmio_start = %lx\n", fix->mmio_start);
 956         fix->mmio_len = share->vidreg_size;
 957         pr_info("fix->mmio_len = %x\n", fix->mmio_len);
 958         switch (var->bits_per_pixel) {
 959         case 8:
 960                 fix->visual = FB_VISUAL_PSEUDOCOLOR;
 961                 break;
 962         case 16:
 963         case 32:
 964                 fix->visual = FB_VISUAL_TRUECOLOR;
 965                 break;
 966         }
 967
 968         /* set var */
 969         var->activate = FB_ACTIVATE_NOW;
 970         var->accel_flags = 0;
 971         var->vmode = FB_VMODE_NONINTERLACED;
 972
 973         pr_debug("#1 show info->cmap : \nstart=%d,len=%d,red=%p,green=%p,blue=%p,transp=%p\n",
 974                  info->cmap.start, info->cmap.len,
 975                  info->cmap.red, info->cmap.green, info->cmap.blue,
 976                  info->cmap.transp);
 977
 978         ret = fb_alloc_cmap(&info->cmap, 256, 0);
 979         if (ret < 0) {
 980                 pr_err("Could not allcate memory for cmap.\n");
 981                 goto exit;
 982         }
 983
 984         pr_debug("#2 show info->cmap :\nstart=%d,len=%d,red=%p,green=%p,blue=%p,transp=%p\n",
 985                  info->cmap.start, info->cmap.len,
 986                  info->cmap.red, info->cmap.green, info->cmap.blue,
 987                  info->cmap.transp);
 988
 989 exit:
 990         lynxfb_ops_check_var(var, info);
 991         return ret;
 992 }
 993
 994 /*      chip specific g_option configuration routine */
 995 static void sm750fb_setup(struct lynx_share *share, char *src)
 996 {
 997         struct sm750_share *spec_share;
 998         char *opt;
 999 #ifdef CAP_EXPENSION
1000         char *exp_res;
1001 #endif
1002         int swap;
1003
1004
1005         spec_share = container_of(share, struct sm750_share, share);
1006 #ifdef CAP_EXPENSIION
1007         exp_res = NULL;
1008 #endif
1009         swap = 0;
1010
1011         spec_share->state.initParm.chip_clk = 0;
1012         spec_share->state.initParm.mem_clk = 0;
1013         spec_share->state.initParm.master_clk = 0;
1014         spec_share->state.initParm.powerMode = 0;
1015         spec_share->state.initParm.setAllEngOff = 0;
1016         spec_share->state.initParm.resetMemory = 1;
1017
1018         /* defaultly turn g_hwcursor on for both view */
1019         g_hwcursor = 3;
1020
1021         if (!src || !*src) {
1022                 pr_warn("no specific g_option.\n");
1023                 goto NO_PARAM;
1024         }
1025
1026         while ((opt = strsep(&src, ":")) != NULL && *opt != 0) {
1027                 pr_err("opt=%s\n", opt);
1028                 pr_err("src=%s\n", src);
1029
1030                 if (!strncmp(opt, "swap", strlen("swap")))
1031                         swap = 1;
1032                 else if (!strncmp(opt, "nocrt", strlen("nocrt")))
1033                         spec_share->state.nocrt = 1;
1034                 else if (!strncmp(opt, "36bit", strlen("36bit")))
1035                         spec_share->state.pnltype = sm750_doubleTFT;
1036                 else if (!strncmp(opt, "18bit", strlen("18bit")))
1037                         spec_share->state.pnltype = sm750_dualTFT;
1038                 else if (!strncmp(opt, "24bit", strlen("24bit")))
1039                         spec_share->state.pnltype = sm750_24TFT;
1040 #ifdef CAP_EXPANSION
1041                 else if (!strncmp(opt, "exp:", strlen("exp:")))
1042                         exp_res = opt + strlen("exp:");
1043 #endif
1044                 else if (!strncmp(opt, "nohwc0", strlen("nohwc0")))
1045                         g_hwcursor &= ~0x1;
1046                 else if (!strncmp(opt, "nohwc1", strlen("nohwc1")))
1047                         g_hwcursor &= ~0x2;
1048                 else if (!strncmp(opt, "nohwc", strlen("nohwc")))
1049                         g_hwcursor = 0;
1050                 else {
1051                         if (!g_fbmode[0]) {
1052                                 g_fbmode[0] = opt;
1053                                 pr_info("find fbmode0 : %s\n", g_fbmode[0]);
1054                         } else if (!g_fbmode[1]) {
1055                                 g_fbmode[1] = opt;
1056                                 pr_info("find fbmode1 : %s\n", g_fbmode[1]);
1057                         } else {
1058                                 pr_warn("How many view you wann set?\n");
1059                         }
1060                 }
1061         }
1062 #ifdef CAP_EXPANSION
1063         if (getExpRes(exp_res,
1064                       &spec_share->state.xLCD,
1065                       &spec_share->state.yLCD)) {
1066                 /* seems exp_res is not valid */
1067                 spec_share->state.xLCD = spec_share->state.yLCD = 0;
1068         }
1069 #endif
1070
1071 NO_PARAM:
1072         if (share->revid != SM750LE_REVISION_ID) {
1073                 if (share->dual) {
1074                         if (swap)
1075                                 spec_share->state.dataflow = sm750_dual_swap;
1076                         else
1077                                 spec_share->state.dataflow = sm750_dual_normal;
1078                 } else {
1079                         if (swap)
1080                                 spec_share->state.dataflow = sm750_simul_sec;
1081                         else
1082                                 spec_share->state.dataflow = sm750_simul_pri;
1083                 }
1084         } else {
1085                 /* SM750LE only have one crt channel */
1086                 spec_share->state.dataflow = sm750_simul_sec;
1087                 /* sm750le do not have complex attributes */
1088                 spec_share->state.nocrt = 0;
1089         }
1090 }
1091
1092 static int lynxfb_pci_probe(struct pci_dev *pdev,
1093                             const struct pci_device_id * ent)
1094 {
1095         struct fb_info *info[] = {NULL, NULL};
1096         struct lynx_share *share = NULL;
1097
1098         struct sm750_share *spec_share = NULL;
1099         size_t spec_offset = 0;
1100         int fbidx;
1101
1102
1103         /* enable device */
1104         if (pci_enable_device(pdev)) {
1105                 pr_err("can not enable device.\n");
1106                 goto err_enable;
1107         }
1108
1109         /* though offset of share in sm750_share is 0,
1110          * we use this marcro as the same */
1111         spec_offset = offsetof(struct sm750_share, share);
1112
1113         spec_share = kzalloc(sizeof(*spec_share), GFP_KERNEL);
1114         if (!spec_share) {
1115                 pr_err("Could not allocate memory for share.\n");
1116                 goto err_share;
1117         }
1118
1119         /* setting share structure */
1120         share = (struct lynx_share *)(&(spec_share->share));
1121         share->fbinfo[0] = share->fbinfo[1] = NULL;
1122         share->devid = pdev->device;
1123         share->revid = pdev->revision;
1124
1125         pr_info("share->revid = %02x\n", share->revid);
1126         share->pdev = pdev;
1127         share->mtrr_off = g_nomtrr;
1128         share->mtrr.vram = 0;
1129         share->accel_off = g_noaccel;
1130         share->dual = g_dualview;
1131         spin_lock_init(&share->slock);
1132
1133         if (!share->accel_off) {
1134                 /* hook deInit and 2d routines, notes that below hw_xxx
1135                  * routine can work on most of lynx chips
1136                  * if some chip need specific function,
1137                  * please hook it in smXXX_set_drv routine */
1138                 share->accel.de_init = hw_de_init;
1139                 share->accel.de_fillrect = hw_fillrect;
1140                 share->accel.de_copyarea = hw_copyarea;
1141                 share->accel.de_imageblit = hw_imageblit;
1142                 pr_info("enable 2d acceleration\n");
1143         } else {
1144                 pr_info("disable 2d acceleration\n");
1145         }
1146
1147         /* call chip specific setup routine  */
1148         sm750fb_setup(share, g_settings);
1149
1150         /* call chip specific mmap routine */
1151         if (hw_sm750_map(share, pdev)) {
1152                 pr_err("Memory map failed\n");
1153                 goto err_map;
1154         }
1155
1156         if (!share->mtrr_off)
1157                 share->mtrr.vram = arch_phys_wc_add(share->vidmem_start,
1158                                                     share->vidmem_size);
1159
1160         memset_io(share->pvMem, 0, share->vidmem_size);
1161
1162         pr_info("sm%3x mmio address = %p\n", share->devid, share->pvReg);
1163
1164         pci_set_drvdata(pdev, share);
1165
1166         /* call chipInit routine */
1167         hw_sm750_inithw(share, pdev);
1168
1169         /* allocate frame buffer info structor according to g_dualview */
1170         fbidx = 0;
1171 ALLOC_FB:
1172         info[fbidx] = framebuffer_alloc(sizeof(struct lynxfb_par), &pdev->dev);
1173         if (!info[fbidx]) {
1174                 pr_err("Could not allocate framebuffer #%d.\n", fbidx);
1175                 if (fbidx == 0)
1176                         goto err_info0_alloc;
1177                 else
1178                         goto err_info1_alloc;
1179         } else {
1180                 struct lynxfb_par *par;
1181                 int errno;
1182
1183                 pr_info("framebuffer #%d alloc okay\n", fbidx);
1184                 share->fbinfo[fbidx] = info[fbidx];
1185                 par = info[fbidx]->par;
1186                 par->share = share;
1187
1188                 /* set fb_info structure */
1189                 if (lynxfb_set_fbinfo(info[fbidx], fbidx)) {
1190                         pr_err("Failed to initial fb_info #%d.\n", fbidx);
1191                         if (fbidx == 0)
1192                                 goto err_info0_set;
1193                         else
1194                                 goto err_info1_set;
1195                 }
1196
1197                 /* register frame buffer */
1198                 pr_info("Ready to register framebuffer #%d.\n", fbidx);
1199                 errno = register_framebuffer(info[fbidx]);
1200                 if (errno < 0) {
1201                         pr_err("Failed to register fb_info #%d. err %d\n",
1202                                fbidx,
1203                                errno);
1204                         if (fbidx == 0)
1205                                 goto err_register0;
1206                         else
1207                                 goto err_register1;
1208                 }
1209                 pr_info("Accomplished register framebuffer #%d.\n", fbidx);
1210         }
1211
1212         /* no dual view by far */
1213         fbidx++;
1214         if (share->dual && fbidx < 2)
1215                 goto ALLOC_FB;
1216
1217         return 0;
1218
1219 err_register1:
1220 err_info1_set:
1221         framebuffer_release(info[1]);
1222 err_info1_alloc:
1223         unregister_framebuffer(info[0]);
1224 err_register0:
1225 err_info0_set:
1226         framebuffer_release(info[0]);
1227 err_info0_alloc:
1228 err_map:
1229         kfree(spec_share);
1230 err_share:
1231 err_enable:
1232         return -ENODEV;
1233 }
1234
1235 static void lynxfb_pci_remove(struct pci_dev *pdev)
1236 {
1237         struct fb_info *info;
1238         struct lynx_share *share;
1239         void *spec_share;
1240         struct lynxfb_par *par;
1241         int cnt;
1242
1243         cnt = 2;
1244         share = pci_get_drvdata(pdev);
1245
1246         while (cnt-- > 0) {
1247                 info = share->fbinfo[cnt];
1248                 if (!info)
1249                         continue;
1250                 par = info->par;
1251
1252                 unregister_framebuffer(info);
1253                 /* clean crtc & output allocations */
1254                 par->crtc.clear(&par->crtc);
1255                 par->output.clear(&par->output);
1256                 /* release frame buffer */
1257                 framebuffer_release(info);
1258         }
1259         arch_phys_wc_del(share->mtrr.vram);
1260
1261         iounmap(share->pvReg);
1262         iounmap(share->pvMem);
1263         spec_share = container_of(share, struct sm750_share, share);
1264         kfree(g_settings);
1265         kfree(spec_share);
1266         pci_set_drvdata(pdev, NULL);
1267 }
1268
1269 static int __init lynxfb_setup(char *options)
1270 {
1271         int len;
1272         char *opt, *tmp;
1273
1274
1275         if (!options || !*options) {
1276                 pr_warn("no options.\n");
1277                 return 0;
1278         }
1279
1280         pr_info("options:%s\n", options);
1281
1282         len = strlen(options) + 1;
1283         g_settings = kzalloc(len, GFP_KERNEL);
1284         if (!g_settings)
1285                 return -ENOMEM;
1286
1287         tmp = g_settings;
1288
1289         /*      Notes:
1290                 char * strsep(char **s,const char * ct);
1291                 @s: the string to be searched
1292                 @ct :the characters to search for
1293
1294                 strsep() updates @options to pointer after the first found token
1295                 it also returns the pointer ahead the token.
1296                 */
1297         while ((opt = strsep(&options, ":")) != NULL) {
1298                 /* options that mean for any lynx chips are configured here */
1299                 if (!strncmp(opt, "noaccel", strlen("noaccel")))
1300                         g_noaccel = 1;
1301                 else if (!strncmp(opt, "nomtrr", strlen("nomtrr")))
1302                         g_nomtrr = 1;
1303                 else if (!strncmp(opt, "dual", strlen("dual")))
1304                         g_dualview = 1;
1305                 else {
1306                         strcat(tmp, opt);
1307                         tmp += strlen(opt);
1308                         if (options != NULL)
1309                                 *tmp++ = ':';
1310                         else
1311                                 *tmp++ = 0;
1312                 }
1313         }
1314
1315         /* misc g_settings are transport to chip specific routines */
1316         pr_info("parameter left for chip specific analysis:%s\n", g_settings);
1317         return 0;
1318 }
1319
1320 static struct pci_device_id smi_pci_table[] = {
1321         { PCI_DEVICE(0x126f, 0x0750), },
1322         {0,}
1323 };
1324
1325 MODULE_DEVICE_TABLE(pci, smi_pci_table);
1326
1327 static struct pci_driver lynxfb_driver = {
1328         .name =         "sm750fb",
1329         .id_table =     smi_pci_table,
1330         .probe =        lynxfb_pci_probe,
1331         .remove =       lynxfb_pci_remove,
1332 #ifdef CONFIG_PM
1333         .suspend = lynxfb_suspend,
1334         .resume = lynxfb_resume,
1335 #endif
1336 };
1337
1338
1339 static int __init lynxfb_init(void)
1340 {
1341         char *option;
1342         int ret;
1343
1344 #ifdef MODULE
1345         option = g_option;
1346 #else
1347         if (fb_get_options("sm750fb", &option))
1348                 return -ENODEV;
1349 #endif
1350
1351         lynxfb_setup(option);
1352         ret = pci_register_driver(&lynxfb_driver);
1353         return ret;
1354 }
1355 module_init(lynxfb_init);
1356
1357 static void __exit lynxfb_exit(void)
1358 {
1359         pci_unregister_driver(&lynxfb_driver);
1360 }
1361 module_exit(lynxfb_exit);
1362
1363 module_param(g_option, charp, S_IRUGO);
1364
1365 MODULE_PARM_DESC(g_option,
1366                  "\n\t\tCommon options:\n"
1367                  "\t\tnoaccel:disable 2d capabilities\n"
1368                  "\t\tnomtrr:disable MTRR attribute for video memory\n"
1369                  "\t\tdualview:dual frame buffer feature enabled\n"
1370                  "\t\tnohwc:disable hardware cursor\n"
1371                  "\t\tUsual example:\n"
1372                  "\t\tinsmod ./sm750fb.ko g_option=\"noaccel,nohwc,1280x1024-8@60\"\n"
1373                  );
1374
1375 MODULE_AUTHOR("monk liu <monk.liu@siliconmotion.com>");
1376 MODULE_AUTHOR("Sudip Mukherjee <sudip@vectorindia.org>");
1377 MODULE_DESCRIPTION("Frame buffer driver for SM750 chipset");
1378 MODULE_LICENSE("GPL v2");