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