drivers/video/i810/i810_dvt.c

   1 /*-*- linux-c -*-
   2  *  linux/drivers/video/i810_dvt.c -- Intel 810 Discrete Video Timings (Intel)
   3  *
   4  *      Copyright (C) 2001 Antonino Daplas<adaplas@pol.net>
   5  *      All Rights Reserved
   6  *
   7  *
   8  *  This file is subject to the terms and conditions of the GNU General Public
   9  *  License. See the file COPYING in the main directory of this archive for
  10  *  more details.
  11  */
  12
  13 #include <linux/kernel.h>
  14
  15 #include "i810_regs.h"
  16 #include "i810.h"
  17
  18 struct mode_registers std_modes[] = {
  19         /* 640x480 @ 60Hz */
  20         { 25000, 0x0013, 0x0003, 0x40, 0x5F, 0x4F, 0x50, 0x82, 0x51, 0x9D,
  21           0x0B, 0x10, 0x40, 0xE9, 0x0B, 0xDF, 0x50, 0xE7, 0x04, 0x02,
  22           0x01, 0x01, 0x01, 0x00, 0x01, 0x22002000, 0x22004000, 0x22006000,
  23           0x22002000, 0x22004000, 0x22006000, 0xC0 },
  24
  25         /* 640x480 @ 70Hz */
  26         { 28000, 0x0053, 0x0010, 0x40, 0x61, 0x4F, 0x4F, 0x85, 0x52, 0x9A,
  27           0xF2, 0x10, 0x40, 0xE0, 0x03, 0xDF, 0x50, 0xDF, 0xF3, 0x01,
  28           0x01, 0x01, 0x01, 0x00, 0x01, 0x22002000, 0x22004000, 0x22005000,
  29           0x22002000, 0x22004000, 0x22005000, 0xC0 },
  30
  31         /* 640x480 @ 72Hz */
  32         { 31000, 0x0013, 0x0002, 0x40, 0x63, 0x4F, 0x4F, 0x87, 0x52, 0x97,
  33           0x06, 0x0F, 0x40, 0xE8, 0x0B, 0xDF, 0x50, 0xDF, 0x07, 0x02,
  34           0x01, 0x01, 0x01, 0x00, 0x01, 0x22003000, 0x22005000, 0x22007000,
  35           0x22003000, 0x22005000, 0x22007000, 0xC0 },
  36
  37         /* 640x480 @ 75Hz */
  38         { 31000, 0x0013, 0x0002, 0x40, 0x64, 0x4F, 0x4F, 0x88, 0x51, 0x99,
  39           0xF2, 0x10, 0x40, 0xE0, 0x03, 0xDF, 0x50, 0xDF, 0xF3, 0x01,
  40           0x01, 0x01, 0x01, 0x00, 0x01, 0x22003000, 0x22005000, 0x22007000,
  41           0x22003000, 0x22005000, 0x22007000, 0xC0 },
  42
  43         /* 640x480 @ 85Hz */
  44         { 36000, 0x0010, 0x0001, 0x40, 0x63, 0x4F, 0x4F, 0x87, 0x56, 0x9D,
  45           0xFB, 0x10, 0x40, 0xE0, 0x03, 0xDF, 0x50, 0xDF, 0xFC, 0x01,
  46           0x01, 0x01, 0x01, 0x00, 0x01, 0x22003000, 0x22005000, 0x22107000,
  47           0x22003000, 0x22005000, 0x22107000, 0xC0 },
  48
  49         /* 800x600 @ 56Hz */
  50         { 36000, 0x0010, 0x0001, 0x40, 0x7B, 0x63, 0x63, 0x9F, 0x66, 0x8F,
  51           0x6F, 0x10, 0x40, 0x58, 0x0A, 0x57, 0xC8, 0x57, 0x70, 0x02,
  52           0x02, 0x02, 0x02, 0x00, 0x01, 0x22003000, 0x22005000, 0x22107000,
  53           0x22003000, 0x22005000, 0x22107000, 0x00 },
  54
  55         /* 800x600 @ 60Hz */
  56         { 40000, 0x0008, 0x0001, 0x30, 0x7F, 0x63, 0x63, 0x83, 0x68, 0x18,
  57           0x72, 0x10, 0x40, 0x58, 0x0C, 0x57, 0xC8, 0x57, 0x73, 0x02,
  58           0x02, 0x02, 0x02, 0x00, 0x00, 0x22003000, 0x22006000, 0x22108000,
  59           0x22003000, 0x22006000, 0x22108000, 0x00 },
  60
  61         /* 800x600 @ 70Hz */
  62         { 45000, 0x0054, 0x0015, 0x30, 0x7D, 0x63, 0x63, 0x81, 0x68, 0x12,
  63           0x6f, 0x10, 0x40, 0x58, 0x0b, 0x57, 0x64, 0x57, 0x70, 0x02,
  64           0x02, 0x02, 0x02, 0x00, 0x00, 0x22004000, 0x22007000, 0x2210A000,
  65           0x22004000, 0x22007000, 0x2210A000, 0x00 },
  66
  67         /* 800x600 @ 72Hz */
  68         { 50000, 0x0017, 0x0004, 0x30, 0x7D, 0x63, 0x63, 0x81, 0x6A, 0x19,
  69           0x98, 0x10, 0x40, 0x7C, 0x02, 0x57, 0xC8, 0x57, 0x99, 0x02,
  70           0x02, 0x02, 0x02, 0x00, 0x00, 0x22004000, 0x22007000, 0x2210A000,
  71           0x22004000, 0x22007000, 0x2210A000, 0x00 },
  72
  73         /* 800x600 @ 75Hz */
  74         { 49000, 0x001F, 0x0006, 0x30, 0x7F, 0x63, 0x63, 0x83, 0x65, 0x0F,
  75           0x6F, 0x10, 0x40, 0x58, 0x0B, 0x57, 0xC8, 0x57, 0x70, 0x02,
  76           0x02, 0x02, 0x02, 0x00, 0x00, 0x22004000, 0x22007000, 0x2210B000,
  77           0x22004000, 0x22007000, 0x2210B000, 0x00 },
  78
  79         /* 800x600 @ 85Hz */
  80         { 56000, 0x0049, 0x000E, 0x30, 0x7E, 0x63, 0x63, 0x82, 0x67, 0x0F,
  81           0x75, 0x10, 0x40, 0x58, 0x0B, 0x57, 0xC8, 0x57, 0x76, 0x02,
  82           0x02, 0x02, 0x02, 0x00, 0x00, 0x22004000, 0x22108000, 0x2210b000,
  83           0x22004000, 0x22108000, 0x2210b000, 0x00 },
  84
  85         /* 1024x768 @ 60Hz */
  86         { 65000, 0x003F, 0x000A, 0x30, 0xA3, 0x7F, 0x7F, 0x87, 0x83, 0x94,
  87           0x24, 0x10, 0x40, 0x02, 0x08, 0xFF, 0x80, 0xFF, 0x25, 0x03,
  88           0x02, 0x03, 0x02, 0x00, 0x00, 0x22005000, 0x22109000, 0x2220D000,
  89           0x22005000, 0x22109000, 0x2220D000, 0xC0 },
  90
  91         /* 1024x768 @ 70Hz */
  92         { 75000, 0x0017, 0x0002, 0x30, 0xA1, 0x7F, 0x7F, 0x85, 0x82, 0x93,
  93           0x24, 0x10, 0x40, 0x02, 0x08, 0xFF, 0x80, 0xFF, 0x25, 0x03,
  94           0x02, 0x03, 0x02, 0x00, 0x00, 0x22005000, 0x2210A000, 0x2220F000,
  95           0x22005000, 0x2210A000, 0x2220F000, 0xC0 },
  96
  97         /* 1024x768 @ 75Hz */
  98         { 78000, 0x0050, 0x0017, 0x20, 0x9F, 0x7F, 0x7F, 0x83, 0x81, 0x8D,
  99           0x1E, 0x10, 0x40, 0x00, 0x03, 0xFF, 0x80, 0xFF, 0x1F, 0x03,
 100           0x02, 0x03, 0x02, 0x00, 0x00, 0x22006000, 0x2210B000, 0x22210000,
 101           0x22006000, 0x2210B000, 0x22210000, 0x00 },
 102
 103         /* 1024x768 @ 85Hz */
 104         { 94000, 0x003D, 0x000E, 0x20, 0xA7, 0x7F, 0x7F, 0x8B, 0x85, 0x91,
 105           0x26, 0x10, 0x40, 0x00, 0x03, 0xFF, 0x80, 0xFF, 0x27, 0x03,
 106           0x02, 0x03, 0x02, 0x00, 0x00, 0x22007000, 0x2220E000, 0x22212000,
 107           0x22007000, 0x2220E000, 0x22212000, 0x00 },
 108
 109         /* 1152x864 @ 60Hz */
 110         { 80000, 0x0008, 0x0001, 0x20, 0xB3, 0x8F, 0x8F, 0x97, 0x93, 0x9f,
 111           0x87, 0x10, 0x40, 0x60, 0x03, 0x5F, 0x90, 0x5f, 0x88, 0x03,
 112           0x03, 0x03, 0x03, 0x00, 0x00, 0x2220C000, 0x22210000, 0x22415000,
 113           0x2220C000, 0x22210000, 0x22415000, 0x00 },
 114
 115         /* 1152x864 @ 70Hz */
 116         { 96000, 0x000a, 0x0001, 0x20, 0xbb, 0x8F, 0x8F, 0x9f, 0x98, 0x87,
 117           0x82, 0x10, 0x40, 0x60, 0x03, 0x5F, 0x90, 0x5F, 0x83, 0x03,
 118           0x03, 0x03, 0x03, 0x00, 0x00, 0x22107000, 0x22210000, 0x22415000,
 119           0x22107000, 0x22210000, 0x22415000, 0x00 },
 120
 121         /* 1152x864 @ 72Hz */
 122         { 99000, 0x001f, 0x0006, 0x20, 0xbb, 0x8F, 0x8F, 0x9f, 0x98, 0x87,
 123           0x83, 0x10, 0x40, 0x60, 0x03, 0x5F, 0x90, 0x5F, 0x84, 0x03,
 124           0x03, 0x03, 0x03, 0x00, 0x00, 0x22107000, 0x22210000, 0x22415000,
 125           0x22107000, 0x22210000, 0x22415000, 0x00 },
 126
 127         /* 1152x864 @ 75Hz */
 128         { 108000, 0x0010, 0x0002, 0x20, 0xC3, 0x8F, 0x8F, 0x87, 0x97, 0x07,
 129           0x82, 0x10, 0x40, 0x60, 0x03, 0x5F, 0x90, 0x5F, 0x83, 0x03,
 130           0x03, 0x03, 0x03, 0x00, 0x01, 0x22107000, 0x22210000, 0x22415000,
 131           0x22107000, 0x22210000, 0x22415000, 0x00 },
 132
 133         /* 1152x864 @ 85Hz */
 134         { 121000, 0x006D, 0x0014, 0x20, 0xc0, 0x8F, 0x8F, 0x84, 0x97, 0x07,
 135           0x93, 0x10, 0x40, 0x60, 0x03, 0x5F, 0x90, 0x5F, 0x94, 0x03,
 136           0x03, 0x03, 0x03, 0x00, 0x01, 0x2220C000, 0x22210000, 0x22415000,
 137           0x2220C000, 0x22210000, 0x22415000, 0x0 },
 138
 139         /* 1280x960 @ 60Hz */
 140         { 108000, 0x0010, 0x0002, 0x20, 0xDC, 0x9F, 0x9F, 0x80, 0xAB, 0x99,
 141           0xE6, 0x10, 0x40, 0xC0, 0x03, 0xBF, 0xA0, 0xBF, 0xE7, 0x03,
 142           0x03, 0x03, 0x03, 0x00, 0x01, 0x2210A000, 0x22210000, 0x22415000,
 143           0x2210A000, 0x22210000, 0x22415000, 0x00 },
 144
 145         /* 1280x960 @ 75Hz */
 146         { 129000, 0x0029, 0x0006, 0x20, 0xD3, 0x9F, 0x9F, 0x97, 0xaa, 0x1b,
 147           0xE8, 0x10, 0x40, 0xC0, 0x03, 0xBF, 0xA0, 0xBF, 0xE9, 0x03,
 148           0x03, 0x03, 0x03, 0x00, 0x01, 0x2210A000, 0x22210000, 0x2241B000,
 149           0x2210A000, 0x22210000, 0x2241B000, 0x00 },
 150
 151         /* 1280x960 @ 85Hz */
 152         { 148000, 0x0042, 0x0009, 0x20, 0xD3, 0x9F, 0x9F, 0x97, 0xA7, 0x1B,
 153           0xF1, 0x10, 0x40, 0xC0, 0x03, 0xBF, 0xA0, 0xBF, 0xF2, 0x03,
 154           0x03, 0x03, 0x03, 0x00, 0x01, 0x2210A000, 0x22220000, 0x2241D000,
 155           0x2210A000, 0x22220000, 0x2241D000, 0x00 },
 156
 157         /* 1600x1200 @ 60Hz */
 158         { 162000, 0x0019, 0x0006, 0x10, 0x09, 0xC7, 0xC7, 0x8D, 0xcf, 0x07,
 159           0xE0, 0x10, 0x40, 0xB0, 0x03, 0xAF, 0xC8, 0xAF, 0xE1, 0x04,
 160           0x04, 0x04, 0x04, 0x01, 0x00, 0x2210b000, 0x22416000, 0x44419000,
 161           0x2210b000, 0x22416000, 0x44419000, 0x00 },
 162
 163         /* 1600x1200 @ 65 Hz */
 164         { 175000, 0x005d, 0x0018, 0x10, 0x09, 0xC7, 0xC7, 0x8D, 0xcf, 0x07,
 165           0xE0, 0x10, 0x40, 0xB0, 0x03, 0xAF, 0xC8, 0xAF, 0xE1, 0x04,
 166           0x04, 0x04, 0x04, 0x01, 0x00, 0x2210c000, 0x22416000, 0x44419000,
 167           0x2210c000, 0x22416000, 0x44419000, 0x00 },
 168
 169         /* 1600x1200 @ 70 Hz */
 170         { 189000, 0x003D, 0x000e, 0x10, 0x09, 0xC7, 0xC7, 0x8d, 0xcf, 0x07,
 171           0xE0, 0x10, 0x40, 0xb0, 0x03, 0xAF, 0xC8, 0xaf, 0xE1, 0x04,
 172           0x04, 0x04, 0x04, 0x01, 0x00, 0x2220e000, 0x22416000, 0x44419000,
 173           0x2220e000, 0x22416000, 0x44419000, 0x00 },
 174
 175         /* 1600x1200 @ 72 Hz */
 176         { 195000, 0x003f, 0x000e, 0x10, 0x0b, 0xC7, 0xC7, 0x8f, 0xd5, 0x0b,
 177           0xE1, 0x10, 0x40, 0xb0, 0x03, 0xAF, 0xC8, 0xaf, 0xe2, 0x04, 0x04,
 178           0x04, 0x04, 0x01, 0x00, 0x2220e000, 0x22416000, 0x44419000,
 179           0x2220e000, 0x22416000, 0x44419000, 0x00 },
 180
 181         /* 1600x1200 @ 75 Hz */
 182         { 202000, 0x0024, 0x0007, 0x10, 0x09, 0xC7, 0xC7, 0x8d, 0xcf, 0x07,
 183           0xE0, 0x10, 0x40, 0xb0, 0x03, 0xAF, 0xC8, 0xaf, 0xE1, 0x04, 0x04,
 184           0x04, 0x04, 0x01, 0x00, 0x2220e000, 0x22416000, 0x44419000,
 185           0x2220e000, 0x22416000, 0x44419000,  0x00 },
 186
 187         /* 1600x1200 @ 85 Hz */
 188         { 229000, 0x0029, 0x0007, 0x10, 0x09, 0xC7, 0xC7, 0x8d, 0xcf, 0x07,
 189           0xE0, 0x10, 0x40, 0xb0, 0x03, 0xAF, 0xC8, 0xaf, 0xE1, 0x04, 0x04,
 190           0x04, 0x04, 0x01, 0x00, 0x22210000, 0x22416000, 0x0,
 191           0x22210000, 0x22416000, 0x0, 0x00 },
 192 };
 193
 194 void round_off_xres(u32 *xres)
 195 {
 196         if (*xres < 800)
 197                 *xres = 640;
 198         if (*xres < 1024 && *xres >= 800)
 199                 *xres = 800;
 200         if (*xres < 1152 && *xres >= 1024)
 201                 *xres = 1024;
 202         if (*xres < 1280 && *xres >= 1152)
 203                 *xres = 1152;
 204         if (*xres < 1600 && *xres >= 1280)
 205                 *xres = 1280;
 206         if (*xres >= 1600)
 207                 *xres = 1600;
 208 }
 209
 210 inline void round_off_yres(u32 *xres, u32 *yres)
 211 {
 212         *yres = (*xres * 3) >> 2;
 213 }
 214
 215 void i810fb_encode_registers(const struct fb_var_screeninfo *var,
 216                              struct i810fb_par *par, u32 xres, u32 yres)
 217 {
 218         u32 diff = 0, diff_best = 0xFFFFFFFF, i = 0, i_best = 0;
 219         u8 hfl;
 220
 221         hfl = (u8) ((xres >> 3) - 1);
 222         for (i = 0; i < ARRAY_SIZE(std_modes); i++) {
 223                 if (std_modes[i].cr01 == hfl) {
 224                         if (std_modes[i].pixclock <= par->regs.pixclock)
 225                                 diff = par->regs.pixclock -
 226                                         std_modes[i].pixclock;
 227                         if (diff < diff_best) {
 228                                 i_best = i;
 229                                 diff_best = diff;
 230                         }
 231                 }
 232         }
 233         par->regs = std_modes[i_best];
 234
 235         /* overlay */
 236         par->ovract = ((xres + var->right_margin + var->hsync_len +
 237                         var->left_margin - 32) | ((xres - 32) << 16));
 238 }
 239
 240 void i810fb_fill_var_timings(struct fb_var_screeninfo *var)
 241 {
 242         struct i810fb_par par;
 243         u32 total, xres, yres;
 244
 245         xres = var->xres;
 246         yres = var->yres;
 247
 248         par.regs.pixclock = 1000000000/var->pixclock;
 249         i810fb_encode_registers(var, &par, xres, yres);
 250
 251         total = ((par.regs.cr00 | (par.regs.cr35 & 1) << 8) + 3) << 3;
 252
 253         var->pixclock = 1000000000/par.regs.pixclock;
 254         var->right_margin = (par.regs.cr04 << 3) - xres;
 255         var->hsync_len = ((par.regs.cr05 & 0x1F) -
 256                                (par.regs.cr04 & 0x1F)) << 3;
 257         var->left_margin = (total - (xres + var->right_margin +
 258                                      var->hsync_len));
 259         var->sync = FB_SYNC_ON_GREEN;
 260         if (~(par.regs.msr & (1 << 6)))
 261                 var->sync |= FB_SYNC_HOR_HIGH_ACT;
 262         if (~(par.regs.msr & (1 << 7)))
 263                 var->sync |= FB_SYNC_VERT_HIGH_ACT;
 264
 265
 266         total = ((par.regs.cr06 | (par.regs.cr30 & 0x0F)  << 8)) + 2;
 267         var->lower_margin = (par.regs.cr10 |
 268                              (par.regs.cr32 & 0x0F) << 8) - yres;
 269         var->vsync_len = (par.regs.cr11 & 0x0F) - (var->lower_margin & 0x0F);
 270         var->upper_margin = total - (yres + var->lower_margin +
 271                                      var->vsync_len);
 272 }
 273
 274 u32 i810_get_watermark(struct fb_var_screeninfo *var,
 275                        struct i810fb_par *par)
 276 {
 277         struct mode_registers *params = &par->regs;
 278         u32 wmark = 0;
 279
 280         if (par->mem_freq == 100) {
 281                 switch (var->bits_per_pixel) {
 282                 case 8:
 283                         wmark = params->bpp8_100;
 284                         break;
 285                 case 16:
 286                         wmark = params->bpp16_100;
 287                         break;
 288                 case 24:
 289                 case 32:
 290                         wmark = params->bpp24_100;
 291                 }
 292         } else {
 293                 switch (var->bits_per_pixel) {
 294                 case 8:
 295                         wmark = params->bpp8_133;
 296                         break;
 297                 case 16:
 298                         wmark = params->bpp16_133;
 299                         break;
 300                 case 24:
 301                 case 32:
 302                         wmark = params->bpp24_133;
 303                 }
 304         }
 305         return wmark;
 306 }
 307