Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 <= 640) |
| 197 | *xres = 640; |
| 198 | else if (*xres <= 800) |
| 199 | *xres = 800; |
| 200 | else if (*xres <= 1024) |
| 201 | *xres = 1024; |
| 202 | else if (*xres <= 1152) |
| 203 | *xres = 1152; |
| 204 | else if (*xres <= 1280) |
| 205 | *xres = 1280; |
| 206 | else |
| 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 | |