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