1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/kernel.h>
14
15#include "i810_regs.h"
16#include "i810.h"
17
18struct mode_registers std_modes[] = {
19
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
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
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
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
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
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
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
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
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
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
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
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
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
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
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
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
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
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
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
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
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
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
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
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
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
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
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
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
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
194void 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
210inline void round_off_yres(u32 *xres, u32 *yres)
211{
212 *yres = (*xres * 3) >> 2;
213}
214
215static int i810fb_find_best_mode(u32 xres, u32 yres, u32 pixclock)
216{
217 u32 diff = 0, diff_best = 0xFFFFFFFF, i = 0, i_best = 0;
218 u8 hfl = (u8) ((xres >> 3) - 1);
219
220 for (i = 0; i < ARRAY_SIZE(std_modes); i++) {
221 if (std_modes[i].cr01 == hfl) {
222 if (std_modes[i].pixclock <= pixclock)
223 diff = pixclock - std_modes[i].pixclock;
224 if (diff < diff_best) {
225 i_best = i;
226 diff_best = diff;
227 }
228 }
229 }
230 return i_best;
231}
232
233void 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
238 par->regs = std_modes[i_best];
239
240
241 par->ovract = ((xres + var->right_margin + var->hsync_len +
242 var->left_margin - 32) | ((xres - 32) << 16));
243}
244
245void i810fb_fill_var_timings(struct fb_var_screeninfo *var)
246{
247 u32 total, xres, yres;
248 u32 mode, pixclock;
249
250 xres = var->xres;
251 yres = var->yres;
252
253 pixclock = 1000000000 / var->pixclock;
254 mode = i810fb_find_best_mode(xres, yres, pixclock);
255
256 total = (std_modes[mode].cr00 | (std_modes[mode].cr35 & 1) << 8) + 3;
257 total <<= 3;
258
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;
263 var->left_margin = (total - (xres + var->right_margin +
264 var->hsync_len));
265 var->sync = FB_SYNC_ON_GREEN;
266 if (~(std_modes[mode].msr & (1 << 6)))
267 var->sync |= FB_SYNC_HOR_HIGH_ACT;
268 if (~(std_modes[mode].msr & (1 << 7)))
269 var->sync |= FB_SYNC_VERT_HIGH_ACT;
270
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);
277}
278
279u32 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
313
