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