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