diff options
Diffstat (limited to 'drivers/video/fbcvt.c')
| -rw-r--r-- | drivers/video/fbcvt.c | 380 |
1 files changed, 380 insertions, 0 deletions
diff --git a/drivers/video/fbcvt.c b/drivers/video/fbcvt.c new file mode 100644 index 000000000000..cfa61b512de0 --- /dev/null +++ b/drivers/video/fbcvt.c | |||
| @@ -0,0 +1,380 @@ | |||
| 1 | /* | ||
| 2 | * linux/drivers/video/fbcvt.c - VESA(TM) Coordinated Video Timings | ||
| 3 | * | ||
| 4 | * Copyright (C) 2005 Antonino Daplas <adaplas@pol.net> | ||
| 5 | * | ||
| 6 | * Based from the VESA(TM) Coordinated Video Timing Generator by | ||
| 7 | * Graham Loveridge April 9, 2003 available at | ||
| 8 | * http://www.vesa.org/public/CVT/CVTd6r1.xls | ||
| 9 | * | ||
| 10 | * This file is subject to the terms and conditions of the GNU General Public | ||
| 11 | * License. See the file COPYING in the main directory of this archive | ||
| 12 | * for more details. | ||
| 13 | * | ||
| 14 | */ | ||
| 15 | #include <linux/fb.h> | ||
| 16 | |||
| 17 | #define FB_CVT_CELLSIZE 8 | ||
| 18 | #define FB_CVT_GTF_C 40 | ||
| 19 | #define FB_CVT_GTF_J 20 | ||
| 20 | #define FB_CVT_GTF_K 128 | ||
| 21 | #define FB_CVT_GTF_M 600 | ||
| 22 | #define FB_CVT_MIN_VSYNC_BP 550 | ||
| 23 | #define FB_CVT_MIN_VPORCH 3 | ||
| 24 | #define FB_CVT_MIN_BPORCH 6 | ||
| 25 | |||
| 26 | #define FB_CVT_RB_MIN_VBLANK 460 | ||
| 27 | #define FB_CVT_RB_HBLANK 160 | ||
| 28 | #define FB_CVT_RB_V_FPORCH 3 | ||
| 29 | |||
| 30 | #define FB_CVT_FLAG_REDUCED_BLANK 1 | ||
| 31 | #define FB_CVT_FLAG_MARGINS 2 | ||
| 32 | #define FB_CVT_FLAG_INTERLACED 4 | ||
| 33 | |||
| 34 | struct fb_cvt_data { | ||
| 35 | u32 xres; | ||
| 36 | u32 yres; | ||
| 37 | u32 refresh; | ||
| 38 | u32 f_refresh; | ||
| 39 | u32 pixclock; | ||
| 40 | u32 hperiod; | ||
| 41 | u32 hblank; | ||
| 42 | u32 hfreq; | ||
| 43 | u32 htotal; | ||
| 44 | u32 vtotal; | ||
| 45 | u32 vsync; | ||
| 46 | u32 hsync; | ||
| 47 | u32 h_front_porch; | ||
| 48 | u32 h_back_porch; | ||
| 49 | u32 v_front_porch; | ||
| 50 | u32 v_back_porch; | ||
| 51 | u32 h_margin; | ||
| 52 | u32 v_margin; | ||
| 53 | u32 interlace; | ||
| 54 | u32 aspect_ratio; | ||
| 55 | u32 active_pixels; | ||
| 56 | u32 flags; | ||
| 57 | u32 status; | ||
| 58 | }; | ||
| 59 | |||
| 60 | static int fb_cvt_vbi_tab[] = { | ||
| 61 | 4, /* 4:3 */ | ||
| 62 | 5, /* 16:9 */ | ||
| 63 | 6, /* 16:10 */ | ||
| 64 | 7, /* 5:4 */ | ||
| 65 | 7, /* 15:9 */ | ||
| 66 | 8, /* reserved */ | ||
| 67 | 9, /* reserved */ | ||
| 68 | 10 /* custom */ | ||
| 69 | }; | ||
| 70 | |||
| 71 | /* returns hperiod * 1000 */ | ||
| 72 | static u32 fb_cvt_hperiod(struct fb_cvt_data *cvt) | ||
| 73 | { | ||
| 74 | u32 num = 1000000000/cvt->f_refresh; | ||
| 75 | u32 den; | ||
| 76 | |||
| 77 | if (cvt->flags & FB_CVT_FLAG_REDUCED_BLANK) { | ||
| 78 | num -= FB_CVT_RB_MIN_VBLANK * 1000; | ||
| 79 | den = 2 * (cvt->yres/cvt->interlace + 2 * cvt->v_margin); | ||
| 80 | } else { | ||
| 81 | num -= FB_CVT_MIN_VSYNC_BP * 1000; | ||
| 82 | den = 2 * (cvt->yres/cvt->interlace + cvt->v_margin * 2 | ||
| 83 | + FB_CVT_MIN_VPORCH + cvt->interlace/2); | ||
| 84 | } | ||
| 85 | |||
| 86 | return 2 * (num/den); | ||
| 87 | } | ||
| 88 | |||
| 89 | /* returns ideal duty cycle * 1000 */ | ||
| 90 | static u32 fb_cvt_ideal_duty_cycle(struct fb_cvt_data *cvt) | ||
| 91 | { | ||
| 92 | u32 c_prime = (FB_CVT_GTF_C - FB_CVT_GTF_J) * | ||
| 93 | (FB_CVT_GTF_K) + 256 * FB_CVT_GTF_J; | ||
| 94 | u32 m_prime = (FB_CVT_GTF_K * FB_CVT_GTF_M); | ||
| 95 | u32 h_period_est = cvt->hperiod; | ||
| 96 | |||
| 97 | return (1000 * c_prime - ((m_prime * h_period_est)/1000))/256; | ||
| 98 | } | ||
| 99 | |||
| 100 | static u32 fb_cvt_hblank(struct fb_cvt_data *cvt) | ||
| 101 | { | ||
| 102 | u32 hblank = 0; | ||
| 103 | |||
| 104 | if (cvt->flags & FB_CVT_FLAG_REDUCED_BLANK) | ||
| 105 | hblank = FB_CVT_RB_HBLANK; | ||
| 106 | else { | ||
| 107 | u32 ideal_duty_cycle = fb_cvt_ideal_duty_cycle(cvt); | ||
| 108 | u32 active_pixels = cvt->active_pixels; | ||
| 109 | |||
| 110 | if (ideal_duty_cycle < 20000) | ||
| 111 | hblank = (active_pixels * 20000)/ | ||
| 112 | (100000 - 20000); | ||
| 113 | else { | ||
| 114 | hblank = (active_pixels * ideal_duty_cycle)/ | ||
| 115 | (100000 - ideal_duty_cycle); | ||
| 116 | } | ||
| 117 | } | ||
| 118 | |||
| 119 | hblank &= ~((2 * FB_CVT_CELLSIZE) - 1); | ||
| 120 | |||
| 121 | return hblank; | ||
| 122 | } | ||
| 123 | |||
| 124 | static u32 fb_cvt_hsync(struct fb_cvt_data *cvt) | ||
| 125 | { | ||
| 126 | u32 hsync; | ||
| 127 | |||
| 128 | if (cvt->flags & FB_CVT_FLAG_REDUCED_BLANK) | ||
| 129 | hsync = 32; | ||
| 130 | else | ||
| 131 | hsync = (FB_CVT_CELLSIZE * cvt->htotal)/100; | ||
| 132 | |||
| 133 | hsync &= ~(FB_CVT_CELLSIZE - 1); | ||
| 134 | return hsync; | ||
| 135 | } | ||
| 136 | |||
| 137 | static u32 fb_cvt_vbi_lines(struct fb_cvt_data *cvt) | ||
| 138 | { | ||
| 139 | u32 vbi_lines, min_vbi_lines, act_vbi_lines; | ||
| 140 | |||
| 141 | if (cvt->flags & FB_CVT_FLAG_REDUCED_BLANK) { | ||
| 142 | vbi_lines = (1000 * FB_CVT_RB_MIN_VBLANK)/cvt->hperiod + 1; | ||
| 143 | min_vbi_lines = FB_CVT_RB_V_FPORCH + cvt->vsync + | ||
| 144 | FB_CVT_MIN_BPORCH; | ||
| 145 | |||
| 146 | } else { | ||
| 147 | vbi_lines = (FB_CVT_MIN_VSYNC_BP * 1000)/cvt->hperiod + 1 + | ||
| 148 | FB_CVT_MIN_VPORCH; | ||
| 149 | min_vbi_lines = cvt->vsync + FB_CVT_MIN_BPORCH + | ||
| 150 | FB_CVT_MIN_VPORCH; | ||
| 151 | } | ||
| 152 | |||
| 153 | if (vbi_lines < min_vbi_lines) | ||
| 154 | act_vbi_lines = min_vbi_lines; | ||
| 155 | else | ||
| 156 | act_vbi_lines = vbi_lines; | ||
| 157 | |||
| 158 | return act_vbi_lines; | ||
| 159 | } | ||
| 160 | |||
| 161 | static u32 fb_cvt_vtotal(struct fb_cvt_data *cvt) | ||
| 162 | { | ||
| 163 | u32 vtotal = cvt->yres/cvt->interlace; | ||
| 164 | |||
| 165 | vtotal += 2 * cvt->v_margin + cvt->interlace/2 + fb_cvt_vbi_lines(cvt); | ||
| 166 | vtotal |= cvt->interlace/2; | ||
| 167 | |||
| 168 | return vtotal; | ||
| 169 | } | ||
| 170 | |||
| 171 | static u32 fb_cvt_pixclock(struct fb_cvt_data *cvt) | ||
| 172 | { | ||
| 173 | u32 pixclock; | ||
| 174 | |||
| 175 | if (cvt->flags & FB_CVT_FLAG_REDUCED_BLANK) | ||
| 176 | pixclock = (cvt->f_refresh * cvt->vtotal * cvt->htotal)/1000; | ||
| 177 | else | ||
| 178 | pixclock = (cvt->htotal * 1000000)/cvt->hperiod; | ||
| 179 | |||
| 180 | pixclock /= 250; | ||
| 181 | pixclock *= 250; | ||
| 182 | pixclock *= 1000; | ||
| 183 | |||
| 184 | return pixclock; | ||
| 185 | } | ||
| 186 | |||
| 187 | static u32 fb_cvt_aspect_ratio(struct fb_cvt_data *cvt) | ||
| 188 | { | ||
| 189 | u32 xres = cvt->xres; | ||
| 190 | u32 yres = cvt->yres; | ||
| 191 | u32 aspect = -1; | ||
| 192 | |||
| 193 | if (xres == (yres * 4)/3 && !((yres * 4) % 3)) | ||
| 194 | aspect = 0; | ||
| 195 | else if (xres == (yres * 16)/9 && !((yres * 16) % 9)) | ||
| 196 | aspect = 1; | ||
| 197 | else if (xres == (yres * 16)/10 && !((yres * 16) % 10)) | ||
| 198 | aspect = 2; | ||
| 199 | else if (xres == (yres * 5)/4 && !((yres * 5) % 4)) | ||
| 200 | aspect = 3; | ||
| 201 | else if (xres == (yres * 15)/9 && !((yres * 15) % 9)) | ||
| 202 | aspect = 4; | ||
| 203 | else { | ||
| 204 | printk(KERN_INFO "fbcvt: Aspect ratio not CVT " | ||
| 205 | "standard\n"); | ||
| 206 | aspect = 7; | ||
| 207 | cvt->status = 1; | ||
| 208 | } | ||
| 209 | |||
| 210 | return aspect; | ||
| 211 | } | ||
| 212 | |||
| 213 | static void fb_cvt_print_name(struct fb_cvt_data *cvt) | ||
| 214 | { | ||
| 215 | u32 pixcount, pixcount_mod; | ||
| 216 | int cnt = 255, offset = 0, read = 0; | ||
| 217 | u8 *buf = kmalloc(256, GFP_KERNEL); | ||
| 218 | |||
| 219 | if (!buf) | ||
| 220 | return; | ||
| 221 | |||
| 222 | memset(buf, 0, 256); | ||
| 223 | pixcount = (cvt->xres * (cvt->yres/cvt->interlace))/1000000; | ||
| 224 | pixcount_mod = (cvt->xres * (cvt->yres/cvt->interlace)) % 1000000; | ||
| 225 | pixcount_mod /= 1000; | ||
| 226 | |||
| 227 | read = snprintf(buf+offset, cnt, "fbcvt: %dx%d@%d: CVT Name - ", | ||
| 228 | cvt->xres, cvt->yres, cvt->refresh); | ||
| 229 | offset += read; | ||
| 230 | cnt -= read; | ||
| 231 | |||
| 232 | if (cvt->status) | ||
| 233 | snprintf(buf+offset, cnt, "Not a CVT standard - %d.%03d Mega " | ||
| 234 | "Pixel Image\n", pixcount, pixcount_mod); | ||
| 235 | else { | ||
| 236 | if (pixcount) { | ||
| 237 | read = snprintf(buf+offset, cnt, "%d", pixcount); | ||
| 238 | cnt -= read; | ||
| 239 | offset += read; | ||
| 240 | } | ||
| 241 | |||
| 242 | read = snprintf(buf+offset, cnt, ".%03dM", pixcount_mod); | ||
| 243 | cnt -= read; | ||
| 244 | offset += read; | ||
| 245 | |||
| 246 | if (cvt->aspect_ratio == 0) | ||
| 247 | read = snprintf(buf+offset, cnt, "3"); | ||
| 248 | else if (cvt->aspect_ratio == 3) | ||
| 249 | read = snprintf(buf+offset, cnt, "4"); | ||
| 250 | else if (cvt->aspect_ratio == 1 || cvt->aspect_ratio == 4) | ||
| 251 | read = snprintf(buf+offset, cnt, "9"); | ||
| 252 | else if (cvt->aspect_ratio == 2) | ||
| 253 | read = snprintf(buf+offset, cnt, "A"); | ||
| 254 | else | ||
| 255 | read = 0; | ||
| 256 | cnt -= read; | ||
| 257 | offset += read; | ||
| 258 | |||
| 259 | if (cvt->flags & FB_CVT_FLAG_REDUCED_BLANK) { | ||
| 260 | read = snprintf(buf+offset, cnt, "-R"); | ||
| 261 | cnt -= read; | ||
| 262 | offset += read; | ||
| 263 | } | ||
| 264 | } | ||
| 265 | |||
| 266 | printk(KERN_INFO "%s\n", buf); | ||
| 267 | kfree(buf); | ||
| 268 | } | ||
| 269 | |||
| 270 | static void fb_cvt_convert_to_mode(struct fb_cvt_data *cvt, | ||
| 271 | struct fb_videomode *mode) | ||
| 272 | { | ||
| 273 | mode->refresh = cvt->f_refresh; | ||
| 274 | mode->pixclock = KHZ2PICOS(cvt->pixclock/1000); | ||
| 275 | mode->left_margin = cvt->h_front_porch; | ||
| 276 | mode->right_margin = cvt->h_back_porch; | ||
| 277 | mode->hsync_len = cvt->hsync; | ||
| 278 | mode->upper_margin = cvt->v_front_porch; | ||
| 279 | mode->lower_margin = cvt->v_back_porch; | ||
| 280 | mode->vsync_len = cvt->vsync; | ||
| 281 | |||
| 282 | mode->sync &= ~(FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT); | ||
| 283 | |||
| 284 | if (cvt->flags & FB_CVT_FLAG_REDUCED_BLANK) | ||
| 285 | mode->sync |= FB_SYNC_HOR_HIGH_ACT; | ||
| 286 | else | ||
| 287 | mode->sync |= FB_SYNC_VERT_HIGH_ACT; | ||
| 288 | } | ||
| 289 | |||
| 290 | /* | ||
| 291 | * fb_find_mode_cvt - calculate mode using VESA(TM) CVT | ||
| 292 | * @mode: pointer to fb_videomode; xres, yres, refresh and vmode must be | ||
| 293 | * pre-filled with the desired values | ||
| 294 | * @margins: add margin to calculation (1.8% of xres and yres) | ||
| 295 | * @rb: compute with reduced blanking (for flatpanels) | ||
| 296 | * | ||
| 297 | * RETURNS: | ||
| 298 | * 0 for success | ||
| 299 | * @mode is filled with computed values. If interlaced, the refresh field | ||
| 300 | * will be filled with the field rate (2x the frame rate) | ||
| 301 | * | ||
| 302 | * DESCRIPTION: | ||
| 303 | * Computes video timings using VESA(TM) Coordinated Video Timings | ||
| 304 | */ | ||
| 305 | int fb_find_mode_cvt(struct fb_videomode *mode, int margins, int rb) | ||
| 306 | { | ||
| 307 | struct fb_cvt_data cvt; | ||
| 308 | |||
| 309 | memset(&cvt, 0, sizeof(cvt)); | ||
| 310 | |||
| 311 | if (margins) | ||
| 312 | cvt.flags |= FB_CVT_FLAG_MARGINS; | ||
| 313 | |||
| 314 | if (rb) | ||
| 315 | cvt.flags |= FB_CVT_FLAG_REDUCED_BLANK; | ||
| 316 | |||
| 317 | if (mode->vmode & FB_VMODE_INTERLACED) | ||
| 318 | cvt.flags |= FB_CVT_FLAG_INTERLACED; | ||
| 319 | |||
| 320 | cvt.xres = mode->xres; | ||
| 321 | cvt.yres = mode->yres; | ||
| 322 | cvt.refresh = mode->refresh; | ||
| 323 | cvt.f_refresh = cvt.refresh; | ||
| 324 | cvt.interlace = 1; | ||
| 325 | |||
| 326 | if (!cvt.xres || !cvt.yres || !cvt.refresh) { | ||
| 327 | printk(KERN_INFO "fbcvt: Invalid input parameters\n"); | ||
| 328 | return 1; | ||
| 329 | } | ||
| 330 | |||
| 331 | if (!(cvt.refresh == 50 || cvt.refresh == 60 || cvt.refresh == 70 || | ||
| 332 | cvt.refresh == 85)) { | ||
| 333 | printk(KERN_INFO "fbcvt: Refresh rate not CVT " | ||
| 334 | "standard\n"); | ||
| 335 | cvt.status = 1; | ||
| 336 | } | ||
| 337 | |||
| 338 | cvt.xres &= ~(FB_CVT_CELLSIZE - 1); | ||
| 339 | |||
| 340 | if (cvt.flags & FB_CVT_FLAG_INTERLACED) { | ||
| 341 | cvt.interlace = 2; | ||
| 342 | cvt.f_refresh *= 2; | ||
| 343 | } | ||
| 344 | |||
| 345 | if (cvt.flags & FB_CVT_FLAG_REDUCED_BLANK) { | ||
| 346 | if (cvt.refresh != 60) { | ||
| 347 | printk(KERN_INFO "fbcvt: 60Hz refresh rate " | ||
| 348 | "advised for reduced blanking\n"); | ||
| 349 | cvt.status = 1; | ||
| 350 | } | ||
| 351 | } | ||
| 352 | |||
| 353 | if (cvt.flags & FB_CVT_FLAG_MARGINS) { | ||
| 354 | cvt.h_margin = (cvt.xres * 18)/1000; | ||
| 355 | cvt.h_margin &= ~(FB_CVT_CELLSIZE - 1); | ||
| 356 | cvt.v_margin = ((cvt.yres/cvt.interlace)* 18)/1000; | ||
| 357 | } | ||
| 358 | |||
| 359 | cvt.aspect_ratio = fb_cvt_aspect_ratio(&cvt); | ||
| 360 | cvt.active_pixels = cvt.xres + 2 * cvt.h_margin; | ||
| 361 | cvt.hperiod = fb_cvt_hperiod(&cvt); | ||
| 362 | cvt.vsync = fb_cvt_vbi_tab[cvt.aspect_ratio]; | ||
| 363 | cvt.vtotal = fb_cvt_vtotal(&cvt); | ||
| 364 | cvt.hblank = fb_cvt_hblank(&cvt); | ||
| 365 | cvt.htotal = cvt.active_pixels + cvt.hblank; | ||
| 366 | cvt.hsync = fb_cvt_hsync(&cvt); | ||
| 367 | cvt.pixclock = fb_cvt_pixclock(&cvt); | ||
| 368 | cvt.hfreq = cvt.pixclock/cvt.htotal; | ||
| 369 | cvt.h_back_porch = cvt.hblank/2 + cvt.h_margin; | ||
| 370 | cvt.h_front_porch = cvt.hblank - cvt.hsync - cvt.h_back_porch + | ||
| 371 | 2 * cvt.h_margin; | ||
| 372 | cvt.v_back_porch = 3 + cvt.v_margin; | ||
| 373 | cvt.v_front_porch = cvt.vtotal - cvt.yres/cvt.interlace - | ||
| 374 | cvt.v_back_porch - cvt.vsync; | ||
| 375 | fb_cvt_print_name(&cvt); | ||
| 376 | fb_cvt_convert_to_mode(&cvt, mode); | ||
| 377 | |||
| 378 | return 0; | ||
| 379 | } | ||
| 380 | EXPORT_SYMBOL(fb_find_mode_cvt); | ||
