Commit | Line | Data |
---|---|---|
1da177e4 LT |
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 | ||
b689a9e8 | 215 | static int i810fb_find_best_mode(u32 xres, u32 yres, u32 pixclock) |
1da177e4 LT |
216 | { |
217 | u32 diff = 0, diff_best = 0xFFFFFFFF, i = 0, i_best = 0; | |
b689a9e8 | 218 | u8 hfl = (u8) ((xres >> 3) - 1); |
1da177e4 | 219 | |
1da177e4 LT |
220 | for (i = 0; i < ARRAY_SIZE(std_modes); i++) { |
221 | if (std_modes[i].cr01 == hfl) { | |
b689a9e8 KH |
222 | if (std_modes[i].pixclock <= pixclock) |
223 | diff = pixclock - std_modes[i].pixclock; | |
1da177e4 LT |
224 | if (diff < diff_best) { |
225 | i_best = i; | |
226 | diff_best = diff; | |
227 | } | |
228 | } | |
229 | } | |
b689a9e8 KH |
230 | return i_best; |
231 | } | |
232 | ||
233 | void i810fb_encode_registers(const struct fb_var_screeninfo *var, | |
234 | struct i810fb_par *par, u32 xres, u32 yres) | |
235 | { | |
236 | u32 i_best = i810fb_find_best_mode(xres, yres, par->regs.pixclock); | |
237 | ||
1da177e4 LT |
238 | par->regs = std_modes[i_best]; |
239 | ||
240 | /* overlay */ | |
241 | par->ovract = ((xres + var->right_margin + var->hsync_len + | |
242 | var->left_margin - 32) | ((xres - 32) << 16)); | |
243 | } | |
244 | ||
245 | void i810fb_fill_var_timings(struct fb_var_screeninfo *var) | |
246 | { | |
1da177e4 | 247 | u32 total, xres, yres; |
b689a9e8 | 248 | u32 mode, pixclock; |
1da177e4 LT |
249 | |
250 | xres = var->xres; | |
251 | yres = var->yres; | |
252 | ||
b689a9e8 KH |
253 | pixclock = 1000000000 / var->pixclock; |
254 | mode = i810fb_find_best_mode(xres, yres, pixclock); | |
1da177e4 | 255 | |
b689a9e8 KH |
256 | total = (std_modes[mode].cr00 | (std_modes[mode].cr35 & 1) << 8) + 3; |
257 | total <<= 3; | |
1da177e4 | 258 | |
b689a9e8 KH |
259 | var->pixclock = 1000000000 / std_modes[mode].pixclock; |
260 | var->right_margin = (std_modes[mode].cr04 << 3) - xres; | |
261 | var->hsync_len = ((std_modes[mode].cr05 & 0x1F) - | |
262 | (std_modes[mode].cr04 & 0x1F)) << 3; | |
1da177e4 LT |
263 | var->left_margin = (total - (xres + var->right_margin + |
264 | var->hsync_len)); | |
265 | var->sync = FB_SYNC_ON_GREEN; | |
b689a9e8 | 266 | if (~(std_modes[mode].msr & (1 << 6))) |
1da177e4 | 267 | var->sync |= FB_SYNC_HOR_HIGH_ACT; |
b689a9e8 | 268 | if (~(std_modes[mode].msr & (1 << 7))) |
1da177e4 LT |
269 | var->sync |= FB_SYNC_VERT_HIGH_ACT; |
270 | ||
b689a9e8 KH |
271 | total = (std_modes[mode].cr06 | (std_modes[mode].cr30 & 0xF) << 8) + 2; |
272 | var->lower_margin = (std_modes[mode].cr10 | | |
273 | (std_modes[mode].cr32 & 0x0F) << 8) - yres; | |
274 | var->vsync_len = (std_modes[mode].cr11 & 0x0F) - | |
275 | (var->lower_margin & 0x0F); | |
276 | var->upper_margin = total - (yres + var->lower_margin + var->vsync_len); | |
1da177e4 LT |
277 | } |
278 | ||
279 | u32 i810_get_watermark(struct fb_var_screeninfo *var, | |
280 | struct i810fb_par *par) | |
281 | { | |
282 | struct mode_registers *params = &par->regs; | |
283 | u32 wmark = 0; | |
284 | ||
285 | if (par->mem_freq == 100) { | |
286 | switch (var->bits_per_pixel) { | |
287 | case 8: | |
288 | wmark = params->bpp8_100; | |
289 | break; | |
290 | case 16: | |
291 | wmark = params->bpp16_100; | |
292 | break; | |
293 | case 24: | |
294 | case 32: | |
295 | wmark = params->bpp24_100; | |
296 | } | |
297 | } else { | |
298 | switch (var->bits_per_pixel) { | |
299 | case 8: | |
300 | wmark = params->bpp8_133; | |
301 | break; | |
302 | case 16: | |
303 | wmark = params->bpp16_133; | |
304 | break; | |
305 | case 24: | |
306 | case 32: | |
307 | wmark = params->bpp24_133; | |
308 | } | |
309 | } | |
310 | return wmark; | |
311 | } | |
312 |