1 /* 2 * Copyright © 1997-2003 by The XFree86 Project, Inc. 3 * Copyright © 2007 Dave Airlie 4 * Copyright © 2007-2008 Intel Corporation 5 * Jesse Barnes <jesse.barnes@intel.com> 6 * Copyright 2005-2006 Luc Verhaegen 7 * Copyright (c) 2001, Andy Ritger aritger@nvidia.com 8 * 9 * Permission is hereby granted, free of charge, to any person obtaining a 10 * copy of this software and associated documentation files (the "Software"), 11 * to deal in the Software without restriction, including without limitation 12 * the rights to use, copy, modify, merge, publish, distribute, sublicense, 13 * and/or sell copies of the Software, and to permit persons to whom the 14 * Software is furnished to do so, subject to the following conditions: 15 * 16 * The above copyright notice and this permission notice shall be included in 17 * all copies or substantial portions of the Software. 18 * 19 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 20 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 21 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 22 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR 23 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, 24 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR 25 * OTHER DEALINGS IN THE SOFTWARE. 26 * 27 * Except as contained in this notice, the name of the copyright holder(s) 28 * and author(s) shall not be used in advertising or otherwise to promote 29 * the sale, use or other dealings in this Software without prior written 30 * authorization from the copyright holder(s) and author(s). 31 */ 32 33 #include <linux/ctype.h> 34 #include <linux/list.h> 35 #include <linux/list_sort.h> 36 #include <linux/export.h> 37 38 #include <video/of_display_timing.h> 39 #include <video/of_videomode.h> 40 #include <video/videomode.h> 41 42 #include <drm/drm_crtc.h> 43 #include <drm/drm_device.h> 44 #include <drm/drm_modes.h> 45 #include <drm/drm_print.h> 46 47 #include "drm_crtc_internal.h" 48 49 /** 50 * drm_mode_debug_printmodeline - print a mode to dmesg 51 * @mode: mode to print 52 * 53 * Describe @mode using DRM_DEBUG. 54 */ 55 void drm_mode_debug_printmodeline(const struct drm_display_mode *mode) 56 { 57 DRM_DEBUG_KMS("Modeline " DRM_MODE_FMT "\n", DRM_MODE_ARG(mode)); 58 } 59 EXPORT_SYMBOL(drm_mode_debug_printmodeline); 60 61 /** 62 * drm_mode_create - create a new display mode 63 * @dev: DRM device 64 * 65 * Create a new, cleared drm_display_mode with kzalloc, allocate an ID for it 66 * and return it. 67 * 68 * Returns: 69 * Pointer to new mode on success, NULL on error. 70 */ 71 struct drm_display_mode *drm_mode_create(struct drm_device *dev) 72 { 73 struct drm_display_mode *nmode; 74 75 nmode = kzalloc(sizeof(struct drm_display_mode), GFP_KERNEL); 76 if (!nmode) 77 return NULL; 78 79 return nmode; 80 } 81 EXPORT_SYMBOL(drm_mode_create); 82 83 /** 84 * drm_mode_destroy - remove a mode 85 * @dev: DRM device 86 * @mode: mode to remove 87 * 88 * Release @mode's unique ID, then free it @mode structure itself using kfree. 89 */ 90 void drm_mode_destroy(struct drm_device *dev, struct drm_display_mode *mode) 91 { 92 if (!mode) 93 return; 94 95 kfree(mode); 96 } 97 EXPORT_SYMBOL(drm_mode_destroy); 98 99 /** 100 * drm_mode_probed_add - add a mode to a connector's probed_mode list 101 * @connector: connector the new mode 102 * @mode: mode data 103 * 104 * Add @mode to @connector's probed_mode list for later use. This list should 105 * then in a second step get filtered and all the modes actually supported by 106 * the hardware moved to the @connector's modes list. 107 */ 108 void drm_mode_probed_add(struct drm_connector *connector, 109 struct drm_display_mode *mode) 110 { 111 WARN_ON(!mutex_is_locked(&connector->dev->mode_config.mutex)); 112 113 list_add_tail(&mode->head, &connector->probed_modes); 114 } 115 EXPORT_SYMBOL(drm_mode_probed_add); 116 117 /** 118 * drm_cvt_mode -create a modeline based on the CVT algorithm 119 * @dev: drm device 120 * @hdisplay: hdisplay size 121 * @vdisplay: vdisplay size 122 * @vrefresh: vrefresh rate 123 * @reduced: whether to use reduced blanking 124 * @interlaced: whether to compute an interlaced mode 125 * @margins: whether to add margins (borders) 126 * 127 * This function is called to generate the modeline based on CVT algorithm 128 * according to the hdisplay, vdisplay, vrefresh. 129 * It is based from the VESA(TM) Coordinated Video Timing Generator by 130 * Graham Loveridge April 9, 2003 available at 131 * http://www.elo.utfsm.cl/~elo212/docs/CVTd6r1.xls 132 * 133 * And it is copied from xf86CVTmode in xserver/hw/xfree86/modes/xf86cvt.c. 134 * What I have done is to translate it by using integer calculation. 135 * 136 * Returns: 137 * The modeline based on the CVT algorithm stored in a drm_display_mode object. 138 * The display mode object is allocated with drm_mode_create(). Returns NULL 139 * when no mode could be allocated. 140 */ 141 struct drm_display_mode *drm_cvt_mode(struct drm_device *dev, int hdisplay, 142 int vdisplay, int vrefresh, 143 bool reduced, bool interlaced, bool margins) 144 { 145 #define HV_FACTOR 1000 146 /* 1) top/bottom margin size (% of height) - default: 1.8, */ 147 #define CVT_MARGIN_PERCENTAGE 18 148 /* 2) character cell horizontal granularity (pixels) - default 8 */ 149 #define CVT_H_GRANULARITY 8 150 /* 3) Minimum vertical porch (lines) - default 3 */ 151 #define CVT_MIN_V_PORCH 3 152 /* 4) Minimum number of vertical back porch lines - default 6 */ 153 #define CVT_MIN_V_BPORCH 6 154 /* Pixel Clock step (kHz) */ 155 #define CVT_CLOCK_STEP 250 156 struct drm_display_mode *drm_mode; 157 unsigned int vfieldrate, hperiod; 158 int hdisplay_rnd, hmargin, vdisplay_rnd, vmargin, vsync; 159 int interlace; 160 u64 tmp; 161 162 if (!hdisplay || !vdisplay) 163 return NULL; 164 165 /* allocate the drm_display_mode structure. If failure, we will 166 * return directly 167 */ 168 drm_mode = drm_mode_create(dev); 169 if (!drm_mode) 170 return NULL; 171 172 /* the CVT default refresh rate is 60Hz */ 173 if (!vrefresh) 174 vrefresh = 60; 175 176 /* the required field fresh rate */ 177 if (interlaced) 178 vfieldrate = vrefresh * 2; 179 else 180 vfieldrate = vrefresh; 181 182 /* horizontal pixels */ 183 hdisplay_rnd = hdisplay - (hdisplay % CVT_H_GRANULARITY); 184 185 /* determine the left&right borders */ 186 hmargin = 0; 187 if (margins) { 188 hmargin = hdisplay_rnd * CVT_MARGIN_PERCENTAGE / 1000; 189 hmargin -= hmargin % CVT_H_GRANULARITY; 190 } 191 /* find the total active pixels */ 192 drm_mode->hdisplay = hdisplay_rnd + 2 * hmargin; 193 194 /* find the number of lines per field */ 195 if (interlaced) 196 vdisplay_rnd = vdisplay / 2; 197 else 198 vdisplay_rnd = vdisplay; 199 200 /* find the top & bottom borders */ 201 vmargin = 0; 202 if (margins) 203 vmargin = vdisplay_rnd * CVT_MARGIN_PERCENTAGE / 1000; 204 205 drm_mode->vdisplay = vdisplay + 2 * vmargin; 206 207 /* Interlaced */ 208 if (interlaced) 209 interlace = 1; 210 else 211 interlace = 0; 212 213 /* Determine VSync Width from aspect ratio */ 214 if (!(vdisplay % 3) && ((vdisplay * 4 / 3) == hdisplay)) 215 vsync = 4; 216 else if (!(vdisplay % 9) && ((vdisplay * 16 / 9) == hdisplay)) 217 vsync = 5; 218 else if (!(vdisplay % 10) && ((vdisplay * 16 / 10) == hdisplay)) 219 vsync = 6; 220 else if (!(vdisplay % 4) && ((vdisplay * 5 / 4) == hdisplay)) 221 vsync = 7; 222 else if (!(vdisplay % 9) && ((vdisplay * 15 / 9) == hdisplay)) 223 vsync = 7; 224 else /* custom */ 225 vsync = 10; 226 227 if (!reduced) { 228 /* simplify the GTF calculation */ 229 /* 4) Minimum time of vertical sync + back porch interval (µs) 230 * default 550.0 231 */ 232 int tmp1, tmp2; 233 #define CVT_MIN_VSYNC_BP 550 234 /* 3) Nominal HSync width (% of line period) - default 8 */ 235 #define CVT_HSYNC_PERCENTAGE 8 236 unsigned int hblank_percentage; 237 int vsyncandback_porch, __maybe_unused vback_porch, hblank; 238 239 /* estimated the horizontal period */ 240 tmp1 = HV_FACTOR * 1000000 - 241 CVT_MIN_VSYNC_BP * HV_FACTOR * vfieldrate; 242 tmp2 = (vdisplay_rnd + 2 * vmargin + CVT_MIN_V_PORCH) * 2 + 243 interlace; 244 hperiod = tmp1 * 2 / (tmp2 * vfieldrate); 245 246 tmp1 = CVT_MIN_VSYNC_BP * HV_FACTOR / hperiod + 1; 247 /* 9. Find number of lines in sync + backporch */ 248 if (tmp1 < (vsync + CVT_MIN_V_PORCH)) 249 vsyncandback_porch = vsync + CVT_MIN_V_PORCH; 250 else 251 vsyncandback_porch = tmp1; 252 /* 10. Find number of lines in back porch */ 253 vback_porch = vsyncandback_porch - vsync; 254 drm_mode->vtotal = vdisplay_rnd + 2 * vmargin + 255 vsyncandback_porch + CVT_MIN_V_PORCH; 256 /* 5) Definition of Horizontal blanking time limitation */ 257 /* Gradient (%/kHz) - default 600 */ 258 #define CVT_M_FACTOR 600 259 /* Offset (%) - default 40 */ 260 #define CVT_C_FACTOR 40 261 /* Blanking time scaling factor - default 128 */ 262 #define CVT_K_FACTOR 128 263 /* Scaling factor weighting - default 20 */ 264 #define CVT_J_FACTOR 20 265 #define CVT_M_PRIME (CVT_M_FACTOR * CVT_K_FACTOR / 256) 266 #define CVT_C_PRIME ((CVT_C_FACTOR - CVT_J_FACTOR) * CVT_K_FACTOR / 256 + \ 267 CVT_J_FACTOR) 268 /* 12. Find ideal blanking duty cycle from formula */ 269 hblank_percentage = CVT_C_PRIME * HV_FACTOR - CVT_M_PRIME * 270 hperiod / 1000; 271 /* 13. Blanking time */ 272 if (hblank_percentage < 20 * HV_FACTOR) 273 hblank_percentage = 20 * HV_FACTOR; 274 hblank = drm_mode->hdisplay * hblank_percentage / 275 (100 * HV_FACTOR - hblank_percentage); 276 hblank -= hblank % (2 * CVT_H_GRANULARITY); 277 /* 14. find the total pixels per line */ 278 drm_mode->htotal = drm_mode->hdisplay + hblank; 279 drm_mode->hsync_end = drm_mode->hdisplay + hblank / 2; 280 drm_mode->hsync_start = drm_mode->hsync_end - 281 (drm_mode->htotal * CVT_HSYNC_PERCENTAGE) / 100; 282 drm_mode->hsync_start += CVT_H_GRANULARITY - 283 drm_mode->hsync_start % CVT_H_GRANULARITY; 284 /* fill the Vsync values */ 285 drm_mode->vsync_start = drm_mode->vdisplay + CVT_MIN_V_PORCH; 286 drm_mode->vsync_end = drm_mode->vsync_start + vsync; 287 } else { 288 /* Reduced blanking */ 289 /* Minimum vertical blanking interval time (µs)- default 460 */ 290 #define CVT_RB_MIN_VBLANK 460 291 /* Fixed number of clocks for horizontal sync */ 292 #define CVT_RB_H_SYNC 32 293 /* Fixed number of clocks for horizontal blanking */ 294 #define CVT_RB_H_BLANK 160 295 /* Fixed number of lines for vertical front porch - default 3*/ 296 #define CVT_RB_VFPORCH 3 297 int vbilines; 298 int tmp1, tmp2; 299 /* 8. Estimate Horizontal period. */ 300 tmp1 = HV_FACTOR * 1000000 - 301 CVT_RB_MIN_VBLANK * HV_FACTOR * vfieldrate; 302 tmp2 = vdisplay_rnd + 2 * vmargin; 303 hperiod = tmp1 / (tmp2 * vfieldrate); 304 /* 9. Find number of lines in vertical blanking */ 305 vbilines = CVT_RB_MIN_VBLANK * HV_FACTOR / hperiod + 1; 306 /* 10. Check if vertical blanking is sufficient */ 307 if (vbilines < (CVT_RB_VFPORCH + vsync + CVT_MIN_V_BPORCH)) 308 vbilines = CVT_RB_VFPORCH + vsync + CVT_MIN_V_BPORCH; 309 /* 11. Find total number of lines in vertical field */ 310 drm_mode->vtotal = vdisplay_rnd + 2 * vmargin + vbilines; 311 /* 12. Find total number of pixels in a line */ 312 drm_mode->htotal = drm_mode->hdisplay + CVT_RB_H_BLANK; 313 /* Fill in HSync values */ 314 drm_mode->hsync_end = drm_mode->hdisplay + CVT_RB_H_BLANK / 2; 315 drm_mode->hsync_start = drm_mode->hsync_end - CVT_RB_H_SYNC; 316 /* Fill in VSync values */ 317 drm_mode->vsync_start = drm_mode->vdisplay + CVT_RB_VFPORCH; 318 drm_mode->vsync_end = drm_mode->vsync_start + vsync; 319 } 320 /* 15/13. Find pixel clock frequency (kHz for xf86) */ 321 tmp = drm_mode->htotal; /* perform intermediate calcs in u64 */ 322 tmp *= HV_FACTOR * 1000; 323 do_div(tmp, hperiod); 324 tmp -= drm_mode->clock % CVT_CLOCK_STEP; 325 drm_mode->clock = tmp; 326 /* 18/16. Find actual vertical frame frequency */ 327 /* ignore - just set the mode flag for interlaced */ 328 if (interlaced) { 329 drm_mode->vtotal *= 2; 330 drm_mode->flags |= DRM_MODE_FLAG_INTERLACE; 331 } 332 /* Fill the mode line name */ 333 drm_mode_set_name(drm_mode); 334 if (reduced) 335 drm_mode->flags |= (DRM_MODE_FLAG_PHSYNC | 336 DRM_MODE_FLAG_NVSYNC); 337 else 338 drm_mode->flags |= (DRM_MODE_FLAG_PVSYNC | 339 DRM_MODE_FLAG_NHSYNC); 340 341 return drm_mode; 342 } 343 EXPORT_SYMBOL(drm_cvt_mode); 344 345 /** 346 * drm_gtf_mode_complex - create the modeline based on the full GTF algorithm 347 * @dev: drm device 348 * @hdisplay: hdisplay size 349 * @vdisplay: vdisplay size 350 * @vrefresh: vrefresh rate. 351 * @interlaced: whether to compute an interlaced mode 352 * @margins: desired margin (borders) size 353 * @GTF_M: extended GTF formula parameters 354 * @GTF_2C: extended GTF formula parameters 355 * @GTF_K: extended GTF formula parameters 356 * @GTF_2J: extended GTF formula parameters 357 * 358 * GTF feature blocks specify C and J in multiples of 0.5, so we pass them 359 * in here multiplied by two. For a C of 40, pass in 80. 360 * 361 * Returns: 362 * The modeline based on the full GTF algorithm stored in a drm_display_mode object. 363 * The display mode object is allocated with drm_mode_create(). Returns NULL 364 * when no mode could be allocated. 365 */ 366 struct drm_display_mode * 367 drm_gtf_mode_complex(struct drm_device *dev, int hdisplay, int vdisplay, 368 int vrefresh, bool interlaced, int margins, 369 int GTF_M, int GTF_2C, int GTF_K, int GTF_2J) 370 { /* 1) top/bottom margin size (% of height) - default: 1.8, */ 371 #define GTF_MARGIN_PERCENTAGE 18 372 /* 2) character cell horizontal granularity (pixels) - default 8 */ 373 #define GTF_CELL_GRAN 8 374 /* 3) Minimum vertical porch (lines) - default 3 */ 375 #define GTF_MIN_V_PORCH 1 376 /* width of vsync in lines */ 377 #define V_SYNC_RQD 3 378 /* width of hsync as % of total line */ 379 #define H_SYNC_PERCENT 8 380 /* min time of vsync + back porch (microsec) */ 381 #define MIN_VSYNC_PLUS_BP 550 382 /* C' and M' are part of the Blanking Duty Cycle computation */ 383 #define GTF_C_PRIME ((((GTF_2C - GTF_2J) * GTF_K / 256) + GTF_2J) / 2) 384 #define GTF_M_PRIME (GTF_K * GTF_M / 256) 385 struct drm_display_mode *drm_mode; 386 unsigned int hdisplay_rnd, vdisplay_rnd, vfieldrate_rqd; 387 int top_margin, bottom_margin; 388 int interlace; 389 unsigned int hfreq_est; 390 int vsync_plus_bp, __maybe_unused vback_porch; 391 unsigned int vtotal_lines, __maybe_unused vfieldrate_est; 392 unsigned int __maybe_unused hperiod; 393 unsigned int vfield_rate, __maybe_unused vframe_rate; 394 int left_margin, right_margin; 395 unsigned int total_active_pixels, ideal_duty_cycle; 396 unsigned int hblank, total_pixels, pixel_freq; 397 int hsync, hfront_porch, vodd_front_porch_lines; 398 unsigned int tmp1, tmp2; 399 400 if (!hdisplay || !vdisplay) 401 return NULL; 402 403 drm_mode = drm_mode_create(dev); 404 if (!drm_mode) 405 return NULL; 406 407 /* 1. In order to give correct results, the number of horizontal 408 * pixels requested is first processed to ensure that it is divisible 409 * by the character size, by rounding it to the nearest character 410 * cell boundary: 411 */ 412 hdisplay_rnd = (hdisplay + GTF_CELL_GRAN / 2) / GTF_CELL_GRAN; 413 hdisplay_rnd = hdisplay_rnd * GTF_CELL_GRAN; 414 415 /* 2. If interlace is requested, the number of vertical lines assumed 416 * by the calculation must be halved, as the computation calculates 417 * the number of vertical lines per field. 418 */ 419 if (interlaced) 420 vdisplay_rnd = vdisplay / 2; 421 else 422 vdisplay_rnd = vdisplay; 423 424 /* 3. Find the frame rate required: */ 425 if (interlaced) 426 vfieldrate_rqd = vrefresh * 2; 427 else 428 vfieldrate_rqd = vrefresh; 429 430 /* 4. Find number of lines in Top margin: */ 431 top_margin = 0; 432 if (margins) 433 top_margin = (vdisplay_rnd * GTF_MARGIN_PERCENTAGE + 500) / 434 1000; 435 /* 5. Find number of lines in bottom margin: */ 436 bottom_margin = top_margin; 437 438 /* 6. If interlace is required, then set variable interlace: */ 439 if (interlaced) 440 interlace = 1; 441 else 442 interlace = 0; 443 444 /* 7. Estimate the Horizontal frequency */ 445 { 446 tmp1 = (1000000 - MIN_VSYNC_PLUS_BP * vfieldrate_rqd) / 500; 447 tmp2 = (vdisplay_rnd + 2 * top_margin + GTF_MIN_V_PORCH) * 448 2 + interlace; 449 hfreq_est = (tmp2 * 1000 * vfieldrate_rqd) / tmp1; 450 } 451 452 /* 8. Find the number of lines in V sync + back porch */ 453 /* [V SYNC+BP] = RINT(([MIN VSYNC+BP] * hfreq_est / 1000000)) */ 454 vsync_plus_bp = MIN_VSYNC_PLUS_BP * hfreq_est / 1000; 455 vsync_plus_bp = (vsync_plus_bp + 500) / 1000; 456 /* 9. Find the number of lines in V back porch alone: */ 457 vback_porch = vsync_plus_bp - V_SYNC_RQD; 458 /* 10. Find the total number of lines in Vertical field period: */ 459 vtotal_lines = vdisplay_rnd + top_margin + bottom_margin + 460 vsync_plus_bp + GTF_MIN_V_PORCH; 461 /* 11. Estimate the Vertical field frequency: */ 462 vfieldrate_est = hfreq_est / vtotal_lines; 463 /* 12. Find the actual horizontal period: */ 464 hperiod = 1000000 / (vfieldrate_rqd * vtotal_lines); 465 466 /* 13. Find the actual Vertical field frequency: */ 467 vfield_rate = hfreq_est / vtotal_lines; 468 /* 14. Find the Vertical frame frequency: */ 469 if (interlaced) 470 vframe_rate = vfield_rate / 2; 471 else 472 vframe_rate = vfield_rate; 473 /* 15. Find number of pixels in left margin: */ 474 if (margins) 475 left_margin = (hdisplay_rnd * GTF_MARGIN_PERCENTAGE + 500) / 476 1000; 477 else 478 left_margin = 0; 479 480 /* 16.Find number of pixels in right margin: */ 481 right_margin = left_margin; 482 /* 17.Find total number of active pixels in image and left and right */ 483 total_active_pixels = hdisplay_rnd + left_margin + right_margin; 484 /* 18.Find the ideal blanking duty cycle from blanking duty cycle */ 485 ideal_duty_cycle = GTF_C_PRIME * 1000 - 486 (GTF_M_PRIME * 1000000 / hfreq_est); 487 /* 19.Find the number of pixels in the blanking time to the nearest 488 * double character cell: */ 489 hblank = total_active_pixels * ideal_duty_cycle / 490 (100000 - ideal_duty_cycle); 491 hblank = (hblank + GTF_CELL_GRAN) / (2 * GTF_CELL_GRAN); 492 hblank = hblank * 2 * GTF_CELL_GRAN; 493 /* 20.Find total number of pixels: */ 494 total_pixels = total_active_pixels + hblank; 495 /* 21.Find pixel clock frequency: */ 496 pixel_freq = total_pixels * hfreq_est / 1000; 497 /* Stage 1 computations are now complete; I should really pass 498 * the results to another function and do the Stage 2 computations, 499 * but I only need a few more values so I'll just append the 500 * computations here for now */ 501 /* 17. Find the number of pixels in the horizontal sync period: */ 502 hsync = H_SYNC_PERCENT * total_pixels / 100; 503 hsync = (hsync + GTF_CELL_GRAN / 2) / GTF_CELL_GRAN; 504 hsync = hsync * GTF_CELL_GRAN; 505 /* 18. Find the number of pixels in horizontal front porch period */ 506 hfront_porch = hblank / 2 - hsync; 507 /* 36. Find the number of lines in the odd front porch period: */ 508 vodd_front_porch_lines = GTF_MIN_V_PORCH ; 509 510 /* finally, pack the results in the mode struct */ 511 drm_mode->hdisplay = hdisplay_rnd; 512 drm_mode->hsync_start = hdisplay_rnd + hfront_porch; 513 drm_mode->hsync_end = drm_mode->hsync_start + hsync; 514 drm_mode->htotal = total_pixels; 515 drm_mode->vdisplay = vdisplay_rnd; 516 drm_mode->vsync_start = vdisplay_rnd + vodd_front_porch_lines; 517 drm_mode->vsync_end = drm_mode->vsync_start + V_SYNC_RQD; 518 drm_mode->vtotal = vtotal_lines; 519 520 drm_mode->clock = pixel_freq; 521 522 if (interlaced) { 523 drm_mode->vtotal *= 2; 524 drm_mode->flags |= DRM_MODE_FLAG_INTERLACE; 525 } 526 527 drm_mode_set_name(drm_mode); 528 if (GTF_M == 600 && GTF_2C == 80 && GTF_K == 128 && GTF_2J == 40) 529 drm_mode->flags = DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC; 530 else 531 drm_mode->flags = DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC; 532 533 return drm_mode; 534 } 535 EXPORT_SYMBOL(drm_gtf_mode_complex); 536 537 /** 538 * drm_gtf_mode - create the modeline based on the GTF algorithm 539 * @dev: drm device 540 * @hdisplay: hdisplay size 541 * @vdisplay: vdisplay size 542 * @vrefresh: vrefresh rate. 543 * @interlaced: whether to compute an interlaced mode 544 * @margins: desired margin (borders) size 545 * 546 * return the modeline based on GTF algorithm 547 * 548 * This function is to create the modeline based on the GTF algorithm. 549 * Generalized Timing Formula is derived from: 550 * 551 * GTF Spreadsheet by Andy Morrish (1/5/97) 552 * available at https://www.vesa.org 553 * 554 * And it is copied from the file of xserver/hw/xfree86/modes/xf86gtf.c. 555 * What I have done is to translate it by using integer calculation. 556 * I also refer to the function of fb_get_mode in the file of 557 * drivers/video/fbmon.c 558 * 559 * Standard GTF parameters:: 560 * 561 * M = 600 562 * C = 40 563 * K = 128 564 * J = 20 565 * 566 * Returns: 567 * The modeline based on the GTF algorithm stored in a drm_display_mode object. 568 * The display mode object is allocated with drm_mode_create(). Returns NULL 569 * when no mode could be allocated. 570 */ 571 struct drm_display_mode * 572 drm_gtf_mode(struct drm_device *dev, int hdisplay, int vdisplay, int vrefresh, 573 bool interlaced, int margins) 574 { 575 return drm_gtf_mode_complex(dev, hdisplay, vdisplay, vrefresh, 576 interlaced, margins, 577 600, 40 * 2, 128, 20 * 2); 578 } 579 EXPORT_SYMBOL(drm_gtf_mode); 580 581 #ifdef CONFIG_VIDEOMODE_HELPERS 582 /** 583 * drm_display_mode_from_videomode - fill in @dmode using @vm, 584 * @vm: videomode structure to use as source 585 * @dmode: drm_display_mode structure to use as destination 586 * 587 * Fills out @dmode using the display mode specified in @vm. 588 */ 589 void drm_display_mode_from_videomode(const struct videomode *vm, 590 struct drm_display_mode *dmode) 591 { 592 dmode->hdisplay = vm->hactive; 593 dmode->hsync_start = dmode->hdisplay + vm->hfront_porch; 594 dmode->hsync_end = dmode->hsync_start + vm->hsync_len; 595 dmode->htotal = dmode->hsync_end + vm->hback_porch; 596 597 dmode->vdisplay = vm->vactive; 598 dmode->vsync_start = dmode->vdisplay + vm->vfront_porch; 599 dmode->vsync_end = dmode->vsync_start + vm->vsync_len; 600 dmode->vtotal = dmode->vsync_end + vm->vback_porch; 601 602 dmode->clock = vm->pixelclock / 1000; 603 604 dmode->flags = 0; 605 if (vm->flags & DISPLAY_FLAGS_HSYNC_HIGH) 606 dmode->flags |= DRM_MODE_FLAG_PHSYNC; 607 else if (vm->flags & DISPLAY_FLAGS_HSYNC_LOW) 608 dmode->flags |= DRM_MODE_FLAG_NHSYNC; 609 if (vm->flags & DISPLAY_FLAGS_VSYNC_HIGH) 610 dmode->flags |= DRM_MODE_FLAG_PVSYNC; 611 else if (vm->flags & DISPLAY_FLAGS_VSYNC_LOW) 612 dmode->flags |= DRM_MODE_FLAG_NVSYNC; 613 if (vm->flags & DISPLAY_FLAGS_INTERLACED) 614 dmode->flags |= DRM_MODE_FLAG_INTERLACE; 615 if (vm->flags & DISPLAY_FLAGS_DOUBLESCAN) 616 dmode->flags |= DRM_MODE_FLAG_DBLSCAN; 617 if (vm->flags & DISPLAY_FLAGS_DOUBLECLK) 618 dmode->flags |= DRM_MODE_FLAG_DBLCLK; 619 drm_mode_set_name(dmode); 620 } 621 EXPORT_SYMBOL_GPL(drm_display_mode_from_videomode); 622 623 /** 624 * drm_display_mode_to_videomode - fill in @vm using @dmode, 625 * @dmode: drm_display_mode structure to use as source 626 * @vm: videomode structure to use as destination 627 * 628 * Fills out @vm using the display mode specified in @dmode. 629 */ 630 void drm_display_mode_to_videomode(const struct drm_display_mode *dmode, 631 struct videomode *vm) 632 { 633 vm->hactive = dmode->hdisplay; 634 vm->hfront_porch = dmode->hsync_start - dmode->hdisplay; 635 vm->hsync_len = dmode->hsync_end - dmode->hsync_start; 636 vm->hback_porch = dmode->htotal - dmode->hsync_end; 637 638 vm->vactive = dmode->vdisplay; 639 vm->vfront_porch = dmode->vsync_start - dmode->vdisplay; 640 vm->vsync_len = dmode->vsync_end - dmode->vsync_start; 641 vm->vback_porch = dmode->vtotal - dmode->vsync_end; 642 643 vm->pixelclock = dmode->clock * 1000; 644 645 vm->flags = 0; 646 if (dmode->flags & DRM_MODE_FLAG_PHSYNC) 647 vm->flags |= DISPLAY_FLAGS_HSYNC_HIGH; 648 else if (dmode->flags & DRM_MODE_FLAG_NHSYNC) 649 vm->flags |= DISPLAY_FLAGS_HSYNC_LOW; 650 if (dmode->flags & DRM_MODE_FLAG_PVSYNC) 651 vm->flags |= DISPLAY_FLAGS_VSYNC_HIGH; 652 else if (dmode->flags & DRM_MODE_FLAG_NVSYNC) 653 vm->flags |= DISPLAY_FLAGS_VSYNC_LOW; 654 if (dmode->flags & DRM_MODE_FLAG_INTERLACE) 655 vm->flags |= DISPLAY_FLAGS_INTERLACED; 656 if (dmode->flags & DRM_MODE_FLAG_DBLSCAN) 657 vm->flags |= DISPLAY_FLAGS_DOUBLESCAN; 658 if (dmode->flags & DRM_MODE_FLAG_DBLCLK) 659 vm->flags |= DISPLAY_FLAGS_DOUBLECLK; 660 } 661 EXPORT_SYMBOL_GPL(drm_display_mode_to_videomode); 662 663 /** 664 * drm_bus_flags_from_videomode - extract information about pixelclk and 665 * DE polarity from videomode and store it in a separate variable 666 * @vm: videomode structure to use 667 * @bus_flags: information about pixelclk, sync and DE polarity will be stored 668 * here 669 * 670 * Sets DRM_BUS_FLAG_DE_(LOW|HIGH), DRM_BUS_FLAG_PIXDATA_DRIVE_(POS|NEG)EDGE 671 * and DISPLAY_FLAGS_SYNC_(POS|NEG)EDGE in @bus_flags according to DISPLAY_FLAGS 672 * found in @vm 673 */ 674 void drm_bus_flags_from_videomode(const struct videomode *vm, u32 *bus_flags) 675 { 676 *bus_flags = 0; 677 if (vm->flags & DISPLAY_FLAGS_PIXDATA_POSEDGE) 678 *bus_flags |= DRM_BUS_FLAG_PIXDATA_DRIVE_POSEDGE; 679 if (vm->flags & DISPLAY_FLAGS_PIXDATA_NEGEDGE) 680 *bus_flags |= DRM_BUS_FLAG_PIXDATA_DRIVE_NEGEDGE; 681 682 if (vm->flags & DISPLAY_FLAGS_SYNC_POSEDGE) 683 *bus_flags |= DRM_BUS_FLAG_SYNC_DRIVE_POSEDGE; 684 if (vm->flags & DISPLAY_FLAGS_SYNC_NEGEDGE) 685 *bus_flags |= DRM_BUS_FLAG_SYNC_DRIVE_NEGEDGE; 686 687 if (vm->flags & DISPLAY_FLAGS_DE_LOW) 688 *bus_flags |= DRM_BUS_FLAG_DE_LOW; 689 if (vm->flags & DISPLAY_FLAGS_DE_HIGH) 690 *bus_flags |= DRM_BUS_FLAG_DE_HIGH; 691 } 692 EXPORT_SYMBOL_GPL(drm_bus_flags_from_videomode); 693 694 #ifdef CONFIG_OF 695 /** 696 * of_get_drm_display_mode - get a drm_display_mode from devicetree 697 * @np: device_node with the timing specification 698 * @dmode: will be set to the return value 699 * @bus_flags: information about pixelclk, sync and DE polarity 700 * @index: index into the list of display timings in devicetree 701 * 702 * This function is expensive and should only be used, if only one mode is to be 703 * read from DT. To get multiple modes start with of_get_display_timings and 704 * work with that instead. 705 * 706 * Returns: 707 * 0 on success, a negative errno code when no of videomode node was found. 708 */ 709 int of_get_drm_display_mode(struct device_node *np, 710 struct drm_display_mode *dmode, u32 *bus_flags, 711 int index) 712 { 713 struct videomode vm; 714 int ret; 715 716 ret = of_get_videomode(np, &vm, index); 717 if (ret) 718 return ret; 719 720 drm_display_mode_from_videomode(&vm, dmode); 721 if (bus_flags) 722 drm_bus_flags_from_videomode(&vm, bus_flags); 723 724 pr_debug("%pOF: got %dx%d display mode\n", 725 np, vm.hactive, vm.vactive); 726 drm_mode_debug_printmodeline(dmode); 727 728 return 0; 729 } 730 EXPORT_SYMBOL_GPL(of_get_drm_display_mode); 731 732 /** 733 * of_get_drm_panel_display_mode - get a panel-timing drm_display_mode from devicetree 734 * @np: device_node with the panel-timing specification 735 * @dmode: will be set to the return value 736 * @bus_flags: information about pixelclk, sync and DE polarity 737 * 738 * The Device Tree properties width-mm and height-mm will be read and set on 739 * the display mode if they are present. 740 * 741 * Returns: 742 * Zero on success, negative error code on failure. 743 */ 744 int of_get_drm_panel_display_mode(struct device_node *np, 745 struct drm_display_mode *dmode, u32 *bus_flags) 746 { 747 u32 width_mm = 0, height_mm = 0; 748 struct display_timing timing; 749 struct videomode vm; 750 int ret; 751 752 ret = of_get_display_timing(np, "panel-timing", &timing); 753 if (ret) 754 return ret; 755 756 videomode_from_timing(&timing, &vm); 757 758 memset(dmode, 0, sizeof(*dmode)); 759 drm_display_mode_from_videomode(&vm, dmode); 760 if (bus_flags) 761 drm_bus_flags_from_videomode(&vm, bus_flags); 762 763 ret = of_property_read_u32(np, "width-mm", &width_mm); 764 if (ret && ret != -EINVAL) 765 return ret; 766 767 ret = of_property_read_u32(np, "height-mm", &height_mm); 768 if (ret && ret != -EINVAL) 769 return ret; 770 771 dmode->width_mm = width_mm; 772 dmode->height_mm = height_mm; 773 774 drm_mode_debug_printmodeline(dmode); 775 776 return 0; 777 } 778 EXPORT_SYMBOL_GPL(of_get_drm_panel_display_mode); 779 #endif /* CONFIG_OF */ 780 #endif /* CONFIG_VIDEOMODE_HELPERS */ 781 782 /** 783 * drm_mode_set_name - set the name on a mode 784 * @mode: name will be set in this mode 785 * 786 * Set the name of @mode to a standard format which is <hdisplay>x<vdisplay> 787 * with an optional 'i' suffix for interlaced modes. 788 */ 789 void drm_mode_set_name(struct drm_display_mode *mode) 790 { 791 bool interlaced = !!(mode->flags & DRM_MODE_FLAG_INTERLACE); 792 793 snprintf(mode->name, DRM_DISPLAY_MODE_LEN, "%dx%d%s", 794 mode->hdisplay, mode->vdisplay, 795 interlaced ? "i" : ""); 796 } 797 EXPORT_SYMBOL(drm_mode_set_name); 798 799 /** 800 * drm_mode_vrefresh - get the vrefresh of a mode 801 * @mode: mode 802 * 803 * Returns: 804 * @modes's vrefresh rate in Hz, rounded to the nearest integer. Calculates the 805 * value first if it is not yet set. 806 */ 807 int drm_mode_vrefresh(const struct drm_display_mode *mode) 808 { 809 unsigned int num, den; 810 811 if (mode->htotal == 0 || mode->vtotal == 0) 812 return 0; 813 814 num = mode->clock; 815 den = mode->htotal * mode->vtotal; 816 817 if (mode->flags & DRM_MODE_FLAG_INTERLACE) 818 num *= 2; 819 if (mode->flags & DRM_MODE_FLAG_DBLSCAN) 820 den *= 2; 821 if (mode->vscan > 1) 822 den *= mode->vscan; 823 824 return DIV_ROUND_CLOSEST_ULL(mul_u32_u32(num, 1000), den); 825 } 826 EXPORT_SYMBOL(drm_mode_vrefresh); 827 828 /** 829 * drm_mode_get_hv_timing - Fetches hdisplay/vdisplay for given mode 830 * @mode: mode to query 831 * @hdisplay: hdisplay value to fill in 832 * @vdisplay: vdisplay value to fill in 833 * 834 * The vdisplay value will be doubled if the specified mode is a stereo mode of 835 * the appropriate layout. 836 */ 837 void drm_mode_get_hv_timing(const struct drm_display_mode *mode, 838 int *hdisplay, int *vdisplay) 839 { 840 struct drm_display_mode adjusted = *mode; 841 842 drm_mode_set_crtcinfo(&adjusted, CRTC_STEREO_DOUBLE_ONLY); 843 *hdisplay = adjusted.crtc_hdisplay; 844 *vdisplay = adjusted.crtc_vdisplay; 845 } 846 EXPORT_SYMBOL(drm_mode_get_hv_timing); 847 848 /** 849 * drm_mode_set_crtcinfo - set CRTC modesetting timing parameters 850 * @p: mode 851 * @adjust_flags: a combination of adjustment flags 852 * 853 * Setup the CRTC modesetting timing parameters for @p, adjusting if necessary. 854 * 855 * - The CRTC_INTERLACE_HALVE_V flag can be used to halve vertical timings of 856 * interlaced modes. 857 * - The CRTC_STEREO_DOUBLE flag can be used to compute the timings for 858 * buffers containing two eyes (only adjust the timings when needed, eg. for 859 * "frame packing" or "side by side full"). 860 * - The CRTC_NO_DBLSCAN and CRTC_NO_VSCAN flags request that adjustment *not* 861 * be performed for doublescan and vscan > 1 modes respectively. 862 */ 863 void drm_mode_set_crtcinfo(struct drm_display_mode *p, int adjust_flags) 864 { 865 if (!p) 866 return; 867 868 p->crtc_clock = p->clock; 869 p->crtc_hdisplay = p->hdisplay; 870 p->crtc_hsync_start = p->hsync_start; 871 p->crtc_hsync_end = p->hsync_end; 872 p->crtc_htotal = p->htotal; 873 p->crtc_hskew = p->hskew; 874 p->crtc_vdisplay = p->vdisplay; 875 p->crtc_vsync_start = p->vsync_start; 876 p->crtc_vsync_end = p->vsync_end; 877 p->crtc_vtotal = p->vtotal; 878 879 if (p->flags & DRM_MODE_FLAG_INTERLACE) { 880 if (adjust_flags & CRTC_INTERLACE_HALVE_V) { 881 p->crtc_vdisplay /= 2; 882 p->crtc_vsync_start /= 2; 883 p->crtc_vsync_end /= 2; 884 p->crtc_vtotal /= 2; 885 } 886 } 887 888 if (!(adjust_flags & CRTC_NO_DBLSCAN)) { 889 if (p->flags & DRM_MODE_FLAG_DBLSCAN) { 890 p->crtc_vdisplay *= 2; 891 p->crtc_vsync_start *= 2; 892 p->crtc_vsync_end *= 2; 893 p->crtc_vtotal *= 2; 894 } 895 } 896 897 if (!(adjust_flags & CRTC_NO_VSCAN)) { 898 if (p->vscan > 1) { 899 p->crtc_vdisplay *= p->vscan; 900 p->crtc_vsync_start *= p->vscan; 901 p->crtc_vsync_end *= p->vscan; 902 p->crtc_vtotal *= p->vscan; 903 } 904 } 905 906 if (adjust_flags & CRTC_STEREO_DOUBLE) { 907 unsigned int layout = p->flags & DRM_MODE_FLAG_3D_MASK; 908 909 switch (layout) { 910 case DRM_MODE_FLAG_3D_FRAME_PACKING: 911 p->crtc_clock *= 2; 912 p->crtc_vdisplay += p->crtc_vtotal; 913 p->crtc_vsync_start += p->crtc_vtotal; 914 p->crtc_vsync_end += p->crtc_vtotal; 915 p->crtc_vtotal += p->crtc_vtotal; 916 break; 917 } 918 } 919 920 p->crtc_vblank_start = min(p->crtc_vsync_start, p->crtc_vdisplay); 921 p->crtc_vblank_end = max(p->crtc_vsync_end, p->crtc_vtotal); 922 p->crtc_hblank_start = min(p->crtc_hsync_start, p->crtc_hdisplay); 923 p->crtc_hblank_end = max(p->crtc_hsync_end, p->crtc_htotal); 924 } 925 EXPORT_SYMBOL(drm_mode_set_crtcinfo); 926 927 /** 928 * drm_mode_copy - copy the mode 929 * @dst: mode to overwrite 930 * @src: mode to copy 931 * 932 * Copy an existing mode into another mode, preserving the 933 * list head of the destination mode. 934 */ 935 void drm_mode_copy(struct drm_display_mode *dst, const struct drm_display_mode *src) 936 { 937 struct list_head head = dst->head; 938 939 *dst = *src; 940 dst->head = head; 941 } 942 EXPORT_SYMBOL(drm_mode_copy); 943 944 /** 945 * drm_mode_init - initialize the mode from another mode 946 * @dst: mode to overwrite 947 * @src: mode to copy 948 * 949 * Copy an existing mode into another mode, zeroing the 950 * list head of the destination mode. Typically used 951 * to guarantee the list head is not left with stack 952 * garbage in on-stack modes. 953 */ 954 void drm_mode_init(struct drm_display_mode *dst, const struct drm_display_mode *src) 955 { 956 memset(dst, 0, sizeof(*dst)); 957 drm_mode_copy(dst, src); 958 } 959 EXPORT_SYMBOL(drm_mode_init); 960 961 /** 962 * drm_mode_duplicate - allocate and duplicate an existing mode 963 * @dev: drm_device to allocate the duplicated mode for 964 * @mode: mode to duplicate 965 * 966 * Just allocate a new mode, copy the existing mode into it, and return 967 * a pointer to it. Used to create new instances of established modes. 968 * 969 * Returns: 970 * Pointer to duplicated mode on success, NULL on error. 971 */ 972 struct drm_display_mode *drm_mode_duplicate(struct drm_device *dev, 973 const struct drm_display_mode *mode) 974 { 975 struct drm_display_mode *nmode; 976 977 nmode = drm_mode_create(dev); 978 if (!nmode) 979 return NULL; 980 981 drm_mode_copy(nmode, mode); 982 983 return nmode; 984 } 985 EXPORT_SYMBOL(drm_mode_duplicate); 986 987 static bool drm_mode_match_timings(const struct drm_display_mode *mode1, 988 const struct drm_display_mode *mode2) 989 { 990 return mode1->hdisplay == mode2->hdisplay && 991 mode1->hsync_start == mode2->hsync_start && 992 mode1->hsync_end == mode2->hsync_end && 993 mode1->htotal == mode2->htotal && 994 mode1->hskew == mode2->hskew && 995 mode1->vdisplay == mode2->vdisplay && 996 mode1->vsync_start == mode2->vsync_start && 997 mode1->vsync_end == mode2->vsync_end && 998 mode1->vtotal == mode2->vtotal && 999 mode1->vscan == mode2->vscan; 1000 } 1001 1002 static bool drm_mode_match_clock(const struct drm_display_mode *mode1, 1003 const struct drm_display_mode *mode2) 1004 { 1005 /* 1006 * do clock check convert to PICOS 1007 * so fb modes get matched the same 1008 */ 1009 if (mode1->clock && mode2->clock) 1010 return KHZ2PICOS(mode1->clock) == KHZ2PICOS(mode2->clock); 1011 else 1012 return mode1->clock == mode2->clock; 1013 } 1014 1015 static bool drm_mode_match_flags(const struct drm_display_mode *mode1, 1016 const struct drm_display_mode *mode2) 1017 { 1018 return (mode1->flags & ~DRM_MODE_FLAG_3D_MASK) == 1019 (mode2->flags & ~DRM_MODE_FLAG_3D_MASK); 1020 } 1021 1022 static bool drm_mode_match_3d_flags(const struct drm_display_mode *mode1, 1023 const struct drm_display_mode *mode2) 1024 { 1025 return (mode1->flags & DRM_MODE_FLAG_3D_MASK) == 1026 (mode2->flags & DRM_MODE_FLAG_3D_MASK); 1027 } 1028 1029 static bool drm_mode_match_aspect_ratio(const struct drm_display_mode *mode1, 1030 const struct drm_display_mode *mode2) 1031 { 1032 return mode1->picture_aspect_ratio == mode2->picture_aspect_ratio; 1033 } 1034 1035 /** 1036 * drm_mode_match - test modes for (partial) equality 1037 * @mode1: first mode 1038 * @mode2: second mode 1039 * @match_flags: which parts need to match (DRM_MODE_MATCH_*) 1040 * 1041 * Check to see if @mode1 and @mode2 are equivalent. 1042 * 1043 * Returns: 1044 * True if the modes are (partially) equal, false otherwise. 1045 */ 1046 bool drm_mode_match(const struct drm_display_mode *mode1, 1047 const struct drm_display_mode *mode2, 1048 unsigned int match_flags) 1049 { 1050 if (!mode1 && !mode2) 1051 return true; 1052 1053 if (!mode1 || !mode2) 1054 return false; 1055 1056 if (match_flags & DRM_MODE_MATCH_TIMINGS && 1057 !drm_mode_match_timings(mode1, mode2)) 1058 return false; 1059 1060 if (match_flags & DRM_MODE_MATCH_CLOCK && 1061 !drm_mode_match_clock(mode1, mode2)) 1062 return false; 1063 1064 if (match_flags & DRM_MODE_MATCH_FLAGS && 1065 !drm_mode_match_flags(mode1, mode2)) 1066 return false; 1067 1068 if (match_flags & DRM_MODE_MATCH_3D_FLAGS && 1069 !drm_mode_match_3d_flags(mode1, mode2)) 1070 return false; 1071 1072 if (match_flags & DRM_MODE_MATCH_ASPECT_RATIO && 1073 !drm_mode_match_aspect_ratio(mode1, mode2)) 1074 return false; 1075 1076 return true; 1077 } 1078 EXPORT_SYMBOL(drm_mode_match); 1079 1080 /** 1081 * drm_mode_equal - test modes for equality 1082 * @mode1: first mode 1083 * @mode2: second mode 1084 * 1085 * Check to see if @mode1 and @mode2 are equivalent. 1086 * 1087 * Returns: 1088 * True if the modes are equal, false otherwise. 1089 */ 1090 bool drm_mode_equal(const struct drm_display_mode *mode1, 1091 const struct drm_display_mode *mode2) 1092 { 1093 return drm_mode_match(mode1, mode2, 1094 DRM_MODE_MATCH_TIMINGS | 1095 DRM_MODE_MATCH_CLOCK | 1096 DRM_MODE_MATCH_FLAGS | 1097 DRM_MODE_MATCH_3D_FLAGS| 1098 DRM_MODE_MATCH_ASPECT_RATIO); 1099 } 1100 EXPORT_SYMBOL(drm_mode_equal); 1101 1102 /** 1103 * drm_mode_equal_no_clocks - test modes for equality 1104 * @mode1: first mode 1105 * @mode2: second mode 1106 * 1107 * Check to see if @mode1 and @mode2 are equivalent, but 1108 * don't check the pixel clocks. 1109 * 1110 * Returns: 1111 * True if the modes are equal, false otherwise. 1112 */ 1113 bool drm_mode_equal_no_clocks(const struct drm_display_mode *mode1, 1114 const struct drm_display_mode *mode2) 1115 { 1116 return drm_mode_match(mode1, mode2, 1117 DRM_MODE_MATCH_TIMINGS | 1118 DRM_MODE_MATCH_FLAGS | 1119 DRM_MODE_MATCH_3D_FLAGS); 1120 } 1121 EXPORT_SYMBOL(drm_mode_equal_no_clocks); 1122 1123 /** 1124 * drm_mode_equal_no_clocks_no_stereo - test modes for equality 1125 * @mode1: first mode 1126 * @mode2: second mode 1127 * 1128 * Check to see if @mode1 and @mode2 are equivalent, but 1129 * don't check the pixel clocks nor the stereo layout. 1130 * 1131 * Returns: 1132 * True if the modes are equal, false otherwise. 1133 */ 1134 bool drm_mode_equal_no_clocks_no_stereo(const struct drm_display_mode *mode1, 1135 const struct drm_display_mode *mode2) 1136 { 1137 return drm_mode_match(mode1, mode2, 1138 DRM_MODE_MATCH_TIMINGS | 1139 DRM_MODE_MATCH_FLAGS); 1140 } 1141 EXPORT_SYMBOL(drm_mode_equal_no_clocks_no_stereo); 1142 1143 static enum drm_mode_status 1144 drm_mode_validate_basic(const struct drm_display_mode *mode) 1145 { 1146 if (mode->type & ~DRM_MODE_TYPE_ALL) 1147 return MODE_BAD; 1148 1149 if (mode->flags & ~DRM_MODE_FLAG_ALL) 1150 return MODE_BAD; 1151 1152 if ((mode->flags & DRM_MODE_FLAG_3D_MASK) > DRM_MODE_FLAG_3D_MAX) 1153 return MODE_BAD; 1154 1155 if (mode->clock == 0) 1156 return MODE_CLOCK_LOW; 1157 1158 if (mode->hdisplay == 0 || 1159 mode->hsync_start < mode->hdisplay || 1160 mode->hsync_end < mode->hsync_start || 1161 mode->htotal < mode->hsync_end) 1162 return MODE_H_ILLEGAL; 1163 1164 if (mode->vdisplay == 0 || 1165 mode->vsync_start < mode->vdisplay || 1166 mode->vsync_end < mode->vsync_start || 1167 mode->vtotal < mode->vsync_end) 1168 return MODE_V_ILLEGAL; 1169 1170 return MODE_OK; 1171 } 1172 1173 /** 1174 * drm_mode_validate_driver - make sure the mode is somewhat sane 1175 * @dev: drm device 1176 * @mode: mode to check 1177 * 1178 * First do basic validation on the mode, and then allow the driver 1179 * to check for device/driver specific limitations via the optional 1180 * &drm_mode_config_helper_funcs.mode_valid hook. 1181 * 1182 * Returns: 1183 * The mode status 1184 */ 1185 enum drm_mode_status 1186 drm_mode_validate_driver(struct drm_device *dev, 1187 const struct drm_display_mode *mode) 1188 { 1189 enum drm_mode_status status; 1190 1191 status = drm_mode_validate_basic(mode); 1192 if (status != MODE_OK) 1193 return status; 1194 1195 if (dev->mode_config.funcs->mode_valid) 1196 return dev->mode_config.funcs->mode_valid(dev, mode); 1197 else 1198 return MODE_OK; 1199 } 1200 EXPORT_SYMBOL(drm_mode_validate_driver); 1201 1202 /** 1203 * drm_mode_validate_size - make sure modes adhere to size constraints 1204 * @mode: mode to check 1205 * @maxX: maximum width 1206 * @maxY: maximum height 1207 * 1208 * This function is a helper which can be used to validate modes against size 1209 * limitations of the DRM device/connector. If a mode is too big its status 1210 * member is updated with the appropriate validation failure code. The list 1211 * itself is not changed. 1212 * 1213 * Returns: 1214 * The mode status 1215 */ 1216 enum drm_mode_status 1217 drm_mode_validate_size(const struct drm_display_mode *mode, 1218 int maxX, int maxY) 1219 { 1220 if (maxX > 0 && mode->hdisplay > maxX) 1221 return MODE_VIRTUAL_X; 1222 1223 if (maxY > 0 && mode->vdisplay > maxY) 1224 return MODE_VIRTUAL_Y; 1225 1226 return MODE_OK; 1227 } 1228 EXPORT_SYMBOL(drm_mode_validate_size); 1229 1230 /** 1231 * drm_mode_validate_ycbcr420 - add 'ycbcr420-only' modes only when allowed 1232 * @mode: mode to check 1233 * @connector: drm connector under action 1234 * 1235 * This function is a helper which can be used to filter out any YCBCR420 1236 * only mode, when the source doesn't support it. 1237 * 1238 * Returns: 1239 * The mode status 1240 */ 1241 enum drm_mode_status 1242 drm_mode_validate_ycbcr420(const struct drm_display_mode *mode, 1243 struct drm_connector *connector) 1244 { 1245 if (!connector->ycbcr_420_allowed && 1246 drm_mode_is_420_only(&connector->display_info, mode)) 1247 return MODE_NO_420; 1248 1249 return MODE_OK; 1250 } 1251 EXPORT_SYMBOL(drm_mode_validate_ycbcr420); 1252 1253 #define MODE_STATUS(status) [MODE_ ## status + 3] = #status 1254 1255 static const char * const drm_mode_status_names[] = { 1256 MODE_STATUS(OK), 1257 MODE_STATUS(HSYNC), 1258 MODE_STATUS(VSYNC), 1259 MODE_STATUS(H_ILLEGAL), 1260 MODE_STATUS(V_ILLEGAL), 1261 MODE_STATUS(BAD_WIDTH), 1262 MODE_STATUS(NOMODE), 1263 MODE_STATUS(NO_INTERLACE), 1264 MODE_STATUS(NO_DBLESCAN), 1265 MODE_STATUS(NO_VSCAN), 1266 MODE_STATUS(MEM), 1267 MODE_STATUS(VIRTUAL_X), 1268 MODE_STATUS(VIRTUAL_Y), 1269 MODE_STATUS(MEM_VIRT), 1270 MODE_STATUS(NOCLOCK), 1271 MODE_STATUS(CLOCK_HIGH), 1272 MODE_STATUS(CLOCK_LOW), 1273 MODE_STATUS(CLOCK_RANGE), 1274 MODE_STATUS(BAD_HVALUE), 1275 MODE_STATUS(BAD_VVALUE), 1276 MODE_STATUS(BAD_VSCAN), 1277 MODE_STATUS(HSYNC_NARROW), 1278 MODE_STATUS(HSYNC_WIDE), 1279 MODE_STATUS(HBLANK_NARROW), 1280 MODE_STATUS(HBLANK_WIDE), 1281 MODE_STATUS(VSYNC_NARROW), 1282 MODE_STATUS(VSYNC_WIDE), 1283 MODE_STATUS(VBLANK_NARROW), 1284 MODE_STATUS(VBLANK_WIDE), 1285 MODE_STATUS(PANEL), 1286 MODE_STATUS(INTERLACE_WIDTH), 1287 MODE_STATUS(ONE_WIDTH), 1288 MODE_STATUS(ONE_HEIGHT), 1289 MODE_STATUS(ONE_SIZE), 1290 MODE_STATUS(NO_REDUCED), 1291 MODE_STATUS(NO_STEREO), 1292 MODE_STATUS(NO_420), 1293 MODE_STATUS(STALE), 1294 MODE_STATUS(BAD), 1295 MODE_STATUS(ERROR), 1296 }; 1297 1298 #undef MODE_STATUS 1299 1300 const char *drm_get_mode_status_name(enum drm_mode_status status) 1301 { 1302 int index = status + 3; 1303 1304 if (WARN_ON(index < 0 || index >= ARRAY_SIZE(drm_mode_status_names))) 1305 return ""; 1306 1307 return drm_mode_status_names[index]; 1308 } 1309 1310 /** 1311 * drm_mode_prune_invalid - remove invalid modes from mode list 1312 * @dev: DRM device 1313 * @mode_list: list of modes to check 1314 * @verbose: be verbose about it 1315 * 1316 * This helper function can be used to prune a display mode list after 1317 * validation has been completed. All modes whose status is not MODE_OK will be 1318 * removed from the list, and if @verbose the status code and mode name is also 1319 * printed to dmesg. 1320 */ 1321 void drm_mode_prune_invalid(struct drm_device *dev, 1322 struct list_head *mode_list, bool verbose) 1323 { 1324 struct drm_display_mode *mode, *t; 1325 1326 list_for_each_entry_safe(mode, t, mode_list, head) { 1327 if (mode->status != MODE_OK) { 1328 list_del(&mode->head); 1329 if (verbose) { 1330 drm_mode_debug_printmodeline(mode); 1331 DRM_DEBUG_KMS("Not using %s mode: %s\n", 1332 mode->name, 1333 drm_get_mode_status_name(mode->status)); 1334 } 1335 drm_mode_destroy(dev, mode); 1336 } 1337 } 1338 } 1339 EXPORT_SYMBOL(drm_mode_prune_invalid); 1340 1341 /** 1342 * drm_mode_compare - compare modes for favorability 1343 * @priv: unused 1344 * @lh_a: list_head for first mode 1345 * @lh_b: list_head for second mode 1346 * 1347 * Compare two modes, given by @lh_a and @lh_b, returning a value indicating 1348 * which is better. 1349 * 1350 * Returns: 1351 * Negative if @lh_a is better than @lh_b, zero if they're equivalent, or 1352 * positive if @lh_b is better than @lh_a. 1353 */ 1354 static int drm_mode_compare(void *priv, const struct list_head *lh_a, 1355 const struct list_head *lh_b) 1356 { 1357 struct drm_display_mode *a = list_entry(lh_a, struct drm_display_mode, head); 1358 struct drm_display_mode *b = list_entry(lh_b, struct drm_display_mode, head); 1359 int diff; 1360 1361 diff = ((b->type & DRM_MODE_TYPE_PREFERRED) != 0) - 1362 ((a->type & DRM_MODE_TYPE_PREFERRED) != 0); 1363 if (diff) 1364 return diff; 1365 diff = b->hdisplay * b->vdisplay - a->hdisplay * a->vdisplay; 1366 if (diff) 1367 return diff; 1368 1369 diff = drm_mode_vrefresh(b) - drm_mode_vrefresh(a); 1370 if (diff) 1371 return diff; 1372 1373 diff = b->clock - a->clock; 1374 return diff; 1375 } 1376 1377 /** 1378 * drm_mode_sort - sort mode list 1379 * @mode_list: list of drm_display_mode structures to sort 1380 * 1381 * Sort @mode_list by favorability, moving good modes to the head of the list. 1382 */ 1383 void drm_mode_sort(struct list_head *mode_list) 1384 { 1385 list_sort(NULL, mode_list, drm_mode_compare); 1386 } 1387 EXPORT_SYMBOL(drm_mode_sort); 1388 1389 /** 1390 * drm_connector_list_update - update the mode list for the connector 1391 * @connector: the connector to update 1392 * 1393 * This moves the modes from the @connector probed_modes list 1394 * to the actual mode list. It compares the probed mode against the current 1395 * list and only adds different/new modes. 1396 * 1397 * This is just a helper functions doesn't validate any modes itself and also 1398 * doesn't prune any invalid modes. Callers need to do that themselves. 1399 */ 1400 void drm_connector_list_update(struct drm_connector *connector) 1401 { 1402 struct drm_display_mode *pmode, *pt; 1403 1404 WARN_ON(!mutex_is_locked(&connector->dev->mode_config.mutex)); 1405 1406 list_for_each_entry_safe(pmode, pt, &connector->probed_modes, head) { 1407 struct drm_display_mode *mode; 1408 bool found_it = false; 1409 1410 /* go through current modes checking for the new probed mode */ 1411 list_for_each_entry(mode, &connector->modes, head) { 1412 if (!drm_mode_equal(pmode, mode)) 1413 continue; 1414 1415 found_it = true; 1416 1417 /* 1418 * If the old matching mode is stale (ie. left over 1419 * from a previous probe) just replace it outright. 1420 * Otherwise just merge the type bits between all 1421 * equal probed modes. 1422 * 1423 * If two probed modes are considered equal, pick the 1424 * actual timings from the one that's marked as 1425 * preferred (in case the match isn't 100%). If 1426 * multiple or zero preferred modes are present, favor 1427 * the mode added to the probed_modes list first. 1428 */ 1429 if (mode->status == MODE_STALE) { 1430 drm_mode_copy(mode, pmode); 1431 } else if ((mode->type & DRM_MODE_TYPE_PREFERRED) == 0 && 1432 (pmode->type & DRM_MODE_TYPE_PREFERRED) != 0) { 1433 pmode->type |= mode->type; 1434 drm_mode_copy(mode, pmode); 1435 } else { 1436 mode->type |= pmode->type; 1437 } 1438 1439 list_del(&pmode->head); 1440 drm_mode_destroy(connector->dev, pmode); 1441 break; 1442 } 1443 1444 if (!found_it) { 1445 list_move_tail(&pmode->head, &connector->modes); 1446 } 1447 } 1448 } 1449 EXPORT_SYMBOL(drm_connector_list_update); 1450 1451 static int drm_mode_parse_cmdline_bpp(const char *str, char **end_ptr, 1452 struct drm_cmdline_mode *mode) 1453 { 1454 unsigned int bpp; 1455 1456 if (str[0] != '-') 1457 return -EINVAL; 1458 1459 str++; 1460 bpp = simple_strtol(str, end_ptr, 10); 1461 if (*end_ptr == str) 1462 return -EINVAL; 1463 1464 mode->bpp = bpp; 1465 mode->bpp_specified = true; 1466 1467 return 0; 1468 } 1469 1470 static int drm_mode_parse_cmdline_refresh(const char *str, char **end_ptr, 1471 struct drm_cmdline_mode *mode) 1472 { 1473 unsigned int refresh; 1474 1475 if (str[0] != '@') 1476 return -EINVAL; 1477 1478 str++; 1479 refresh = simple_strtol(str, end_ptr, 10); 1480 if (*end_ptr == str) 1481 return -EINVAL; 1482 1483 mode->refresh = refresh; 1484 mode->refresh_specified = true; 1485 1486 return 0; 1487 } 1488 1489 static int drm_mode_parse_cmdline_extra(const char *str, int length, 1490 bool freestanding, 1491 const struct drm_connector *connector, 1492 struct drm_cmdline_mode *mode) 1493 { 1494 int i; 1495 1496 for (i = 0; i < length; i++) { 1497 switch (str[i]) { 1498 case 'i': 1499 if (freestanding) 1500 return -EINVAL; 1501 1502 mode->interlace = true; 1503 break; 1504 case 'm': 1505 if (freestanding) 1506 return -EINVAL; 1507 1508 mode->margins = true; 1509 break; 1510 case 'D': 1511 if (mode->force != DRM_FORCE_UNSPECIFIED) 1512 return -EINVAL; 1513 1514 if ((connector->connector_type != DRM_MODE_CONNECTOR_DVII) && 1515 (connector->connector_type != DRM_MODE_CONNECTOR_HDMIB)) 1516 mode->force = DRM_FORCE_ON; 1517 else 1518 mode->force = DRM_FORCE_ON_DIGITAL; 1519 break; 1520 case 'd': 1521 if (mode->force != DRM_FORCE_UNSPECIFIED) 1522 return -EINVAL; 1523 1524 mode->force = DRM_FORCE_OFF; 1525 break; 1526 case 'e': 1527 if (mode->force != DRM_FORCE_UNSPECIFIED) 1528 return -EINVAL; 1529 1530 mode->force = DRM_FORCE_ON; 1531 break; 1532 default: 1533 return -EINVAL; 1534 } 1535 } 1536 1537 return 0; 1538 } 1539 1540 static int drm_mode_parse_cmdline_res_mode(const char *str, unsigned int length, 1541 bool extras, 1542 const struct drm_connector *connector, 1543 struct drm_cmdline_mode *mode) 1544 { 1545 const char *str_start = str; 1546 bool rb = false, cvt = false; 1547 int xres = 0, yres = 0; 1548 int remaining, i; 1549 char *end_ptr; 1550 1551 xres = simple_strtol(str, &end_ptr, 10); 1552 if (end_ptr == str) 1553 return -EINVAL; 1554 1555 if (end_ptr[0] != 'x') 1556 return -EINVAL; 1557 end_ptr++; 1558 1559 str = end_ptr; 1560 yres = simple_strtol(str, &end_ptr, 10); 1561 if (end_ptr == str) 1562 return -EINVAL; 1563 1564 remaining = length - (end_ptr - str_start); 1565 if (remaining < 0) 1566 return -EINVAL; 1567 1568 for (i = 0; i < remaining; i++) { 1569 switch (end_ptr[i]) { 1570 case 'M': 1571 cvt = true; 1572 break; 1573 case 'R': 1574 rb = true; 1575 break; 1576 default: 1577 /* 1578 * Try to pass that to our extras parsing 1579 * function to handle the case where the 1580 * extras are directly after the resolution 1581 */ 1582 if (extras) { 1583 int ret = drm_mode_parse_cmdline_extra(end_ptr + i, 1584 1, 1585 false, 1586 connector, 1587 mode); 1588 if (ret) 1589 return ret; 1590 } else { 1591 return -EINVAL; 1592 } 1593 } 1594 } 1595 1596 mode->xres = xres; 1597 mode->yres = yres; 1598 mode->cvt = cvt; 1599 mode->rb = rb; 1600 1601 return 0; 1602 } 1603 1604 static int drm_mode_parse_cmdline_int(const char *delim, unsigned int *int_ret) 1605 { 1606 const char *value; 1607 char *endp; 1608 1609 /* 1610 * delim must point to the '=', otherwise it is a syntax error and 1611 * if delim points to the terminating zero, then delim + 1 will point 1612 * past the end of the string. 1613 */ 1614 if (*delim != '=') 1615 return -EINVAL; 1616 1617 value = delim + 1; 1618 *int_ret = simple_strtol(value, &endp, 10); 1619 1620 /* Make sure we have parsed something */ 1621 if (endp == value) 1622 return -EINVAL; 1623 1624 return 0; 1625 } 1626 1627 static int drm_mode_parse_panel_orientation(const char *delim, 1628 struct drm_cmdline_mode *mode) 1629 { 1630 const char *value; 1631 1632 if (*delim != '=') 1633 return -EINVAL; 1634 1635 value = delim + 1; 1636 delim = strchr(value, ','); 1637 if (!delim) 1638 delim = value + strlen(value); 1639 1640 if (!strncmp(value, "normal", delim - value)) 1641 mode->panel_orientation = DRM_MODE_PANEL_ORIENTATION_NORMAL; 1642 else if (!strncmp(value, "upside_down", delim - value)) 1643 mode->panel_orientation = DRM_MODE_PANEL_ORIENTATION_BOTTOM_UP; 1644 else if (!strncmp(value, "left_side_up", delim - value)) 1645 mode->panel_orientation = DRM_MODE_PANEL_ORIENTATION_LEFT_UP; 1646 else if (!strncmp(value, "right_side_up", delim - value)) 1647 mode->panel_orientation = DRM_MODE_PANEL_ORIENTATION_RIGHT_UP; 1648 else 1649 return -EINVAL; 1650 1651 return 0; 1652 } 1653 1654 static int drm_mode_parse_cmdline_options(const char *str, 1655 bool freestanding, 1656 const struct drm_connector *connector, 1657 struct drm_cmdline_mode *mode) 1658 { 1659 unsigned int deg, margin, rotation = 0; 1660 const char *delim, *option, *sep; 1661 1662 option = str; 1663 do { 1664 delim = strchr(option, '='); 1665 if (!delim) { 1666 delim = strchr(option, ','); 1667 1668 if (!delim) 1669 delim = option + strlen(option); 1670 } 1671 1672 if (!strncmp(option, "rotate", delim - option)) { 1673 if (drm_mode_parse_cmdline_int(delim, °)) 1674 return -EINVAL; 1675 1676 switch (deg) { 1677 case 0: 1678 rotation |= DRM_MODE_ROTATE_0; 1679 break; 1680 1681 case 90: 1682 rotation |= DRM_MODE_ROTATE_90; 1683 break; 1684 1685 case 180: 1686 rotation |= DRM_MODE_ROTATE_180; 1687 break; 1688 1689 case 270: 1690 rotation |= DRM_MODE_ROTATE_270; 1691 break; 1692 1693 default: 1694 return -EINVAL; 1695 } 1696 } else if (!strncmp(option, "reflect_x", delim - option)) { 1697 rotation |= DRM_MODE_REFLECT_X; 1698 } else if (!strncmp(option, "reflect_y", delim - option)) { 1699 rotation |= DRM_MODE_REFLECT_Y; 1700 } else if (!strncmp(option, "margin_right", delim - option)) { 1701 if (drm_mode_parse_cmdline_int(delim, &margin)) 1702 return -EINVAL; 1703 1704 mode->tv_margins.right = margin; 1705 } else if (!strncmp(option, "margin_left", delim - option)) { 1706 if (drm_mode_parse_cmdline_int(delim, &margin)) 1707 return -EINVAL; 1708 1709 mode->tv_margins.left = margin; 1710 } else if (!strncmp(option, "margin_top", delim - option)) { 1711 if (drm_mode_parse_cmdline_int(delim, &margin)) 1712 return -EINVAL; 1713 1714 mode->tv_margins.top = margin; 1715 } else if (!strncmp(option, "margin_bottom", delim - option)) { 1716 if (drm_mode_parse_cmdline_int(delim, &margin)) 1717 return -EINVAL; 1718 1719 mode->tv_margins.bottom = margin; 1720 } else if (!strncmp(option, "panel_orientation", delim - option)) { 1721 if (drm_mode_parse_panel_orientation(delim, mode)) 1722 return -EINVAL; 1723 } else { 1724 return -EINVAL; 1725 } 1726 sep = strchr(delim, ','); 1727 option = sep + 1; 1728 } while (sep); 1729 1730 if (rotation && freestanding) 1731 return -EINVAL; 1732 1733 if (!(rotation & DRM_MODE_ROTATE_MASK)) 1734 rotation |= DRM_MODE_ROTATE_0; 1735 1736 /* Make sure there is exactly one rotation defined */ 1737 if (!is_power_of_2(rotation & DRM_MODE_ROTATE_MASK)) 1738 return -EINVAL; 1739 1740 mode->rotation_reflection = rotation; 1741 1742 return 0; 1743 } 1744 1745 static const char * const drm_named_modes_whitelist[] = { 1746 "NTSC", 1747 "PAL", 1748 }; 1749 1750 /** 1751 * drm_mode_parse_command_line_for_connector - parse command line modeline for connector 1752 * @mode_option: optional per connector mode option 1753 * @connector: connector to parse modeline for 1754 * @mode: preallocated drm_cmdline_mode structure to fill out 1755 * 1756 * This parses @mode_option command line modeline for modes and options to 1757 * configure the connector. If @mode_option is NULL the default command line 1758 * modeline in fb_mode_option will be parsed instead. 1759 * 1760 * This uses the same parameters as the fb modedb.c, except for an extra 1761 * force-enable, force-enable-digital and force-disable bit at the end:: 1762 * 1763 * <xres>x<yres>[M][R][-<bpp>][@<refresh>][i][m][eDd] 1764 * 1765 * Additionals options can be provided following the mode, using a comma to 1766 * separate each option. Valid options can be found in 1767 * Documentation/fb/modedb.rst. 1768 * 1769 * The intermediate drm_cmdline_mode structure is required to store additional 1770 * options from the command line modline like the force-enable/disable flag. 1771 * 1772 * Returns: 1773 * True if a valid modeline has been parsed, false otherwise. 1774 */ 1775 bool drm_mode_parse_command_line_for_connector(const char *mode_option, 1776 const struct drm_connector *connector, 1777 struct drm_cmdline_mode *mode) 1778 { 1779 const char *name; 1780 bool freestanding = false, parse_extras = false; 1781 unsigned int bpp_off = 0, refresh_off = 0, options_off = 0; 1782 unsigned int mode_end = 0; 1783 const char *bpp_ptr = NULL, *refresh_ptr = NULL, *extra_ptr = NULL; 1784 const char *options_ptr = NULL; 1785 char *bpp_end_ptr = NULL, *refresh_end_ptr = NULL; 1786 int i, len, ret; 1787 1788 memset(mode, 0, sizeof(*mode)); 1789 mode->panel_orientation = DRM_MODE_PANEL_ORIENTATION_UNKNOWN; 1790 1791 if (!mode_option) 1792 return false; 1793 1794 name = mode_option; 1795 1796 /* Try to locate the bpp and refresh specifiers, if any */ 1797 bpp_ptr = strchr(name, '-'); 1798 if (bpp_ptr) 1799 bpp_off = bpp_ptr - name; 1800 1801 refresh_ptr = strchr(name, '@'); 1802 if (refresh_ptr) 1803 refresh_off = refresh_ptr - name; 1804 1805 /* Locate the start of named options */ 1806 options_ptr = strchr(name, ','); 1807 if (options_ptr) 1808 options_off = options_ptr - name; 1809 1810 /* Locate the end of the name / resolution, and parse it */ 1811 if (bpp_ptr) { 1812 mode_end = bpp_off; 1813 } else if (refresh_ptr) { 1814 mode_end = refresh_off; 1815 } else if (options_ptr) { 1816 mode_end = options_off; 1817 parse_extras = true; 1818 } else { 1819 mode_end = strlen(name); 1820 parse_extras = true; 1821 } 1822 1823 /* First check for a named mode */ 1824 for (i = 0; i < ARRAY_SIZE(drm_named_modes_whitelist); i++) { 1825 ret = str_has_prefix(name, drm_named_modes_whitelist[i]); 1826 if (ret == mode_end) { 1827 if (refresh_ptr) 1828 return false; /* named + refresh is invalid */ 1829 1830 strcpy(mode->name, drm_named_modes_whitelist[i]); 1831 mode->specified = true; 1832 break; 1833 } 1834 } 1835 1836 /* No named mode? Check for a normal mode argument, e.g. 1024x768 */ 1837 if (!mode->specified && isdigit(name[0])) { 1838 ret = drm_mode_parse_cmdline_res_mode(name, mode_end, 1839 parse_extras, 1840 connector, 1841 mode); 1842 if (ret) 1843 return false; 1844 1845 mode->specified = true; 1846 } 1847 1848 /* No mode? Check for freestanding extras and/or options */ 1849 if (!mode->specified) { 1850 unsigned int len = strlen(mode_option); 1851 1852 if (bpp_ptr || refresh_ptr) 1853 return false; /* syntax error */ 1854 1855 if (len == 1 || (len >= 2 && mode_option[1] == ',')) 1856 extra_ptr = mode_option; 1857 else 1858 options_ptr = mode_option - 1; 1859 1860 freestanding = true; 1861 } 1862 1863 if (bpp_ptr) { 1864 ret = drm_mode_parse_cmdline_bpp(bpp_ptr, &bpp_end_ptr, mode); 1865 if (ret) 1866 return false; 1867 1868 mode->bpp_specified = true; 1869 } 1870 1871 if (refresh_ptr) { 1872 ret = drm_mode_parse_cmdline_refresh(refresh_ptr, 1873 &refresh_end_ptr, mode); 1874 if (ret) 1875 return false; 1876 1877 mode->refresh_specified = true; 1878 } 1879 1880 /* 1881 * Locate the end of the bpp / refresh, and parse the extras 1882 * if relevant 1883 */ 1884 if (bpp_ptr && refresh_ptr) 1885 extra_ptr = max(bpp_end_ptr, refresh_end_ptr); 1886 else if (bpp_ptr) 1887 extra_ptr = bpp_end_ptr; 1888 else if (refresh_ptr) 1889 extra_ptr = refresh_end_ptr; 1890 1891 if (extra_ptr) { 1892 if (options_ptr) 1893 len = options_ptr - extra_ptr; 1894 else 1895 len = strlen(extra_ptr); 1896 1897 ret = drm_mode_parse_cmdline_extra(extra_ptr, len, freestanding, 1898 connector, mode); 1899 if (ret) 1900 return false; 1901 } 1902 1903 if (options_ptr) { 1904 ret = drm_mode_parse_cmdline_options(options_ptr + 1, 1905 freestanding, 1906 connector, mode); 1907 if (ret) 1908 return false; 1909 } 1910 1911 return true; 1912 } 1913 EXPORT_SYMBOL(drm_mode_parse_command_line_for_connector); 1914 1915 /** 1916 * drm_mode_create_from_cmdline_mode - convert a command line modeline into a DRM display mode 1917 * @dev: DRM device to create the new mode for 1918 * @cmd: input command line modeline 1919 * 1920 * Returns: 1921 * Pointer to converted mode on success, NULL on error. 1922 */ 1923 struct drm_display_mode * 1924 drm_mode_create_from_cmdline_mode(struct drm_device *dev, 1925 struct drm_cmdline_mode *cmd) 1926 { 1927 struct drm_display_mode *mode; 1928 1929 if (cmd->xres == 0 || cmd->yres == 0) 1930 return NULL; 1931 1932 if (cmd->cvt) 1933 mode = drm_cvt_mode(dev, 1934 cmd->xres, cmd->yres, 1935 cmd->refresh_specified ? cmd->refresh : 60, 1936 cmd->rb, cmd->interlace, 1937 cmd->margins); 1938 else 1939 mode = drm_gtf_mode(dev, 1940 cmd->xres, cmd->yres, 1941 cmd->refresh_specified ? cmd->refresh : 60, 1942 cmd->interlace, 1943 cmd->margins); 1944 if (!mode) 1945 return NULL; 1946 1947 mode->type |= DRM_MODE_TYPE_USERDEF; 1948 /* fix up 1368x768: GFT/CVT can't express 1366 width due to alignment */ 1949 if (cmd->xres == 1366) 1950 drm_mode_fixup_1366x768(mode); 1951 drm_mode_set_crtcinfo(mode, CRTC_INTERLACE_HALVE_V); 1952 return mode; 1953 } 1954 EXPORT_SYMBOL(drm_mode_create_from_cmdline_mode); 1955 1956 /** 1957 * drm_mode_convert_to_umode - convert a drm_display_mode into a modeinfo 1958 * @out: drm_mode_modeinfo struct to return to the user 1959 * @in: drm_display_mode to use 1960 * 1961 * Convert a drm_display_mode into a drm_mode_modeinfo structure to return to 1962 * the user. 1963 */ 1964 void drm_mode_convert_to_umode(struct drm_mode_modeinfo *out, 1965 const struct drm_display_mode *in) 1966 { 1967 out->clock = in->clock; 1968 out->hdisplay = in->hdisplay; 1969 out->hsync_start = in->hsync_start; 1970 out->hsync_end = in->hsync_end; 1971 out->htotal = in->htotal; 1972 out->hskew = in->hskew; 1973 out->vdisplay = in->vdisplay; 1974 out->vsync_start = in->vsync_start; 1975 out->vsync_end = in->vsync_end; 1976 out->vtotal = in->vtotal; 1977 out->vscan = in->vscan; 1978 out->vrefresh = drm_mode_vrefresh(in); 1979 out->flags = in->flags; 1980 out->type = in->type; 1981 1982 switch (in->picture_aspect_ratio) { 1983 case HDMI_PICTURE_ASPECT_4_3: 1984 out->flags |= DRM_MODE_FLAG_PIC_AR_4_3; 1985 break; 1986 case HDMI_PICTURE_ASPECT_16_9: 1987 out->flags |= DRM_MODE_FLAG_PIC_AR_16_9; 1988 break; 1989 case HDMI_PICTURE_ASPECT_64_27: 1990 out->flags |= DRM_MODE_FLAG_PIC_AR_64_27; 1991 break; 1992 case HDMI_PICTURE_ASPECT_256_135: 1993 out->flags |= DRM_MODE_FLAG_PIC_AR_256_135; 1994 break; 1995 default: 1996 WARN(1, "Invalid aspect ratio (0%x) on mode\n", 1997 in->picture_aspect_ratio); 1998 fallthrough; 1999 case HDMI_PICTURE_ASPECT_NONE: 2000 out->flags |= DRM_MODE_FLAG_PIC_AR_NONE; 2001 break; 2002 } 2003 2004 strncpy(out->name, in->name, DRM_DISPLAY_MODE_LEN); 2005 out->name[DRM_DISPLAY_MODE_LEN-1] = 0; 2006 } 2007 2008 /** 2009 * drm_mode_convert_umode - convert a modeinfo into a drm_display_mode 2010 * @dev: drm device 2011 * @out: drm_display_mode to return to the user 2012 * @in: drm_mode_modeinfo to use 2013 * 2014 * Convert a drm_mode_modeinfo into a drm_display_mode structure to return to 2015 * the caller. 2016 * 2017 * Returns: 2018 * Zero on success, negative errno on failure. 2019 */ 2020 int drm_mode_convert_umode(struct drm_device *dev, 2021 struct drm_display_mode *out, 2022 const struct drm_mode_modeinfo *in) 2023 { 2024 if (in->clock > INT_MAX || in->vrefresh > INT_MAX) 2025 return -ERANGE; 2026 2027 out->clock = in->clock; 2028 out->hdisplay = in->hdisplay; 2029 out->hsync_start = in->hsync_start; 2030 out->hsync_end = in->hsync_end; 2031 out->htotal = in->htotal; 2032 out->hskew = in->hskew; 2033 out->vdisplay = in->vdisplay; 2034 out->vsync_start = in->vsync_start; 2035 out->vsync_end = in->vsync_end; 2036 out->vtotal = in->vtotal; 2037 out->vscan = in->vscan; 2038 out->flags = in->flags; 2039 /* 2040 * Old xf86-video-vmware (possibly others too) used to 2041 * leave 'type' uninitialized. Just ignore any bits we 2042 * don't like. It's a just hint after all, and more 2043 * useful for the kernel->userspace direction anyway. 2044 */ 2045 out->type = in->type & DRM_MODE_TYPE_ALL; 2046 strncpy(out->name, in->name, DRM_DISPLAY_MODE_LEN); 2047 out->name[DRM_DISPLAY_MODE_LEN-1] = 0; 2048 2049 /* Clearing picture aspect ratio bits from out flags, 2050 * as the aspect-ratio information is not stored in 2051 * flags for kernel-mode, but in picture_aspect_ratio. 2052 */ 2053 out->flags &= ~DRM_MODE_FLAG_PIC_AR_MASK; 2054 2055 switch (in->flags & DRM_MODE_FLAG_PIC_AR_MASK) { 2056 case DRM_MODE_FLAG_PIC_AR_4_3: 2057 out->picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3; 2058 break; 2059 case DRM_MODE_FLAG_PIC_AR_16_9: 2060 out->picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9; 2061 break; 2062 case DRM_MODE_FLAG_PIC_AR_64_27: 2063 out->picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27; 2064 break; 2065 case DRM_MODE_FLAG_PIC_AR_256_135: 2066 out->picture_aspect_ratio = HDMI_PICTURE_ASPECT_256_135; 2067 break; 2068 case DRM_MODE_FLAG_PIC_AR_NONE: 2069 out->picture_aspect_ratio = HDMI_PICTURE_ASPECT_NONE; 2070 break; 2071 default: 2072 return -EINVAL; 2073 } 2074 2075 out->status = drm_mode_validate_driver(dev, out); 2076 if (out->status != MODE_OK) 2077 return -EINVAL; 2078 2079 drm_mode_set_crtcinfo(out, CRTC_INTERLACE_HALVE_V); 2080 2081 return 0; 2082 } 2083 2084 /** 2085 * drm_mode_is_420_only - if a given videomode can be only supported in YCBCR420 2086 * output format 2087 * 2088 * @display: display under action 2089 * @mode: video mode to be tested. 2090 * 2091 * Returns: 2092 * true if the mode can be supported in YCBCR420 format 2093 * false if not. 2094 */ 2095 bool drm_mode_is_420_only(const struct drm_display_info *display, 2096 const struct drm_display_mode *mode) 2097 { 2098 u8 vic = drm_match_cea_mode(mode); 2099 2100 return test_bit(vic, display->hdmi.y420_vdb_modes); 2101 } 2102 EXPORT_SYMBOL(drm_mode_is_420_only); 2103 2104 /** 2105 * drm_mode_is_420_also - if a given videomode can be supported in YCBCR420 2106 * output format also (along with RGB/YCBCR444/422) 2107 * 2108 * @display: display under action. 2109 * @mode: video mode to be tested. 2110 * 2111 * Returns: 2112 * true if the mode can be support YCBCR420 format 2113 * false if not. 2114 */ 2115 bool drm_mode_is_420_also(const struct drm_display_info *display, 2116 const struct drm_display_mode *mode) 2117 { 2118 u8 vic = drm_match_cea_mode(mode); 2119 2120 return test_bit(vic, display->hdmi.y420_cmdb_modes); 2121 } 2122 EXPORT_SYMBOL(drm_mode_is_420_also); 2123 /** 2124 * drm_mode_is_420 - if a given videomode can be supported in YCBCR420 2125 * output format 2126 * 2127 * @display: display under action. 2128 * @mode: video mode to be tested. 2129 * 2130 * Returns: 2131 * true if the mode can be supported in YCBCR420 format 2132 * false if not. 2133 */ 2134 bool drm_mode_is_420(const struct drm_display_info *display, 2135 const struct drm_display_mode *mode) 2136 { 2137 return drm_mode_is_420_only(display, mode) || 2138 drm_mode_is_420_also(display, mode); 2139 } 2140 EXPORT_SYMBOL(drm_mode_is_420); 2141