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

   1 /*
   2  * Copyright 1998-2008 VIA Technologies, Inc. All Rights Reserved.
   3  * Copyright 2001-2008 S3 Graphics, Inc. All Rights Reserved.
   4
   5  * This program is free software; you can redistribute it and/or
   6  * modify it under the terms of the GNU General Public
   7  * License as published by the Free Software Foundation;
   8  * either version 2, or (at your option) any later version.
   9
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTIES OR REPRESENTATIONS; without even
  12  * the implied warranty of MERCHANTABILITY or FITNESS FOR
  13  * A PARTICULAR PURPOSE.See the GNU General Public License
  14  * for more details.
  15
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, write to the Free Software
  18  * Foundation, Inc.,
  19  * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  20  */
  21
  22 #include <linux/module.h>
  23 #include <linux/seq_file.h>
  24 #include <linux/stat.h>
  25 #define _MASTER_FILE
  26
  27 #include "global.h"
  28
  29 static struct fb_var_screeninfo default_var;
  30 static char *viafb_name = "Via";
  31 static u32 pseudo_pal[17];
  32
  33 /* video mode */
  34 static char *viafb_mode = "640x480";
  35 static char *viafb_mode1 = "640x480";
  36
  37 static int viafb_accel = 1;
  38
  39 /* Added for specifying active devices.*/
  40 char *viafb_active_dev = "";
  41
  42 /*Added for specify lcd output port*/
  43 char *viafb_lcd_port = "";
  44 char *viafb_dvi_port = "";
  45
  46 static void viafb_set_device(struct device_t active_dev);
  47 static int apply_device_setting(struct viafb_ioctl_setting setting_info,
  48                          struct fb_info *info);
  49 static void apply_second_mode_setting(struct fb_var_screeninfo
  50         *sec_var);
  51 static void retrieve_device_setting(struct viafb_ioctl_setting
  52         *setting_info);
  53 static int viafb_pan_display(struct fb_var_screeninfo *var,
  54         struct fb_info *info);
  55
  56 static struct fb_ops viafb_ops;
  57
  58
  59 static void viafb_update_fix(struct fb_info *info)
  60 {
  61         u32 bpp = info->var.bits_per_pixel;
  62
  63         info->fix.visual =
  64                 bpp == 8 ? FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_TRUECOLOR;
  65         info->fix.line_length =
  66                 ((info->var.xres_virtual + 7) & ~7) * bpp / 8;
  67 }
  68
  69 static void viafb_setup_fixinfo(struct fb_fix_screeninfo *fix,
  70         struct viafb_par *viaparinfo)
  71 {
  72         memset(fix, 0, sizeof(struct fb_fix_screeninfo));
  73         strcpy(fix->id, viafb_name);
  74
  75         fix->smem_start = viaparinfo->fbmem;
  76         fix->smem_len = viaparinfo->fbmem_free;
  77
  78         fix->type = FB_TYPE_PACKED_PIXELS;
  79         fix->type_aux = 0;
  80
  81         fix->xpanstep = fix->ywrapstep = 0;
  82         fix->ypanstep = 1;
  83
  84         /* Just tell the accel name */
  85         viafbinfo->fix.accel = FB_ACCEL_VIA_UNICHROME;
  86 }
  87 static int viafb_open(struct fb_info *info, int user)
  88 {
  89         DEBUG_MSG(KERN_INFO "viafb_open!\n");
  90         return 0;
  91 }
  92
  93 static int viafb_release(struct fb_info *info, int user)
  94 {
  95         DEBUG_MSG(KERN_INFO "viafb_release!\n");
  96         return 0;
  97 }
  98
  99 static int viafb_check_var(struct fb_var_screeninfo *var,
 100         struct fb_info *info)
 101 {
 102         int htotal, vtotal;
 103         struct VideoModeTable *vmode_entry;
 104         struct viafb_par *ppar = info->par;
 105         u32 long_refresh;
 106
 107         DEBUG_MSG(KERN_INFO "viafb_check_var!\n");
 108         /* Sanity check */
 109         /* HW neither support interlacte nor double-scaned mode */
 110         if (var->vmode & FB_VMODE_INTERLACED || var->vmode & FB_VMODE_DOUBLE)
 111                 return -EINVAL;
 112
 113         vmode_entry = viafb_get_mode(var->xres, var->yres);
 114         if (!vmode_entry) {
 115                 DEBUG_MSG(KERN_INFO
 116                           "viafb: Mode %dx%dx%d not supported!!\n",
 117                           var->xres, var->yres, var->bits_per_pixel);
 118                 return -EINVAL;
 119         }
 120
 121         if (24 == var->bits_per_pixel)
 122                 var->bits_per_pixel = 32;
 123
 124         if (var->bits_per_pixel != 8 && var->bits_per_pixel != 16 &&
 125                 var->bits_per_pixel != 32)
 126                 return -EINVAL;
 127
 128         if ((var->xres_virtual * (var->bits_per_pixel >> 3)) & 0x1F)
 129                 /*32 pixel alignment */
 130                 var->xres_virtual = (var->xres_virtual + 31) & ~31;
 131         if (var->xres_virtual * var->yres_virtual * var->bits_per_pixel / 8 >
 132                 ppar->memsize)
 133                 return -EINVAL;
 134
 135         /* Based on var passed in to calculate the refresh,
 136          * because our driver use some modes special.
 137          */
 138         htotal = var->xres + var->left_margin +
 139         var->right_margin + var->hsync_len;
 140         vtotal = var->yres + var->upper_margin +
 141                 var->lower_margin + var->vsync_len;
 142         long_refresh = 1000000000UL / var->pixclock * 1000;
 143         long_refresh /= (htotal * vtotal);
 144
 145         viafb_refresh = viafb_get_refresh(var->xres, var->yres, long_refresh);
 146
 147         /* Adjust var according to our driver's own table */
 148         viafb_fill_var_timing_info(var, viafb_refresh, vmode_entry);
 149         if (info->var.accel_flags & FB_ACCELF_TEXT &&
 150                 !ppar->shared->engine_mmio)
 151                 info->var.accel_flags = 0;
 152
 153         return 0;
 154 }
 155
 156 static int viafb_set_par(struct fb_info *info)
 157 {
 158         struct viafb_par *viapar = info->par;
 159         struct VideoModeTable *vmode_entry, *vmode_entry1 = NULL;
 160         DEBUG_MSG(KERN_INFO "viafb_set_par!\n");
 161
 162         viapar->depth = fb_get_color_depth(&info->var, &info->fix);
 163         viafb_update_device_setting(info->var.xres, info->var.yres,
 164                               info->var.bits_per_pixel, viafb_refresh, 0);
 165
 166         vmode_entry = viafb_get_mode(info->var.xres, info->var.yres);
 167         if (viafb_SAMM_ON == 1) {
 168                 DEBUG_MSG(KERN_INFO
 169                 "viafb_second_xres = %d, viafb_second_yres = %d, bpp = %d\n",
 170                           viafb_second_xres, viafb_second_yres, viafb_bpp1);
 171                 vmode_entry1 = viafb_get_mode(viafb_second_xres,
 172                         viafb_second_yres);
 173
 174                 viafb_update_device_setting(viafb_second_xres,
 175                         viafb_second_yres, viafb_bpp1, viafb_refresh1, 1);
 176         }
 177
 178         if (vmode_entry) {
 179                 viafb_update_fix(info);
 180                 viafb_bpp = info->var.bits_per_pixel;
 181                 if (info->var.accel_flags & FB_ACCELF_TEXT)
 182                         info->flags &= ~FBINFO_HWACCEL_DISABLED;
 183                 else
 184                         info->flags |= FBINFO_HWACCEL_DISABLED;
 185                 viafb_setmode(vmode_entry, info->var.bits_per_pixel,
 186                         vmode_entry1, viafb_bpp1);
 187                 viafb_pan_display(&info->var, info);
 188         }
 189
 190         return 0;
 191 }
 192
 193 /* Set one color register */
 194 static int viafb_setcolreg(unsigned regno, unsigned red, unsigned green,
 195 unsigned blue, unsigned transp, struct fb_info *info)
 196 {
 197         u8 sr1a, sr1b, cr67, cr6a, rev = 0, shift = 10;
 198         unsigned cmap_entries = (info->var.bits_per_pixel == 8) ? 256 : 16;
 199         DEBUG_MSG(KERN_INFO "viafb_setcolreg!\n");
 200         if (regno >= cmap_entries)
 201                 return 1;
 202         if (UNICHROME_CLE266 == viaparinfo->chip_info->gfx_chip_name) {
 203                 /*
 204                  * Read PCI bus 0,dev 0,function 0,index 0xF6 to get chip rev.
 205                  */
 206                 outl(0x80000000 | (0xf6 & ~3), (unsigned long)0xCF8);
 207                 rev = (inl((unsigned long)0xCFC) >> ((0xf6 & 3) * 8)) & 0xff;
 208         }
 209         switch (info->var.bits_per_pixel) {
 210         case 8:
 211                 outb(0x1A, 0x3C4);
 212                 sr1a = inb(0x3C5);
 213                 outb(0x1B, 0x3C4);
 214                 sr1b = inb(0x3C5);
 215                 outb(0x67, 0x3D4);
 216                 cr67 = inb(0x3D5);
 217                 outb(0x6A, 0x3D4);
 218                 cr6a = inb(0x3D5);
 219
 220                 /* Map the 3C6/7/8/9 to the IGA2 */
 221                 outb(0x1A, 0x3C4);
 222                 outb(sr1a | 0x01, 0x3C5);
 223                 /* Second Display Engine colck always on */
 224                 outb(0x1B, 0x3C4);
 225                 outb(sr1b | 0x80, 0x3C5);
 226                 /* Second Display Color Depth 8 */
 227                 outb(0x67, 0x3D4);
 228                 outb(cr67 & 0x3F, 0x3D5);
 229                 outb(0x6A, 0x3D4);
 230                 /* Second Display Channel Reset CR6A[6]) */
 231                 outb(cr6a & 0xBF, 0x3D5);
 232                 /* Second Display Channel Enable CR6A[7] */
 233                 outb(cr6a | 0x80, 0x3D5);
 234                 /* Second Display Channel stop reset) */
 235                 outb(cr6a | 0x40, 0x3D5);
 236
 237                 /* Bit mask of palette */
 238                 outb(0xFF, 0x3c6);
 239                 /* Write one register of IGA2 */
 240                 outb(regno, 0x3C8);
 241                 if (UNICHROME_CLE266 == viaparinfo->chip_info->gfx_chip_name &&
 242                         rev >= 15) {
 243                         shift = 8;
 244                         viafb_write_reg_mask(CR6A, VIACR, BIT5, BIT5);
 245                         viafb_write_reg_mask(SR15, VIASR, BIT7, BIT7);
 246                 } else {
 247                         shift = 10;
 248                         viafb_write_reg_mask(CR6A, VIACR, 0, BIT5);
 249                         viafb_write_reg_mask(SR15, VIASR, 0, BIT7);
 250                 }
 251                 outb(red >> shift, 0x3C9);
 252                 outb(green >> shift, 0x3C9);
 253                 outb(blue >> shift, 0x3C9);
 254
 255                 /* Map the 3C6/7/8/9 to the IGA1 */
 256                 outb(0x1A, 0x3C4);
 257                 outb(sr1a & 0xFE, 0x3C5);
 258                 /* Bit mask of palette */
 259                 outb(0xFF, 0x3c6);
 260                 /* Write one register of IGA1 */
 261                 outb(regno, 0x3C8);
 262                 outb(red >> shift, 0x3C9);
 263                 outb(green >> shift, 0x3C9);
 264                 outb(blue >> shift, 0x3C9);
 265
 266                 outb(0x1A, 0x3C4);
 267                 outb(sr1a, 0x3C5);
 268                 outb(0x1B, 0x3C4);
 269                 outb(sr1b, 0x3C5);
 270                 outb(0x67, 0x3D4);
 271                 outb(cr67, 0x3D5);
 272                 outb(0x6A, 0x3D4);
 273                 outb(cr6a, 0x3D5);
 274                 break;
 275         case 16:
 276                 ((u32 *) info->pseudo_palette)[regno] = (red & 0xF800) |
 277                     ((green & 0xFC00) >> 5) | ((blue & 0xF800) >> 11);
 278                 break;
 279         case 32:
 280                 ((u32 *) info->pseudo_palette)[regno] =
 281                     ((transp & 0xFF00) << 16) |
 282                     ((red & 0xFF00) << 8) |
 283                     ((green & 0xFF00)) | ((blue & 0xFF00) >> 8);
 284                 break;
 285         }
 286
 287         return 0;
 288
 289 }
 290
 291 /*CALLED BY: fb_set_cmap */
 292 /*           fb_set_var, pass 256 colors */
 293 /*CALLED BY: fb_set_cmap */
 294 /*           fbcon_set_palette, pass 16 colors */
 295 static int viafb_setcmap(struct fb_cmap *cmap, struct fb_info *info)
 296 {
 297         u32 len = cmap->len;
 298         u32 i;
 299         u16 *pred = cmap->red;
 300         u16 *pgreen = cmap->green;
 301         u16 *pblue = cmap->blue;
 302         u16 *ptransp = cmap->transp;
 303         u8 sr1a, sr1b, cr67, cr6a, rev = 0, shift = 10;
 304         if (len > 256)
 305                 return 1;
 306         if (UNICHROME_CLE266 == viaparinfo->chip_info->gfx_chip_name) {
 307                 /*
 308                  * Read PCI bus 0, dev 0, function 0, index 0xF6 to get chip
 309                  * rev.
 310                  */
 311                 outl(0x80000000 | (0xf6 & ~3), (unsigned long)0xCF8);
 312                 rev = (inl((unsigned long)0xCFC) >> ((0xf6 & 3) * 8)) & 0xff;
 313         }
 314         switch (info->var.bits_per_pixel) {
 315         case 8:
 316                 outb(0x1A, 0x3C4);
 317                 sr1a = inb(0x3C5);
 318                 outb(0x1B, 0x3C4);
 319                 sr1b = inb(0x3C5);
 320                 outb(0x67, 0x3D4);
 321                 cr67 = inb(0x3D5);
 322                 outb(0x6A, 0x3D4);
 323                 cr6a = inb(0x3D5);
 324                 /* Map the 3C6/7/8/9 to the IGA2 */
 325                 outb(0x1A, 0x3C4);
 326                 outb(sr1a | 0x01, 0x3C5);
 327                 outb(0x1B, 0x3C4);
 328                 /* Second Display Engine colck always on */
 329                 outb(sr1b | 0x80, 0x3C5);
 330                 outb(0x67, 0x3D4);
 331                 /* Second Display Color Depth 8 */
 332                 outb(cr67 & 0x3F, 0x3D5);
 333                 outb(0x6A, 0x3D4);
 334                 /* Second Display Channel Reset CR6A[6]) */
 335                 outb(cr6a & 0xBF, 0x3D5);
 336                 /* Second Display Channel Enable CR6A[7] */
 337                 outb(cr6a | 0x80, 0x3D5);
 338                 /* Second Display Channel stop reset) */
 339                 outb(cr6a | 0xC0, 0x3D5);
 340
 341                 /* Bit mask of palette */
 342                 outb(0xFF, 0x3c6);
 343                 outb(0x00, 0x3C8);
 344                 if (UNICHROME_CLE266 == viaparinfo->chip_info->gfx_chip_name &&
 345                         rev >= 15) {
 346                         shift = 8;
 347                         viafb_write_reg_mask(CR6A, VIACR, BIT5, BIT5);
 348                         viafb_write_reg_mask(SR15, VIASR, BIT7, BIT7);
 349                 } else {
 350                         shift = 10;
 351                         viafb_write_reg_mask(CR6A, VIACR, 0, BIT5);
 352                         viafb_write_reg_mask(SR15, VIASR, 0, BIT7);
 353                 }
 354                 for (i = 0; i < len; i++) {
 355                         outb((*(pred + i)) >> shift, 0x3C9);
 356                         outb((*(pgreen + i)) >> shift, 0x3C9);
 357                         outb((*(pblue + i)) >> shift, 0x3C9);
 358                 }
 359
 360                 outb(0x1A, 0x3C4);
 361                 /* Map the 3C6/7/8/9 to the IGA1 */
 362                 outb(sr1a & 0xFE, 0x3C5);
 363                 /* Bit mask of palette */
 364                 outb(0xFF, 0x3c6);
 365                 outb(0x00, 0x3C8);
 366                 for (i = 0; i < len; i++) {
 367                         outb((*(pred + i)) >> shift, 0x3C9);
 368                         outb((*(pgreen + i)) >> shift, 0x3C9);
 369                         outb((*(pblue + i)) >> shift, 0x3C9);
 370                 }
 371
 372                 outb(0x1A, 0x3C4);
 373                 outb(sr1a, 0x3C5);
 374                 outb(0x1B, 0x3C4);
 375                 outb(sr1b, 0x3C5);
 376                 outb(0x67, 0x3D4);
 377                 outb(cr67, 0x3D5);
 378                 outb(0x6A, 0x3D4);
 379                 outb(cr6a, 0x3D5);
 380                 break;
 381         case 16:
 382                 if (len > 17)
 383                         return 0;       /* Because static u32 pseudo_pal[17]; */
 384                 for (i = 0; i < len; i++)
 385                         ((u32 *) info->pseudo_palette)[i] =
 386                             (*(pred + i) & 0xF800) |
 387                             ((*(pgreen + i) & 0xFC00) >> 5) |
 388                             ((*(pblue + i) & 0xF800) >> 11);
 389                 break;
 390         case 32:
 391                 if (len > 17)
 392                         return 0;
 393                 if (ptransp) {
 394                         for (i = 0; i < len; i++)
 395                                 ((u32 *) info->pseudo_palette)[i] =
 396                                     ((*(ptransp + i) & 0xFF00) << 16) |
 397                                     ((*(pred + i) & 0xFF00) << 8) |
 398                                     ((*(pgreen + i) & 0xFF00)) |
 399                                     ((*(pblue + i) & 0xFF00) >> 8);
 400                 } else {
 401                         for (i = 0; i < len; i++)
 402                                 ((u32 *) info->pseudo_palette)[i] =
 403                                     0x00000000 |
 404                                     ((*(pred + i) & 0xFF00) << 8) |
 405                                     ((*(pgreen + i) & 0xFF00)) |
 406                                     ((*(pblue + i) & 0xFF00) >> 8);
 407                 }
 408                 break;
 409         }
 410         return 0;
 411 }
 412
 413 static int viafb_pan_display(struct fb_var_screeninfo *var,
 414         struct fb_info *info)
 415 {
 416         struct viafb_par *viapar = info->par;
 417         u32 vram_addr = (var->yoffset * var->xres_virtual + var->xoffset)
 418                 * (var->bits_per_pixel / 8) + viapar->vram_addr;
 419
 420         DEBUG_MSG(KERN_DEBUG "viafb_pan_display, address = %d\n", vram_addr);
 421         if (!viafb_dual_fb) {
 422                 viafb_set_primary_address(vram_addr);
 423                 viafb_set_secondary_address(vram_addr);
 424         } else if (viapar->iga_path == IGA1)
 425                 viafb_set_primary_address(vram_addr);
 426         else
 427                 viafb_set_secondary_address(vram_addr);
 428
 429         return 0;
 430 }
 431
 432 static int viafb_blank(int blank_mode, struct fb_info *info)
 433 {
 434         DEBUG_MSG(KERN_INFO "viafb_blank!\n");
 435         /* clear DPMS setting */
 436
 437         switch (blank_mode) {
 438         case FB_BLANK_UNBLANK:
 439                 /* Screen: On, HSync: On, VSync: On */
 440                 /* control CRT monitor power management */
 441                 viafb_write_reg_mask(CR36, VIACR, 0x00, BIT4 + BIT5);
 442                 break;
 443         case FB_BLANK_HSYNC_SUSPEND:
 444                 /* Screen: Off, HSync: Off, VSync: On */
 445                 /* control CRT monitor power management */
 446                 viafb_write_reg_mask(CR36, VIACR, 0x10, BIT4 + BIT5);
 447                 break;
 448         case FB_BLANK_VSYNC_SUSPEND:
 449                 /* Screen: Off, HSync: On, VSync: Off */
 450                 /* control CRT monitor power management */
 451                 viafb_write_reg_mask(CR36, VIACR, 0x20, BIT4 + BIT5);
 452                 break;
 453         case FB_BLANK_POWERDOWN:
 454                 /* Screen: Off, HSync: Off, VSync: Off */
 455                 /* control CRT monitor power management */
 456                 viafb_write_reg_mask(CR36, VIACR, 0x30, BIT4 + BIT5);
 457                 break;
 458         }
 459
 460         return 0;
 461 }
 462
 463 static int viafb_ioctl(struct fb_info *info, u_int cmd, u_long arg)
 464 {
 465         union {
 466                 struct viafb_ioctl_mode viamode;
 467                 struct viafb_ioctl_samm viasamm;
 468                 struct viafb_driver_version driver_version;
 469                 struct fb_var_screeninfo sec_var;
 470                 struct _panel_size_pos_info panel_pos_size_para;
 471                 struct viafb_ioctl_setting viafb_setting;
 472                 struct device_t active_dev;
 473         } u;
 474         u32 state_info = 0;
 475         u32 *viafb_gamma_table;
 476         char driver_name[] = "viafb";
 477
 478         u32 __user *argp = (u32 __user *) arg;
 479         u32 gpu32;
 480
 481         DEBUG_MSG(KERN_INFO "viafb_ioctl: 0x%X !!\n", cmd);
 482         printk(KERN_WARNING "viafb_ioctl: Please avoid this interface as it is unstable and might change or vanish at any time!\n");
 483         memset(&u, 0, sizeof(u));
 484
 485         switch (cmd) {
 486         case VIAFB_GET_CHIP_INFO:
 487                 if (copy_to_user(argp, viaparinfo->chip_info,
 488                                 sizeof(struct chip_information)))
 489                         return -EFAULT;
 490                 break;
 491         case VIAFB_GET_INFO_SIZE:
 492                 return put_user((u32)sizeof(struct viafb_ioctl_info), argp);
 493         case VIAFB_GET_INFO:
 494                 return viafb_ioctl_get_viafb_info(arg);
 495         case VIAFB_HOTPLUG:
 496                 return put_user(viafb_ioctl_hotplug(info->var.xres,
 497                                               info->var.yres,
 498                                               info->var.bits_per_pixel), argp);
 499         case VIAFB_SET_HOTPLUG_FLAG:
 500                 if (copy_from_user(&gpu32, argp, sizeof(gpu32)))
 501                         return -EFAULT;
 502                 viafb_hotplug = (gpu32) ? 1 : 0;
 503                 break;
 504         case VIAFB_GET_RESOLUTION:
 505                 u.viamode.xres = (u32) viafb_hotplug_Xres;
 506                 u.viamode.yres = (u32) viafb_hotplug_Yres;
 507                 u.viamode.refresh = (u32) viafb_hotplug_refresh;
 508                 u.viamode.bpp = (u32) viafb_hotplug_bpp;
 509                 if (viafb_SAMM_ON == 1) {
 510                         u.viamode.xres_sec = viafb_second_xres;
 511                         u.viamode.yres_sec = viafb_second_yres;
 512                         u.viamode.virtual_xres_sec = viafb_second_virtual_xres;
 513                         u.viamode.virtual_yres_sec = viafb_second_virtual_yres;
 514                         u.viamode.refresh_sec = viafb_refresh1;
 515                         u.viamode.bpp_sec = viafb_bpp1;
 516                 } else {
 517                         u.viamode.xres_sec = 0;
 518                         u.viamode.yres_sec = 0;
 519                         u.viamode.virtual_xres_sec = 0;
 520                         u.viamode.virtual_yres_sec = 0;
 521                         u.viamode.refresh_sec = 0;
 522                         u.viamode.bpp_sec = 0;
 523                 }
 524                 if (copy_to_user(argp, &u.viamode, sizeof(u.viamode)))
 525                         return -EFAULT;
 526                 break;
 527         case VIAFB_GET_SAMM_INFO:
 528                 u.viasamm.samm_status = viafb_SAMM_ON;
 529
 530                 if (viafb_SAMM_ON == 1) {
 531                         if (viafb_dual_fb) {
 532                                 u.viasamm.size_prim = viaparinfo->fbmem_free;
 533                                 u.viasamm.size_sec = viaparinfo1->fbmem_free;
 534                         } else {
 535                                 if (viafb_second_size) {
 536                                         u.viasamm.size_prim =
 537                                             viaparinfo->fbmem_free -
 538                                             viafb_second_size * 1024 * 1024;
 539                                         u.viasamm.size_sec =
 540                                             viafb_second_size * 1024 * 1024;
 541                                 } else {
 542                                         u.viasamm.size_prim =
 543                                             viaparinfo->fbmem_free >> 1;
 544                                         u.viasamm.size_sec =
 545                                             (viaparinfo->fbmem_free >> 1);
 546                                 }
 547                         }
 548                         u.viasamm.mem_base = viaparinfo->fbmem;
 549                         u.viasamm.offset_sec = viafb_second_offset;
 550                 } else {
 551                         u.viasamm.size_prim =
 552                             viaparinfo->memsize - viaparinfo->fbmem_used;
 553                         u.viasamm.size_sec = 0;
 554                         u.viasamm.mem_base = viaparinfo->fbmem;
 555                         u.viasamm.offset_sec = 0;
 556                 }
 557
 558                 if (copy_to_user(argp, &u.viasamm, sizeof(u.viasamm)))
 559                         return -EFAULT;
 560
 561                 break;
 562         case VIAFB_TURN_ON_OUTPUT_DEVICE:
 563                 if (copy_from_user(&gpu32, argp, sizeof(gpu32)))
 564                         return -EFAULT;
 565                 if (gpu32 & CRT_Device)
 566                         viafb_crt_enable();
 567                 if (gpu32 & DVI_Device)
 568                         viafb_dvi_enable();
 569                 if (gpu32 & LCD_Device)
 570                         viafb_lcd_enable();
 571                 break;
 572         case VIAFB_TURN_OFF_OUTPUT_DEVICE:
 573                 if (copy_from_user(&gpu32, argp, sizeof(gpu32)))
 574                         return -EFAULT;
 575                 if (gpu32 & CRT_Device)
 576                         viafb_crt_disable();
 577                 if (gpu32 & DVI_Device)
 578                         viafb_dvi_disable();
 579                 if (gpu32 & LCD_Device)
 580                         viafb_lcd_disable();
 581                 break;
 582         case VIAFB_SET_DEVICE:
 583                 if (copy_from_user(&u.active_dev, (void *)argp,
 584                         sizeof(u.active_dev)))
 585                         return -EFAULT;
 586                 viafb_set_device(u.active_dev);
 587                 viafb_set_par(info);
 588                 break;
 589         case VIAFB_GET_DEVICE:
 590                 u.active_dev.crt = viafb_CRT_ON;
 591                 u.active_dev.dvi = viafb_DVI_ON;
 592                 u.active_dev.lcd = viafb_LCD_ON;
 593                 u.active_dev.samm = viafb_SAMM_ON;
 594                 u.active_dev.primary_dev = viafb_primary_dev;
 595
 596                 u.active_dev.lcd_dsp_cent = viafb_lcd_dsp_method;
 597                 u.active_dev.lcd_panel_id = viafb_lcd_panel_id;
 598                 u.active_dev.lcd_mode = viafb_lcd_mode;
 599
 600                 u.active_dev.xres = viafb_hotplug_Xres;
 601                 u.active_dev.yres = viafb_hotplug_Yres;
 602
 603                 u.active_dev.xres1 = viafb_second_xres;
 604                 u.active_dev.yres1 = viafb_second_yres;
 605
 606                 u.active_dev.bpp = viafb_bpp;
 607                 u.active_dev.bpp1 = viafb_bpp1;
 608                 u.active_dev.refresh = viafb_refresh;
 609                 u.active_dev.refresh1 = viafb_refresh1;
 610
 611                 u.active_dev.epia_dvi = viafb_platform_epia_dvi;
 612                 u.active_dev.lcd_dual_edge = viafb_device_lcd_dualedge;
 613                 u.active_dev.bus_width = viafb_bus_width;
 614
 615                 if (copy_to_user(argp, &u.active_dev, sizeof(u.active_dev)))
 616                         return -EFAULT;
 617                 break;
 618
 619         case VIAFB_GET_DRIVER_VERSION:
 620                 u.driver_version.iMajorNum = VERSION_MAJOR;
 621                 u.driver_version.iKernelNum = VERSION_KERNEL;
 622                 u.driver_version.iOSNum = VERSION_OS;
 623                 u.driver_version.iMinorNum = VERSION_MINOR;
 624
 625                 if (copy_to_user(argp, &u.driver_version,
 626                         sizeof(u.driver_version)))
 627                         return -EFAULT;
 628
 629                 break;
 630
 631         case VIAFB_SET_DEVICE_INFO:
 632                 if (copy_from_user(&u.viafb_setting,
 633                         argp, sizeof(u.viafb_setting)))
 634                         return -EFAULT;
 635                 if (apply_device_setting(u.viafb_setting, info) < 0)
 636                         return -EINVAL;
 637
 638                 break;
 639
 640         case VIAFB_SET_SECOND_MODE:
 641                 if (copy_from_user(&u.sec_var, argp, sizeof(u.sec_var)))
 642                         return -EFAULT;
 643                 apply_second_mode_setting(&u.sec_var);
 644                 break;
 645
 646         case VIAFB_GET_DEVICE_INFO:
 647
 648                 retrieve_device_setting(&u.viafb_setting);
 649
 650                 if (copy_to_user(argp, &u.viafb_setting,
 651                                  sizeof(u.viafb_setting)))
 652                         return -EFAULT;
 653
 654                 break;
 655
 656         case VIAFB_GET_DEVICE_SUPPORT:
 657                 viafb_get_device_support_state(&state_info);
 658                 if (put_user(state_info, argp))
 659                         return -EFAULT;
 660                 break;
 661
 662         case VIAFB_GET_DEVICE_CONNECT:
 663                 viafb_get_device_connect_state(&state_info);
 664                 if (put_user(state_info, argp))
 665                         return -EFAULT;
 666                 break;
 667
 668         case VIAFB_GET_PANEL_SUPPORT_EXPAND:
 669                 state_info =
 670                     viafb_lcd_get_support_expand_state(info->var.xres,
 671                                                  info->var.yres);
 672                 if (put_user(state_info, argp))
 673                         return -EFAULT;
 674                 break;
 675
 676         case VIAFB_GET_DRIVER_NAME:
 677                 if (copy_to_user(argp, driver_name, sizeof(driver_name)))
 678                         return -EFAULT;
 679                 break;
 680
 681         case VIAFB_SET_GAMMA_LUT:
 682                 viafb_gamma_table = kmalloc(256 * sizeof(u32), GFP_KERNEL);
 683                 if (!viafb_gamma_table)
 684                         return -ENOMEM;
 685                 if (copy_from_user(viafb_gamma_table, argp,
 686                                 256 * sizeof(u32))) {
 687                         kfree(viafb_gamma_table);
 688                         return -EFAULT;
 689                 }
 690                 viafb_set_gamma_table(viafb_bpp, viafb_gamma_table);
 691                 kfree(viafb_gamma_table);
 692                 break;
 693
 694         case VIAFB_GET_GAMMA_LUT:
 695                 viafb_gamma_table = kmalloc(256 * sizeof(u32), GFP_KERNEL);
 696                 if (!viafb_gamma_table)
 697                         return -ENOMEM;
 698                 viafb_get_gamma_table(viafb_gamma_table);
 699                 if (copy_to_user(argp, viafb_gamma_table,
 700                         256 * sizeof(u32))) {
 701                         kfree(viafb_gamma_table);
 702                         return -EFAULT;
 703                 }
 704                 kfree(viafb_gamma_table);
 705                 break;
 706
 707         case VIAFB_GET_GAMMA_SUPPORT_STATE:
 708                 viafb_get_gamma_support_state(viafb_bpp, &state_info);
 709                 if (put_user(state_info, argp))
 710                         return -EFAULT;
 711                 break;
 712         case VIAFB_SYNC_SURFACE:
 713                 DEBUG_MSG(KERN_INFO "lobo VIAFB_SYNC_SURFACE\n");
 714                 break;
 715         case VIAFB_GET_DRIVER_CAPS:
 716                 break;
 717
 718         case VIAFB_GET_PANEL_MAX_SIZE:
 719                 if (copy_from_user(&u.panel_pos_size_para, argp,
 720                                    sizeof(u.panel_pos_size_para)))
 721                         return -EFAULT;
 722                 u.panel_pos_size_para.x = u.panel_pos_size_para.y = 0;
 723                 if (copy_to_user(argp, &u.panel_pos_size_para,
 724                      sizeof(u.panel_pos_size_para)))
 725                         return -EFAULT;
 726                 break;
 727         case VIAFB_GET_PANEL_MAX_POSITION:
 728                 if (copy_from_user(&u.panel_pos_size_para, argp,
 729                                    sizeof(u.panel_pos_size_para)))
 730                         return -EFAULT;
 731                 u.panel_pos_size_para.x = u.panel_pos_size_para.y = 0;
 732                 if (copy_to_user(argp, &u.panel_pos_size_para,
 733                                  sizeof(u.panel_pos_size_para)))
 734                         return -EFAULT;
 735                 break;
 736
 737         case VIAFB_GET_PANEL_POSITION:
 738                 if (copy_from_user(&u.panel_pos_size_para, argp,
 739                                    sizeof(u.panel_pos_size_para)))
 740                         return -EFAULT;
 741                 u.panel_pos_size_para.x = u.panel_pos_size_para.y = 0;
 742                 if (copy_to_user(argp, &u.panel_pos_size_para,
 743                                  sizeof(u.panel_pos_size_para)))
 744                         return -EFAULT;
 745                 break;
 746         case VIAFB_GET_PANEL_SIZE:
 747                 if (copy_from_user(&u.panel_pos_size_para, argp,
 748                                    sizeof(u.panel_pos_size_para)))
 749                         return -EFAULT;
 750                 u.panel_pos_size_para.x = u.panel_pos_size_para.y = 0;
 751                 if (copy_to_user(argp, &u.panel_pos_size_para,
 752                                  sizeof(u.panel_pos_size_para)))
 753                         return -EFAULT;
 754                 break;
 755
 756         case VIAFB_SET_PANEL_POSITION:
 757                 if (copy_from_user(&u.panel_pos_size_para, argp,
 758                                    sizeof(u.panel_pos_size_para)))
 759                         return -EFAULT;
 760                 break;
 761         case VIAFB_SET_PANEL_SIZE:
 762                 if (copy_from_user(&u.panel_pos_size_para, argp,
 763                                    sizeof(u.panel_pos_size_para)))
 764                         return -EFAULT;
 765                 break;
 766
 767         default:
 768                 return -EINVAL;
 769         }
 770
 771         return 0;
 772 }
 773
 774 static void viafb_fillrect(struct fb_info *info,
 775         const struct fb_fillrect *rect)
 776 {
 777         struct viafb_par *viapar = info->par;
 778         struct viafb_shared *shared = viapar->shared;
 779         u32 fg_color;
 780         u8 rop;
 781
 782         if (info->flags & FBINFO_HWACCEL_DISABLED || !shared->hw_bitblt) {
 783                 cfb_fillrect(info, rect);
 784                 return;
 785         }
 786
 787         if (!rect->width || !rect->height)
 788                 return;
 789
 790         if (info->fix.visual == FB_VISUAL_TRUECOLOR)
 791                 fg_color = ((u32 *)info->pseudo_palette)[rect->color];
 792         else
 793                 fg_color = rect->color;
 794
 795         if (rect->rop == ROP_XOR)
 796                 rop = 0x5A;
 797         else
 798                 rop = 0xF0;
 799
 800         DEBUG_MSG(KERN_DEBUG "viafb 2D engine: fillrect\n");
 801         if (shared->hw_bitblt(shared->engine_mmio, VIA_BITBLT_FILL,
 802                 rect->width, rect->height, info->var.bits_per_pixel,
 803                 viapar->vram_addr, info->fix.line_length, rect->dx, rect->dy,
 804                 NULL, 0, 0, 0, 0, fg_color, 0, rop))
 805                 cfb_fillrect(info, rect);
 806 }
 807
 808 static void viafb_copyarea(struct fb_info *info,
 809         const struct fb_copyarea *area)
 810 {
 811         struct viafb_par *viapar = info->par;
 812         struct viafb_shared *shared = viapar->shared;
 813
 814         if (info->flags & FBINFO_HWACCEL_DISABLED || !shared->hw_bitblt) {
 815                 cfb_copyarea(info, area);
 816                 return;
 817         }
 818
 819         if (!area->width || !area->height)
 820                 return;
 821
 822         DEBUG_MSG(KERN_DEBUG "viafb 2D engine: copyarea\n");
 823         if (shared->hw_bitblt(shared->engine_mmio, VIA_BITBLT_COLOR,
 824                 area->width, area->height, info->var.bits_per_pixel,
 825                 viapar->vram_addr, info->fix.line_length, area->dx, area->dy,
 826                 NULL, viapar->vram_addr, info->fix.line_length,
 827                 area->sx, area->sy, 0, 0, 0))
 828                 cfb_copyarea(info, area);
 829 }
 830
 831 static void viafb_imageblit(struct fb_info *info,
 832         const struct fb_image *image)
 833 {
 834         struct viafb_par *viapar = info->par;
 835         struct viafb_shared *shared = viapar->shared;
 836         u32 fg_color = 0, bg_color = 0;
 837         u8 op;
 838
 839         if (info->flags & FBINFO_HWACCEL_DISABLED || !shared->hw_bitblt ||
 840                 (image->depth != 1 && image->depth != viapar->depth)) {
 841                 cfb_imageblit(info, image);
 842                 return;
 843         }
 844
 845         if (image->depth == 1) {
 846                 op = VIA_BITBLT_MONO;
 847                 if (info->fix.visual == FB_VISUAL_TRUECOLOR) {
 848                         fg_color =
 849                                 ((u32 *)info->pseudo_palette)[image->fg_color];
 850                         bg_color =
 851                                 ((u32 *)info->pseudo_palette)[image->bg_color];
 852                 } else {
 853                         fg_color = image->fg_color;
 854                         bg_color = image->bg_color;
 855                 }
 856         } else
 857                 op = VIA_BITBLT_COLOR;
 858
 859         DEBUG_MSG(KERN_DEBUG "viafb 2D engine: imageblit\n");
 860         if (shared->hw_bitblt(shared->engine_mmio, op,
 861                 image->width, image->height, info->var.bits_per_pixel,
 862                 viapar->vram_addr, info->fix.line_length, image->dx, image->dy,
 863                 (u32 *)image->data, 0, 0, 0, 0, fg_color, bg_color, 0))
 864                 cfb_imageblit(info, image);
 865 }
 866
 867 static int viafb_cursor(struct fb_info *info, struct fb_cursor *cursor)
 868 {
 869         struct viafb_par *viapar = info->par;
 870         void __iomem *engine = viapar->shared->engine_mmio;
 871         u32 temp, xx, yy, bg_color = 0, fg_color = 0,
 872                 chip_name = viapar->shared->chip_info.gfx_chip_name;
 873         int i, j = 0, cur_size = 64;
 874
 875         if (info->flags & FBINFO_HWACCEL_DISABLED || info != viafbinfo)
 876                 return -ENODEV;
 877
 878         /* LCD ouput does not support hw cursors (at least on VN896) */
 879         if ((chip_name == UNICHROME_CLE266 && viapar->iga_path == IGA2) ||
 880                 viafb_LCD_ON)
 881                 return -ENODEV;
 882
 883         viafb_show_hw_cursor(info, HW_Cursor_OFF);
 884
 885         if (cursor->set & FB_CUR_SETHOT) {
 886                 temp = (cursor->hot.x << 16) + cursor->hot.y;
 887                 writel(temp, engine + VIA_REG_CURSOR_ORG);
 888         }
 889
 890         if (cursor->set & FB_CUR_SETPOS) {
 891                 yy = cursor->image.dy - info->var.yoffset;
 892                 xx = cursor->image.dx - info->var.xoffset;
 893                 temp = yy & 0xFFFF;
 894                 temp |= (xx << 16);
 895                 writel(temp, engine + VIA_REG_CURSOR_POS);
 896         }
 897
 898         if (cursor->image.width <= 32 && cursor->image.height <= 32)
 899                 cur_size = 32;
 900         else if (cursor->image.width <= 64 && cursor->image.height <= 64)
 901                 cur_size = 64;
 902         else {
 903                 printk(KERN_WARNING "viafb_cursor: The cursor is too large "
 904                         "%dx%d", cursor->image.width, cursor->image.height);
 905                 return -ENXIO;
 906         }
 907
 908         if (cursor->set & FB_CUR_SETSIZE) {
 909                 temp = readl(engine + VIA_REG_CURSOR_MODE);
 910                 if (cur_size == 32)
 911                         temp |= 0x2;
 912                 else
 913                         temp &= ~0x2;
 914
 915                 writel(temp, engine + VIA_REG_CURSOR_MODE);
 916         }
 917
 918         if (cursor->set & FB_CUR_SETCMAP) {
 919                 fg_color = cursor->image.fg_color;
 920                 bg_color = cursor->image.bg_color;
 921                 if (chip_name == UNICHROME_CX700 ||
 922                         chip_name == UNICHROME_VX800 ||
 923                         chip_name == UNICHROME_VX855) {
 924                         fg_color =
 925                                 ((info->cmap.red[fg_color] & 0xFFC0) << 14) |
 926                                 ((info->cmap.green[fg_color] & 0xFFC0) << 4) |
 927                                 ((info->cmap.blue[fg_color] & 0xFFC0) >> 6);
 928                         bg_color =
 929                                 ((info->cmap.red[bg_color] & 0xFFC0) << 14) |
 930                                 ((info->cmap.green[bg_color] & 0xFFC0) << 4) |
 931                                 ((info->cmap.blue[bg_color] & 0xFFC0) >> 6);
 932                 } else {
 933                         fg_color =
 934                                 ((info->cmap.red[fg_color] & 0xFF00) << 8) |
 935                                 (info->cmap.green[fg_color] & 0xFF00) |
 936                                 ((info->cmap.blue[fg_color] & 0xFF00) >> 8);
 937                         bg_color =
 938                                 ((info->cmap.red[bg_color] & 0xFF00) << 8) |
 939                                 (info->cmap.green[bg_color] & 0xFF00) |
 940                                 ((info->cmap.blue[bg_color] & 0xFF00) >> 8);
 941                 }
 942
 943                 writel(bg_color, engine + VIA_REG_CURSOR_BG);
 944                 writel(fg_color, engine + VIA_REG_CURSOR_FG);
 945         }
 946
 947         if (cursor->set & FB_CUR_SETSHAPE) {
 948                 struct {
 949                         u8 data[CURSOR_SIZE];
 950                         u32 bak[CURSOR_SIZE / 4];
 951                 } *cr_data = kzalloc(sizeof(*cr_data), GFP_ATOMIC);
 952                 int size = ((cursor->image.width + 7) >> 3) *
 953                         cursor->image.height;
 954
 955                 if (!cr_data)
 956                         return -ENOMEM;
 957
 958                 if (cur_size == 32) {
 959                         for (i = 0; i < (CURSOR_SIZE / 4); i++) {
 960                                 cr_data->bak[i] = 0x0;
 961                                 cr_data->bak[i + 1] = 0xFFFFFFFF;
 962                                 i += 1;
 963                         }
 964                 } else {
 965                         for (i = 0; i < (CURSOR_SIZE / 4); i++) {
 966                                 cr_data->bak[i] = 0x0;
 967                                 cr_data->bak[i + 1] = 0x0;
 968                                 cr_data->bak[i + 2] = 0xFFFFFFFF;
 969                                 cr_data->bak[i + 3] = 0xFFFFFFFF;
 970                                 i += 3;
 971                         }
 972                 }
 973
 974                 switch (cursor->rop) {
 975                 case ROP_XOR:
 976                         for (i = 0; i < size; i++)
 977                                 cr_data->data[i] = cursor->mask[i];
 978                         break;
 979                 case ROP_COPY:
 980
 981                         for (i = 0; i < size; i++)
 982                                 cr_data->data[i] = cursor->mask[i];
 983                         break;
 984                 default:
 985                         break;
 986                 }
 987
 988                 if (cur_size == 32) {
 989                         for (i = 0; i < size; i++) {
 990                                 cr_data->bak[j] = (u32) cr_data->data[i];
 991                                 cr_data->bak[j + 1] = ~cr_data->bak[j];
 992                                 j += 2;
 993                         }
 994                 } else {
 995                         for (i = 0; i < size; i++) {
 996                                 cr_data->bak[j] = (u32) cr_data->data[i];
 997                                 cr_data->bak[j + 1] = 0x0;
 998                                 cr_data->bak[j + 2] = ~cr_data->bak[j];
 999                                 cr_data->bak[j + 3] = ~cr_data->bak[j + 1];
1000                                 j += 4;
1001                         }
1002                 }
1003
1004                 memcpy_toio(viafbinfo->screen_base + viapar->shared->
1005                         cursor_vram_addr, cr_data->bak, CURSOR_SIZE);
1006                 kfree(cr_data);
1007         }
1008
1009         if (cursor->enable)
1010                 viafb_show_hw_cursor(info, HW_Cursor_ON);
1011
1012         return 0;
1013 }
1014
1015 static int viafb_sync(struct fb_info *info)
1016 {
1017         if (!(info->flags & FBINFO_HWACCEL_DISABLED))
1018                 viafb_wait_engine_idle(info);
1019         return 0;
1020 }
1021
1022 static void check_available_device_to_enable(int device_id)
1023 {
1024         int device_num = 0;
1025
1026         /* Initialize: */
1027         viafb_CRT_ON = STATE_OFF;
1028         viafb_DVI_ON = STATE_OFF;
1029         viafb_LCD_ON = STATE_OFF;
1030         viafb_LCD2_ON = STATE_OFF;
1031         viafb_DeviceStatus = None_Device;
1032
1033         if ((device_id & CRT_Device) && (device_num < MAX_ACTIVE_DEV_NUM)) {
1034                 viafb_CRT_ON = STATE_ON;
1035                 device_num++;
1036                 viafb_DeviceStatus |= CRT_Device;
1037         }
1038
1039         if ((device_id & DVI_Device) && (device_num < MAX_ACTIVE_DEV_NUM)) {
1040                 viafb_DVI_ON = STATE_ON;
1041                 device_num++;
1042                 viafb_DeviceStatus |= DVI_Device;
1043         }
1044
1045         if ((device_id & LCD_Device) && (device_num < MAX_ACTIVE_DEV_NUM)) {
1046                 viafb_LCD_ON = STATE_ON;
1047                 device_num++;
1048                 viafb_DeviceStatus |= LCD_Device;
1049         }
1050
1051         if ((device_id & LCD2_Device) && (device_num < MAX_ACTIVE_DEV_NUM)) {
1052                 viafb_LCD2_ON = STATE_ON;
1053                 device_num++;
1054                 viafb_DeviceStatus |= LCD2_Device;
1055         }
1056
1057         if (viafb_DeviceStatus == None_Device) {
1058                 /* Use CRT as default active device: */
1059                 viafb_CRT_ON = STATE_ON;
1060                 viafb_DeviceStatus = CRT_Device;
1061         }
1062         DEBUG_MSG(KERN_INFO "Device Status:%x", viafb_DeviceStatus);
1063 }
1064
1065 static void viafb_set_device(struct device_t active_dev)
1066 {
1067         /* Check available device to enable: */
1068         int device_id = None_Device;
1069         if (active_dev.crt)
1070                 device_id |= CRT_Device;
1071         if (active_dev.dvi)
1072                 device_id |= DVI_Device;
1073         if (active_dev.lcd)
1074                 device_id |= LCD_Device;
1075
1076         check_available_device_to_enable(device_id);
1077
1078         /* Check property of LCD: */
1079         if (viafb_LCD_ON) {
1080                 if (active_dev.lcd_dsp_cent) {
1081                         viaparinfo->lvds_setting_info->display_method =
1082                                 viafb_lcd_dsp_method = LCD_CENTERING;
1083                 } else {
1084                         viaparinfo->lvds_setting_info->display_method =
1085                                 viafb_lcd_dsp_method = LCD_EXPANDSION;
1086                 }
1087
1088                 if (active_dev.lcd_mode == LCD_SPWG) {
1089                         viaparinfo->lvds_setting_info->lcd_mode =
1090                                 viafb_lcd_mode = LCD_SPWG;
1091                 } else {
1092                         viaparinfo->lvds_setting_info->lcd_mode =
1093                                 viafb_lcd_mode = LCD_OPENLDI;
1094                 }
1095
1096                 if (active_dev.lcd_panel_id <= LCD_PANEL_ID_MAXIMUM) {
1097                         viafb_lcd_panel_id = active_dev.lcd_panel_id;
1098                         viafb_init_lcd_size();
1099                 }
1100         }
1101
1102         /* Check property of mode: */
1103         if (!active_dev.xres1)
1104                 viafb_second_xres = 640;
1105         else
1106                 viafb_second_xres = active_dev.xres1;
1107         if (!active_dev.yres1)
1108                 viafb_second_yres = 480;
1109         else
1110                 viafb_second_yres = active_dev.yres1;
1111         if (active_dev.bpp != 0)
1112                 viafb_bpp = active_dev.bpp;
1113         if (active_dev.bpp1 != 0)
1114                 viafb_bpp1 = active_dev.bpp1;
1115         if (active_dev.refresh != 0)
1116                 viafb_refresh = active_dev.refresh;
1117         if (active_dev.refresh1 != 0)
1118                 viafb_refresh1 = active_dev.refresh1;
1119         if ((active_dev.samm == STATE_OFF) || (active_dev.samm == STATE_ON))
1120                 viafb_SAMM_ON = active_dev.samm;
1121         viafb_primary_dev = active_dev.primary_dev;
1122
1123         viafb_set_primary_address(0);
1124         viafb_set_secondary_address(viafb_SAMM_ON ? viafb_second_offset : 0);
1125         viafb_set_iga_path();
1126 }
1127
1128 static int get_primary_device(void)
1129 {
1130         int primary_device = 0;
1131         /* Rule: device on iga1 path are the primary device. */
1132         if (viafb_SAMM_ON) {
1133                 if (viafb_CRT_ON) {
1134                         if (viaparinfo->crt_setting_info->iga_path == IGA1) {
1135                                 DEBUG_MSG(KERN_INFO "CRT IGA Path:%d\n",
1136                                         viaparinfo->
1137                                         crt_setting_info->iga_path);
1138                                 primary_device = CRT_Device;
1139                         }
1140                 }
1141                 if (viafb_DVI_ON) {
1142                         if (viaparinfo->tmds_setting_info->iga_path == IGA1) {
1143                                 DEBUG_MSG(KERN_INFO "DVI IGA Path:%d\n",
1144                                         viaparinfo->
1145                                         tmds_setting_info->iga_path);
1146                                 primary_device = DVI_Device;
1147                         }
1148                 }
1149                 if (viafb_LCD_ON) {
1150                         if (viaparinfo->lvds_setting_info->iga_path == IGA1) {
1151                                 DEBUG_MSG(KERN_INFO "LCD IGA Path:%d\n",
1152                                         viaparinfo->
1153                                         lvds_setting_info->iga_path);
1154                                 primary_device = LCD_Device;
1155                         }
1156                 }
1157                 if (viafb_LCD2_ON) {
1158                         if (viaparinfo->lvds_setting_info2->iga_path == IGA1) {
1159                                 DEBUG_MSG(KERN_INFO "LCD2 IGA Path:%d\n",
1160                                         viaparinfo->
1161                                         lvds_setting_info2->iga_path);
1162                                 primary_device = LCD2_Device;
1163                         }
1164                 }
1165         }
1166         return primary_device;
1167 }
1168
1169 static void apply_second_mode_setting(struct fb_var_screeninfo
1170         *sec_var)
1171 {
1172         u32 htotal, vtotal, long_refresh;
1173
1174         htotal = sec_var->xres + sec_var->left_margin +
1175                 sec_var->right_margin + sec_var->hsync_len;
1176         vtotal = sec_var->yres + sec_var->upper_margin +
1177                 sec_var->lower_margin + sec_var->vsync_len;
1178         if ((sec_var->xres_virtual * (sec_var->bits_per_pixel >> 3)) & 0x1F) {
1179                 /*Is 32 bytes alignment? */
1180                 /*32 pixel alignment */
1181                 sec_var->xres_virtual = (sec_var->xres_virtual + 31) & ~31;
1182         }
1183
1184         htotal = sec_var->xres + sec_var->left_margin +
1185                 sec_var->right_margin + sec_var->hsync_len;
1186         vtotal = sec_var->yres + sec_var->upper_margin +
1187                 sec_var->lower_margin + sec_var->vsync_len;
1188         long_refresh = 1000000000UL / sec_var->pixclock * 1000;
1189         long_refresh /= (htotal * vtotal);
1190
1191         viafb_second_xres = sec_var->xres;
1192         viafb_second_yres = sec_var->yres;
1193         viafb_second_virtual_xres = sec_var->xres_virtual;
1194         viafb_second_virtual_yres = sec_var->yres_virtual;
1195         viafb_bpp1 = sec_var->bits_per_pixel;
1196         viafb_refresh1 = viafb_get_refresh(sec_var->xres, sec_var->yres,
1197                 long_refresh);
1198 }
1199
1200 static int apply_device_setting(struct viafb_ioctl_setting setting_info,
1201         struct fb_info *info)
1202 {
1203         int need_set_mode = 0;
1204         DEBUG_MSG(KERN_INFO "apply_device_setting\n");
1205
1206         if (setting_info.device_flag) {
1207                 need_set_mode = 1;
1208                 check_available_device_to_enable(setting_info.device_status);
1209         }
1210
1211         /* Unlock LCD's operation according to LCD flag
1212            and check if the setting value is valid. */
1213         /* If the value is valid, apply the new setting value to the device. */
1214         if (viafb_LCD_ON) {
1215                 if (setting_info.lcd_operation_flag & OP_LCD_CENTERING) {
1216                         need_set_mode = 1;
1217                         if (setting_info.lcd_attributes.display_center) {
1218                                 /* Centering */
1219                                 viaparinfo->lvds_setting_info->display_method =
1220                                     LCD_CENTERING;
1221                                 viafb_lcd_dsp_method = LCD_CENTERING;
1222                                 viaparinfo->lvds_setting_info2->display_method =
1223                                     viafb_lcd_dsp_method = LCD_CENTERING;
1224                         } else {
1225                                 /* expandsion */
1226                                 viaparinfo->lvds_setting_info->display_method =
1227                                     LCD_EXPANDSION;
1228                                 viafb_lcd_dsp_method = LCD_EXPANDSION;
1229                                 viaparinfo->lvds_setting_info2->display_method =
1230                                     LCD_EXPANDSION;
1231                                 viafb_lcd_dsp_method = LCD_EXPANDSION;
1232                         }
1233                 }
1234
1235                 if (setting_info.lcd_operation_flag & OP_LCD_MODE) {
1236                         need_set_mode = 1;
1237                         if (setting_info.lcd_attributes.lcd_mode ==
1238                                 LCD_SPWG) {
1239                                 viaparinfo->lvds_setting_info->lcd_mode =
1240                                         viafb_lcd_mode = LCD_SPWG;
1241                         } else {
1242                                 viaparinfo->lvds_setting_info->lcd_mode =
1243                                         viafb_lcd_mode = LCD_OPENLDI;
1244                         }
1245                         viaparinfo->lvds_setting_info2->lcd_mode =
1246                             viaparinfo->lvds_setting_info->lcd_mode;
1247                 }
1248
1249                 if (setting_info.lcd_operation_flag & OP_LCD_PANEL_ID) {
1250                         need_set_mode = 1;
1251                         if (setting_info.lcd_attributes.panel_id <=
1252                             LCD_PANEL_ID_MAXIMUM) {
1253                                 viafb_lcd_panel_id =
1254                                     setting_info.lcd_attributes.panel_id;
1255                                 viafb_init_lcd_size();
1256                         }
1257                 }
1258         }
1259
1260         if (0 != (setting_info.samm_status & OP_SAMM)) {
1261                 setting_info.samm_status =
1262                     setting_info.samm_status & (~OP_SAMM);
1263                 if (setting_info.samm_status == 0
1264                     || setting_info.samm_status == 1) {
1265                         viafb_SAMM_ON = setting_info.samm_status;
1266
1267                         if (viafb_SAMM_ON)
1268                                 viafb_primary_dev = setting_info.primary_device;
1269
1270                         viafb_set_primary_address(0);
1271                         viafb_set_secondary_address(viafb_SAMM_ON ? viafb_second_offset : 0);
1272                         viafb_set_iga_path();
1273                 }
1274                 need_set_mode = 1;
1275         }
1276
1277         if (!need_set_mode) {
1278                 ;
1279         } else {
1280                 viafb_set_iga_path();
1281                 viafb_set_par(info);
1282         }
1283         return true;
1284 }
1285
1286 static void retrieve_device_setting(struct viafb_ioctl_setting
1287         *setting_info)
1288 {
1289
1290         /* get device status */
1291         if (viafb_CRT_ON == 1)
1292                 setting_info->device_status = CRT_Device;
1293         if (viafb_DVI_ON == 1)
1294                 setting_info->device_status |= DVI_Device;
1295         if (viafb_LCD_ON == 1)
1296                 setting_info->device_status |= LCD_Device;
1297         if (viafb_LCD2_ON == 1)
1298                 setting_info->device_status |= LCD2_Device;
1299
1300         setting_info->samm_status = viafb_SAMM_ON;
1301         setting_info->primary_device = get_primary_device();
1302
1303         setting_info->first_dev_bpp = viafb_bpp;
1304         setting_info->second_dev_bpp = viafb_bpp1;
1305
1306         setting_info->first_dev_refresh = viafb_refresh;
1307         setting_info->second_dev_refresh = viafb_refresh1;
1308
1309         setting_info->first_dev_hor_res = viafb_hotplug_Xres;
1310         setting_info->first_dev_ver_res = viafb_hotplug_Yres;
1311         setting_info->second_dev_hor_res = viafb_second_xres;
1312         setting_info->second_dev_ver_res = viafb_second_yres;
1313
1314         /* Get lcd attributes */
1315         setting_info->lcd_attributes.display_center = viafb_lcd_dsp_method;
1316         setting_info->lcd_attributes.panel_id = viafb_lcd_panel_id;
1317         setting_info->lcd_attributes.lcd_mode = viafb_lcd_mode;
1318 }
1319
1320 static void parse_active_dev(void)
1321 {
1322         viafb_CRT_ON = STATE_OFF;
1323         viafb_DVI_ON = STATE_OFF;
1324         viafb_LCD_ON = STATE_OFF;
1325         viafb_LCD2_ON = STATE_OFF;
1326         /* 1. Modify the active status of devices. */
1327         /* 2. Keep the order of devices, so we can set corresponding
1328            IGA path to devices in SAMM case. */
1329         /*    Note: The previous of active_dev is primary device,
1330            and the following is secondary device. */
1331         if (!strncmp(viafb_active_dev, "CRT+DVI", 7)) {
1332                 /* CRT+DVI */
1333                 viafb_CRT_ON = STATE_ON;
1334                 viafb_DVI_ON = STATE_ON;
1335                 viafb_primary_dev = CRT_Device;
1336         } else if (!strncmp(viafb_active_dev, "DVI+CRT", 7)) {
1337                 /* DVI+CRT */
1338                 viafb_CRT_ON = STATE_ON;
1339                 viafb_DVI_ON = STATE_ON;
1340                 viafb_primary_dev = DVI_Device;
1341         } else if (!strncmp(viafb_active_dev, "CRT+LCD", 7)) {
1342                 /* CRT+LCD */
1343                 viafb_CRT_ON = STATE_ON;
1344                 viafb_LCD_ON = STATE_ON;
1345                 viafb_primary_dev = CRT_Device;
1346         } else if (!strncmp(viafb_active_dev, "LCD+CRT", 7)) {
1347                 /* LCD+CRT */
1348                 viafb_CRT_ON = STATE_ON;
1349                 viafb_LCD_ON = STATE_ON;
1350                 viafb_primary_dev = LCD_Device;
1351         } else if (!strncmp(viafb_active_dev, "DVI+LCD", 7)) {
1352                 /* DVI+LCD */
1353                 viafb_DVI_ON = STATE_ON;
1354                 viafb_LCD_ON = STATE_ON;
1355                 viafb_primary_dev = DVI_Device;
1356         } else if (!strncmp(viafb_active_dev, "LCD+DVI", 7)) {
1357                 /* LCD+DVI */
1358                 viafb_DVI_ON = STATE_ON;
1359                 viafb_LCD_ON = STATE_ON;
1360                 viafb_primary_dev = LCD_Device;
1361         } else if (!strncmp(viafb_active_dev, "LCD+LCD2", 8)) {
1362                 viafb_LCD_ON = STATE_ON;
1363                 viafb_LCD2_ON = STATE_ON;
1364                 viafb_primary_dev = LCD_Device;
1365         } else if (!strncmp(viafb_active_dev, "LCD2+LCD", 8)) {
1366                 viafb_LCD_ON = STATE_ON;
1367                 viafb_LCD2_ON = STATE_ON;
1368                 viafb_primary_dev = LCD2_Device;
1369         } else if (!strncmp(viafb_active_dev, "CRT", 3)) {
1370                 /* CRT only */
1371                 viafb_CRT_ON = STATE_ON;
1372                 viafb_SAMM_ON = STATE_OFF;
1373         } else if (!strncmp(viafb_active_dev, "DVI", 3)) {
1374                 /* DVI only */
1375                 viafb_DVI_ON = STATE_ON;
1376                 viafb_SAMM_ON = STATE_OFF;
1377         } else if (!strncmp(viafb_active_dev, "LCD", 3)) {
1378                 /* LCD only */
1379                 viafb_LCD_ON = STATE_ON;
1380                 viafb_SAMM_ON = STATE_OFF;
1381         } else {
1382                 viafb_CRT_ON = STATE_ON;
1383                 viafb_SAMM_ON = STATE_OFF;
1384         }
1385 }
1386
1387 static int parse_port(char *opt_str, int *output_interface)
1388 {
1389         if (!strncmp(opt_str, "DVP0", 4))
1390                 *output_interface = INTERFACE_DVP0;
1391         else if (!strncmp(opt_str, "DVP1", 4))
1392                 *output_interface = INTERFACE_DVP1;
1393         else if (!strncmp(opt_str, "DFP_HIGHLOW", 11))
1394                 *output_interface = INTERFACE_DFP;
1395         else if (!strncmp(opt_str, "DFP_HIGH", 8))
1396                 *output_interface = INTERFACE_DFP_HIGH;
1397         else if (!strncmp(opt_str, "DFP_LOW", 7))
1398                 *output_interface = INTERFACE_DFP_LOW;
1399         else
1400                 *output_interface = INTERFACE_NONE;
1401         return 0;
1402 }
1403
1404 static void parse_lcd_port(void)
1405 {
1406         parse_port(viafb_lcd_port, &viaparinfo->chip_info->lvds_chip_info.
1407                 output_interface);
1408         /*Initialize to avoid unexpected behavior */
1409         viaparinfo->chip_info->lvds_chip_info2.output_interface =
1410         INTERFACE_NONE;
1411
1412         DEBUG_MSG(KERN_INFO "parse_lcd_port: viafb_lcd_port:%s,interface:%d\n",
1413                   viafb_lcd_port, viaparinfo->chip_info->lvds_chip_info.
1414                   output_interface);
1415 }
1416
1417 static void parse_dvi_port(void)
1418 {
1419         parse_port(viafb_dvi_port, &viaparinfo->chip_info->tmds_chip_info.
1420                 output_interface);
1421
1422         DEBUG_MSG(KERN_INFO "parse_dvi_port: viafb_dvi_port:%s,interface:%d\n",
1423                   viafb_dvi_port, viaparinfo->chip_info->tmds_chip_info.
1424                   output_interface);
1425 }
1426
1427 /*
1428  * The proc filesystem read/write function, a simple proc implement to
1429  * get/set the value of DPA  DVP0,   DVP0DataDriving,  DVP0ClockDriving, DVP1,
1430  * DVP1Driving, DFPHigh, DFPLow CR96,   SR2A[5], SR1B[1], SR2A[4], SR1E[2],
1431  * CR9B,    SR65,    CR97,    CR99
1432  */
1433 static int viafb_dvp0_proc_show(struct seq_file *m, void *v)
1434 {
1435         u8 dvp0_data_dri = 0, dvp0_clk_dri = 0, dvp0 = 0;
1436         dvp0_data_dri =
1437             (viafb_read_reg(VIASR, SR2A) & BIT5) >> 4 |
1438             (viafb_read_reg(VIASR, SR1B) & BIT1) >> 1;
1439         dvp0_clk_dri =
1440             (viafb_read_reg(VIASR, SR2A) & BIT4) >> 3 |
1441             (viafb_read_reg(VIASR, SR1E) & BIT2) >> 2;
1442         dvp0 = viafb_read_reg(VIACR, CR96) & 0x0f;
1443         seq_printf(m, "%x %x %x\n", dvp0, dvp0_data_dri, dvp0_clk_dri);
1444         return 0;
1445 }
1446
1447 static int viafb_dvp0_proc_open(struct inode *inode, struct file *file)
1448 {
1449         return single_open(file, viafb_dvp0_proc_show, NULL);
1450 }
1451
1452 static ssize_t viafb_dvp0_proc_write(struct file *file,
1453         const char __user *buffer, size_t count, loff_t *pos)
1454 {
1455         char buf[20], *value, *pbuf;
1456         u8 reg_val = 0;
1457         unsigned long length, i;
1458         if (count < 1)
1459                 return -EINVAL;
1460         length = count > 20 ? 20 : count;
1461         if (copy_from_user(&buf[0], buffer, length))
1462                 return -EFAULT;
1463         buf[length - 1] = '\0'; /*Ensure end string */
1464         pbuf = &buf[0];
1465         for (i = 0; i < 3; i++) {
1466                 value = strsep(&pbuf, " ");
1467                 if (value != NULL) {
1468                         strict_strtoul(value, 0, (unsigned long *)&reg_val);
1469                         DEBUG_MSG(KERN_INFO "DVP0:reg_val[%l]=:%x\n", i,
1470                                   reg_val);
1471                         switch (i) {
1472                         case 0:
1473                                 viafb_write_reg_mask(CR96, VIACR,
1474                                         reg_val, 0x0f);
1475                                 break;
1476                         case 1:
1477                                 viafb_write_reg_mask(SR2A, VIASR,
1478                                         reg_val << 4, BIT5);
1479                                 viafb_write_reg_mask(SR1B, VIASR,
1480                                         reg_val << 1, BIT1);
1481                                 break;
1482                         case 2:
1483                                 viafb_write_reg_mask(SR2A, VIASR,
1484                                         reg_val << 3, BIT4);
1485                                 viafb_write_reg_mask(SR1E, VIASR,
1486                                         reg_val << 2, BIT2);
1487                                 break;
1488                         default:
1489                                 break;
1490                         }
1491                 } else {
1492                         break;
1493                 }
1494         }
1495         return count;
1496 }
1497
1498 static const struct file_operations viafb_dvp0_proc_fops = {
1499         .owner          = THIS_MODULE,
1500         .open           = viafb_dvp0_proc_open,
1501         .read           = seq_read,
1502         .llseek         = seq_lseek,
1503         .release        = single_release,
1504         .write          = viafb_dvp0_proc_write,
1505 };
1506
1507 static int viafb_dvp1_proc_show(struct seq_file *m, void *v)
1508 {
1509         u8 dvp1 = 0, dvp1_data_dri = 0, dvp1_clk_dri = 0;
1510         dvp1 = viafb_read_reg(VIACR, CR9B) & 0x0f;
1511         dvp1_data_dri = (viafb_read_reg(VIASR, SR65) & 0x0c) >> 2;
1512         dvp1_clk_dri = viafb_read_reg(VIASR, SR65) & 0x03;
1513         seq_printf(m, "%x %x %x\n", dvp1, dvp1_data_dri, dvp1_clk_dri);
1514         return 0;
1515 }
1516
1517 static int viafb_dvp1_proc_open(struct inode *inode, struct file *file)
1518 {
1519         return single_open(file, viafb_dvp1_proc_show, NULL);
1520 }
1521
1522 static ssize_t viafb_dvp1_proc_write(struct file *file,
1523         const char __user *buffer, size_t count, loff_t *pos)
1524 {
1525         char buf[20], *value, *pbuf;
1526         u8 reg_val = 0;
1527         unsigned long length, i;
1528         if (count < 1)
1529                 return -EINVAL;
1530         length = count > 20 ? 20 : count;
1531         if (copy_from_user(&buf[0], buffer, length))
1532                 return -EFAULT;
1533         buf[length - 1] = '\0'; /*Ensure end string */
1534         pbuf = &buf[0];
1535         for (i = 0; i < 3; i++) {
1536                 value = strsep(&pbuf, " ");
1537                 if (value != NULL) {
1538                         strict_strtoul(value, 0, (unsigned long *)&reg_val);
1539                         switch (i) {
1540                         case 0:
1541                                 viafb_write_reg_mask(CR9B, VIACR,
1542                                         reg_val, 0x0f);
1543                                 break;
1544                         case 1:
1545                                 viafb_write_reg_mask(SR65, VIASR,
1546                                         reg_val << 2, 0x0c);
1547                                 break;
1548                         case 2:
1549                                 viafb_write_reg_mask(SR65, VIASR,
1550                                         reg_val, 0x03);
1551                                 break;
1552                         default:
1553                                 break;
1554                         }
1555                 } else {
1556                         break;
1557                 }
1558         }
1559         return count;
1560 }
1561
1562 static const struct file_operations viafb_dvp1_proc_fops = {
1563         .owner          = THIS_MODULE,
1564         .open           = viafb_dvp1_proc_open,
1565         .read           = seq_read,
1566         .llseek         = seq_lseek,
1567         .release        = single_release,
1568         .write          = viafb_dvp1_proc_write,
1569 };
1570
1571 static int viafb_dfph_proc_show(struct seq_file *m, void *v)
1572 {
1573         u8 dfp_high = 0;
1574         dfp_high = viafb_read_reg(VIACR, CR97) & 0x0f;
1575         seq_printf(m, "%x\n", dfp_high);
1576         return 0;
1577 }
1578
1579 static int viafb_dfph_proc_open(struct inode *inode, struct file *file)
1580 {
1581         return single_open(file, viafb_dfph_proc_show, NULL);
1582 }
1583
1584 static ssize_t viafb_dfph_proc_write(struct file *file,
1585         const char __user *buffer, size_t count, loff_t *pos)
1586 {
1587         char buf[20];
1588         u8 reg_val = 0;
1589         unsigned long length;
1590         if (count < 1)
1591                 return -EINVAL;
1592         length = count > 20 ? 20 : count;
1593         if (copy_from_user(&buf[0], buffer, length))
1594                 return -EFAULT;
1595         buf[length - 1] = '\0'; /*Ensure end string */
1596         strict_strtoul(&buf[0], 0, (unsigned long *)&reg_val);
1597         viafb_write_reg_mask(CR97, VIACR, reg_val, 0x0f);
1598         return count;
1599 }
1600
1601 static const struct file_operations viafb_dfph_proc_fops = {
1602         .owner          = THIS_MODULE,
1603         .open           = viafb_dfph_proc_open,
1604         .read           = seq_read,
1605         .llseek         = seq_lseek,
1606         .release        = single_release,
1607         .write          = viafb_dfph_proc_write,
1608 };
1609
1610 static int viafb_dfpl_proc_show(struct seq_file *m, void *v)
1611 {
1612         u8 dfp_low = 0;
1613         dfp_low = viafb_read_reg(VIACR, CR99) & 0x0f;
1614         seq_printf(m, "%x\n", dfp_low);
1615         return 0;
1616 }
1617
1618 static int viafb_dfpl_proc_open(struct inode *inode, struct file *file)
1619 {
1620         return single_open(file, viafb_dfpl_proc_show, NULL);
1621 }
1622
1623 static ssize_t viafb_dfpl_proc_write(struct file *file,
1624         const char __user *buffer, size_t count, loff_t *pos)
1625 {
1626         char buf[20];
1627         u8 reg_val = 0;
1628         unsigned long length;
1629         if (count < 1)
1630                 return -EINVAL;
1631         length = count > 20 ? 20 : count;
1632         if (copy_from_user(&buf[0], buffer, length))
1633                 return -EFAULT;
1634         buf[length - 1] = '\0'; /*Ensure end string */
1635         strict_strtoul(&buf[0], 0, (unsigned long *)&reg_val);
1636         viafb_write_reg_mask(CR99, VIACR, reg_val, 0x0f);
1637         return count;
1638 }
1639
1640 static const struct file_operations viafb_dfpl_proc_fops = {
1641         .owner          = THIS_MODULE,
1642         .open           = viafb_dfpl_proc_open,
1643         .read           = seq_read,
1644         .llseek         = seq_lseek,
1645         .release        = single_release,
1646         .write          = viafb_dfpl_proc_write,
1647 };
1648
1649 static int viafb_vt1636_proc_show(struct seq_file *m, void *v)
1650 {
1651         u8 vt1636_08 = 0, vt1636_09 = 0;
1652         switch (viaparinfo->chip_info->lvds_chip_info.lvds_chip_name) {
1653         case VT1636_LVDS:
1654                 vt1636_08 =
1655                     viafb_gpio_i2c_read_lvds(viaparinfo->lvds_setting_info,
1656                     &viaparinfo->chip_info->lvds_chip_info, 0x08) & 0x0f;
1657                 vt1636_09 =
1658                     viafb_gpio_i2c_read_lvds(viaparinfo->lvds_setting_info,
1659                     &viaparinfo->chip_info->lvds_chip_info, 0x09) & 0x1f;
1660                 seq_printf(m, "%x %x\n", vt1636_08, vt1636_09);
1661                 break;
1662         default:
1663                 break;
1664         }
1665         switch (viaparinfo->chip_info->lvds_chip_info2.lvds_chip_name) {
1666         case VT1636_LVDS:
1667                 vt1636_08 =
1668                     viafb_gpio_i2c_read_lvds(viaparinfo->lvds_setting_info2,
1669                         &viaparinfo->chip_info->lvds_chip_info2, 0x08) & 0x0f;
1670                 vt1636_09 =
1671                     viafb_gpio_i2c_read_lvds(viaparinfo->lvds_setting_info2,
1672                         &viaparinfo->chip_info->lvds_chip_info2, 0x09) & 0x1f;
1673                 seq_printf(m, " %x %x\n", vt1636_08, vt1636_09);
1674                 break;
1675         default:
1676                 break;
1677         }
1678         return 0;
1679 }
1680
1681 static int viafb_vt1636_proc_open(struct inode *inode, struct file *file)
1682 {
1683         return single_open(file, viafb_vt1636_proc_show, NULL);
1684 }
1685
1686 static ssize_t viafb_vt1636_proc_write(struct file *file,
1687         const char __user *buffer, size_t count, loff_t *pos)
1688 {
1689         char buf[30], *value, *pbuf;
1690         struct IODATA reg_val;
1691         unsigned long length, i;
1692         if (count < 1)
1693                 return -EINVAL;
1694         length = count > 30 ? 30 : count;
1695         if (copy_from_user(&buf[0], buffer, length))
1696                 return -EFAULT;
1697         buf[length - 1] = '\0'; /*Ensure end string */
1698         pbuf = &buf[0];
1699         switch (viaparinfo->chip_info->lvds_chip_info.lvds_chip_name) {
1700         case VT1636_LVDS:
1701                 for (i = 0; i < 2; i++) {
1702                         value = strsep(&pbuf, " ");
1703                         if (value != NULL) {
1704                                 strict_strtoul(value, 0,
1705                                         (unsigned long *)&reg_val.Data);
1706                                 switch (i) {
1707                                 case 0:
1708                                         reg_val.Index = 0x08;
1709                                         reg_val.Mask = 0x0f;
1710                                         viafb_gpio_i2c_write_mask_lvds
1711                                             (viaparinfo->lvds_setting_info,
1712                                             &viaparinfo->
1713                                             chip_info->lvds_chip_info,
1714                                              reg_val);
1715                                         break;
1716                                 case 1:
1717                                         reg_val.Index = 0x09;
1718                                         reg_val.Mask = 0x1f;
1719                                         viafb_gpio_i2c_write_mask_lvds
1720                                             (viaparinfo->lvds_setting_info,
1721                                             &viaparinfo->
1722                                             chip_info->lvds_chip_info,
1723                                              reg_val);
1724                                         break;
1725                                 default:
1726                                         break;
1727                                 }
1728                         } else {
1729                                 break;
1730                         }
1731                 }
1732                 break;
1733         default:
1734                 break;
1735         }
1736         switch (viaparinfo->chip_info->lvds_chip_info2.lvds_chip_name) {
1737         case VT1636_LVDS:
1738                 for (i = 0; i < 2; i++) {
1739                         value = strsep(&pbuf, " ");
1740                         if (value != NULL) {
1741                                 strict_strtoul(value, 0,
1742                                         (unsigned long *)&reg_val.Data);
1743                                 switch (i) {
1744                                 case 0:
1745                                         reg_val.Index = 0x08;
1746                                         reg_val.Mask = 0x0f;
1747                                         viafb_gpio_i2c_write_mask_lvds
1748                                             (viaparinfo->lvds_setting_info2,
1749                                             &viaparinfo->
1750                                             chip_info->lvds_chip_info2,
1751                                              reg_val);
1752                                         break;
1753                                 case 1:
1754                                         reg_val.Index = 0x09;
1755                                         reg_val.Mask = 0x1f;
1756                                         viafb_gpio_i2c_write_mask_lvds
1757                                             (viaparinfo->lvds_setting_info2,
1758                                             &viaparinfo->
1759                                             chip_info->lvds_chip_info2,
1760                                              reg_val);
1761                                         break;
1762                                 default:
1763                                         break;
1764                                 }
1765                         } else {
1766                                 break;
1767                         }
1768                 }
1769                 break;
1770         default:
1771                 break;
1772         }
1773         return count;
1774 }
1775
1776 static const struct file_operations viafb_vt1636_proc_fops = {
1777         .owner          = THIS_MODULE,
1778         .open           = viafb_vt1636_proc_open,
1779         .read           = seq_read,
1780         .llseek         = seq_lseek,
1781         .release        = single_release,
1782         .write          = viafb_vt1636_proc_write,
1783 };
1784
1785 static void viafb_init_proc(struct proc_dir_entry **viafb_entry)
1786 {
1787         *viafb_entry = proc_mkdir("viafb", NULL);
1788         if (*viafb_entry) {
1789                 proc_create("dvp0", 0, *viafb_entry, &viafb_dvp0_proc_fops);
1790                 proc_create("dvp1", 0, *viafb_entry, &viafb_dvp1_proc_fops);
1791                 proc_create("dfph", 0, *viafb_entry, &viafb_dfph_proc_fops);
1792                 proc_create("dfpl", 0, *viafb_entry, &viafb_dfpl_proc_fops);
1793                 if (VT1636_LVDS == viaparinfo->chip_info->lvds_chip_info.
1794                         lvds_chip_name || VT1636_LVDS ==
1795                     viaparinfo->chip_info->lvds_chip_info2.lvds_chip_name) {
1796                         proc_create("vt1636", 0, *viafb_entry, &viafb_vt1636_proc_fops);
1797                 }
1798
1799         }
1800 }
1801 static void viafb_remove_proc(struct proc_dir_entry *viafb_entry)
1802 {
1803         /* no problem if it was not registered */
1804         remove_proc_entry("dvp0", viafb_entry);/* parent dir */
1805         remove_proc_entry("dvp1", viafb_entry);
1806         remove_proc_entry("dfph", viafb_entry);
1807         remove_proc_entry("dfpl", viafb_entry);
1808         remove_proc_entry("vt1636", viafb_entry);
1809         remove_proc_entry("vt1625", viafb_entry);
1810         remove_proc_entry("viafb", NULL);
1811 }
1812
1813 static void parse_mode(const char *str, u32 *xres, u32 *yres)
1814 {
1815         char *ptr;
1816
1817         *xres = simple_strtoul(str, &ptr, 10);
1818         if (ptr[0] != 'x')
1819                 goto out_default;
1820
1821         *yres = simple_strtoul(&ptr[1], &ptr, 10);
1822         if (ptr[0])
1823                 goto out_default;
1824
1825         return;
1826
1827 out_default:
1828         printk(KERN_WARNING "viafb received invalid mode string: %s\n", str);
1829         *xres = 640;
1830         *yres = 480;
1831 }
1832
1833 static int __devinit via_pci_probe(struct pci_dev *pdev,
1834                                    const struct pci_device_id *ent)
1835 {
1836         u32 default_xres, default_yres;
1837         struct VideoModeTable *vmode_entry;
1838         u32 viafb_par_length;
1839
1840         DEBUG_MSG(KERN_INFO "VIAFB PCI Probe!!\n");
1841
1842         viafb_par_length = ALIGN(sizeof(struct viafb_par), BITS_PER_LONG/8);
1843
1844         /* Allocate fb_info and ***_par here, also including some other needed
1845          * variables
1846         */
1847         viafbinfo = framebuffer_alloc(viafb_par_length +
1848                 ALIGN(sizeof(struct viafb_shared), BITS_PER_LONG/8),
1849                 &pdev->dev);
1850         if (!viafbinfo) {
1851                 printk(KERN_ERR"Could not allocate memory for viafb_info.\n");
1852                 return -ENODEV;
1853         }
1854
1855         viaparinfo = (struct viafb_par *)viafbinfo->par;
1856         viaparinfo->shared = viafbinfo->par + viafb_par_length;
1857         viaparinfo->vram_addr = 0;
1858         viaparinfo->tmds_setting_info = &viaparinfo->shared->tmds_setting_info;
1859         viaparinfo->lvds_setting_info = &viaparinfo->shared->lvds_setting_info;
1860         viaparinfo->lvds_setting_info2 =
1861                 &viaparinfo->shared->lvds_setting_info2;
1862         viaparinfo->crt_setting_info = &viaparinfo->shared->crt_setting_info;
1863         viaparinfo->chip_info = &viaparinfo->shared->chip_info;
1864
1865         if (viafb_dual_fb)
1866                 viafb_SAMM_ON = 1;
1867         parse_active_dev();
1868         parse_lcd_port();
1869         parse_dvi_port();
1870
1871         /* for dual-fb must viafb_SAMM_ON=1 and viafb_dual_fb=1 */
1872         if (!viafb_SAMM_ON)
1873                 viafb_dual_fb = 0;
1874
1875         /* Set up I2C bus stuff */
1876         viafb_create_i2c_bus(viaparinfo);
1877
1878         viafb_init_chip_info(pdev, ent);
1879         viaparinfo->fbmem = pci_resource_start(pdev, 0);
1880         viaparinfo->memsize = viafb_get_fb_size_from_pci();
1881         viaparinfo->fbmem_free = viaparinfo->memsize;
1882         viaparinfo->fbmem_used = 0;
1883         viafbinfo->screen_base = ioremap_nocache(viaparinfo->fbmem,
1884                 viaparinfo->memsize);
1885         if (!viafbinfo->screen_base) {
1886                 printk(KERN_INFO "ioremap failed\n");
1887                 return -ENOMEM;
1888         }
1889
1890         viafbinfo->fix.mmio_start = pci_resource_start(pdev, 1);
1891         viafbinfo->fix.mmio_len = pci_resource_len(pdev, 1);
1892         viafbinfo->node = 0;
1893         viafbinfo->fbops = &viafb_ops;
1894         viafbinfo->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_YPAN;
1895
1896         viafbinfo->pseudo_palette = pseudo_pal;
1897         if (viafb_accel && !viafb_init_engine(viafbinfo)) {
1898                 viafbinfo->flags |= FBINFO_HWACCEL_COPYAREA |
1899                         FBINFO_HWACCEL_FILLRECT |  FBINFO_HWACCEL_IMAGEBLIT;
1900                 default_var.accel_flags = FB_ACCELF_TEXT;
1901         } else {
1902                 viafbinfo->flags |= FBINFO_HWACCEL_DISABLED;
1903                 default_var.accel_flags = 0;
1904         }
1905
1906         if (viafb_second_size && (viafb_second_size < 8)) {
1907                 viafb_second_offset = viaparinfo->fbmem_free -
1908                         viafb_second_size * 1024 * 1024;
1909         } else {
1910                 viafb_second_size = 8;
1911                 viafb_second_offset = viaparinfo->fbmem_free -
1912                         viafb_second_size * 1024 * 1024;
1913         }
1914
1915         parse_mode(viafb_mode, &default_xres, &default_yres);
1916         vmode_entry = viafb_get_mode(default_xres, default_yres);
1917         if (viafb_SAMM_ON == 1) {
1918                 parse_mode(viafb_mode1, &viafb_second_xres,
1919                         &viafb_second_yres);
1920
1921                 if (0 == viafb_second_virtual_xres) {
1922                         switch (viafb_second_xres) {
1923                         case 1400:
1924                                 viafb_second_virtual_xres = 1408;
1925                                 break;
1926                         default:
1927                                 viafb_second_virtual_xres = viafb_second_xres;
1928                                 break;
1929                         }
1930                 }
1931                 if (0 == viafb_second_virtual_yres)
1932                         viafb_second_virtual_yres = viafb_second_yres;
1933         }
1934
1935         switch (viafb_bpp) {
1936         case 0 ... 8:
1937                 viafb_bpp = 8;
1938                 break;
1939         case 9 ... 16:
1940                 viafb_bpp = 16;
1941                 break;
1942         case 17 ... 32:
1943                 viafb_bpp = 32;
1944                 break;
1945         default:
1946                 viafb_bpp = 8;
1947         }
1948         default_var.xres = default_xres;
1949         default_var.yres = default_yres;
1950         switch (default_xres) {
1951         case 1400:
1952                 default_var.xres_virtual = 1408;
1953                 break;
1954         default:
1955                 default_var.xres_virtual = default_xres;
1956                 break;
1957         }
1958         default_var.yres_virtual = default_yres;
1959         default_var.bits_per_pixel = viafb_bpp;
1960         if (default_var.bits_per_pixel == 15)
1961                 default_var.bits_per_pixel = 16;
1962         default_var.pixclock =
1963             viafb_get_pixclock(default_xres, default_yres, viafb_refresh);
1964         default_var.left_margin = (default_xres >> 3) & 0xf8;
1965         default_var.right_margin = 32;
1966         default_var.upper_margin = 16;
1967         default_var.lower_margin = 4;
1968         default_var.hsync_len = default_var.left_margin;
1969         default_var.vsync_len = 4;
1970         viafb_setup_fixinfo(&viafbinfo->fix, viaparinfo);
1971         viafb_check_var(&default_var, viafbinfo);
1972         viafbinfo->var = default_var;
1973
1974         if (viafb_dual_fb) {
1975                 viafbinfo1 = framebuffer_alloc(viafb_par_length, &pdev->dev);
1976                 if (!viafbinfo1) {
1977                         printk(KERN_ERR
1978                         "allocate the second framebuffer struct error\n");
1979                         framebuffer_release(viafbinfo);
1980                         return -ENOMEM;
1981                 }
1982                 viaparinfo1 = viafbinfo1->par;
1983                 memcpy(viaparinfo1, viaparinfo, viafb_par_length);
1984                 viaparinfo1->vram_addr = viafb_second_offset;
1985                 viaparinfo1->memsize = viaparinfo->memsize -
1986                         viafb_second_offset;
1987                 viaparinfo->memsize = viafb_second_offset;
1988                 viaparinfo1->fbmem = viaparinfo->fbmem + viafb_second_offset;
1989
1990                 viaparinfo1->fbmem_used = viaparinfo->fbmem_used;
1991                 viaparinfo1->fbmem_free = viaparinfo1->memsize -
1992                         viaparinfo1->fbmem_used;
1993                 viaparinfo->fbmem_free = viaparinfo->memsize;
1994                 viaparinfo->fbmem_used = 0;
1995
1996                 viaparinfo->iga_path = IGA1;
1997                 viaparinfo1->iga_path = IGA2;
1998                 memcpy(viafbinfo1, viafbinfo, sizeof(struct fb_info));
1999                 viafbinfo1->par = viaparinfo1;
2000                 viafbinfo1->screen_base = viafbinfo->screen_base +
2001                         viafb_second_offset;
2002
2003                 default_var.xres = viafb_second_xres;
2004                 default_var.yres = viafb_second_yres;
2005                 default_var.xres_virtual = viafb_second_virtual_xres;
2006                 default_var.yres_virtual = viafb_second_virtual_yres;
2007                 if (viafb_bpp1 != viafb_bpp)
2008                         viafb_bpp1 = viafb_bpp;
2009                 default_var.bits_per_pixel = viafb_bpp1;
2010                 default_var.pixclock =
2011                     viafb_get_pixclock(viafb_second_xres, viafb_second_yres,
2012                     viafb_refresh);
2013                 default_var.left_margin = (viafb_second_xres >> 3) & 0xf8;
2014                 default_var.right_margin = 32;
2015                 default_var.upper_margin = 16;
2016                 default_var.lower_margin = 4;
2017                 default_var.hsync_len = default_var.left_margin;
2018                 default_var.vsync_len = 4;
2019
2020                 viafb_setup_fixinfo(&viafbinfo1->fix, viaparinfo1);
2021                 viafb_check_var(&default_var, viafbinfo1);
2022                 viafbinfo1->var = default_var;
2023                 viafb_update_fix(viafbinfo1);
2024                 viaparinfo1->depth = fb_get_color_depth(&viafbinfo1->var,
2025                         &viafbinfo1->fix);
2026         }
2027
2028         viafb_update_fix(viafbinfo);
2029         viaparinfo->depth = fb_get_color_depth(&viafbinfo->var,
2030                 &viafbinfo->fix);
2031         default_var.activate = FB_ACTIVATE_NOW;
2032         fb_alloc_cmap(&viafbinfo->cmap, 256, 0);
2033
2034         if (viafb_dual_fb && (viafb_primary_dev == LCD_Device)
2035             && (viaparinfo->chip_info->gfx_chip_name == UNICHROME_CLE266)) {
2036                 if (register_framebuffer(viafbinfo1) < 0)
2037                         return -EINVAL;
2038         }
2039         if (register_framebuffer(viafbinfo) < 0)
2040                 return -EINVAL;
2041
2042         if (viafb_dual_fb && ((viafb_primary_dev != LCD_Device)
2043                         || (viaparinfo->chip_info->gfx_chip_name !=
2044                         UNICHROME_CLE266))) {
2045                 if (register_framebuffer(viafbinfo1) < 0)
2046                         return -EINVAL;
2047         }
2048         DEBUG_MSG(KERN_INFO "fb%d: %s frame buffer device %dx%d-%dbpp\n",
2049                   viafbinfo->node, viafbinfo->fix.id, default_var.xres,
2050                   default_var.yres, default_var.bits_per_pixel);
2051
2052         viafb_init_proc(&viaparinfo->shared->proc_entry);
2053         viafb_init_dac(IGA2);
2054         return 0;
2055 }
2056
2057 static void __devexit via_pci_remove(struct pci_dev *pdev)
2058 {
2059         DEBUG_MSG(KERN_INFO "via_pci_remove!\n");
2060         fb_dealloc_cmap(&viafbinfo->cmap);
2061         unregister_framebuffer(viafbinfo);
2062         if (viafb_dual_fb)
2063                 unregister_framebuffer(viafbinfo1);
2064         iounmap((void *)viafbinfo->screen_base);
2065         iounmap(viaparinfo->shared->engine_mmio);
2066
2067         viafb_delete_i2c_buss(viaparinfo);
2068
2069         framebuffer_release(viafbinfo);
2070         if (viafb_dual_fb)
2071                 framebuffer_release(viafbinfo1);
2072
2073         viafb_remove_proc(viaparinfo->shared->proc_entry);
2074 }
2075
2076 #ifndef MODULE
2077 static int __init viafb_setup(char *options)
2078 {
2079         char *this_opt;
2080         DEBUG_MSG(KERN_INFO "viafb_setup!\n");
2081
2082         if (!options || !*options)
2083                 return 0;
2084
2085         while ((this_opt = strsep(&options, ",")) != NULL) {
2086                 if (!*this_opt)
2087                         continue;
2088
2089                 if (!strncmp(this_opt, "viafb_mode1=", 12))
2090                         viafb_mode1 = kstrdup(this_opt + 12, GFP_KERNEL);
2091                 else if (!strncmp(this_opt, "viafb_mode=", 11))
2092                         viafb_mode = kstrdup(this_opt + 11, GFP_KERNEL);
2093                 else if (!strncmp(this_opt, "viafb_bpp1=", 11))
2094                         strict_strtoul(this_opt + 11, 0,
2095                                 (unsigned long *)&viafb_bpp1);
2096                 else if (!strncmp(this_opt, "viafb_bpp=", 10))
2097                         strict_strtoul(this_opt + 10, 0,
2098                                 (unsigned long *)&viafb_bpp);
2099                 else if (!strncmp(this_opt, "viafb_refresh1=", 15))
2100                         strict_strtoul(this_opt + 15, 0,
2101                                 (unsigned long *)&viafb_refresh1);
2102                 else if (!strncmp(this_opt, "viafb_refresh=", 14))
2103                         strict_strtoul(this_opt + 14, 0,
2104                                 (unsigned long *)&viafb_refresh);
2105                 else if (!strncmp(this_opt, "viafb_lcd_dsp_method=", 21))
2106                         strict_strtoul(this_opt + 21, 0,
2107                                 (unsigned long *)&viafb_lcd_dsp_method);
2108                 else if (!strncmp(this_opt, "viafb_lcd_panel_id=", 19))
2109                         strict_strtoul(this_opt + 19, 0,
2110                                 (unsigned long *)&viafb_lcd_panel_id);
2111                 else if (!strncmp(this_opt, "viafb_accel=", 12))
2112                         strict_strtoul(this_opt + 12, 0,
2113                                 (unsigned long *)&viafb_accel);
2114                 else if (!strncmp(this_opt, "viafb_SAMM_ON=", 14))
2115                         strict_strtoul(this_opt + 14, 0,
2116                                 (unsigned long *)&viafb_SAMM_ON);
2117                 else if (!strncmp(this_opt, "viafb_active_dev=", 17))
2118                         viafb_active_dev = kstrdup(this_opt + 17, GFP_KERNEL);
2119                 else if (!strncmp(this_opt,
2120                         "viafb_display_hardware_layout=", 30))
2121                         strict_strtoul(this_opt + 30, 0,
2122                         (unsigned long *)&viafb_display_hardware_layout);
2123                 else if (!strncmp(this_opt, "viafb_second_size=", 18))
2124                         strict_strtoul(this_opt + 18, 0,
2125                                 (unsigned long *)&viafb_second_size);
2126                 else if (!strncmp(this_opt,
2127                         "viafb_platform_epia_dvi=", 24))
2128                         strict_strtoul(this_opt + 24, 0,
2129                                 (unsigned long *)&viafb_platform_epia_dvi);
2130                 else if (!strncmp(this_opt,
2131                         "viafb_device_lcd_dualedge=", 26))
2132                         strict_strtoul(this_opt + 26, 0,
2133                                 (unsigned long *)&viafb_device_lcd_dualedge);
2134                 else if (!strncmp(this_opt, "viafb_bus_width=", 16))
2135                         strict_strtoul(this_opt + 16, 0,
2136                                 (unsigned long *)&viafb_bus_width);
2137                 else if (!strncmp(this_opt, "viafb_lcd_mode=", 15))
2138                         strict_strtoul(this_opt + 15, 0,
2139                                 (unsigned long *)&viafb_lcd_mode);
2140                 else if (!strncmp(this_opt, "viafb_lcd_port=", 15))
2141                         viafb_lcd_port = kstrdup(this_opt + 15, GFP_KERNEL);
2142                 else if (!strncmp(this_opt, "viafb_dvi_port=", 15))
2143                         viafb_dvi_port = kstrdup(this_opt + 15, GFP_KERNEL);
2144         }
2145         return 0;
2146 }
2147 #endif
2148
2149 static struct pci_device_id viafb_pci_table[] __devinitdata = {
2150         { PCI_DEVICE(PCI_VENDOR_ID_VIA, UNICHROME_CLE266_DID),
2151           .driver_data = UNICHROME_CLE266 },
2152         { PCI_DEVICE(PCI_VENDOR_ID_VIA, UNICHROME_PM800_DID),
2153           .driver_data = UNICHROME_PM800 },
2154         { PCI_DEVICE(PCI_VENDOR_ID_VIA, UNICHROME_K400_DID),
2155           .driver_data = UNICHROME_K400 },
2156         { PCI_DEVICE(PCI_VENDOR_ID_VIA, UNICHROME_K800_DID),
2157           .driver_data = UNICHROME_K800 },
2158         { PCI_DEVICE(PCI_VENDOR_ID_VIA, UNICHROME_P4M890_DID),
2159           .driver_data = UNICHROME_CN700 },
2160         { PCI_DEVICE(PCI_VENDOR_ID_VIA, UNICHROME_K8M890_DID),
2161           .driver_data = UNICHROME_K8M890 },
2162         { PCI_DEVICE(PCI_VENDOR_ID_VIA, UNICHROME_CX700_DID),
2163           .driver_data = UNICHROME_CX700 },
2164         { PCI_DEVICE(PCI_VENDOR_ID_VIA, UNICHROME_P4M900_DID),
2165           .driver_data = UNICHROME_P4M900 },
2166         { PCI_DEVICE(PCI_VENDOR_ID_VIA, UNICHROME_CN750_DID),
2167           .driver_data = UNICHROME_CN750 },
2168         { PCI_DEVICE(PCI_VENDOR_ID_VIA, UNICHROME_VX800_DID),
2169           .driver_data = UNICHROME_VX800 },
2170         { PCI_DEVICE(PCI_VENDOR_ID_VIA, UNICHROME_VX855_DID),
2171           .driver_data = UNICHROME_VX855 },
2172         { }
2173 };
2174 MODULE_DEVICE_TABLE(pci, viafb_pci_table);
2175
2176 static struct pci_driver viafb_driver = {
2177         .name           = "viafb",
2178         .id_table       = viafb_pci_table,
2179         .probe          = via_pci_probe,
2180         .remove         = __devexit_p(via_pci_remove),
2181 };
2182
2183 static int __init viafb_init(void)
2184 {
2185 #ifndef MODULE
2186         char *option = NULL;
2187         if (fb_get_options("viafb", &option))
2188                 return -ENODEV;
2189         viafb_setup(option);
2190 #endif
2191         printk(KERN_INFO
2192        "VIA Graphics Intergration Chipset framebuffer %d.%d initializing\n",
2193                VERSION_MAJOR, VERSION_MINOR);
2194         return pci_register_driver(&viafb_driver);
2195 }
2196
2197 static void __exit viafb_exit(void)
2198 {
2199         DEBUG_MSG(KERN_INFO "viafb_exit!\n");
2200         pci_unregister_driver(&viafb_driver);
2201 }
2202
2203 static struct fb_ops viafb_ops = {
2204         .owner = THIS_MODULE,
2205         .fb_open = viafb_open,
2206         .fb_release = viafb_release,
2207         .fb_check_var = viafb_check_var,
2208         .fb_set_par = viafb_set_par,
2209         .fb_setcolreg = viafb_setcolreg,
2210         .fb_pan_display = viafb_pan_display,
2211         .fb_blank = viafb_blank,
2212         .fb_fillrect = viafb_fillrect,
2213         .fb_copyarea = viafb_copyarea,
2214         .fb_imageblit = viafb_imageblit,
2215         .fb_cursor = viafb_cursor,
2216         .fb_ioctl = viafb_ioctl,
2217         .fb_sync = viafb_sync,
2218         .fb_setcmap = viafb_setcmap,
2219 };
2220
2221 module_init(viafb_init);
2222 module_exit(viafb_exit);
2223
2224 #ifdef MODULE
2225 module_param(viafb_mode, charp, S_IRUSR);
2226 MODULE_PARM_DESC(viafb_mode, "Set resolution (default=640x480)");
2227
2228 module_param(viafb_mode1, charp, S_IRUSR);
2229 MODULE_PARM_DESC(viafb_mode1, "Set resolution (default=640x480)");
2230
2231 module_param(viafb_bpp, int, S_IRUSR);
2232 MODULE_PARM_DESC(viafb_bpp, "Set color depth (default=32bpp)");
2233
2234 module_param(viafb_bpp1, int, S_IRUSR);
2235 MODULE_PARM_DESC(viafb_bpp1, "Set color depth (default=32bpp)");
2236
2237 module_param(viafb_refresh, int, S_IRUSR);
2238 MODULE_PARM_DESC(viafb_refresh,
2239         "Set CRT viafb_refresh rate (default = 60)");
2240
2241 module_param(viafb_refresh1, int, S_IRUSR);
2242 MODULE_PARM_DESC(viafb_refresh1,
2243         "Set CRT refresh rate (default = 60)");
2244
2245 module_param(viafb_lcd_panel_id, int, S_IRUSR);
2246 MODULE_PARM_DESC(viafb_lcd_panel_id,
2247         "Set Flat Panel type(Default=1024x768)");
2248
2249 module_param(viafb_lcd_dsp_method, int, S_IRUSR);
2250 MODULE_PARM_DESC(viafb_lcd_dsp_method,
2251         "Set Flat Panel display scaling method.(Default=Expandsion)");
2252
2253 module_param(viafb_SAMM_ON, int, S_IRUSR);
2254 MODULE_PARM_DESC(viafb_SAMM_ON,
2255         "Turn on/off flag of SAMM(Default=OFF)");
2256
2257 module_param(viafb_accel, int, S_IRUSR);
2258 MODULE_PARM_DESC(viafb_accel,
2259         "Set 2D Hardware Acceleration: 0 = OFF, 1 = ON (default)");
2260
2261 module_param(viafb_active_dev, charp, S_IRUSR);
2262 MODULE_PARM_DESC(viafb_active_dev, "Specify active devices.");
2263
2264 module_param(viafb_display_hardware_layout, int, S_IRUSR);
2265 MODULE_PARM_DESC(viafb_display_hardware_layout,
2266         "Display Hardware Layout (LCD Only, DVI Only...,etc)");
2267
2268 module_param(viafb_second_size, int, S_IRUSR);
2269 MODULE_PARM_DESC(viafb_second_size,
2270         "Set secondary device memory size");
2271
2272 module_param(viafb_dual_fb, int, S_IRUSR);
2273 MODULE_PARM_DESC(viafb_dual_fb,
2274         "Turn on/off flag of dual framebuffer devices.(Default = OFF)");
2275
2276 module_param(viafb_platform_epia_dvi, int, S_IRUSR);
2277 MODULE_PARM_DESC(viafb_platform_epia_dvi,
2278         "Turn on/off flag of DVI devices on EPIA board.(Default = OFF)");
2279
2280 module_param(viafb_device_lcd_dualedge, int, S_IRUSR);
2281 MODULE_PARM_DESC(viafb_device_lcd_dualedge,
2282         "Turn on/off flag of dual edge panel.(Default = OFF)");
2283
2284 module_param(viafb_bus_width, int, S_IRUSR);
2285 MODULE_PARM_DESC(viafb_bus_width,
2286         "Set bus width of panel.(Default = 12)");
2287
2288 module_param(viafb_lcd_mode, int, S_IRUSR);
2289 MODULE_PARM_DESC(viafb_lcd_mode,
2290         "Set Flat Panel mode(Default=OPENLDI)");
2291
2292 module_param(viafb_lcd_port, charp, S_IRUSR);
2293 MODULE_PARM_DESC(viafb_lcd_port, "Specify LCD output port.");
2294
2295 module_param(viafb_dvi_port, charp, S_IRUSR);
2296 MODULE_PARM_DESC(viafb_dvi_port, "Specify DVI output port.");
2297
2298 MODULE_LICENSE("GPL");
2299 #endif