File Index
Files and directories
Sign in
FILE

i810_dvt.c

File preview with syntax highlighting.

linux-6.19.14/drivers/video/fbdev/i810/i810_dvt.c 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#include "i810_main.h"
 18
 19struct 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
195void 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
211inline void round_off_yres(u32 *xres, u32 *yres)
212{
213	*yres = (*xres * 3) >> 2;
214}
215
216static 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
234void 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
246void 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
280u32 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
~/ Read-only file preview.