1  /*
2   *  linux/drivers/video/modedb.c -- Standard video mode database management
3   *
4   *	Copyright (C) 1999 Geert Uytterhoeven
5   *
6   *	2001 - Documented with DocBook
7   *	- Brad Douglas <brad@neruo.com>
8   *
9   *  This file is subject to the terms and conditions of the GNU General Public
10   *  License. See the file COPYING in the main directory of this archive for
11   *  more details.
12   */
13  
14  #include <linux/module.h>
15  #include <linux/slab.h>
16  #include <linux/fb.h>
17  #include <linux/kernel.h>
18  
19  #undef DEBUG
20  
21  #define name_matches(v, s, l) \
22      ((v).name && !strncmp((s), (v).name, (l)) && strlen((v).name) == (l))
23  #define res_matches(v, x, y) \
24      ((v).xres == (x) && (v).yres == (y))
25  
26  #ifdef DEBUG
27  #define DPRINTK(fmt, args...)	printk("modedb %s: " fmt, __func__ , ## args)
28  #else
29  #define DPRINTK(fmt, args...)
30  #endif
31  
32  /*
33   *  Standard video mode definitions (taken from XFree86)
34   */
35  
36  static const struct fb_videomode modedb[] = {
37  
38  	/* 640x400 @ 70 Hz, 31.5 kHz hsync */
39  	{ NULL, 70, 640, 400, 39721, 40, 24, 39, 9, 96, 2, 0,
40  		FB_VMODE_NONINTERLACED },
41  
42  	/* 640x480 @ 60 Hz, 31.5 kHz hsync */
43  	{ NULL, 60, 640, 480, 39721, 40, 24, 32, 11, 96, 2,	0,
44  		FB_VMODE_NONINTERLACED },
45  
46  	/* 800x600 @ 56 Hz, 35.15 kHz hsync */
47  	{ NULL, 56, 800, 600, 27777, 128, 24, 22, 1, 72, 2,	0,
48  		FB_VMODE_NONINTERLACED },
49  
50  	/* 1024x768 @ 87 Hz interlaced, 35.5 kHz hsync */
51  	{ NULL, 87, 1024, 768, 22271, 56, 24, 33, 8, 160, 8, 0,
52  		FB_VMODE_INTERLACED },
53  
54  	/* 640x400 @ 85 Hz, 37.86 kHz hsync */
55  	{ NULL, 85, 640, 400, 31746, 96, 32, 41, 1, 64, 3,
56  		FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED },
57  
58  	/* 640x480 @ 72 Hz, 36.5 kHz hsync */
59  	{ NULL, 72, 640, 480, 31746, 144, 40, 30, 8, 40, 3, 0,
60  		FB_VMODE_NONINTERLACED },
61  
62  	/* 640x480 @ 75 Hz, 37.50 kHz hsync */
63  	{ NULL, 75, 640, 480, 31746, 120, 16, 16, 1, 64, 3,	0,
64  		FB_VMODE_NONINTERLACED },
65  
66  	/* 800x600 @ 60 Hz, 37.8 kHz hsync */
67  	{ NULL, 60, 800, 600, 25000, 88, 40, 23, 1, 128, 4,
68  		FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
69  		FB_VMODE_NONINTERLACED },
70  
71  	/* 640x480 @ 85 Hz, 43.27 kHz hsync */
72  	{ NULL, 85, 640, 480, 27777, 80, 56, 25, 1, 56, 3, 0,
73  		FB_VMODE_NONINTERLACED },
74  
75  	/* 1152x864 @ 89 Hz interlaced, 44 kHz hsync */
76  	{ NULL, 89, 1152, 864, 15384, 96, 16, 110, 1, 216, 10, 0,
77  		FB_VMODE_INTERLACED },
78  	/* 800x600 @ 72 Hz, 48.0 kHz hsync */
79  	{ NULL, 72, 800, 600, 20000, 64, 56, 23, 37, 120, 6,
80  		FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
81  		FB_VMODE_NONINTERLACED },
82  
83  	/* 1024x768 @ 60 Hz, 48.4 kHz hsync */
84  	{ NULL, 60, 1024, 768, 15384, 168, 8, 29, 3, 144, 6, 0,
85  		FB_VMODE_NONINTERLACED },
86  
87  	/* 640x480 @ 100 Hz, 53.01 kHz hsync */
88  	{ NULL, 100, 640, 480, 21834, 96, 32, 36, 8, 96, 6,	0,
89  		FB_VMODE_NONINTERLACED },
90  
91  	/* 1152x864 @ 60 Hz, 53.5 kHz hsync */
92  	{ NULL, 60, 1152, 864, 11123, 208, 64, 16, 4, 256, 8, 0,
93  		FB_VMODE_NONINTERLACED },
94  
95  	/* 800x600 @ 85 Hz, 55.84 kHz hsync */
96  	{ NULL, 85, 800, 600, 16460, 160, 64, 36, 16, 64, 5, 0,
97  		FB_VMODE_NONINTERLACED },
98  
99  	/* 1024x768 @ 70 Hz, 56.5 kHz hsync */
100  	{ NULL, 70, 1024, 768, 13333, 144, 24, 29, 3, 136, 6, 0,
101  		FB_VMODE_NONINTERLACED },
102  
103  	/* 1280x1024 @ 87 Hz interlaced, 51 kHz hsync */
104  	{ NULL, 87, 1280, 1024, 12500, 56, 16, 128, 1, 216, 12,	0,
105  		FB_VMODE_INTERLACED },
106  
107  	/* 800x600 @ 100 Hz, 64.02 kHz hsync */
108  	{ NULL, 100, 800, 600, 14357, 160, 64, 30, 4, 64, 6, 0,
109  		FB_VMODE_NONINTERLACED },
110  
111  	/* 1024x768 @ 76 Hz, 62.5 kHz hsync */
112  	{ NULL, 76, 1024, 768, 11764, 208, 8, 36, 16, 120, 3, 0,
113  		FB_VMODE_NONINTERLACED },
114  
115  	/* 1152x864 @ 70 Hz, 62.4 kHz hsync */
116  	{ NULL, 70, 1152, 864, 10869, 106, 56, 20, 1, 160, 10, 0,
117  		FB_VMODE_NONINTERLACED },
118  
119  	/* 1280x1024 @ 61 Hz, 64.2 kHz hsync */
120  	{ NULL, 61, 1280, 1024, 9090, 200, 48, 26, 1, 184, 3, 0,
121  		FB_VMODE_NONINTERLACED },
122  
123  	/* 1400x1050 @ 60Hz, 63.9 kHz hsync */
124  	{ NULL, 60, 1400, 1050, 9259, 136, 40, 13, 1, 112, 3, 0,
125  		FB_VMODE_NONINTERLACED },
126  
127  	/* 1400x1050 @ 75,107 Hz, 82,392 kHz +hsync +vsync*/
128  	{ NULL, 75, 1400, 1050, 7190, 120, 56, 23, 10, 112, 13,
129  		FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
130  		FB_VMODE_NONINTERLACED },
131  
132  	/* 1400x1050 @ 60 Hz, ? kHz +hsync +vsync*/
133  	{ NULL, 60, 1400, 1050, 9259, 128, 40, 12, 0, 112, 3,
134  		FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
135  		FB_VMODE_NONINTERLACED },
136  
137  	/* 1024x768 @ 85 Hz, 70.24 kHz hsync */
138  	{ NULL, 85, 1024, 768, 10111, 192, 32, 34, 14, 160, 6, 0,
139  		FB_VMODE_NONINTERLACED },
140  
141  	/* 1152x864 @ 78 Hz, 70.8 kHz hsync */
142  	{ NULL, 78, 1152, 864, 9090, 228, 88, 32, 0, 84, 12, 0,
143  		FB_VMODE_NONINTERLACED },
144  
145  	/* 1280x1024 @ 70 Hz, 74.59 kHz hsync */
146  	{ NULL, 70, 1280, 1024, 7905, 224, 32, 28, 8, 160, 8, 0,
147  		FB_VMODE_NONINTERLACED },
148  
149  	/* 1600x1200 @ 60Hz, 75.00 kHz hsync */
150  	{ NULL, 60, 1600, 1200, 6172, 304, 64, 46, 1, 192, 3,
151  		FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
152  		FB_VMODE_NONINTERLACED },
153  
154  	/* 1152x864 @ 84 Hz, 76.0 kHz hsync */
155  	{ NULL, 84, 1152, 864, 7407, 184, 312, 32, 0, 128, 12, 0,
156  		FB_VMODE_NONINTERLACED },
157  
158  	/* 1280x1024 @ 74 Hz, 78.85 kHz hsync */
159  	{ NULL, 74, 1280, 1024, 7407, 256, 32, 34, 3, 144, 3, 0,
160  		FB_VMODE_NONINTERLACED },
161  
162  	/* 1024x768 @ 100Hz, 80.21 kHz hsync */
163  	{ NULL, 100, 1024, 768, 8658, 192, 32, 21, 3, 192, 10, 0,
164  		FB_VMODE_NONINTERLACED },
165  
166  	/* 1280x1024 @ 76 Hz, 81.13 kHz hsync */
167  	{ NULL, 76, 1280, 1024, 7407, 248, 32, 34, 3, 104, 3, 0,
168  		FB_VMODE_NONINTERLACED },
169  
170  	/* 1600x1200 @ 70 Hz, 87.50 kHz hsync */
171  	{ NULL, 70, 1600, 1200, 5291, 304, 64, 46, 1, 192, 3, 0,
172  		FB_VMODE_NONINTERLACED },
173  
174  	/* 1152x864 @ 100 Hz, 89.62 kHz hsync */
175  	{ NULL, 100, 1152, 864, 7264, 224, 32, 17, 2, 128, 19, 0,
176  		FB_VMODE_NONINTERLACED },
177  
178  	/* 1280x1024 @ 85 Hz, 91.15 kHz hsync */
179  	{ NULL, 85, 1280, 1024, 6349, 224, 64, 44, 1, 160, 3,
180  		FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
181  		FB_VMODE_NONINTERLACED },
182  
183  	/* 1600x1200 @ 75 Hz, 93.75 kHz hsync */
184  	{ NULL, 75, 1600, 1200, 4938, 304, 64, 46, 1, 192, 3,
185  		FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
186  		FB_VMODE_NONINTERLACED },
187  
188  	/* 1680x1050 @ 60 Hz, 65.191 kHz hsync */
189  	{ NULL, 60, 1680, 1050, 6848, 280, 104, 30, 3, 176, 6,
190  		FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
191  		FB_VMODE_NONINTERLACED },
192  
193  	/* 1600x1200 @ 85 Hz, 105.77 kHz hsync */
194  	{ NULL, 85, 1600, 1200, 4545, 272, 16, 37, 4, 192, 3,
195  		FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
196  		FB_VMODE_NONINTERLACED },
197  
198  	/* 1280x1024 @ 100 Hz, 107.16 kHz hsync */
199  	{ NULL, 100, 1280, 1024, 5502, 256, 32, 26, 7, 128, 15, 0,
200  		FB_VMODE_NONINTERLACED },
201  
202  	/* 1800x1440 @ 64Hz, 96.15 kHz hsync  */
203  	{ NULL, 64, 1800, 1440, 4347, 304, 96, 46, 1, 192, 3,
204  		FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
205  		FB_VMODE_NONINTERLACED },
206  
207  	/* 1800x1440 @ 70Hz, 104.52 kHz hsync  */
208  	{ NULL, 70, 1800, 1440, 4000, 304, 96, 46, 1, 192, 3,
209  		FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
210  		FB_VMODE_NONINTERLACED },
211  
212  	/* 512x384 @ 78 Hz, 31.50 kHz hsync */
213  	{ NULL, 78, 512, 384, 49603, 48, 16, 16, 1, 64, 3, 0,
214  		FB_VMODE_NONINTERLACED },
215  
216  	/* 512x384 @ 85 Hz, 34.38 kHz hsync */
217  	{ NULL, 85, 512, 384, 45454, 48, 16, 16, 1, 64, 3, 0,
218  		FB_VMODE_NONINTERLACED },
219  
220  	/* 320x200 @ 70 Hz, 31.5 kHz hsync, 8:5 aspect ratio */
221  	{ NULL, 70, 320, 200, 79440, 16, 16, 20, 4, 48, 1, 0,
222  		FB_VMODE_DOUBLE },
223  
224  	/* 320x240 @ 60 Hz, 31.5 kHz hsync, 4:3 aspect ratio */
225  	{ NULL, 60, 320, 240, 79440, 16, 16, 16, 5, 48, 1, 0,
226  		FB_VMODE_DOUBLE },
227  
228  	/* 320x240 @ 72 Hz, 36.5 kHz hsync */
229  	{ NULL, 72, 320, 240, 63492, 16, 16, 16, 4, 48, 2, 0,
230  		FB_VMODE_DOUBLE },
231  
232  	/* 400x300 @ 56 Hz, 35.2 kHz hsync, 4:3 aspect ratio */
233  	{ NULL, 56, 400, 300, 55555, 64, 16, 10, 1, 32, 1, 0,
234  		FB_VMODE_DOUBLE },
235  
236  	/* 400x300 @ 60 Hz, 37.8 kHz hsync */
237  	{ NULL, 60, 400, 300, 50000, 48, 16, 11, 1, 64, 2, 0,
238  		FB_VMODE_DOUBLE },
239  
240  	/* 400x300 @ 72 Hz, 48.0 kHz hsync */
241  	{ NULL, 72, 400, 300, 40000, 32, 24, 11, 19, 64, 3,	0,
242  		FB_VMODE_DOUBLE },
243  
244  	/* 480x300 @ 56 Hz, 35.2 kHz hsync, 8:5 aspect ratio */
245  	{ NULL, 56, 480, 300, 46176, 80, 16, 10, 1, 40, 1, 0,
246  		FB_VMODE_DOUBLE },
247  
248  	/* 480x300 @ 60 Hz, 37.8 kHz hsync */
249  	{ NULL, 60, 480, 300, 41858, 56, 16, 11, 1, 80, 2, 0,
250  		FB_VMODE_DOUBLE },
251  
252  	/* 480x300 @ 63 Hz, 39.6 kHz hsync */
253  	{ NULL, 63, 480, 300, 40000, 56, 16, 11, 1, 80, 2, 0,
254  		FB_VMODE_DOUBLE },
255  
256  	/* 480x300 @ 72 Hz, 48.0 kHz hsync */
257  	{ NULL, 72, 480, 300, 33386, 40, 24, 11, 19, 80, 3, 0,
258  		FB_VMODE_DOUBLE },
259  
260  	/* 1920x1080 @ 60 Hz, 67.3 kHz hsync */
261  	{ NULL, 60, 1920, 1080, 6734, 148, 88, 36, 4, 44, 5, 0,
262  		FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
263  		FB_VMODE_NONINTERLACED },
264  
265  	/* 1920x1200 @ 60 Hz, 74.5 Khz hsync */
266  	{ NULL, 60, 1920, 1200, 5177, 128, 336, 1, 38, 208, 3,
267  		FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
268  		FB_VMODE_NONINTERLACED },
269  
270  	/* 1152x768, 60 Hz, PowerBook G4 Titanium I and II */
271  	{ NULL, 60, 1152, 768, 14047, 158, 26, 29, 3, 136, 6,
272  		FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
273  		FB_VMODE_NONINTERLACED },
274  
275  	/* 1366x768, 60 Hz, 47.403 kHz hsync, WXGA 16:9 aspect ratio */
276  	{ NULL, 60, 1366, 768, 13806, 120, 10, 14, 3, 32, 5, 0,
277  		FB_VMODE_NONINTERLACED },
278  
279  	/* 1280x800, 60 Hz, 47.403 kHz hsync, WXGA 16:10 aspect ratio */
280  	{ NULL, 60, 1280, 800, 12048, 200, 64, 24, 1, 136, 3, 0,
281  		FB_VMODE_NONINTERLACED },
282  
283  	/* 720x576i @ 50 Hz, 15.625 kHz hsync (PAL RGB) */
284  	{ NULL, 50, 720, 576, 74074, 64, 16, 39, 5, 64, 5, 0,
285  		FB_VMODE_INTERLACED },
286  
287  	/* 800x520i @ 50 Hz, 15.625 kHz hsync (PAL RGB) */
288  	{ NULL, 50, 800, 520, 58823, 144, 64, 72, 28, 80, 5, 0,
289  		FB_VMODE_INTERLACED },
290  
291  	/* 864x480 @ 60 Hz, 35.15 kHz hsync */
292  	{ NULL, 60, 864, 480, 27777, 1, 1, 1, 1, 0, 0,
293  		0, FB_VMODE_NONINTERLACED },
294  };
295  
296  #ifdef CONFIG_FB_MODE_HELPERS
297  const struct fb_videomode vesa_modes[] = {
298  	/* 0 640x350-85 VESA */
299  	{ NULL, 85, 640, 350, 31746,  96, 32, 60, 32, 64, 3,
300  	  FB_SYNC_HOR_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA},
301  	/* 1 640x400-85 VESA */
302  	{ NULL, 85, 640, 400, 31746,  96, 32, 41, 01, 64, 3,
303  	  FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
304  	/* 2 720x400-85 VESA */
305  	{ NULL, 85, 721, 400, 28169, 108, 36, 42, 01, 72, 3,
306  	  FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
307  	/* 3 640x480-60 VESA */
308  	{ NULL, 60, 640, 480, 39682,  48, 16, 33, 10, 96, 2,
309  	  0, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
310  	/* 4 640x480-72 VESA */
311  	{ NULL, 72, 640, 480, 31746, 128, 24, 29, 9, 40, 2,
312  	  0, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
313  	/* 5 640x480-75 VESA */
314  	{ NULL, 75, 640, 480, 31746, 120, 16, 16, 01, 64, 3,
315  	  0, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
316  	/* 6 640x480-85 VESA */
317  	{ NULL, 85, 640, 480, 27777, 80, 56, 25, 01, 56, 3,
318  	  0, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
319  	/* 7 800x600-56 VESA */
320  	{ NULL, 56, 800, 600, 27777, 128, 24, 22, 01, 72, 2,
321  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
322  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
323  	/* 8 800x600-60 VESA */
324  	{ NULL, 60, 800, 600, 25000, 88, 40, 23, 01, 128, 4,
325  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
326  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
327  	/* 9 800x600-72 VESA */
328  	{ NULL, 72, 800, 600, 20000, 64, 56, 23, 37, 120, 6,
329  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
330  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
331  	/* 10 800x600-75 VESA */
332  	{ NULL, 75, 800, 600, 20202, 160, 16, 21, 01, 80, 3,
333  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
334  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
335  	/* 11 800x600-85 VESA */
336  	{ NULL, 85, 800, 600, 17761, 152, 32, 27, 01, 64, 3,
337  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
338  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
339          /* 12 1024x768i-43 VESA */
340  	{ NULL, 43, 1024, 768, 22271, 56, 8, 41, 0, 176, 8,
341  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
342  	  FB_VMODE_INTERLACED, FB_MODE_IS_VESA },
343  	/* 13 1024x768-60 VESA */
344  	{ NULL, 60, 1024, 768, 15384, 160, 24, 29, 3, 136, 6,
345  	  0, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
346  	/* 14 1024x768-70 VESA */
347  	{ NULL, 70, 1024, 768, 13333, 144, 24, 29, 3, 136, 6,
348  	  0, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
349  	/* 15 1024x768-75 VESA */
350  	{ NULL, 75, 1024, 768, 12690, 176, 16, 28, 1, 96, 3,
351  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
352  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
353  	/* 16 1024x768-85 VESA */
354  	{ NULL, 85, 1024, 768, 10582, 208, 48, 36, 1, 96, 3,
355  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
356  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
357  	/* 17 1152x864-75 VESA */
358  	{ NULL, 75, 1152, 864, 9259, 256, 64, 32, 1, 128, 3,
359  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
360  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
361  	/* 18 1280x960-60 VESA */
362  	{ NULL, 60, 1280, 960, 9259, 312, 96, 36, 1, 112, 3,
363  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
364  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
365  	/* 19 1280x960-85 VESA */
366  	{ NULL, 85, 1280, 960, 6734, 224, 64, 47, 1, 160, 3,
367  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
368  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
369  	/* 20 1280x1024-60 VESA */
370  	{ NULL, 60, 1280, 1024, 9259, 248, 48, 38, 1, 112, 3,
371  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
372  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
373  	/* 21 1280x1024-75 VESA */
374  	{ NULL, 75, 1280, 1024, 7407, 248, 16, 38, 1, 144, 3,
375  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
376  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
377  	/* 22 1280x1024-85 VESA */
378  	{ NULL, 85, 1280, 1024, 6349, 224, 64, 44, 1, 160, 3,
379  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
380  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
381  	/* 23 1600x1200-60 VESA */
382  	{ NULL, 60, 1600, 1200, 6172, 304, 64, 46, 1, 192, 3,
383  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
384  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
385  	/* 24 1600x1200-65 VESA */
386  	{ NULL, 65, 1600, 1200, 5698, 304,  64, 46, 1, 192, 3,
387  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
388  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
389  	/* 25 1600x1200-70 VESA */
390  	{ NULL, 70, 1600, 1200, 5291, 304, 64, 46, 1, 192, 3,
391  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
392  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
393  	/* 26 1600x1200-75 VESA */
394  	{ NULL, 75, 1600, 1200, 4938, 304, 64, 46, 1, 192, 3,
395  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
396  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
397  	/* 27 1600x1200-85 VESA */
398  	{ NULL, 85, 1600, 1200, 4357, 304, 64, 46, 1, 192, 3,
399  	  FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
400  	  FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
401  	/* 28 1792x1344-60 VESA */
402  	{ NULL, 60, 1792, 1344, 4882, 328, 128, 46, 1, 200, 3,
403  	  FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
404  	/* 29 1792x1344-75 VESA */
405  	{ NULL, 75, 1792, 1344, 3831, 352, 96, 69, 1, 216, 3,
406  	  FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
407  	/* 30 1856x1392-60 VESA */
408  	{ NULL, 60, 1856, 1392, 4580, 352, 96, 43, 1, 224, 3,
409  	  FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
410  	/* 31 1856x1392-75 VESA */
411  	{ NULL, 75, 1856, 1392, 3472, 352, 128, 104, 1, 224, 3,
412  	  FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
413  	/* 32 1920x1440-60 VESA */
414  	{ NULL, 60, 1920, 1440, 4273, 344, 128, 56, 1, 200, 3,
415  	  FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
416  	/* 33 1920x1440-75 VESA */
417  	{ NULL, 75, 1920, 1440, 3367, 352, 144, 56, 1, 224, 3,
418  	  FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
419  	/* 34 1920x1200-60 RB VESA */
420  	{ NULL, 60, 1920, 1200, 6493, 80, 48, 26, 3, 32, 6,
421  	  FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
422  	/* 35 1920x1200-60 VESA */
423  	{ NULL, 60, 1920, 1200, 5174, 336, 136, 36, 3, 200, 6,
424  	  FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
425  	/* 36 1920x1200-75 VESA */
426  	{ NULL, 75, 1920, 1200, 4077, 344, 136, 46, 3, 208, 6,
427  	  FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
428  	/* 37 1920x1200-85 VESA */
429  	{ NULL, 85, 1920, 1200, 3555, 352, 144, 53, 3, 208, 6,
430  	  FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
431  	/* 38 2560x1600-60 RB VESA */
432  	{ NULL, 60, 2560, 1600, 3724, 80, 48, 37, 3, 32, 6,
433  	  FB_SYNC_HOR_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
434  	/* 39 2560x1600-60 VESA */
435  	{ NULL, 60, 2560, 1600, 2869, 472, 192, 49, 3, 280, 6,
436  	  FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
437  	/* 40 2560x1600-75 VESA */
438  	{ NULL, 75, 2560, 1600, 2256, 488, 208, 63, 3, 280, 6,
439  	  FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
440  	/* 41 2560x1600-85 VESA */
441  	{ NULL, 85, 2560, 1600, 1979, 488, 208, 73, 3, 280, 6,
442  	  FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
443  	/* 42 2560x1600-120 RB VESA */
444  	{ NULL, 120, 2560, 1600, 1809, 80, 48, 85, 3, 32, 6,
445  	  FB_SYNC_HOR_HIGH_ACT, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA },
446  };
447  EXPORT_SYMBOL(vesa_modes);
448  
449  const struct dmt_videomode dmt_modes[DMT_SIZE] = {
450  	{ 0x01, 0x0000, 0x000000, &vesa_modes[0] },
451  	{ 0x02, 0x3119, 0x000000, &vesa_modes[1] },
452  	{ 0x03, 0x0000, 0x000000, &vesa_modes[2] },
453  	{ 0x04, 0x3140, 0x000000, &vesa_modes[3] },
454  	{ 0x05, 0x314c, 0x000000, &vesa_modes[4] },
455  	{ 0x06, 0x314f, 0x000000, &vesa_modes[5] },
456  	{ 0x07, 0x3159, 0x000000, &vesa_modes[6] },
457  	{ 0x08, 0x0000, 0x000000, &vesa_modes[7] },
458  	{ 0x09, 0x4540, 0x000000, &vesa_modes[8] },
459  	{ 0x0a, 0x454c, 0x000000, &vesa_modes[9] },
460  	{ 0x0b, 0x454f, 0x000000, &vesa_modes[10] },
461  	{ 0x0c, 0x4559, 0x000000, &vesa_modes[11] },
462  	{ 0x0d, 0x0000, 0x000000, NULL },
463  	{ 0x0e, 0x0000, 0x000000, NULL },
464  	{ 0x0f, 0x0000, 0x000000, &vesa_modes[12] },
465  	{ 0x10, 0x6140, 0x000000, &vesa_modes[13] },
466  	{ 0x11, 0x614a, 0x000000, &vesa_modes[14] },
467  	{ 0x12, 0x614f, 0x000000, &vesa_modes[15] },
468  	{ 0x13, 0x6159, 0x000000, &vesa_modes[16] },
469  	{ 0x14, 0x0000, 0x000000, NULL },
470  	{ 0x15, 0x714f, 0x000000, &vesa_modes[17] },
471  	{ 0x16, 0x0000, 0x7f1c21, NULL },
472  	{ 0x17, 0x0000, 0x7f1c28, NULL },
473  	{ 0x18, 0x0000, 0x7f1c44, NULL },
474  	{ 0x19, 0x0000, 0x7f1c62, NULL },
475  	{ 0x1a, 0x0000, 0x000000, NULL },
476  	{ 0x1b, 0x0000, 0x8f1821, NULL },
477  	{ 0x1c, 0x8100, 0x8f1828, NULL },
478  	{ 0x1d, 0x810f, 0x8f1844, NULL },
479  	{ 0x1e, 0x8119, 0x8f1862, NULL },
480  	{ 0x1f, 0x0000, 0x000000, NULL },
481  	{ 0x20, 0x8140, 0x000000, &vesa_modes[18] },
482  	{ 0x21, 0x8159, 0x000000, &vesa_modes[19] },
483  	{ 0x22, 0x0000, 0x000000, NULL },
484  	{ 0x23, 0x8180, 0x000000, &vesa_modes[20] },
485  	{ 0x24, 0x818f, 0x000000, &vesa_modes[21] },
486  	{ 0x25, 0x8199, 0x000000, &vesa_modes[22] },
487  	{ 0x26, 0x0000, 0x000000, NULL },
488  	{ 0x27, 0x0000, 0x000000, NULL },
489  	{ 0x28, 0x0000, 0x000000, NULL },
490  	{ 0x29, 0x0000, 0x0c2021, NULL },
491  	{ 0x2a, 0x9040, 0x0c2028, NULL },
492  	{ 0x2b, 0x904f, 0x0c2044, NULL },
493  	{ 0x2c, 0x9059, 0x0c2062, NULL },
494  	{ 0x2d, 0x0000, 0x000000, NULL },
495  	{ 0x2e, 0x9500, 0xc11821, NULL },
496  	{ 0x2f, 0x9500, 0xc11828, NULL },
497  	{ 0x30, 0x950f, 0xc11844, NULL },
498  	{ 0x31, 0x9519, 0xc11868, NULL },
499  	{ 0x32, 0x0000, 0x000000, NULL },
500  	{ 0x33, 0xa940, 0x000000, &vesa_modes[23] },
501  	{ 0x34, 0xa945, 0x000000, &vesa_modes[24] },
502  	{ 0x35, 0xa94a, 0x000000, &vesa_modes[25] },
503  	{ 0x36, 0xa94f, 0x000000, &vesa_modes[26] },
504  	{ 0x37, 0xa959, 0x000000, &vesa_modes[27] },
505  	{ 0x38, 0x0000, 0x000000, NULL },
506  	{ 0x39, 0x0000, 0x0c2821, NULL },
507  	{ 0x3a, 0xb300, 0x0c2828, NULL },
508  	{ 0x3b, 0xb30f, 0x0c2844, NULL },
509  	{ 0x3c, 0xb319, 0x0c2868, NULL },
510  	{ 0x3d, 0x0000, 0x000000, NULL },
511  	{ 0x3e, 0xc140, 0x000000, &vesa_modes[28] },
512  	{ 0x3f, 0xc14f, 0x000000, &vesa_modes[29] },
513  	{ 0x40, 0x0000, 0x000000, NULL},
514  	{ 0x41, 0xc940, 0x000000, &vesa_modes[30] },
515  	{ 0x42, 0xc94f, 0x000000, &vesa_modes[31] },
516  	{ 0x43, 0x0000, 0x000000, NULL },
517  	{ 0x44, 0x0000, 0x572821, &vesa_modes[34] },
518  	{ 0x45, 0xd100, 0x572828, &vesa_modes[35] },
519  	{ 0x46, 0xd10f, 0x572844, &vesa_modes[36] },
520  	{ 0x47, 0xd119, 0x572862, &vesa_modes[37] },
521  	{ 0x48, 0x0000, 0x000000, NULL },
522  	{ 0x49, 0xd140, 0x000000, &vesa_modes[32] },
523  	{ 0x4a, 0xd14f, 0x000000, &vesa_modes[33] },
524  	{ 0x4b, 0x0000, 0x000000, NULL },
525  	{ 0x4c, 0x0000, 0x1f3821, &vesa_modes[38] },
526  	{ 0x4d, 0x0000, 0x1f3828, &vesa_modes[39] },
527  	{ 0x4e, 0x0000, 0x1f3844, &vesa_modes[40] },
528  	{ 0x4f, 0x0000, 0x1f3862, &vesa_modes[41] },
529  	{ 0x50, 0x0000, 0x000000, &vesa_modes[42] },
530  };
531  EXPORT_SYMBOL(dmt_modes);
532  #endif /* CONFIG_FB_MODE_HELPERS */
533  
534  /**
535   *	fb_try_mode - test a video mode
536   *	@var: frame buffer user defined part of display
537   *	@info: frame buffer info structure
538   *	@mode: frame buffer video mode structure
539   *	@bpp: color depth in bits per pixel
540   *
541   *	Tries a video mode to test it's validity for device @info.
542   *
543   *	Returns 1 on success.
544   *
545   */
546  
fb_try_mode(struct fb_var_screeninfo * var,struct fb_info * info,const struct fb_videomode * mode,unsigned int bpp)547  static int fb_try_mode(struct fb_var_screeninfo *var, struct fb_info *info,
548  		       const struct fb_videomode *mode, unsigned int bpp)
549  {
550  	int err = 0;
551  
552  	DPRINTK("Trying mode %s %dx%d-%d@%d\n",
553  		mode->name ? mode->name : "noname",
554  		mode->xres, mode->yres, bpp, mode->refresh);
555  	var->xres = mode->xres;
556  	var->yres = mode->yres;
557  	var->xres_virtual = mode->xres;
558  	var->yres_virtual = mode->yres;
559  	var->xoffset = 0;
560  	var->yoffset = 0;
561  	var->bits_per_pixel = bpp;
562  	var->activate |= FB_ACTIVATE_TEST;
563  	var->pixclock = mode->pixclock;
564  	var->left_margin = mode->left_margin;
565  	var->right_margin = mode->right_margin;
566  	var->upper_margin = mode->upper_margin;
567  	var->lower_margin = mode->lower_margin;
568  	var->hsync_len = mode->hsync_len;
569  	var->vsync_len = mode->vsync_len;
570  	var->sync = mode->sync;
571  	var->vmode = mode->vmode;
572  	if (info->fbops->fb_check_var)
573  		err = info->fbops->fb_check_var(var, info);
574  	var->activate &= ~FB_ACTIVATE_TEST;
575  	return err;
576  }
577  
578  /**
579   * fb_find_mode - finds a valid video mode
580   * @var: frame buffer user defined part of display
581   * @info: frame buffer info structure
582   * @mode_option: string video mode to find
583   * @db: video mode database
584   * @dbsize: size of @db
585   * @default_mode: default video mode to fall back to
586   * @default_bpp: default color depth in bits per pixel
587   *
588   * Finds a suitable video mode, starting with the specified mode
589   * in @mode_option with fallback to @default_mode.  If
590   * @default_mode fails, all modes in the video mode database will
591   * be tried.
592   *
593   * Valid mode specifiers for @mode_option::
594   *
595   *     <xres>x<yres>[M][R][-<bpp>][@<refresh>][i][p][m]
596   *
597   * or ::
598   *
599   *     <name>[-<bpp>][@<refresh>]
600   *
601   * with <xres>, <yres>, <bpp> and <refresh> decimal numbers and
602   * <name> a string.
603   *
604   * If 'M' is present after yres (and before refresh/bpp if present),
605   * the function will compute the timings using VESA(tm) Coordinated
606   * Video Timings (CVT).  If 'R' is present after 'M', will compute with
607   * reduced blanking (for flatpanels).  If 'i' or 'p' are present, compute
608   * interlaced or progressive mode.  If 'm' is present, add margins equal
609   * to 1.8% of xres rounded down to 8 pixels, and 1.8% of yres. The char
610   * 'i', 'p' and 'm' must be after 'M' and 'R'. Example::
611   *
612   *     1024x768MR-8@60m - Reduced blank with margins at 60Hz.
613   *
614   * NOTE: The passed struct @var is _not_ cleared!  This allows you
615   * to supply values for e.g. the grayscale and accel_flags fields.
616   *
617   * Returns zero for failure, 1 if using specified @mode_option,
618   * 2 if using specified @mode_option with an ignored refresh rate,
619   * 3 if default mode is used, 4 if fall back to any valid mode.
620   */
621  
fb_find_mode(struct fb_var_screeninfo * var,struct fb_info * info,const char * mode_option,const struct fb_videomode * db,unsigned int dbsize,const struct fb_videomode * default_mode,unsigned int default_bpp)622  int fb_find_mode(struct fb_var_screeninfo *var,
623  		 struct fb_info *info, const char *mode_option,
624  		 const struct fb_videomode *db, unsigned int dbsize,
625  		 const struct fb_videomode *default_mode,
626  		 unsigned int default_bpp)
627  {
628  	char *mode_option_buf = NULL;
629  	int i;
630  
631  	/* Set up defaults */
632  	if (!db) {
633  		db = modedb;
634  		dbsize = ARRAY_SIZE(modedb);
635  	}
636  
637  	if (!default_mode)
638  		default_mode = &db[0];
639  
640  	if (!default_bpp)
641  		default_bpp = 8;
642  
643  	/* Did the user specify a video mode? */
644  	if (!mode_option) {
645  		fb_get_options(NULL, &mode_option_buf);
646  		mode_option = mode_option_buf;
647  	}
648  	if (mode_option) {
649  		const char *name = mode_option;
650  		unsigned int namelen = strlen(name);
651  		int res_specified = 0, bpp_specified = 0, refresh_specified = 0;
652  		unsigned int xres = 0, yres = 0, bpp = default_bpp, refresh = 0;
653  		int yres_specified = 0, cvt = 0, rb = 0;
654  		int interlace_specified = 0, interlace = 0;
655  		int margins = 0;
656  		u32 best, diff, tdiff;
657  
658  		for (i = namelen-1; i >= 0; i--) {
659  			switch (name[i]) {
660  			case '@':
661  				namelen = i;
662  				if (!refresh_specified && !bpp_specified &&
663  				    !yres_specified) {
664  					refresh = simple_strtol(&name[i+1], NULL,
665  								10);
666  					refresh_specified = 1;
667  					if (cvt || rb)
668  						cvt = 0;
669  				} else
670  					goto done;
671  				break;
672  			case '-':
673  				namelen = i;
674  				if (!bpp_specified && !yres_specified) {
675  					bpp = simple_strtol(&name[i+1], NULL,
676  							    10);
677  					bpp_specified = 1;
678  					if (cvt || rb)
679  						cvt = 0;
680  				} else
681  					goto done;
682  				break;
683  			case 'x':
684  				if (!yres_specified) {
685  					yres = simple_strtol(&name[i+1], NULL,
686  							     10);
687  					yres_specified = 1;
688  				} else
689  					goto done;
690  				break;
691  			case '0' ... '9':
692  				break;
693  			case 'M':
694  				if (!yres_specified)
695  					cvt = 1;
696  				break;
697  			case 'R':
698  				if (!cvt)
699  					rb = 1;
700  				break;
701  			case 'm':
702  				if (!cvt)
703  					margins = 1;
704  				break;
705  			case 'p':
706  				if (!cvt) {
707  					interlace = 0;
708  					interlace_specified = 1;
709  				}
710  				break;
711  			case 'i':
712  				if (!cvt) {
713  					interlace = 1;
714  					interlace_specified = 1;
715  				}
716  				break;
717  			default:
718  				goto done;
719  			}
720  		}
721  		if (i < 0 && yres_specified) {
722  			xres = simple_strtol(name, NULL, 10);
723  			res_specified = 1;
724  		}
725  done:
726  		kfree(mode_option_buf);
727  		if (cvt) {
728  			struct fb_videomode cvt_mode;
729  			int ret;
730  
731  			DPRINTK("CVT mode %dx%d@%dHz%s%s%s\n", xres, yres,
732  				(refresh) ? refresh : 60,
733  				(rb) ? " reduced blanking" : "",
734  				(margins) ? " with margins" : "",
735  				(interlace) ? " interlaced" : "");
736  
737  			memset(&cvt_mode, 0, sizeof(cvt_mode));
738  			cvt_mode.xres = xres;
739  			cvt_mode.yres = yres;
740  			cvt_mode.refresh = (refresh) ? refresh : 60;
741  
742  			if (interlace)
743  				cvt_mode.vmode |= FB_VMODE_INTERLACED;
744  			else
745  				cvt_mode.vmode &= ~FB_VMODE_INTERLACED;
746  
747  			ret = fb_find_mode_cvt(&cvt_mode, margins, rb);
748  
749  			if (!ret && !fb_try_mode(var, info, &cvt_mode, bpp)) {
750  				DPRINTK("modedb CVT: CVT mode ok\n");
751  				return 1;
752  			}
753  
754  			DPRINTK("CVT mode invalid, getting mode from database\n");
755  		}
756  
757  		DPRINTK("Trying specified video mode%s %ix%i\n",
758  			refresh_specified ? "" : " (ignoring refresh rate)",
759  			xres, yres);
760  
761  		if (!refresh_specified) {
762  			/*
763  			 * If the caller has provided a custom mode database and
764  			 * a valid monspecs structure, we look for the mode with
765  			 * the highest refresh rate.  Otherwise we play it safe
766  			 * it and try to find a mode with a refresh rate closest
767  			 * to the standard 60 Hz.
768  			 */
769  			if (db != modedb &&
770  			    info->monspecs.vfmin && info->monspecs.vfmax &&
771  			    info->monspecs.hfmin && info->monspecs.hfmax &&
772  			    info->monspecs.dclkmax) {
773  				refresh = 1000;
774  			} else {
775  				refresh = 60;
776  			}
777  		}
778  
779  		diff = -1;
780  		best = -1;
781  		for (i = 0; i < dbsize; i++) {
782  			if ((name_matches(db[i], name, namelen) ||
783  			     (res_specified && res_matches(db[i], xres, yres))) &&
784  			    !fb_try_mode(var, info, &db[i], bpp)) {
785  				const int db_interlace = (db[i].vmode &
786  					FB_VMODE_INTERLACED ? 1 : 0);
787  				int score = abs(db[i].refresh - refresh);
788  
789  				if (interlace_specified)
790  					score += abs(db_interlace - interlace);
791  
792  				if (!interlace_specified ||
793  				    db_interlace == interlace)
794  					if (refresh_specified &&
795  					    db[i].refresh == refresh)
796  						return 1;
797  
798  				if (score < diff) {
799  					diff = score;
800  					best = i;
801  				}
802  			}
803  		}
804  		if (best != -1) {
805  			fb_try_mode(var, info, &db[best], bpp);
806  			return (refresh_specified) ? 2 : 1;
807  		}
808  
809  		diff = 2 * (xres + yres);
810  		best = -1;
811  		DPRINTK("Trying best-fit modes\n");
812  		for (i = 0; i < dbsize; i++) {
813  			DPRINTK("Trying %ix%i\n", db[i].xres, db[i].yres);
814  			if (!fb_try_mode(var, info, &db[i], bpp)) {
815  				tdiff = abs(db[i].xres - xres) +
816  					abs(db[i].yres - yres);
817  
818  				/*
819  				 * Penalize modes with resolutions smaller
820  				 * than requested.
821  				 */
822  				if (xres > db[i].xres || yres > db[i].yres)
823  					tdiff += xres + yres;
824  
825  				if (diff > tdiff) {
826  					diff = tdiff;
827  					best = i;
828  				}
829  			}
830  		}
831  		if (best != -1) {
832  			fb_try_mode(var, info, &db[best], bpp);
833  			return 5;
834  		}
835  	}
836  
837  	DPRINTK("Trying default video mode\n");
838  	if (!fb_try_mode(var, info, default_mode, default_bpp))
839  		return 3;
840  
841  	DPRINTK("Trying all modes\n");
842  	for (i = 0; i < dbsize; i++)
843  		if (!fb_try_mode(var, info, &db[i], default_bpp))
844  			return 4;
845  
846  	DPRINTK("No valid mode found\n");
847  	return 0;
848  }
849  
850  /**
851   * fb_var_to_videomode - convert fb_var_screeninfo to fb_videomode
852   * @mode: pointer to struct fb_videomode
853   * @var: pointer to struct fb_var_screeninfo
854   */
fb_var_to_videomode(struct fb_videomode * mode,const struct fb_var_screeninfo * var)855  void fb_var_to_videomode(struct fb_videomode *mode,
856  			 const struct fb_var_screeninfo *var)
857  {
858  	u32 pixclock, hfreq, htotal, vtotal;
859  
860  	mode->name = NULL;
861  	mode->xres = var->xres;
862  	mode->yres = var->yres;
863  	mode->pixclock = var->pixclock;
864  	mode->hsync_len = var->hsync_len;
865  	mode->vsync_len = var->vsync_len;
866  	mode->left_margin = var->left_margin;
867  	mode->right_margin = var->right_margin;
868  	mode->upper_margin = var->upper_margin;
869  	mode->lower_margin = var->lower_margin;
870  	mode->sync = var->sync;
871  	mode->vmode = var->vmode & FB_VMODE_MASK;
872  	mode->flag = FB_MODE_IS_FROM_VAR;
873  	mode->refresh = 0;
874  
875  	if (!var->pixclock)
876  		return;
877  
878  	pixclock = PICOS2KHZ(var->pixclock) * 1000;
879  
880  	htotal = var->xres + var->right_margin + var->hsync_len +
881  		var->left_margin;
882  	vtotal = var->yres + var->lower_margin + var->vsync_len +
883  		var->upper_margin;
884  
885  	if (var->vmode & FB_VMODE_INTERLACED)
886  		vtotal /= 2;
887  	if (var->vmode & FB_VMODE_DOUBLE)
888  		vtotal *= 2;
889  
890  	if (!htotal || !vtotal)
891  		return;
892  
893  	hfreq = pixclock/htotal;
894  	mode->refresh = hfreq/vtotal;
895  }
896  
897  /**
898   * fb_videomode_to_var - convert fb_videomode to fb_var_screeninfo
899   * @var: pointer to struct fb_var_screeninfo
900   * @mode: pointer to struct fb_videomode
901   */
fb_videomode_to_var(struct fb_var_screeninfo * var,const struct fb_videomode * mode)902  void fb_videomode_to_var(struct fb_var_screeninfo *var,
903  			 const struct fb_videomode *mode)
904  {
905  	var->xres = mode->xres;
906  	var->yres = mode->yres;
907  	var->xres_virtual = mode->xres;
908  	var->yres_virtual = mode->yres;
909  	var->xoffset = 0;
910  	var->yoffset = 0;
911  	var->pixclock = mode->pixclock;
912  	var->left_margin = mode->left_margin;
913  	var->right_margin = mode->right_margin;
914  	var->upper_margin = mode->upper_margin;
915  	var->lower_margin = mode->lower_margin;
916  	var->hsync_len = mode->hsync_len;
917  	var->vsync_len = mode->vsync_len;
918  	var->sync = mode->sync;
919  	var->vmode = mode->vmode & FB_VMODE_MASK;
920  }
921  
922  /**
923   * fb_mode_is_equal - compare 2 videomodes
924   * @mode1: first videomode
925   * @mode2: second videomode
926   *
927   * RETURNS:
928   * 1 if equal, 0 if not
929   */
fb_mode_is_equal(const struct fb_videomode * mode1,const struct fb_videomode * mode2)930  int fb_mode_is_equal(const struct fb_videomode *mode1,
931  		     const struct fb_videomode *mode2)
932  {
933  	return (mode1->xres         == mode2->xres &&
934  		mode1->yres         == mode2->yres &&
935  		mode1->pixclock     == mode2->pixclock &&
936  		mode1->hsync_len    == mode2->hsync_len &&
937  		mode1->vsync_len    == mode2->vsync_len &&
938  		mode1->left_margin  == mode2->left_margin &&
939  		mode1->right_margin == mode2->right_margin &&
940  		mode1->upper_margin == mode2->upper_margin &&
941  		mode1->lower_margin == mode2->lower_margin &&
942  		mode1->sync         == mode2->sync &&
943  		mode1->vmode        == mode2->vmode);
944  }
945  
946  /**
947   * fb_find_best_mode - find best matching videomode
948   * @var: pointer to struct fb_var_screeninfo
949   * @head: pointer to struct list_head of modelist
950   *
951   * RETURNS:
952   * struct fb_videomode, NULL if none found
953   *
954   * IMPORTANT:
955   * This function assumes that all modelist entries in
956   * info->modelist are valid.
957   *
958   * NOTES:
959   * Finds best matching videomode which has an equal or greater dimension than
960   * var->xres and var->yres.  If more than 1 videomode is found, will return
961   * the videomode with the highest refresh rate
962   */
fb_find_best_mode(const struct fb_var_screeninfo * var,struct list_head * head)963  const struct fb_videomode *fb_find_best_mode(const struct fb_var_screeninfo *var,
964  					     struct list_head *head)
965  {
966  	struct fb_modelist *modelist;
967  	struct fb_videomode *mode, *best = NULL;
968  	u32 diff = -1;
969  
970  	list_for_each_entry(modelist, head, list) {
971  		u32 d;
972  		mode = &modelist->mode;
973  
974  		if (mode->xres >= var->xres && mode->yres >= var->yres) {
975  			d = (mode->xres - var->xres) +
976  				(mode->yres - var->yres);
977  			if (diff > d) {
978  				diff = d;
979  				best = mode;
980  			} else if (diff == d && best &&
981  				   mode->refresh > best->refresh)
982  				best = mode;
983  		}
984  	}
985  	return best;
986  }
987  
988  /**
989   * fb_find_nearest_mode - find closest videomode
990   *
991   * @mode: pointer to struct fb_videomode
992   * @head: pointer to modelist
993   *
994   * Finds best matching videomode, smaller or greater in dimension.
995   * If more than 1 videomode is found, will return the videomode with
996   * the closest refresh rate.
997   */
fb_find_nearest_mode(const struct fb_videomode * mode,struct list_head * head)998  const struct fb_videomode *fb_find_nearest_mode(const struct fb_videomode *mode,
999  					        struct list_head *head)
1000  {
1001  	struct fb_modelist *modelist;
1002  	struct fb_videomode *cmode, *best = NULL;
1003  	u32 diff = -1, diff_refresh = -1;
1004  
1005  	list_for_each_entry(modelist, head, list) {
1006  		u32 d;
1007  		cmode = &modelist->mode;
1008  
1009  		d = abs(cmode->xres - mode->xres) +
1010  			abs(cmode->yres - mode->yres);
1011  		if (diff > d) {
1012  			diff = d;
1013  			diff_refresh = abs(cmode->refresh - mode->refresh);
1014  			best = cmode;
1015  		} else if (diff == d) {
1016  			d = abs(cmode->refresh - mode->refresh);
1017  			if (diff_refresh > d) {
1018  				diff_refresh = d;
1019  				best = cmode;
1020  			}
1021  		}
1022  	}
1023  
1024  	return best;
1025  }
1026  
1027  /**
1028   * fb_match_mode - find a videomode which exactly matches the timings in var
1029   * @var: pointer to struct fb_var_screeninfo
1030   * @head: pointer to struct list_head of modelist
1031   *
1032   * RETURNS:
1033   * struct fb_videomode, NULL if none found
1034   */
fb_match_mode(const struct fb_var_screeninfo * var,struct list_head * head)1035  const struct fb_videomode *fb_match_mode(const struct fb_var_screeninfo *var,
1036  					 struct list_head *head)
1037  {
1038  	struct fb_modelist *modelist;
1039  	struct fb_videomode *m, mode;
1040  
1041  	fb_var_to_videomode(&mode, var);
1042  	list_for_each_entry(modelist, head, list) {
1043  		m = &modelist->mode;
1044  		if (fb_mode_is_equal(m, &mode))
1045  			return m;
1046  	}
1047  	return NULL;
1048  }
1049  
1050  /**
1051   * fb_add_videomode - adds videomode entry to modelist
1052   * @mode: videomode to add
1053   * @head: struct list_head of modelist
1054   *
1055   * NOTES:
1056   * Will only add unmatched mode entries
1057   */
fb_add_videomode(const struct fb_videomode * mode,struct list_head * head)1058  int fb_add_videomode(const struct fb_videomode *mode, struct list_head *head)
1059  {
1060  	struct fb_modelist *modelist;
1061  	struct fb_videomode *m;
1062  	int found = 0;
1063  
1064  	list_for_each_entry(modelist, head, list) {
1065  		m = &modelist->mode;
1066  		if (fb_mode_is_equal(m, mode)) {
1067  			found = 1;
1068  			break;
1069  		}
1070  	}
1071  	if (!found) {
1072  		modelist = kmalloc(sizeof(struct fb_modelist),
1073  						  GFP_KERNEL);
1074  
1075  		if (!modelist)
1076  			return -ENOMEM;
1077  		modelist->mode = *mode;
1078  		list_add(&modelist->list, head);
1079  	}
1080  	return 0;
1081  }
1082  
1083  /**
1084   * fb_delete_videomode - removed videomode entry from modelist
1085   * @mode: videomode to remove
1086   * @head: struct list_head of modelist
1087   *
1088   * NOTES:
1089   * Will remove all matching mode entries
1090   */
fb_delete_videomode(const struct fb_videomode * mode,struct list_head * head)1091  void fb_delete_videomode(const struct fb_videomode *mode,
1092  			 struct list_head *head)
1093  {
1094  	struct list_head *pos, *n;
1095  	struct fb_modelist *modelist;
1096  	struct fb_videomode *m;
1097  
1098  	list_for_each_safe(pos, n, head) {
1099  		modelist = list_entry(pos, struct fb_modelist, list);
1100  		m = &modelist->mode;
1101  		if (fb_mode_is_equal(m, mode)) {
1102  			list_del(pos);
1103  			kfree(pos);
1104  		}
1105  	}
1106  }
1107  
1108  /**
1109   * fb_destroy_modelist - destroy modelist
1110   * @head: struct list_head of modelist
1111   */
fb_destroy_modelist(struct list_head * head)1112  void fb_destroy_modelist(struct list_head *head)
1113  {
1114  	struct list_head *pos, *n;
1115  
1116  	list_for_each_safe(pos, n, head) {
1117  		list_del(pos);
1118  		kfree(pos);
1119  	}
1120  }
1121  EXPORT_SYMBOL_GPL(fb_destroy_modelist);
1122  
1123  /**
1124   * fb_videomode_to_modelist - convert mode array to mode list
1125   * @modedb: array of struct fb_videomode
1126   * @num: number of entries in array
1127   * @head: struct list_head of modelist
1128   */
fb_videomode_to_modelist(const struct fb_videomode * modedb,int num,struct list_head * head)1129  void fb_videomode_to_modelist(const struct fb_videomode *modedb, int num,
1130  			      struct list_head *head)
1131  {
1132  	int i;
1133  
1134  	INIT_LIST_HEAD(head);
1135  
1136  	for (i = 0; i < num; i++) {
1137  		if (fb_add_videomode(&modedb[i], head))
1138  			return;
1139  	}
1140  }
1141  
fb_find_best_display(const struct fb_monspecs * specs,struct list_head * head)1142  const struct fb_videomode *fb_find_best_display(const struct fb_monspecs *specs,
1143  					        struct list_head *head)
1144  {
1145  	struct fb_modelist *modelist;
1146  	const struct fb_videomode *m, *m1 = NULL, *md = NULL, *best = NULL;
1147  	int first = 0;
1148  
1149  	if (!head->prev || !head->next || list_empty(head))
1150  		goto finished;
1151  
1152  	/* get the first detailed mode and the very first mode */
1153  	list_for_each_entry(modelist, head, list) {
1154  		m = &modelist->mode;
1155  
1156  		if (!first) {
1157  			m1 = m;
1158  			first = 1;
1159  		}
1160  
1161  		if (m->flag & FB_MODE_IS_FIRST) {
1162   			md = m;
1163  			break;
1164  		}
1165  	}
1166  
1167  	/* first detailed timing is preferred */
1168  	if (specs->misc & FB_MISC_1ST_DETAIL) {
1169  		best = md;
1170  		goto finished;
1171  	}
1172  
1173  	/* find best mode based on display width and height */
1174  	if (specs->max_x && specs->max_y) {
1175  		struct fb_var_screeninfo var;
1176  
1177  		memset(&var, 0, sizeof(struct fb_var_screeninfo));
1178  		var.xres = (specs->max_x * 7200)/254;
1179  		var.yres = (specs->max_y * 7200)/254;
1180  		m = fb_find_best_mode(&var, head);
1181  		if (m) {
1182  			best = m;
1183  			goto finished;
1184  		}
1185  	}
1186  
1187  	/* use first detailed mode */
1188  	if (md) {
1189  		best = md;
1190  		goto finished;
1191  	}
1192  
1193  	/* last resort, use the very first mode */
1194  	best = m1;
1195  finished:
1196  	return best;
1197  }
1198  EXPORT_SYMBOL(fb_find_best_display);
1199  
1200  EXPORT_SYMBOL(fb_videomode_to_var);
1201  EXPORT_SYMBOL(fb_var_to_videomode);
1202  EXPORT_SYMBOL(fb_mode_is_equal);
1203  EXPORT_SYMBOL(fb_add_videomode);
1204  EXPORT_SYMBOL(fb_match_mode);
1205  EXPORT_SYMBOL(fb_find_best_mode);
1206  EXPORT_SYMBOL(fb_find_nearest_mode);
1207  EXPORT_SYMBOL(fb_videomode_to_modelist);
1208  EXPORT_SYMBOL(fb_find_mode);
1209  EXPORT_SYMBOL(fb_find_mode_cvt);
1210