Commit | Line | Data |
---|---|---|
f453ba04 | 1 | /* |
f453ba04 DA |
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> | |
d782c3f9 | 6 | * Copyright 2005-2006 Luc Verhaegen |
26bbdada | 7 | * Copyright (c) 2001, Andy Ritger aritger@nvidia.com |
f453ba04 DA |
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/list.h> | |
2c761270 | 34 | #include <linux/list_sort.h> |
2d1a8a48 | 35 | #include <linux/export.h> |
760285e7 DH |
36 | #include <drm/drmP.h> |
37 | #include <drm/drm_crtc.h> | |
edb37a95 | 38 | #include <video/of_videomode.h> |
ebc64e45 | 39 | #include <video/videomode.h> |
55310008 | 40 | #include <drm/drm_modes.h> |
f453ba04 | 41 | |
8bd441b2 DV |
42 | #include "drm_crtc_internal.h" |
43 | ||
f453ba04 | 44 | /** |
3ec0db81 | 45 | * drm_mode_debug_printmodeline - print a mode to dmesg |
f453ba04 DA |
46 | * @mode: mode to print |
47 | * | |
f453ba04 DA |
48 | * Describe @mode using DRM_DEBUG. |
49 | */ | |
0b3904ab | 50 | void drm_mode_debug_printmodeline(const struct drm_display_mode *mode) |
f453ba04 | 51 | { |
65c7dc18 | 52 | DRM_DEBUG_KMS("Modeline " DRM_MODE_FMT "\n", DRM_MODE_ARG(mode)); |
f453ba04 DA |
53 | } |
54 | EXPORT_SYMBOL(drm_mode_debug_printmodeline); | |
55 | ||
8bd441b2 DV |
56 | /** |
57 | * drm_mode_create - create a new display mode | |
58 | * @dev: DRM device | |
59 | * | |
f5aabb97 DV |
60 | * Create a new, cleared drm_display_mode with kzalloc, allocate an ID for it |
61 | * and return it. | |
8bd441b2 | 62 | * |
f5aabb97 | 63 | * Returns: |
8bd441b2 DV |
64 | * Pointer to new mode on success, NULL on error. |
65 | */ | |
66 | struct drm_display_mode *drm_mode_create(struct drm_device *dev) | |
67 | { | |
68 | struct drm_display_mode *nmode; | |
69 | ||
70 | nmode = kzalloc(sizeof(struct drm_display_mode), GFP_KERNEL); | |
71 | if (!nmode) | |
72 | return NULL; | |
73 | ||
2135ea7a | 74 | if (drm_mode_object_add(dev, &nmode->base, DRM_MODE_OBJECT_MODE)) { |
8bd441b2 DV |
75 | kfree(nmode); |
76 | return NULL; | |
77 | } | |
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 | * | |
f5aabb97 | 88 | * Release @mode's unique ID, then free it @mode structure itself using kfree. |
8bd441b2 DV |
89 | */ |
90 | void drm_mode_destroy(struct drm_device *dev, struct drm_display_mode *mode) | |
91 | { | |
92 | if (!mode) | |
93 | return; | |
94 | ||
7c8f6d25 | 95 | drm_mode_object_unregister(dev, &mode->base); |
8bd441b2 DV |
96 | |
97 | kfree(mode); | |
98 | } | |
99 | EXPORT_SYMBOL(drm_mode_destroy); | |
100 | ||
101 | /** | |
f5aabb97 | 102 | * drm_mode_probed_add - add a mode to a connector's probed_mode list |
8bd441b2 DV |
103 | * @connector: connector the new mode |
104 | * @mode: mode data | |
105 | * | |
f5aabb97 DV |
106 | * Add @mode to @connector's probed_mode list for later use. This list should |
107 | * then in a second step get filtered and all the modes actually supported by | |
108 | * the hardware moved to the @connector's modes list. | |
8bd441b2 DV |
109 | */ |
110 | void drm_mode_probed_add(struct drm_connector *connector, | |
111 | struct drm_display_mode *mode) | |
112 | { | |
113 | WARN_ON(!mutex_is_locked(&connector->dev->mode_config.mutex)); | |
114 | ||
115 | list_add_tail(&mode->head, &connector->probed_modes); | |
116 | } | |
117 | EXPORT_SYMBOL(drm_mode_probed_add); | |
118 | ||
d782c3f9 | 119 | /** |
f5aabb97 DV |
120 | * drm_cvt_mode -create a modeline based on the CVT algorithm |
121 | * @dev: drm device | |
d782c3f9 ZY |
122 | * @hdisplay: hdisplay size |
123 | * @vdisplay: vdisplay size | |
f5aabb97 DV |
124 | * @vrefresh: vrefresh rate |
125 | * @reduced: whether to use reduced blanking | |
126 | * @interlaced: whether to compute an interlaced mode | |
127 | * @margins: whether to add margins (borders) | |
d782c3f9 ZY |
128 | * |
129 | * This function is called to generate the modeline based on CVT algorithm | |
130 | * according to the hdisplay, vdisplay, vrefresh. | |
131 | * It is based from the VESA(TM) Coordinated Video Timing Generator by | |
132 | * Graham Loveridge April 9, 2003 available at | |
631dd1a8 | 133 | * http://www.elo.utfsm.cl/~elo212/docs/CVTd6r1.xls |
d782c3f9 ZY |
134 | * |
135 | * And it is copied from xf86CVTmode in xserver/hw/xfree86/modes/xf86cvt.c. | |
136 | * What I have done is to translate it by using integer calculation. | |
f5aabb97 DV |
137 | * |
138 | * Returns: | |
139 | * The modeline based on the CVT algorithm stored in a drm_display_mode object. | |
140 | * The display mode object is allocated with drm_mode_create(). Returns NULL | |
141 | * when no mode could be allocated. | |
d782c3f9 | 142 | */ |
d782c3f9 ZY |
143 | struct drm_display_mode *drm_cvt_mode(struct drm_device *dev, int hdisplay, |
144 | int vdisplay, int vrefresh, | |
d50ba256 | 145 | bool reduced, bool interlaced, bool margins) |
d782c3f9 | 146 | { |
3ec0db81 | 147 | #define HV_FACTOR 1000 |
d782c3f9 ZY |
148 | /* 1) top/bottom margin size (% of height) - default: 1.8, */ |
149 | #define CVT_MARGIN_PERCENTAGE 18 | |
150 | /* 2) character cell horizontal granularity (pixels) - default 8 */ | |
151 | #define CVT_H_GRANULARITY 8 | |
152 | /* 3) Minimum vertical porch (lines) - default 3 */ | |
153 | #define CVT_MIN_V_PORCH 3 | |
154 | /* 4) Minimum number of vertical back porch lines - default 6 */ | |
155 | #define CVT_MIN_V_BPORCH 6 | |
156 | /* Pixel Clock step (kHz) */ | |
157 | #define CVT_CLOCK_STEP 250 | |
158 | struct drm_display_mode *drm_mode; | |
d782c3f9 ZY |
159 | unsigned int vfieldrate, hperiod; |
160 | int hdisplay_rnd, hmargin, vdisplay_rnd, vmargin, vsync; | |
161 | int interlace; | |
8a5bbf32 | 162 | u64 tmp; |
d782c3f9 ZY |
163 | |
164 | /* allocate the drm_display_mode structure. If failure, we will | |
165 | * return directly | |
166 | */ | |
167 | drm_mode = drm_mode_create(dev); | |
168 | if (!drm_mode) | |
169 | return NULL; | |
170 | ||
171 | /* the CVT default refresh rate is 60Hz */ | |
172 | if (!vrefresh) | |
173 | vrefresh = 60; | |
174 | ||
175 | /* the required field fresh rate */ | |
176 | if (interlaced) | |
177 | vfieldrate = vrefresh * 2; | |
178 | else | |
179 | vfieldrate = vrefresh; | |
180 | ||
181 | /* horizontal pixels */ | |
182 | hdisplay_rnd = hdisplay - (hdisplay % CVT_H_GRANULARITY); | |
183 | ||
184 | /* determine the left&right borders */ | |
185 | hmargin = 0; | |
186 | if (margins) { | |
187 | hmargin = hdisplay_rnd * CVT_MARGIN_PERCENTAGE / 1000; | |
188 | hmargin -= hmargin % CVT_H_GRANULARITY; | |
189 | } | |
190 | /* find the total active pixels */ | |
191 | drm_mode->hdisplay = hdisplay_rnd + 2 * hmargin; | |
192 | ||
193 | /* find the number of lines per field */ | |
194 | if (interlaced) | |
195 | vdisplay_rnd = vdisplay / 2; | |
196 | else | |
197 | vdisplay_rnd = vdisplay; | |
198 | ||
199 | /* find the top & bottom borders */ | |
200 | vmargin = 0; | |
201 | if (margins) | |
202 | vmargin = vdisplay_rnd * CVT_MARGIN_PERCENTAGE / 1000; | |
203 | ||
841b4117 | 204 | drm_mode->vdisplay = vdisplay + 2 * vmargin; |
d782c3f9 ZY |
205 | |
206 | /* Interlaced */ | |
207 | if (interlaced) | |
208 | interlace = 1; | |
209 | else | |
210 | interlace = 0; | |
211 | ||
212 | /* Determine VSync Width from aspect ratio */ | |
213 | if (!(vdisplay % 3) && ((vdisplay * 4 / 3) == hdisplay)) | |
214 | vsync = 4; | |
215 | else if (!(vdisplay % 9) && ((vdisplay * 16 / 9) == hdisplay)) | |
216 | vsync = 5; | |
217 | else if (!(vdisplay % 10) && ((vdisplay * 16 / 10) == hdisplay)) | |
218 | vsync = 6; | |
219 | else if (!(vdisplay % 4) && ((vdisplay * 5 / 4) == hdisplay)) | |
220 | vsync = 7; | |
221 | else if (!(vdisplay % 9) && ((vdisplay * 15 / 9) == hdisplay)) | |
222 | vsync = 7; | |
223 | else /* custom */ | |
224 | vsync = 10; | |
225 | ||
226 | if (!reduced) { | |
227 | /* simplify the GTF calculation */ | |
228 | /* 4) Minimum time of vertical sync + back porch interval (µs) | |
229 | * default 550.0 | |
230 | */ | |
231 | int tmp1, tmp2; | |
232 | #define CVT_MIN_VSYNC_BP 550 | |
233 | /* 3) Nominal HSync width (% of line period) - default 8 */ | |
234 | #define CVT_HSYNC_PERCENTAGE 8 | |
235 | unsigned int hblank_percentage; | |
236 | int vsyncandback_porch, vback_porch, hblank; | |
237 | ||
238 | /* estimated the horizontal period */ | |
239 | tmp1 = HV_FACTOR * 1000000 - | |
240 | CVT_MIN_VSYNC_BP * HV_FACTOR * vfieldrate; | |
241 | tmp2 = (vdisplay_rnd + 2 * vmargin + CVT_MIN_V_PORCH) * 2 + | |
242 | interlace; | |
243 | hperiod = tmp1 * 2 / (tmp2 * vfieldrate); | |
244 | ||
245 | tmp1 = CVT_MIN_VSYNC_BP * HV_FACTOR / hperiod + 1; | |
246 | /* 9. Find number of lines in sync + backporch */ | |
247 | if (tmp1 < (vsync + CVT_MIN_V_PORCH)) | |
248 | vsyncandback_porch = vsync + CVT_MIN_V_PORCH; | |
249 | else | |
250 | vsyncandback_porch = tmp1; | |
251 | /* 10. Find number of lines in back porch */ | |
252 | vback_porch = vsyncandback_porch - vsync; | |
253 | drm_mode->vtotal = vdisplay_rnd + 2 * vmargin + | |
254 | vsyncandback_porch + CVT_MIN_V_PORCH; | |
255 | /* 5) Definition of Horizontal blanking time limitation */ | |
256 | /* Gradient (%/kHz) - default 600 */ | |
257 | #define CVT_M_FACTOR 600 | |
258 | /* Offset (%) - default 40 */ | |
259 | #define CVT_C_FACTOR 40 | |
260 | /* Blanking time scaling factor - default 128 */ | |
261 | #define CVT_K_FACTOR 128 | |
262 | /* Scaling factor weighting - default 20 */ | |
263 | #define CVT_J_FACTOR 20 | |
264 | #define CVT_M_PRIME (CVT_M_FACTOR * CVT_K_FACTOR / 256) | |
265 | #define CVT_C_PRIME ((CVT_C_FACTOR - CVT_J_FACTOR) * CVT_K_FACTOR / 256 + \ | |
266 | CVT_J_FACTOR) | |
267 | /* 12. Find ideal blanking duty cycle from formula */ | |
268 | hblank_percentage = CVT_C_PRIME * HV_FACTOR - CVT_M_PRIME * | |
269 | hperiod / 1000; | |
270 | /* 13. Blanking time */ | |
271 | if (hblank_percentage < 20 * HV_FACTOR) | |
272 | hblank_percentage = 20 * HV_FACTOR; | |
273 | hblank = drm_mode->hdisplay * hblank_percentage / | |
274 | (100 * HV_FACTOR - hblank_percentage); | |
275 | hblank -= hblank % (2 * CVT_H_GRANULARITY); | |
2a97acd6 | 276 | /* 14. find the total pixels per line */ |
d782c3f9 ZY |
277 | drm_mode->htotal = drm_mode->hdisplay + hblank; |
278 | drm_mode->hsync_end = drm_mode->hdisplay + hblank / 2; | |
279 | drm_mode->hsync_start = drm_mode->hsync_end - | |
280 | (drm_mode->htotal * CVT_HSYNC_PERCENTAGE) / 100; | |
281 | drm_mode->hsync_start += CVT_H_GRANULARITY - | |
282 | drm_mode->hsync_start % CVT_H_GRANULARITY; | |
283 | /* fill the Vsync values */ | |
284 | drm_mode->vsync_start = drm_mode->vdisplay + CVT_MIN_V_PORCH; | |
285 | drm_mode->vsync_end = drm_mode->vsync_start + vsync; | |
286 | } else { | |
287 | /* Reduced blanking */ | |
288 | /* Minimum vertical blanking interval time (µs)- default 460 */ | |
289 | #define CVT_RB_MIN_VBLANK 460 | |
290 | /* Fixed number of clocks for horizontal sync */ | |
291 | #define CVT_RB_H_SYNC 32 | |
292 | /* Fixed number of clocks for horizontal blanking */ | |
293 | #define CVT_RB_H_BLANK 160 | |
294 | /* Fixed number of lines for vertical front porch - default 3*/ | |
295 | #define CVT_RB_VFPORCH 3 | |
296 | int vbilines; | |
297 | int tmp1, tmp2; | |
298 | /* 8. Estimate Horizontal period. */ | |
299 | tmp1 = HV_FACTOR * 1000000 - | |
300 | CVT_RB_MIN_VBLANK * HV_FACTOR * vfieldrate; | |
301 | tmp2 = vdisplay_rnd + 2 * vmargin; | |
302 | hperiod = tmp1 / (tmp2 * vfieldrate); | |
303 | /* 9. Find number of lines in vertical blanking */ | |
304 | vbilines = CVT_RB_MIN_VBLANK * HV_FACTOR / hperiod + 1; | |
305 | /* 10. Check if vertical blanking is sufficient */ | |
306 | if (vbilines < (CVT_RB_VFPORCH + vsync + CVT_MIN_V_BPORCH)) | |
307 | vbilines = CVT_RB_VFPORCH + vsync + CVT_MIN_V_BPORCH; | |
308 | /* 11. Find total number of lines in vertical field */ | |
309 | drm_mode->vtotal = vdisplay_rnd + 2 * vmargin + vbilines; | |
310 | /* 12. Find total number of pixels in a line */ | |
311 | drm_mode->htotal = drm_mode->hdisplay + CVT_RB_H_BLANK; | |
312 | /* Fill in HSync values */ | |
313 | drm_mode->hsync_end = drm_mode->hdisplay + CVT_RB_H_BLANK / 2; | |
adde0f23 AJ |
314 | drm_mode->hsync_start = drm_mode->hsync_end - CVT_RB_H_SYNC; |
315 | /* Fill in VSync values */ | |
316 | drm_mode->vsync_start = drm_mode->vdisplay + CVT_RB_VFPORCH; | |
317 | drm_mode->vsync_end = drm_mode->vsync_start + vsync; | |
d782c3f9 ZY |
318 | } |
319 | /* 15/13. Find pixel clock frequency (kHz for xf86) */ | |
8a5bbf32 CW |
320 | tmp = drm_mode->htotal; /* perform intermediate calcs in u64 */ |
321 | tmp *= HV_FACTOR * 1000; | |
322 | do_div(tmp, hperiod); | |
323 | tmp -= drm_mode->clock % CVT_CLOCK_STEP; | |
324 | drm_mode->clock = tmp; | |
d782c3f9 ZY |
325 | /* 18/16. Find actual vertical frame frequency */ |
326 | /* ignore - just set the mode flag for interlaced */ | |
171fdd89 | 327 | if (interlaced) { |
d782c3f9 | 328 | drm_mode->vtotal *= 2; |
171fdd89 AJ |
329 | drm_mode->flags |= DRM_MODE_FLAG_INTERLACE; |
330 | } | |
d782c3f9 ZY |
331 | /* Fill the mode line name */ |
332 | drm_mode_set_name(drm_mode); | |
333 | if (reduced) | |
334 | drm_mode->flags |= (DRM_MODE_FLAG_PHSYNC | | |
335 | DRM_MODE_FLAG_NVSYNC); | |
336 | else | |
337 | drm_mode->flags |= (DRM_MODE_FLAG_PVSYNC | | |
338 | DRM_MODE_FLAG_NHSYNC); | |
d782c3f9 | 339 | |
171fdd89 | 340 | return drm_mode; |
d782c3f9 ZY |
341 | } |
342 | EXPORT_SYMBOL(drm_cvt_mode); | |
343 | ||
26bbdada | 344 | /** |
f5aabb97 DV |
345 | * drm_gtf_mode_complex - create the modeline based on the full GTF algorithm |
346 | * @dev: drm device | |
347 | * @hdisplay: hdisplay size | |
348 | * @vdisplay: vdisplay size | |
349 | * @vrefresh: vrefresh rate. | |
350 | * @interlaced: whether to compute an interlaced mode | |
351 | * @margins: desired margin (borders) size | |
3ec0db81 DV |
352 | * @GTF_M: extended GTF formula parameters |
353 | * @GTF_2C: extended GTF formula parameters | |
354 | * @GTF_K: extended GTF formula parameters | |
355 | * @GTF_2J: extended GTF formula parameters | |
26bbdada | 356 | * |
7a374350 AJ |
357 | * GTF feature blocks specify C and J in multiples of 0.5, so we pass them |
358 | * in here multiplied by two. For a C of 40, pass in 80. | |
f5aabb97 DV |
359 | * |
360 | * Returns: | |
361 | * The modeline based on the full GTF algorithm stored in a drm_display_mode object. | |
362 | * The display mode object is allocated with drm_mode_create(). Returns NULL | |
363 | * when no mode could be allocated. | |
26bbdada | 364 | */ |
7a374350 AJ |
365 | struct drm_display_mode * |
366 | drm_gtf_mode_complex(struct drm_device *dev, int hdisplay, int vdisplay, | |
367 | int vrefresh, bool interlaced, int margins, | |
368 | int GTF_M, int GTF_2C, int GTF_K, int GTF_2J) | |
369 | { /* 1) top/bottom margin size (% of height) - default: 1.8, */ | |
26bbdada ZY |
370 | #define GTF_MARGIN_PERCENTAGE 18 |
371 | /* 2) character cell horizontal granularity (pixels) - default 8 */ | |
372 | #define GTF_CELL_GRAN 8 | |
373 | /* 3) Minimum vertical porch (lines) - default 3 */ | |
374 | #define GTF_MIN_V_PORCH 1 | |
375 | /* width of vsync in lines */ | |
376 | #define V_SYNC_RQD 3 | |
377 | /* width of hsync as % of total line */ | |
378 | #define H_SYNC_PERCENT 8 | |
379 | /* min time of vsync + back porch (microsec) */ | |
380 | #define MIN_VSYNC_PLUS_BP 550 | |
26bbdada | 381 | /* C' and M' are part of the Blanking Duty Cycle computation */ |
7a374350 AJ |
382 | #define GTF_C_PRIME ((((GTF_2C - GTF_2J) * GTF_K / 256) + GTF_2J) / 2) |
383 | #define GTF_M_PRIME (GTF_K * GTF_M / 256) | |
26bbdada ZY |
384 | struct drm_display_mode *drm_mode; |
385 | unsigned int hdisplay_rnd, vdisplay_rnd, vfieldrate_rqd; | |
386 | int top_margin, bottom_margin; | |
387 | int interlace; | |
388 | unsigned int hfreq_est; | |
389 | int vsync_plus_bp, vback_porch; | |
390 | unsigned int vtotal_lines, vfieldrate_est, hperiod; | |
391 | unsigned int vfield_rate, vframe_rate; | |
392 | int left_margin, right_margin; | |
393 | unsigned int total_active_pixels, ideal_duty_cycle; | |
394 | unsigned int hblank, total_pixels, pixel_freq; | |
395 | int hsync, hfront_porch, vodd_front_porch_lines; | |
396 | unsigned int tmp1, tmp2; | |
397 | ||
398 | drm_mode = drm_mode_create(dev); | |
399 | if (!drm_mode) | |
400 | return NULL; | |
401 | ||
402 | /* 1. In order to give correct results, the number of horizontal | |
403 | * pixels requested is first processed to ensure that it is divisible | |
404 | * by the character size, by rounding it to the nearest character | |
405 | * cell boundary: | |
406 | */ | |
407 | hdisplay_rnd = (hdisplay + GTF_CELL_GRAN / 2) / GTF_CELL_GRAN; | |
408 | hdisplay_rnd = hdisplay_rnd * GTF_CELL_GRAN; | |
409 | ||
410 | /* 2. If interlace is requested, the number of vertical lines assumed | |
411 | * by the calculation must be halved, as the computation calculates | |
412 | * the number of vertical lines per field. | |
413 | */ | |
414 | if (interlaced) | |
415 | vdisplay_rnd = vdisplay / 2; | |
416 | else | |
417 | vdisplay_rnd = vdisplay; | |
418 | ||
419 | /* 3. Find the frame rate required: */ | |
420 | if (interlaced) | |
421 | vfieldrate_rqd = vrefresh * 2; | |
422 | else | |
423 | vfieldrate_rqd = vrefresh; | |
424 | ||
425 | /* 4. Find number of lines in Top margin: */ | |
426 | top_margin = 0; | |
427 | if (margins) | |
428 | top_margin = (vdisplay_rnd * GTF_MARGIN_PERCENTAGE + 500) / | |
429 | 1000; | |
430 | /* 5. Find number of lines in bottom margin: */ | |
431 | bottom_margin = top_margin; | |
432 | ||
433 | /* 6. If interlace is required, then set variable interlace: */ | |
434 | if (interlaced) | |
435 | interlace = 1; | |
436 | else | |
437 | interlace = 0; | |
438 | ||
439 | /* 7. Estimate the Horizontal frequency */ | |
440 | { | |
441 | tmp1 = (1000000 - MIN_VSYNC_PLUS_BP * vfieldrate_rqd) / 500; | |
442 | tmp2 = (vdisplay_rnd + 2 * top_margin + GTF_MIN_V_PORCH) * | |
443 | 2 + interlace; | |
444 | hfreq_est = (tmp2 * 1000 * vfieldrate_rqd) / tmp1; | |
445 | } | |
446 | ||
447 | /* 8. Find the number of lines in V sync + back porch */ | |
448 | /* [V SYNC+BP] = RINT(([MIN VSYNC+BP] * hfreq_est / 1000000)) */ | |
449 | vsync_plus_bp = MIN_VSYNC_PLUS_BP * hfreq_est / 1000; | |
450 | vsync_plus_bp = (vsync_plus_bp + 500) / 1000; | |
451 | /* 9. Find the number of lines in V back porch alone: */ | |
452 | vback_porch = vsync_plus_bp - V_SYNC_RQD; | |
453 | /* 10. Find the total number of lines in Vertical field period: */ | |
454 | vtotal_lines = vdisplay_rnd + top_margin + bottom_margin + | |
455 | vsync_plus_bp + GTF_MIN_V_PORCH; | |
456 | /* 11. Estimate the Vertical field frequency: */ | |
457 | vfieldrate_est = hfreq_est / vtotal_lines; | |
458 | /* 12. Find the actual horizontal period: */ | |
459 | hperiod = 1000000 / (vfieldrate_rqd * vtotal_lines); | |
460 | ||
461 | /* 13. Find the actual Vertical field frequency: */ | |
462 | vfield_rate = hfreq_est / vtotal_lines; | |
463 | /* 14. Find the Vertical frame frequency: */ | |
464 | if (interlaced) | |
465 | vframe_rate = vfield_rate / 2; | |
466 | else | |
467 | vframe_rate = vfield_rate; | |
468 | /* 15. Find number of pixels in left margin: */ | |
469 | if (margins) | |
470 | left_margin = (hdisplay_rnd * GTF_MARGIN_PERCENTAGE + 500) / | |
471 | 1000; | |
472 | else | |
473 | left_margin = 0; | |
474 | ||
475 | /* 16.Find number of pixels in right margin: */ | |
476 | right_margin = left_margin; | |
477 | /* 17.Find total number of active pixels in image and left and right */ | |
478 | total_active_pixels = hdisplay_rnd + left_margin + right_margin; | |
479 | /* 18.Find the ideal blanking duty cycle from blanking duty cycle */ | |
480 | ideal_duty_cycle = GTF_C_PRIME * 1000 - | |
481 | (GTF_M_PRIME * 1000000 / hfreq_est); | |
482 | /* 19.Find the number of pixels in the blanking time to the nearest | |
483 | * double character cell: */ | |
484 | hblank = total_active_pixels * ideal_duty_cycle / | |
485 | (100000 - ideal_duty_cycle); | |
486 | hblank = (hblank + GTF_CELL_GRAN) / (2 * GTF_CELL_GRAN); | |
487 | hblank = hblank * 2 * GTF_CELL_GRAN; | |
488 | /* 20.Find total number of pixels: */ | |
489 | total_pixels = total_active_pixels + hblank; | |
490 | /* 21.Find pixel clock frequency: */ | |
491 | pixel_freq = total_pixels * hfreq_est / 1000; | |
492 | /* Stage 1 computations are now complete; I should really pass | |
493 | * the results to another function and do the Stage 2 computations, | |
494 | * but I only need a few more values so I'll just append the | |
495 | * computations here for now */ | |
496 | /* 17. Find the number of pixels in the horizontal sync period: */ | |
497 | hsync = H_SYNC_PERCENT * total_pixels / 100; | |
498 | hsync = (hsync + GTF_CELL_GRAN / 2) / GTF_CELL_GRAN; | |
499 | hsync = hsync * GTF_CELL_GRAN; | |
500 | /* 18. Find the number of pixels in horizontal front porch period */ | |
501 | hfront_porch = hblank / 2 - hsync; | |
502 | /* 36. Find the number of lines in the odd front porch period: */ | |
503 | vodd_front_porch_lines = GTF_MIN_V_PORCH ; | |
504 | ||
505 | /* finally, pack the results in the mode struct */ | |
506 | drm_mode->hdisplay = hdisplay_rnd; | |
507 | drm_mode->hsync_start = hdisplay_rnd + hfront_porch; | |
508 | drm_mode->hsync_end = drm_mode->hsync_start + hsync; | |
509 | drm_mode->htotal = total_pixels; | |
510 | drm_mode->vdisplay = vdisplay_rnd; | |
511 | drm_mode->vsync_start = vdisplay_rnd + vodd_front_porch_lines; | |
512 | drm_mode->vsync_end = drm_mode->vsync_start + V_SYNC_RQD; | |
513 | drm_mode->vtotal = vtotal_lines; | |
514 | ||
515 | drm_mode->clock = pixel_freq; | |
516 | ||
26bbdada ZY |
517 | if (interlaced) { |
518 | drm_mode->vtotal *= 2; | |
519 | drm_mode->flags |= DRM_MODE_FLAG_INTERLACE; | |
520 | } | |
521 | ||
171fdd89 | 522 | drm_mode_set_name(drm_mode); |
c385e50c AJ |
523 | if (GTF_M == 600 && GTF_2C == 80 && GTF_K == 128 && GTF_2J == 40) |
524 | drm_mode->flags = DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC; | |
525 | else | |
526 | drm_mode->flags = DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC; | |
171fdd89 | 527 | |
26bbdada ZY |
528 | return drm_mode; |
529 | } | |
7a374350 AJ |
530 | EXPORT_SYMBOL(drm_gtf_mode_complex); |
531 | ||
532 | /** | |
f5aabb97 DV |
533 | * drm_gtf_mode - create the modeline based on the GTF algorithm |
534 | * @dev: drm device | |
535 | * @hdisplay: hdisplay size | |
536 | * @vdisplay: vdisplay size | |
537 | * @vrefresh: vrefresh rate. | |
538 | * @interlaced: whether to compute an interlaced mode | |
539 | * @margins: desired margin (borders) size | |
7a374350 | 540 | * |
7a374350 AJ |
541 | * return the modeline based on GTF algorithm |
542 | * | |
543 | * This function is to create the modeline based on the GTF algorithm. | |
544 | * Generalized Timing Formula is derived from: | |
2e7a5701 | 545 | * |
7a374350 AJ |
546 | * GTF Spreadsheet by Andy Morrish (1/5/97) |
547 | * available at http://www.vesa.org | |
548 | * | |
549 | * And it is copied from the file of xserver/hw/xfree86/modes/xf86gtf.c. | |
550 | * What I have done is to translate it by using integer calculation. | |
551 | * I also refer to the function of fb_get_mode in the file of | |
552 | * drivers/video/fbmon.c | |
553 | * | |
da5335b8 DV |
554 | * Standard GTF parameters:: |
555 | * | |
f03d8ede DCLP |
556 | * M = 600 |
557 | * C = 40 | |
558 | * K = 128 | |
559 | * J = 20 | |
f5aabb97 DV |
560 | * |
561 | * Returns: | |
562 | * The modeline based on the GTF algorithm stored in a drm_display_mode object. | |
563 | * The display mode object is allocated with drm_mode_create(). Returns NULL | |
564 | * when no mode could be allocated. | |
7a374350 AJ |
565 | */ |
566 | struct drm_display_mode * | |
567 | drm_gtf_mode(struct drm_device *dev, int hdisplay, int vdisplay, int vrefresh, | |
3ec0db81 | 568 | bool interlaced, int margins) |
7a374350 | 569 | { |
3ec0db81 DV |
570 | return drm_gtf_mode_complex(dev, hdisplay, vdisplay, vrefresh, |
571 | interlaced, margins, | |
572 | 600, 40 * 2, 128, 20 * 2); | |
7a374350 | 573 | } |
26bbdada | 574 | EXPORT_SYMBOL(drm_gtf_mode); |
7a374350 | 575 | |
a38884f6 | 576 | #ifdef CONFIG_VIDEOMODE_HELPERS |
f5aabb97 DV |
577 | /** |
578 | * drm_display_mode_from_videomode - fill in @dmode using @vm, | |
579 | * @vm: videomode structure to use as source | |
580 | * @dmode: drm_display_mode structure to use as destination | |
581 | * | |
582 | * Fills out @dmode using the display mode specified in @vm. | |
583 | */ | |
ba0c2422 DV |
584 | void drm_display_mode_from_videomode(const struct videomode *vm, |
585 | struct drm_display_mode *dmode) | |
ebc64e45 ST |
586 | { |
587 | dmode->hdisplay = vm->hactive; | |
588 | dmode->hsync_start = dmode->hdisplay + vm->hfront_porch; | |
589 | dmode->hsync_end = dmode->hsync_start + vm->hsync_len; | |
590 | dmode->htotal = dmode->hsync_end + vm->hback_porch; | |
591 | ||
592 | dmode->vdisplay = vm->vactive; | |
593 | dmode->vsync_start = dmode->vdisplay + vm->vfront_porch; | |
594 | dmode->vsync_end = dmode->vsync_start + vm->vsync_len; | |
595 | dmode->vtotal = dmode->vsync_end + vm->vback_porch; | |
596 | ||
597 | dmode->clock = vm->pixelclock / 1000; | |
598 | ||
599 | dmode->flags = 0; | |
06a33079 | 600 | if (vm->flags & DISPLAY_FLAGS_HSYNC_HIGH) |
ebc64e45 | 601 | dmode->flags |= DRM_MODE_FLAG_PHSYNC; |
06a33079 | 602 | else if (vm->flags & DISPLAY_FLAGS_HSYNC_LOW) |
ebc64e45 | 603 | dmode->flags |= DRM_MODE_FLAG_NHSYNC; |
06a33079 | 604 | if (vm->flags & DISPLAY_FLAGS_VSYNC_HIGH) |
ebc64e45 | 605 | dmode->flags |= DRM_MODE_FLAG_PVSYNC; |
06a33079 | 606 | else if (vm->flags & DISPLAY_FLAGS_VSYNC_LOW) |
ebc64e45 | 607 | dmode->flags |= DRM_MODE_FLAG_NVSYNC; |
06a33079 | 608 | if (vm->flags & DISPLAY_FLAGS_INTERLACED) |
ebc64e45 | 609 | dmode->flags |= DRM_MODE_FLAG_INTERLACE; |
06a33079 | 610 | if (vm->flags & DISPLAY_FLAGS_DOUBLESCAN) |
ebc64e45 | 611 | dmode->flags |= DRM_MODE_FLAG_DBLSCAN; |
328a4719 ST |
612 | if (vm->flags & DISPLAY_FLAGS_DOUBLECLK) |
613 | dmode->flags |= DRM_MODE_FLAG_DBLCLK; | |
ebc64e45 | 614 | drm_mode_set_name(dmode); |
ebc64e45 ST |
615 | } |
616 | EXPORT_SYMBOL_GPL(drm_display_mode_from_videomode); | |
ebc64e45 | 617 | |
d490f455 SL |
618 | /** |
619 | * drm_display_mode_to_videomode - fill in @vm using @dmode, | |
620 | * @dmode: drm_display_mode structure to use as source | |
621 | * @vm: videomode structure to use as destination | |
622 | * | |
623 | * Fills out @vm using the display mode specified in @dmode. | |
624 | */ | |
625 | void drm_display_mode_to_videomode(const struct drm_display_mode *dmode, | |
626 | struct videomode *vm) | |
627 | { | |
628 | vm->hactive = dmode->hdisplay; | |
629 | vm->hfront_porch = dmode->hsync_start - dmode->hdisplay; | |
630 | vm->hsync_len = dmode->hsync_end - dmode->hsync_start; | |
631 | vm->hback_porch = dmode->htotal - dmode->hsync_end; | |
632 | ||
633 | vm->vactive = dmode->vdisplay; | |
634 | vm->vfront_porch = dmode->vsync_start - dmode->vdisplay; | |
635 | vm->vsync_len = dmode->vsync_end - dmode->vsync_start; | |
636 | vm->vback_porch = dmode->vtotal - dmode->vsync_end; | |
637 | ||
638 | vm->pixelclock = dmode->clock * 1000; | |
639 | ||
640 | vm->flags = 0; | |
641 | if (dmode->flags & DRM_MODE_FLAG_PHSYNC) | |
642 | vm->flags |= DISPLAY_FLAGS_HSYNC_HIGH; | |
643 | else if (dmode->flags & DRM_MODE_FLAG_NHSYNC) | |
644 | vm->flags |= DISPLAY_FLAGS_HSYNC_LOW; | |
645 | if (dmode->flags & DRM_MODE_FLAG_PVSYNC) | |
646 | vm->flags |= DISPLAY_FLAGS_VSYNC_HIGH; | |
647 | else if (dmode->flags & DRM_MODE_FLAG_NVSYNC) | |
648 | vm->flags |= DISPLAY_FLAGS_VSYNC_LOW; | |
649 | if (dmode->flags & DRM_MODE_FLAG_INTERLACE) | |
650 | vm->flags |= DISPLAY_FLAGS_INTERLACED; | |
651 | if (dmode->flags & DRM_MODE_FLAG_DBLSCAN) | |
652 | vm->flags |= DISPLAY_FLAGS_DOUBLESCAN; | |
653 | if (dmode->flags & DRM_MODE_FLAG_DBLCLK) | |
654 | vm->flags |= DISPLAY_FLAGS_DOUBLECLK; | |
655 | } | |
656 | EXPORT_SYMBOL_GPL(drm_display_mode_to_videomode); | |
657 | ||
cb34d7f2 LW |
658 | /** |
659 | * drm_bus_flags_from_videomode - extract information about pixelclk and | |
660 | * DE polarity from videomode and store it in a separate variable | |
661 | * @vm: videomode structure to use | |
662 | * @bus_flags: information about pixelclk and DE polarity will be stored here | |
663 | * | |
664 | * Sets DRM_BUS_FLAG_DE_(LOW|HIGH) and DRM_BUS_FLAG_PIXDATA_(POS|NEG)EDGE | |
665 | * in @bus_flags according to DISPLAY_FLAGS found in @vm | |
666 | */ | |
d72daa0d LW |
667 | void drm_bus_flags_from_videomode(const struct videomode *vm, u32 *bus_flags) |
668 | { | |
669 | *bus_flags = 0; | |
670 | if (vm->flags & DISPLAY_FLAGS_PIXDATA_POSEDGE) | |
671 | *bus_flags |= DRM_BUS_FLAG_PIXDATA_POSEDGE; | |
672 | if (vm->flags & DISPLAY_FLAGS_PIXDATA_NEGEDGE) | |
673 | *bus_flags |= DRM_BUS_FLAG_PIXDATA_NEGEDGE; | |
674 | ||
675 | if (vm->flags & DISPLAY_FLAGS_DE_LOW) | |
676 | *bus_flags |= DRM_BUS_FLAG_DE_LOW; | |
677 | if (vm->flags & DISPLAY_FLAGS_DE_HIGH) | |
678 | *bus_flags |= DRM_BUS_FLAG_DE_HIGH; | |
679 | } | |
680 | EXPORT_SYMBOL_GPL(drm_bus_flags_from_videomode); | |
681 | ||
a38884f6 | 682 | #ifdef CONFIG_OF |
edb37a95 ST |
683 | /** |
684 | * of_get_drm_display_mode - get a drm_display_mode from devicetree | |
685 | * @np: device_node with the timing specification | |
686 | * @dmode: will be set to the return value | |
cb34d7f2 | 687 | * @bus_flags: information about pixelclk and DE polarity |
edb37a95 ST |
688 | * @index: index into the list of display timings in devicetree |
689 | * | |
690 | * This function is expensive and should only be used, if only one mode is to be | |
691 | * read from DT. To get multiple modes start with of_get_display_timings and | |
692 | * work with that instead. | |
f5aabb97 DV |
693 | * |
694 | * Returns: | |
695 | * 0 on success, a negative errno code when no of videomode node was found. | |
edb37a95 ST |
696 | */ |
697 | int of_get_drm_display_mode(struct device_node *np, | |
fafc79ef LW |
698 | struct drm_display_mode *dmode, u32 *bus_flags, |
699 | int index) | |
edb37a95 ST |
700 | { |
701 | struct videomode vm; | |
702 | int ret; | |
703 | ||
704 | ret = of_get_videomode(np, &vm, index); | |
705 | if (ret) | |
706 | return ret; | |
707 | ||
708 | drm_display_mode_from_videomode(&vm, dmode); | |
fafc79ef LW |
709 | if (bus_flags) |
710 | drm_bus_flags_from_videomode(&vm, bus_flags); | |
edb37a95 | 711 | |
4bf99144 RH |
712 | pr_debug("%pOF: got %dx%d display mode from %s\n", |
713 | np, vm.hactive, vm.vactive, np->name); | |
edb37a95 ST |
714 | drm_mode_debug_printmodeline(dmode); |
715 | ||
716 | return 0; | |
717 | } | |
718 | EXPORT_SYMBOL_GPL(of_get_drm_display_mode); | |
a38884f6 TV |
719 | #endif /* CONFIG_OF */ |
720 | #endif /* CONFIG_VIDEOMODE_HELPERS */ | |
edb37a95 | 721 | |
f453ba04 DA |
722 | /** |
723 | * drm_mode_set_name - set the name on a mode | |
724 | * @mode: name will be set in this mode | |
725 | * | |
f5aabb97 DV |
726 | * Set the name of @mode to a standard format which is <hdisplay>x<vdisplay> |
727 | * with an optional 'i' suffix for interlaced modes. | |
f453ba04 DA |
728 | */ |
729 | void drm_mode_set_name(struct drm_display_mode *mode) | |
730 | { | |
171fdd89 AJ |
731 | bool interlaced = !!(mode->flags & DRM_MODE_FLAG_INTERLACE); |
732 | ||
733 | snprintf(mode->name, DRM_DISPLAY_MODE_LEN, "%dx%d%s", | |
734 | mode->hdisplay, mode->vdisplay, | |
735 | interlaced ? "i" : ""); | |
f453ba04 DA |
736 | } |
737 | EXPORT_SYMBOL(drm_mode_set_name); | |
738 | ||
30ecad77 DV |
739 | /** |
740 | * drm_mode_hsync - get the hsync of a mode | |
7ac96a9c AJ |
741 | * @mode: mode |
742 | * | |
f5aabb97 DV |
743 | * Returns: |
744 | * @modes's hsync rate in kHz, rounded to the nearest integer. Calculates the | |
745 | * value first if it is not yet set. | |
7ac96a9c | 746 | */ |
b1f559ec | 747 | int drm_mode_hsync(const struct drm_display_mode *mode) |
7ac96a9c AJ |
748 | { |
749 | unsigned int calc_val; | |
750 | ||
751 | if (mode->hsync) | |
752 | return mode->hsync; | |
753 | ||
754 | if (mode->htotal < 0) | |
755 | return 0; | |
756 | ||
757 | calc_val = (mode->clock * 1000) / mode->htotal; /* hsync in Hz */ | |
758 | calc_val += 500; /* round to 1000Hz */ | |
759 | calc_val /= 1000; /* truncate to kHz */ | |
760 | ||
761 | return calc_val; | |
762 | } | |
763 | EXPORT_SYMBOL(drm_mode_hsync); | |
764 | ||
f453ba04 DA |
765 | /** |
766 | * drm_mode_vrefresh - get the vrefresh of a mode | |
767 | * @mode: mode | |
768 | * | |
f5aabb97 DV |
769 | * Returns: |
770 | * @modes's vrefresh rate in Hz, rounded to the nearest integer. Calculates the | |
771 | * value first if it is not yet set. | |
f453ba04 | 772 | */ |
b1f559ec | 773 | int drm_mode_vrefresh(const struct drm_display_mode *mode) |
f453ba04 DA |
774 | { |
775 | int refresh = 0; | |
f453ba04 DA |
776 | |
777 | if (mode->vrefresh > 0) | |
778 | refresh = mode->vrefresh; | |
779 | else if (mode->htotal > 0 && mode->vtotal > 0) { | |
2f0e9d80 VS |
780 | unsigned int num, den; |
781 | ||
782 | num = mode->clock * 1000; | |
783 | den = mode->htotal * mode->vtotal; | |
f453ba04 | 784 | |
f453ba04 | 785 | if (mode->flags & DRM_MODE_FLAG_INTERLACE) |
2f0e9d80 | 786 | num *= 2; |
f453ba04 | 787 | if (mode->flags & DRM_MODE_FLAG_DBLSCAN) |
2f0e9d80 | 788 | den *= 2; |
f453ba04 | 789 | if (mode->vscan > 1) |
2f0e9d80 VS |
790 | den *= mode->vscan; |
791 | ||
792 | refresh = DIV_ROUND_CLOSEST(num, den); | |
f453ba04 DA |
793 | } |
794 | return refresh; | |
795 | } | |
796 | EXPORT_SYMBOL(drm_mode_vrefresh); | |
797 | ||
196cd5d3 DV |
798 | /** |
799 | * drm_mode_get_hv_timing - Fetches hdisplay/vdisplay for given mode | |
800 | * @mode: mode to query | |
801 | * @hdisplay: hdisplay value to fill in | |
802 | * @vdisplay: vdisplay value to fill in | |
803 | * | |
804 | * The vdisplay value will be doubled if the specified mode is a stereo mode of | |
805 | * the appropriate layout. | |
806 | */ | |
807 | void drm_mode_get_hv_timing(const struct drm_display_mode *mode, | |
808 | int *hdisplay, int *vdisplay) | |
809 | { | |
6f15f84c | 810 | struct drm_display_mode adjusted = *mode; |
196cd5d3 | 811 | |
196cd5d3 DV |
812 | drm_mode_set_crtcinfo(&adjusted, CRTC_STEREO_DOUBLE_ONLY); |
813 | *hdisplay = adjusted.crtc_hdisplay; | |
814 | *vdisplay = adjusted.crtc_vdisplay; | |
815 | } | |
816 | EXPORT_SYMBOL(drm_mode_get_hv_timing); | |
817 | ||
f453ba04 | 818 | /** |
f5aabb97 | 819 | * drm_mode_set_crtcinfo - set CRTC modesetting timing parameters |
f453ba04 | 820 | * @p: mode |
448cce25 | 821 | * @adjust_flags: a combination of adjustment flags |
f453ba04 | 822 | * |
f5aabb97 | 823 | * Setup the CRTC modesetting timing parameters for @p, adjusting if necessary. |
448cce25 DL |
824 | * |
825 | * - The CRTC_INTERLACE_HALVE_V flag can be used to halve vertical timings of | |
826 | * interlaced modes. | |
827 | * - The CRTC_STEREO_DOUBLE flag can be used to compute the timings for | |
828 | * buffers containing two eyes (only adjust the timings when needed, eg. for | |
829 | * "frame packing" or "side by side full"). | |
ecb7e16b GP |
830 | * - The CRTC_NO_DBLSCAN and CRTC_NO_VSCAN flags request that adjustment *not* |
831 | * be performed for doublescan and vscan > 1 modes respectively. | |
f453ba04 DA |
832 | */ |
833 | void drm_mode_set_crtcinfo(struct drm_display_mode *p, int adjust_flags) | |
834 | { | |
4f09c77b | 835 | if (!p) |
f453ba04 DA |
836 | return; |
837 | ||
bde2dcf7 | 838 | p->crtc_clock = p->clock; |
f453ba04 DA |
839 | p->crtc_hdisplay = p->hdisplay; |
840 | p->crtc_hsync_start = p->hsync_start; | |
841 | p->crtc_hsync_end = p->hsync_end; | |
842 | p->crtc_htotal = p->htotal; | |
843 | p->crtc_hskew = p->hskew; | |
844 | p->crtc_vdisplay = p->vdisplay; | |
845 | p->crtc_vsync_start = p->vsync_start; | |
846 | p->crtc_vsync_end = p->vsync_end; | |
847 | p->crtc_vtotal = p->vtotal; | |
848 | ||
849 | if (p->flags & DRM_MODE_FLAG_INTERLACE) { | |
850 | if (adjust_flags & CRTC_INTERLACE_HALVE_V) { | |
851 | p->crtc_vdisplay /= 2; | |
852 | p->crtc_vsync_start /= 2; | |
853 | p->crtc_vsync_end /= 2; | |
854 | p->crtc_vtotal /= 2; | |
855 | } | |
f453ba04 DA |
856 | } |
857 | ||
ecb7e16b GP |
858 | if (!(adjust_flags & CRTC_NO_DBLSCAN)) { |
859 | if (p->flags & DRM_MODE_FLAG_DBLSCAN) { | |
860 | p->crtc_vdisplay *= 2; | |
861 | p->crtc_vsync_start *= 2; | |
862 | p->crtc_vsync_end *= 2; | |
863 | p->crtc_vtotal *= 2; | |
864 | } | |
f453ba04 DA |
865 | } |
866 | ||
ecb7e16b GP |
867 | if (!(adjust_flags & CRTC_NO_VSCAN)) { |
868 | if (p->vscan > 1) { | |
869 | p->crtc_vdisplay *= p->vscan; | |
870 | p->crtc_vsync_start *= p->vscan; | |
871 | p->crtc_vsync_end *= p->vscan; | |
872 | p->crtc_vtotal *= p->vscan; | |
873 | } | |
f453ba04 DA |
874 | } |
875 | ||
448cce25 DL |
876 | if (adjust_flags & CRTC_STEREO_DOUBLE) { |
877 | unsigned int layout = p->flags & DRM_MODE_FLAG_3D_MASK; | |
878 | ||
879 | switch (layout) { | |
880 | case DRM_MODE_FLAG_3D_FRAME_PACKING: | |
881 | p->crtc_clock *= 2; | |
882 | p->crtc_vdisplay += p->crtc_vtotal; | |
883 | p->crtc_vsync_start += p->crtc_vtotal; | |
884 | p->crtc_vsync_end += p->crtc_vtotal; | |
885 | p->crtc_vtotal += p->crtc_vtotal; | |
886 | break; | |
887 | } | |
888 | } | |
889 | ||
f453ba04 DA |
890 | p->crtc_vblank_start = min(p->crtc_vsync_start, p->crtc_vdisplay); |
891 | p->crtc_vblank_end = max(p->crtc_vsync_end, p->crtc_vtotal); | |
892 | p->crtc_hblank_start = min(p->crtc_hsync_start, p->crtc_hdisplay); | |
893 | p->crtc_hblank_end = max(p->crtc_hsync_end, p->crtc_htotal); | |
f453ba04 DA |
894 | } |
895 | EXPORT_SYMBOL(drm_mode_set_crtcinfo); | |
896 | ||
c3c50e8b VS |
897 | /** |
898 | * drm_mode_copy - copy the mode | |
899 | * @dst: mode to overwrite | |
900 | * @src: mode to copy | |
901 | * | |
72e45e92 VS |
902 | * Copy an existing mode into another mode, preserving the object id and |
903 | * list head of the destination mode. | |
c3c50e8b VS |
904 | */ |
905 | void drm_mode_copy(struct drm_display_mode *dst, const struct drm_display_mode *src) | |
906 | { | |
907 | int id = dst->base.id; | |
72e45e92 | 908 | struct list_head head = dst->head; |
c3c50e8b VS |
909 | |
910 | *dst = *src; | |
911 | dst->base.id = id; | |
72e45e92 | 912 | dst->head = head; |
c3c50e8b VS |
913 | } |
914 | EXPORT_SYMBOL(drm_mode_copy); | |
915 | ||
f453ba04 DA |
916 | /** |
917 | * drm_mode_duplicate - allocate and duplicate an existing mode | |
3ec0db81 DV |
918 | * @dev: drm_device to allocate the duplicated mode for |
919 | * @mode: mode to duplicate | |
f453ba04 | 920 | * |
f453ba04 DA |
921 | * Just allocate a new mode, copy the existing mode into it, and return |
922 | * a pointer to it. Used to create new instances of established modes. | |
f5aabb97 DV |
923 | * |
924 | * Returns: | |
925 | * Pointer to duplicated mode on success, NULL on error. | |
f453ba04 DA |
926 | */ |
927 | struct drm_display_mode *drm_mode_duplicate(struct drm_device *dev, | |
b1f559ec | 928 | const struct drm_display_mode *mode) |
f453ba04 DA |
929 | { |
930 | struct drm_display_mode *nmode; | |
f453ba04 DA |
931 | |
932 | nmode = drm_mode_create(dev); | |
933 | if (!nmode) | |
934 | return NULL; | |
935 | ||
c3c50e8b VS |
936 | drm_mode_copy(nmode, mode); |
937 | ||
f453ba04 DA |
938 | return nmode; |
939 | } | |
940 | EXPORT_SYMBOL(drm_mode_duplicate); | |
941 | ||
dd7c2626 VS |
942 | static bool drm_mode_match_timings(const struct drm_display_mode *mode1, |
943 | const struct drm_display_mode *mode2) | |
944 | { | |
945 | return mode1->hdisplay == mode2->hdisplay && | |
946 | mode1->hsync_start == mode2->hsync_start && | |
947 | mode1->hsync_end == mode2->hsync_end && | |
948 | mode1->htotal == mode2->htotal && | |
949 | mode1->hskew == mode2->hskew && | |
950 | mode1->vdisplay == mode2->vdisplay && | |
951 | mode1->vsync_start == mode2->vsync_start && | |
952 | mode1->vsync_end == mode2->vsync_end && | |
953 | mode1->vtotal == mode2->vtotal && | |
954 | mode1->vscan == mode2->vscan; | |
955 | } | |
956 | ||
957 | static bool drm_mode_match_clock(const struct drm_display_mode *mode1, | |
958 | const struct drm_display_mode *mode2) | |
959 | { | |
960 | /* | |
961 | * do clock check convert to PICOS | |
962 | * so fb modes get matched the same | |
963 | */ | |
964 | if (mode1->clock && mode2->clock) | |
965 | return KHZ2PICOS(mode1->clock) == KHZ2PICOS(mode2->clock); | |
966 | else | |
967 | return mode1->clock == mode2->clock; | |
968 | } | |
969 | ||
970 | static bool drm_mode_match_flags(const struct drm_display_mode *mode1, | |
971 | const struct drm_display_mode *mode2) | |
972 | { | |
973 | return (mode1->flags & ~DRM_MODE_FLAG_3D_MASK) == | |
974 | (mode2->flags & ~DRM_MODE_FLAG_3D_MASK); | |
975 | } | |
976 | ||
977 | static bool drm_mode_match_3d_flags(const struct drm_display_mode *mode1, | |
978 | const struct drm_display_mode *mode2) | |
979 | { | |
980 | return (mode1->flags & DRM_MODE_FLAG_3D_MASK) == | |
981 | (mode2->flags & DRM_MODE_FLAG_3D_MASK); | |
982 | } | |
983 | ||
984 | static bool drm_mode_match_aspect_ratio(const struct drm_display_mode *mode1, | |
985 | const struct drm_display_mode *mode2) | |
986 | { | |
987 | return mode1->picture_aspect_ratio == mode2->picture_aspect_ratio; | |
988 | } | |
989 | ||
f453ba04 | 990 | /** |
dd7c2626 | 991 | * drm_mode_match - test modes for (partial) equality |
f453ba04 DA |
992 | * @mode1: first mode |
993 | * @mode2: second mode | |
dd7c2626 | 994 | * @match_flags: which parts need to match (DRM_MODE_MATCH_*) |
f453ba04 | 995 | * |
f453ba04 DA |
996 | * Check to see if @mode1 and @mode2 are equivalent. |
997 | * | |
f5aabb97 | 998 | * Returns: |
dd7c2626 | 999 | * True if the modes are (partially) equal, false otherwise. |
f453ba04 | 1000 | */ |
dd7c2626 VS |
1001 | bool drm_mode_match(const struct drm_display_mode *mode1, |
1002 | const struct drm_display_mode *mode2, | |
1003 | unsigned int match_flags) | |
f453ba04 | 1004 | { |
54270952 DS |
1005 | if (!mode1 && !mode2) |
1006 | return true; | |
1007 | ||
1008 | if (!mode1 || !mode2) | |
1009 | return false; | |
1010 | ||
dd7c2626 VS |
1011 | if (match_flags & DRM_MODE_MATCH_TIMINGS && |
1012 | !drm_mode_match_timings(mode1, mode2)) | |
f453ba04 DA |
1013 | return false; |
1014 | ||
dd7c2626 VS |
1015 | if (match_flags & DRM_MODE_MATCH_CLOCK && |
1016 | !drm_mode_match_clock(mode1, mode2)) | |
1017 | return false; | |
1018 | ||
1019 | if (match_flags & DRM_MODE_MATCH_FLAGS && | |
1020 | !drm_mode_match_flags(mode1, mode2)) | |
1021 | return false; | |
1022 | ||
1023 | if (match_flags & DRM_MODE_MATCH_3D_FLAGS && | |
1024 | !drm_mode_match_3d_flags(mode1, mode2)) | |
1025 | return false; | |
1026 | ||
1027 | if (match_flags & DRM_MODE_MATCH_ASPECT_RATIO && | |
1028 | !drm_mode_match_aspect_ratio(mode1, mode2)) | |
1029 | return false; | |
1030 | ||
1031 | return true; | |
1032 | } | |
1033 | EXPORT_SYMBOL(drm_mode_match); | |
1034 | ||
1035 | /** | |
1036 | * drm_mode_equal - test modes for equality | |
1037 | * @mode1: first mode | |
1038 | * @mode2: second mode | |
1039 | * | |
1040 | * Check to see if @mode1 and @mode2 are equivalent. | |
1041 | * | |
1042 | * Returns: | |
1043 | * True if the modes are equal, false otherwise. | |
1044 | */ | |
1045 | bool drm_mode_equal(const struct drm_display_mode *mode1, | |
1046 | const struct drm_display_mode *mode2) | |
1047 | { | |
1048 | return drm_mode_match(mode1, mode2, | |
1049 | DRM_MODE_MATCH_TIMINGS | | |
1050 | DRM_MODE_MATCH_CLOCK | | |
1051 | DRM_MODE_MATCH_FLAGS | | |
222ec161 SS |
1052 | DRM_MODE_MATCH_3D_FLAGS| |
1053 | DRM_MODE_MATCH_ASPECT_RATIO); | |
4c6bcf44 VS |
1054 | } |
1055 | EXPORT_SYMBOL(drm_mode_equal); | |
1056 | ||
1057 | /** | |
1058 | * drm_mode_equal_no_clocks - test modes for equality | |
1059 | * @mode1: first mode | |
1060 | * @mode2: second mode | |
1061 | * | |
1062 | * Check to see if @mode1 and @mode2 are equivalent, but | |
1063 | * don't check the pixel clocks. | |
1064 | * | |
1065 | * Returns: | |
1066 | * True if the modes are equal, false otherwise. | |
1067 | */ | |
dd7c2626 VS |
1068 | bool drm_mode_equal_no_clocks(const struct drm_display_mode *mode1, |
1069 | const struct drm_display_mode *mode2) | |
4c6bcf44 | 1070 | { |
dd7c2626 VS |
1071 | return drm_mode_match(mode1, mode2, |
1072 | DRM_MODE_MATCH_TIMINGS | | |
1073 | DRM_MODE_MATCH_FLAGS | | |
1074 | DRM_MODE_MATCH_3D_FLAGS); | |
8cc3f23c | 1075 | } |
4c6bcf44 | 1076 | EXPORT_SYMBOL(drm_mode_equal_no_clocks); |
8cc3f23c VS |
1077 | |
1078 | /** | |
f2ecf2e3 | 1079 | * drm_mode_equal_no_clocks_no_stereo - test modes for equality |
8cc3f23c VS |
1080 | * @mode1: first mode |
1081 | * @mode2: second mode | |
1082 | * | |
8cc3f23c | 1083 | * Check to see if @mode1 and @mode2 are equivalent, but |
f2ecf2e3 | 1084 | * don't check the pixel clocks nor the stereo layout. |
8cc3f23c | 1085 | * |
f5aabb97 | 1086 | * Returns: |
8cc3f23c VS |
1087 | * True if the modes are equal, false otherwise. |
1088 | */ | |
f2ecf2e3 DL |
1089 | bool drm_mode_equal_no_clocks_no_stereo(const struct drm_display_mode *mode1, |
1090 | const struct drm_display_mode *mode2) | |
8cc3f23c | 1091 | { |
dd7c2626 VS |
1092 | return drm_mode_match(mode1, mode2, |
1093 | DRM_MODE_MATCH_TIMINGS | | |
1094 | DRM_MODE_MATCH_FLAGS); | |
f453ba04 | 1095 | } |
f2ecf2e3 | 1096 | EXPORT_SYMBOL(drm_mode_equal_no_clocks_no_stereo); |
f453ba04 | 1097 | |
75a655e0 | 1098 | static enum drm_mode_status |
abc0b144 VS |
1099 | drm_mode_validate_basic(const struct drm_display_mode *mode) |
1100 | { | |
c6ed6dad VS |
1101 | if (mode->type & ~DRM_MODE_TYPE_ALL) |
1102 | return MODE_BAD; | |
1103 | ||
1104 | if (mode->flags & ~DRM_MODE_FLAG_ALL) | |
1105 | return MODE_BAD; | |
1106 | ||
064a3e6e VS |
1107 | if ((mode->flags & DRM_MODE_FLAG_3D_MASK) > DRM_MODE_FLAG_3D_MAX) |
1108 | return MODE_BAD; | |
1109 | ||
abc0b144 VS |
1110 | if (mode->clock == 0) |
1111 | return MODE_CLOCK_LOW; | |
1112 | ||
1113 | if (mode->hdisplay == 0 || | |
1114 | mode->hsync_start < mode->hdisplay || | |
1115 | mode->hsync_end < mode->hsync_start || | |
1116 | mode->htotal < mode->hsync_end) | |
1117 | return MODE_H_ILLEGAL; | |
1118 | ||
1119 | if (mode->vdisplay == 0 || | |
1120 | mode->vsync_start < mode->vdisplay || | |
1121 | mode->vsync_end < mode->vsync_start || | |
1122 | mode->vtotal < mode->vsync_end) | |
1123 | return MODE_V_ILLEGAL; | |
1124 | ||
1125 | return MODE_OK; | |
1126 | } | |
75a655e0 VS |
1127 | |
1128 | /** | |
1129 | * drm_mode_validate_driver - make sure the mode is somewhat sane | |
1130 | * @dev: drm device | |
1131 | * @mode: mode to check | |
1132 | * | |
1133 | * First do basic validation on the mode, and then allow the driver | |
1134 | * to check for device/driver specific limitations via the optional | |
1135 | * &drm_mode_config_helper_funcs.mode_valid hook. | |
1136 | * | |
1137 | * Returns: | |
1138 | * The mode status | |
1139 | */ | |
1140 | enum drm_mode_status | |
1141 | drm_mode_validate_driver(struct drm_device *dev, | |
1142 | const struct drm_display_mode *mode) | |
1143 | { | |
1144 | enum drm_mode_status status; | |
1145 | ||
1146 | status = drm_mode_validate_basic(mode); | |
1147 | if (status != MODE_OK) | |
1148 | return status; | |
1149 | ||
1150 | if (dev->mode_config.funcs->mode_valid) | |
1151 | return dev->mode_config.funcs->mode_valid(dev, mode); | |
1152 | else | |
1153 | return MODE_OK; | |
1154 | } | |
1155 | EXPORT_SYMBOL(drm_mode_validate_driver); | |
abc0b144 | 1156 | |
f453ba04 DA |
1157 | /** |
1158 | * drm_mode_validate_size - make sure modes adhere to size constraints | |
05acaec3 | 1159 | * @mode: mode to check |
f453ba04 DA |
1160 | * @maxX: maximum width |
1161 | * @maxY: maximum height | |
f453ba04 | 1162 | * |
f5aabb97 DV |
1163 | * This function is a helper which can be used to validate modes against size |
1164 | * limitations of the DRM device/connector. If a mode is too big its status | |
32197aab | 1165 | * member is updated with the appropriate validation failure code. The list |
f5aabb97 | 1166 | * itself is not changed. |
05acaec3 VS |
1167 | * |
1168 | * Returns: | |
1169 | * The mode status | |
f453ba04 | 1170 | */ |
05acaec3 VS |
1171 | enum drm_mode_status |
1172 | drm_mode_validate_size(const struct drm_display_mode *mode, | |
1173 | int maxX, int maxY) | |
f453ba04 | 1174 | { |
05acaec3 VS |
1175 | if (maxX > 0 && mode->hdisplay > maxX) |
1176 | return MODE_VIRTUAL_X; | |
f453ba04 | 1177 | |
05acaec3 VS |
1178 | if (maxY > 0 && mode->vdisplay > maxY) |
1179 | return MODE_VIRTUAL_Y; | |
f453ba04 | 1180 | |
05acaec3 | 1181 | return MODE_OK; |
f453ba04 DA |
1182 | } |
1183 | EXPORT_SYMBOL(drm_mode_validate_size); | |
1184 | ||
d8523153 SS |
1185 | /** |
1186 | * drm_mode_validate_ycbcr420 - add 'ycbcr420-only' modes only when allowed | |
1187 | * @mode: mode to check | |
1188 | * @connector: drm connector under action | |
1189 | * | |
1190 | * This function is a helper which can be used to filter out any YCBCR420 | |
1191 | * only mode, when the source doesn't support it. | |
1192 | * | |
1193 | * Returns: | |
1194 | * The mode status | |
1195 | */ | |
1196 | enum drm_mode_status | |
1197 | drm_mode_validate_ycbcr420(const struct drm_display_mode *mode, | |
1198 | struct drm_connector *connector) | |
1199 | { | |
1200 | u8 vic = drm_match_cea_mode(mode); | |
1201 | enum drm_mode_status status = MODE_OK; | |
1202 | struct drm_hdmi_info *hdmi = &connector->display_info.hdmi; | |
1203 | ||
1204 | if (test_bit(vic, hdmi->y420_vdb_modes)) { | |
1205 | if (!connector->ycbcr_420_allowed) | |
1206 | status = MODE_NO_420; | |
1207 | } | |
1208 | ||
1209 | return status; | |
1210 | } | |
1211 | EXPORT_SYMBOL(drm_mode_validate_ycbcr420); | |
1212 | ||
e4bf44b3 VS |
1213 | #define MODE_STATUS(status) [MODE_ ## status + 3] = #status |
1214 | ||
1215 | static const char * const drm_mode_status_names[] = { | |
1216 | MODE_STATUS(OK), | |
1217 | MODE_STATUS(HSYNC), | |
1218 | MODE_STATUS(VSYNC), | |
1219 | MODE_STATUS(H_ILLEGAL), | |
1220 | MODE_STATUS(V_ILLEGAL), | |
1221 | MODE_STATUS(BAD_WIDTH), | |
1222 | MODE_STATUS(NOMODE), | |
1223 | MODE_STATUS(NO_INTERLACE), | |
1224 | MODE_STATUS(NO_DBLESCAN), | |
1225 | MODE_STATUS(NO_VSCAN), | |
1226 | MODE_STATUS(MEM), | |
1227 | MODE_STATUS(VIRTUAL_X), | |
1228 | MODE_STATUS(VIRTUAL_Y), | |
1229 | MODE_STATUS(MEM_VIRT), | |
1230 | MODE_STATUS(NOCLOCK), | |
1231 | MODE_STATUS(CLOCK_HIGH), | |
1232 | MODE_STATUS(CLOCK_LOW), | |
1233 | MODE_STATUS(CLOCK_RANGE), | |
1234 | MODE_STATUS(BAD_HVALUE), | |
1235 | MODE_STATUS(BAD_VVALUE), | |
1236 | MODE_STATUS(BAD_VSCAN), | |
1237 | MODE_STATUS(HSYNC_NARROW), | |
1238 | MODE_STATUS(HSYNC_WIDE), | |
1239 | MODE_STATUS(HBLANK_NARROW), | |
1240 | MODE_STATUS(HBLANK_WIDE), | |
1241 | MODE_STATUS(VSYNC_NARROW), | |
1242 | MODE_STATUS(VSYNC_WIDE), | |
1243 | MODE_STATUS(VBLANK_NARROW), | |
1244 | MODE_STATUS(VBLANK_WIDE), | |
1245 | MODE_STATUS(PANEL), | |
1246 | MODE_STATUS(INTERLACE_WIDTH), | |
1247 | MODE_STATUS(ONE_WIDTH), | |
1248 | MODE_STATUS(ONE_HEIGHT), | |
1249 | MODE_STATUS(ONE_SIZE), | |
1250 | MODE_STATUS(NO_REDUCED), | |
1251 | MODE_STATUS(NO_STEREO), | |
d8523153 | 1252 | MODE_STATUS(NO_420), |
5ba89406 | 1253 | MODE_STATUS(STALE), |
e4bf44b3 VS |
1254 | MODE_STATUS(BAD), |
1255 | MODE_STATUS(ERROR), | |
1256 | }; | |
1257 | ||
1258 | #undef MODE_STATUS | |
1259 | ||
1260 | static const char *drm_get_mode_status_name(enum drm_mode_status status) | |
1261 | { | |
1262 | int index = status + 3; | |
1263 | ||
1264 | if (WARN_ON(index < 0 || index >= ARRAY_SIZE(drm_mode_status_names))) | |
1265 | return ""; | |
1266 | ||
1267 | return drm_mode_status_names[index]; | |
1268 | } | |
1269 | ||
f453ba04 DA |
1270 | /** |
1271 | * drm_mode_prune_invalid - remove invalid modes from mode list | |
1272 | * @dev: DRM device | |
1273 | * @mode_list: list of modes to check | |
1274 | * @verbose: be verbose about it | |
1275 | * | |
f5aabb97 DV |
1276 | * This helper function can be used to prune a display mode list after |
1277 | * validation has been completed. All modes who's status is not MODE_OK will be | |
1278 | * removed from the list, and if @verbose the status code and mode name is also | |
1279 | * printed to dmesg. | |
f453ba04 DA |
1280 | */ |
1281 | void drm_mode_prune_invalid(struct drm_device *dev, | |
1282 | struct list_head *mode_list, bool verbose) | |
1283 | { | |
1284 | struct drm_display_mode *mode, *t; | |
1285 | ||
1286 | list_for_each_entry_safe(mode, t, mode_list, head) { | |
1287 | if (mode->status != MODE_OK) { | |
1288 | list_del(&mode->head); | |
1289 | if (verbose) { | |
1290 | drm_mode_debug_printmodeline(mode); | |
e4bf44b3 VS |
1291 | DRM_DEBUG_KMS("Not using %s mode: %s\n", |
1292 | mode->name, | |
1293 | drm_get_mode_status_name(mode->status)); | |
f453ba04 DA |
1294 | } |
1295 | drm_mode_destroy(dev, mode); | |
1296 | } | |
1297 | } | |
1298 | } | |
1299 | EXPORT_SYMBOL(drm_mode_prune_invalid); | |
1300 | ||
1301 | /** | |
1302 | * drm_mode_compare - compare modes for favorability | |
2c761270 | 1303 | * @priv: unused |
f453ba04 DA |
1304 | * @lh_a: list_head for first mode |
1305 | * @lh_b: list_head for second mode | |
1306 | * | |
f453ba04 DA |
1307 | * Compare two modes, given by @lh_a and @lh_b, returning a value indicating |
1308 | * which is better. | |
1309 | * | |
f5aabb97 | 1310 | * Returns: |
f453ba04 DA |
1311 | * Negative if @lh_a is better than @lh_b, zero if they're equivalent, or |
1312 | * positive if @lh_b is better than @lh_a. | |
1313 | */ | |
2c761270 | 1314 | static int drm_mode_compare(void *priv, struct list_head *lh_a, struct list_head *lh_b) |
f453ba04 DA |
1315 | { |
1316 | struct drm_display_mode *a = list_entry(lh_a, struct drm_display_mode, head); | |
1317 | struct drm_display_mode *b = list_entry(lh_b, struct drm_display_mode, head); | |
1318 | int diff; | |
1319 | ||
1320 | diff = ((b->type & DRM_MODE_TYPE_PREFERRED) != 0) - | |
1321 | ((a->type & DRM_MODE_TYPE_PREFERRED) != 0); | |
1322 | if (diff) | |
1323 | return diff; | |
1324 | diff = b->hdisplay * b->vdisplay - a->hdisplay * a->vdisplay; | |
1325 | if (diff) | |
1326 | return diff; | |
9bc3cd56 VS |
1327 | |
1328 | diff = b->vrefresh - a->vrefresh; | |
1329 | if (diff) | |
1330 | return diff; | |
1331 | ||
f453ba04 DA |
1332 | diff = b->clock - a->clock; |
1333 | return diff; | |
1334 | } | |
1335 | ||
f453ba04 DA |
1336 | /** |
1337 | * drm_mode_sort - sort mode list | |
f5aabb97 | 1338 | * @mode_list: list of drm_display_mode structures to sort |
f453ba04 | 1339 | * |
f5aabb97 | 1340 | * Sort @mode_list by favorability, moving good modes to the head of the list. |
f453ba04 DA |
1341 | */ |
1342 | void drm_mode_sort(struct list_head *mode_list) | |
1343 | { | |
2c761270 | 1344 | list_sort(NULL, mode_list, drm_mode_compare); |
f453ba04 DA |
1345 | } |
1346 | EXPORT_SYMBOL(drm_mode_sort); | |
1347 | ||
1348 | /** | |
1349 | * drm_mode_connector_list_update - update the mode list for the connector | |
1350 | * @connector: the connector to update | |
1351 | * | |
f453ba04 DA |
1352 | * This moves the modes from the @connector probed_modes list |
1353 | * to the actual mode list. It compares the probed mode against the current | |
f5aabb97 DV |
1354 | * list and only adds different/new modes. |
1355 | * | |
1356 | * This is just a helper functions doesn't validate any modes itself and also | |
1357 | * doesn't prune any invalid modes. Callers need to do that themselves. | |
f453ba04 | 1358 | */ |
6af3e656 | 1359 | void drm_mode_connector_list_update(struct drm_connector *connector) |
f453ba04 | 1360 | { |
f453ba04 | 1361 | struct drm_display_mode *pmode, *pt; |
f453ba04 | 1362 | |
63951385 DV |
1363 | WARN_ON(!mutex_is_locked(&connector->dev->mode_config.mutex)); |
1364 | ||
2f8c19e7 VS |
1365 | list_for_each_entry_safe(pmode, pt, &connector->probed_modes, head) { |
1366 | struct drm_display_mode *mode; | |
1367 | bool found_it = false; | |
1368 | ||
f453ba04 DA |
1369 | /* go through current modes checking for the new probed mode */ |
1370 | list_for_each_entry(mode, &connector->modes, head) { | |
2f8c19e7 VS |
1371 | if (!drm_mode_equal(pmode, mode)) |
1372 | continue; | |
1373 | ||
1374 | found_it = true; | |
fc245f88 VS |
1375 | |
1376 | /* | |
1377 | * If the old matching mode is stale (ie. left over | |
1378 | * from a previous probe) just replace it outright. | |
1379 | * Otherwise just merge the type bits between all | |
1380 | * equal probed modes. | |
1381 | * | |
1382 | * If two probed modes are considered equal, pick the | |
1383 | * actual timings from the one that's marked as | |
1384 | * preferred (in case the match isn't 100%). If | |
1385 | * multiple or zero preferred modes are present, favor | |
1386 | * the mode added to the probed_modes list first. | |
1387 | */ | |
1388 | if (mode->status == MODE_STALE) { | |
1389 | drm_mode_copy(mode, pmode); | |
1390 | } else if ((mode->type & DRM_MODE_TYPE_PREFERRED) == 0 && | |
1391 | (pmode->type & DRM_MODE_TYPE_PREFERRED) != 0) { | |
6af3e656 | 1392 | pmode->type |= mode->type; |
fc245f88 VS |
1393 | drm_mode_copy(mode, pmode); |
1394 | } else { | |
6af3e656 | 1395 | mode->type |= pmode->type; |
fc245f88 VS |
1396 | } |
1397 | ||
2f8c19e7 VS |
1398 | list_del(&pmode->head); |
1399 | drm_mode_destroy(connector->dev, pmode); | |
1400 | break; | |
f453ba04 DA |
1401 | } |
1402 | ||
1403 | if (!found_it) { | |
1404 | list_move_tail(&pmode->head, &connector->modes); | |
1405 | } | |
1406 | } | |
1407 | } | |
1408 | EXPORT_SYMBOL(drm_mode_connector_list_update); | |
1794d257 CW |
1409 | |
1410 | /** | |
f5aabb97 DV |
1411 | * drm_mode_parse_command_line_for_connector - parse command line modeline for connector |
1412 | * @mode_option: optional per connector mode option | |
1413 | * @connector: connector to parse modeline for | |
1414 | * @mode: preallocated drm_cmdline_mode structure to fill out | |
1415 | * | |
1416 | * This parses @mode_option command line modeline for modes and options to | |
1417 | * configure the connector. If @mode_option is NULL the default command line | |
1418 | * modeline in fb_mode_option will be parsed instead. | |
1794d257 | 1419 | * |
f5aabb97 | 1420 | * This uses the same parameters as the fb modedb.c, except for an extra |
dbd124f0 | 1421 | * force-enable, force-enable-digital and force-disable bit at the end:: |
1794d257 | 1422 | * |
dbd124f0 | 1423 | * <xres>x<yres>[M][R][-<bpp>][@<refresh>][i][m][eDd] |
1794d257 | 1424 | * |
f5aabb97 | 1425 | * The intermediate drm_cmdline_mode structure is required to store additional |
2a97acd6 | 1426 | * options from the command line modline like the force-enable/disable flag. |
f5aabb97 DV |
1427 | * |
1428 | * Returns: | |
1429 | * True if a valid modeline has been parsed, false otherwise. | |
1794d257 CW |
1430 | */ |
1431 | bool drm_mode_parse_command_line_for_connector(const char *mode_option, | |
1432 | struct drm_connector *connector, | |
1433 | struct drm_cmdline_mode *mode) | |
1434 | { | |
1435 | const char *name; | |
1436 | unsigned int namelen; | |
04fee895 | 1437 | bool res_specified = false, bpp_specified = false, refresh_specified = false; |
1794d257 | 1438 | unsigned int xres = 0, yres = 0, bpp = 32, refresh = 0; |
04fee895 REB |
1439 | bool yres_specified = false, cvt = false, rb = false; |
1440 | bool interlace = false, margins = false, was_digit = false; | |
d6e6e14f | 1441 | int i; |
1794d257 CW |
1442 | enum drm_connector_force force = DRM_FORCE_UNSPECIFIED; |
1443 | ||
cb3c438e | 1444 | #ifdef CONFIG_FB |
1794d257 CW |
1445 | if (!mode_option) |
1446 | mode_option = fb_mode_option; | |
cb3c438e | 1447 | #endif |
1794d257 CW |
1448 | |
1449 | if (!mode_option) { | |
1450 | mode->specified = false; | |
1451 | return false; | |
1452 | } | |
1453 | ||
1454 | name = mode_option; | |
1455 | namelen = strlen(name); | |
1456 | for (i = namelen-1; i >= 0; i--) { | |
1457 | switch (name[i]) { | |
1458 | case '@': | |
1794d257 | 1459 | if (!refresh_specified && !bpp_specified && |
04fee895 | 1460 | !yres_specified && !cvt && !rb && was_digit) { |
d6e6e14f | 1461 | refresh = simple_strtol(&name[i+1], NULL, 10); |
04fee895 REB |
1462 | refresh_specified = true; |
1463 | was_digit = false; | |
1794d257 CW |
1464 | } else |
1465 | goto done; | |
1466 | break; | |
1467 | case '-': | |
04fee895 REB |
1468 | if (!bpp_specified && !yres_specified && !cvt && |
1469 | !rb && was_digit) { | |
d6e6e14f | 1470 | bpp = simple_strtol(&name[i+1], NULL, 10); |
04fee895 REB |
1471 | bpp_specified = true; |
1472 | was_digit = false; | |
1794d257 CW |
1473 | } else |
1474 | goto done; | |
1475 | break; | |
1476 | case 'x': | |
04fee895 | 1477 | if (!yres_specified && was_digit) { |
d6e6e14f | 1478 | yres = simple_strtol(&name[i+1], NULL, 10); |
04fee895 REB |
1479 | yres_specified = true; |
1480 | was_digit = false; | |
1794d257 CW |
1481 | } else |
1482 | goto done; | |
97fbfbf4 | 1483 | break; |
1794d257 | 1484 | case '0' ... '9': |
04fee895 | 1485 | was_digit = true; |
1794d257 CW |
1486 | break; |
1487 | case 'M': | |
04fee895 REB |
1488 | if (yres_specified || cvt || was_digit) |
1489 | goto done; | |
1490 | cvt = true; | |
1794d257 CW |
1491 | break; |
1492 | case 'R': | |
04fee895 REB |
1493 | if (yres_specified || cvt || rb || was_digit) |
1494 | goto done; | |
1495 | rb = true; | |
1794d257 CW |
1496 | break; |
1497 | case 'm': | |
04fee895 REB |
1498 | if (cvt || yres_specified || was_digit) |
1499 | goto done; | |
1500 | margins = true; | |
1794d257 CW |
1501 | break; |
1502 | case 'i': | |
04fee895 REB |
1503 | if (cvt || yres_specified || was_digit) |
1504 | goto done; | |
1505 | interlace = true; | |
1794d257 CW |
1506 | break; |
1507 | case 'e': | |
04fee895 REB |
1508 | if (yres_specified || bpp_specified || refresh_specified || |
1509 | was_digit || (force != DRM_FORCE_UNSPECIFIED)) | |
1510 | goto done; | |
1511 | ||
1794d257 CW |
1512 | force = DRM_FORCE_ON; |
1513 | break; | |
1514 | case 'D': | |
04fee895 REB |
1515 | if (yres_specified || bpp_specified || refresh_specified || |
1516 | was_digit || (force != DRM_FORCE_UNSPECIFIED)) | |
1517 | goto done; | |
1518 | ||
1794d257 CW |
1519 | if ((connector->connector_type != DRM_MODE_CONNECTOR_DVII) && |
1520 | (connector->connector_type != DRM_MODE_CONNECTOR_HDMIB)) | |
1521 | force = DRM_FORCE_ON; | |
1522 | else | |
1523 | force = DRM_FORCE_ON_DIGITAL; | |
1524 | break; | |
1525 | case 'd': | |
04fee895 REB |
1526 | if (yres_specified || bpp_specified || refresh_specified || |
1527 | was_digit || (force != DRM_FORCE_UNSPECIFIED)) | |
1528 | goto done; | |
1529 | ||
1794d257 CW |
1530 | force = DRM_FORCE_OFF; |
1531 | break; | |
1532 | default: | |
1533 | goto done; | |
1534 | } | |
1535 | } | |
04fee895 | 1536 | |
1794d257 | 1537 | if (i < 0 && yres_specified) { |
04fee895 REB |
1538 | char *ch; |
1539 | xres = simple_strtol(name, &ch, 10); | |
1540 | if ((ch != NULL) && (*ch == 'x')) | |
1541 | res_specified = true; | |
1542 | else | |
1543 | i = ch - name; | |
1544 | } else if (!yres_specified && was_digit) { | |
1545 | /* catch mode that begins with digits but has no 'x' */ | |
1546 | i = 0; | |
1794d257 CW |
1547 | } |
1548 | done: | |
04fee895 | 1549 | if (i >= 0) { |
67fe85dd | 1550 | pr_warn("[drm] parse error at position %i in video mode '%s'\n", |
04fee895 REB |
1551 | i, name); |
1552 | mode->specified = false; | |
1553 | return false; | |
1554 | } | |
1555 | ||
1794d257 CW |
1556 | if (res_specified) { |
1557 | mode->specified = true; | |
1558 | mode->xres = xres; | |
1559 | mode->yres = yres; | |
1560 | } | |
1561 | ||
1562 | if (refresh_specified) { | |
1563 | mode->refresh_specified = true; | |
1564 | mode->refresh = refresh; | |
1565 | } | |
1566 | ||
1567 | if (bpp_specified) { | |
1568 | mode->bpp_specified = true; | |
1569 | mode->bpp = bpp; | |
1570 | } | |
04fee895 REB |
1571 | mode->rb = rb; |
1572 | mode->cvt = cvt; | |
1573 | mode->interlace = interlace; | |
1574 | mode->margins = margins; | |
1794d257 CW |
1575 | mode->force = force; |
1576 | ||
1577 | return true; | |
1578 | } | |
1579 | EXPORT_SYMBOL(drm_mode_parse_command_line_for_connector); | |
1580 | ||
f5aabb97 DV |
1581 | /** |
1582 | * drm_mode_create_from_cmdline_mode - convert a command line modeline into a DRM display mode | |
1583 | * @dev: DRM device to create the new mode for | |
1584 | * @cmd: input command line modeline | |
1585 | * | |
1586 | * Returns: | |
1587 | * Pointer to converted mode on success, NULL on error. | |
1588 | */ | |
1794d257 CW |
1589 | struct drm_display_mode * |
1590 | drm_mode_create_from_cmdline_mode(struct drm_device *dev, | |
1591 | struct drm_cmdline_mode *cmd) | |
1592 | { | |
1593 | struct drm_display_mode *mode; | |
1594 | ||
1595 | if (cmd->cvt) | |
1596 | mode = drm_cvt_mode(dev, | |
1597 | cmd->xres, cmd->yres, | |
1598 | cmd->refresh_specified ? cmd->refresh : 60, | |
1599 | cmd->rb, cmd->interlace, | |
1600 | cmd->margins); | |
1601 | else | |
1602 | mode = drm_gtf_mode(dev, | |
1603 | cmd->xres, cmd->yres, | |
1604 | cmd->refresh_specified ? cmd->refresh : 60, | |
1605 | cmd->interlace, | |
1606 | cmd->margins); | |
1607 | if (!mode) | |
1608 | return NULL; | |
1609 | ||
eaf99c74 | 1610 | mode->type |= DRM_MODE_TYPE_USERDEF; |
fdf35a6b | 1611 | /* fix up 1368x768: GFT/CVT can't express 1366 width due to alignment */ |
969218fe TI |
1612 | if (cmd->xres == 1366) |
1613 | drm_mode_fixup_1366x768(mode); | |
1794d257 CW |
1614 | drm_mode_set_crtcinfo(mode, CRTC_INTERLACE_HALVE_V); |
1615 | return mode; | |
1616 | } | |
1617 | EXPORT_SYMBOL(drm_mode_create_from_cmdline_mode); | |
934a8a89 DS |
1618 | |
1619 | /** | |
1620 | * drm_crtc_convert_to_umode - convert a drm_display_mode into a modeinfo | |
1621 | * @out: drm_mode_modeinfo struct to return to the user | |
1622 | * @in: drm_display_mode to use | |
1623 | * | |
1624 | * Convert a drm_display_mode into a drm_mode_modeinfo structure to return to | |
1625 | * the user. | |
1626 | */ | |
1627 | void drm_mode_convert_to_umode(struct drm_mode_modeinfo *out, | |
1628 | const struct drm_display_mode *in) | |
1629 | { | |
1630 | WARN(in->hdisplay > USHRT_MAX || in->hsync_start > USHRT_MAX || | |
1631 | in->hsync_end > USHRT_MAX || in->htotal > USHRT_MAX || | |
1632 | in->hskew > USHRT_MAX || in->vdisplay > USHRT_MAX || | |
1633 | in->vsync_start > USHRT_MAX || in->vsync_end > USHRT_MAX || | |
1634 | in->vtotal > USHRT_MAX || in->vscan > USHRT_MAX, | |
1635 | "timing values too large for mode info\n"); | |
1636 | ||
1637 | out->clock = in->clock; | |
1638 | out->hdisplay = in->hdisplay; | |
1639 | out->hsync_start = in->hsync_start; | |
1640 | out->hsync_end = in->hsync_end; | |
1641 | out->htotal = in->htotal; | |
1642 | out->hskew = in->hskew; | |
1643 | out->vdisplay = in->vdisplay; | |
1644 | out->vsync_start = in->vsync_start; | |
1645 | out->vsync_end = in->vsync_end; | |
1646 | out->vtotal = in->vtotal; | |
1647 | out->vscan = in->vscan; | |
1648 | out->vrefresh = in->vrefresh; | |
1649 | out->flags = in->flags; | |
1650 | out->type = in->type; | |
222ec161 SS |
1651 | |
1652 | switch (in->picture_aspect_ratio) { | |
1653 | case HDMI_PICTURE_ASPECT_4_3: | |
1654 | out->flags |= DRM_MODE_FLAG_PIC_AR_4_3; | |
1655 | break; | |
1656 | case HDMI_PICTURE_ASPECT_16_9: | |
1657 | out->flags |= DRM_MODE_FLAG_PIC_AR_16_9; | |
1658 | break; | |
900aa8ad SS |
1659 | case HDMI_PICTURE_ASPECT_64_27: |
1660 | out->flags |= DRM_MODE_FLAG_PIC_AR_64_27; | |
1661 | break; | |
1662 | case HDMI_PICTURE_ASPECT_256_135: | |
1663 | out->flags |= DRM_MODE_FLAG_PIC_AR_256_135; | |
1664 | break; | |
222ec161 SS |
1665 | case HDMI_PICTURE_ASPECT_RESERVED: |
1666 | default: | |
1667 | out->flags |= DRM_MODE_FLAG_PIC_AR_NONE; | |
1668 | break; | |
1669 | } | |
1670 | ||
934a8a89 DS |
1671 | strncpy(out->name, in->name, DRM_DISPLAY_MODE_LEN); |
1672 | out->name[DRM_DISPLAY_MODE_LEN-1] = 0; | |
1673 | } | |
1674 | ||
1675 | /** | |
1676 | * drm_crtc_convert_umode - convert a modeinfo into a drm_display_mode | |
75a655e0 | 1677 | * @dev: drm device |
934a8a89 DS |
1678 | * @out: drm_display_mode to return to the user |
1679 | * @in: drm_mode_modeinfo to use | |
1680 | * | |
1681 | * Convert a drm_mode_modeinfo into a drm_display_mode structure to return to | |
1682 | * the caller. | |
1683 | * | |
1684 | * Returns: | |
1685 | * Zero on success, negative errno on failure. | |
1686 | */ | |
75a655e0 VS |
1687 | int drm_mode_convert_umode(struct drm_device *dev, |
1688 | struct drm_display_mode *out, | |
934a8a89 DS |
1689 | const struct drm_mode_modeinfo *in) |
1690 | { | |
df550548 VS |
1691 | if (in->clock > INT_MAX || in->vrefresh > INT_MAX) |
1692 | return -ERANGE; | |
934a8a89 | 1693 | |
934a8a89 DS |
1694 | out->clock = in->clock; |
1695 | out->hdisplay = in->hdisplay; | |
1696 | out->hsync_start = in->hsync_start; | |
1697 | out->hsync_end = in->hsync_end; | |
1698 | out->htotal = in->htotal; | |
1699 | out->hskew = in->hskew; | |
1700 | out->vdisplay = in->vdisplay; | |
1701 | out->vsync_start = in->vsync_start; | |
1702 | out->vsync_end = in->vsync_end; | |
1703 | out->vtotal = in->vtotal; | |
1704 | out->vscan = in->vscan; | |
1705 | out->vrefresh = in->vrefresh; | |
1706 | out->flags = in->flags; | |
a01c4773 VS |
1707 | /* |
1708 | * Old xf86-video-vmware (possibly others too) used to | |
1709 | * leave 'type' unititialized. Just ignore any bits we | |
1710 | * don't like. It's a just hint after all, and more | |
1711 | * useful for the kernel->userspace direction anyway. | |
1712 | */ | |
1713 | out->type = in->type & DRM_MODE_TYPE_ALL; | |
934a8a89 DS |
1714 | strncpy(out->name, in->name, DRM_DISPLAY_MODE_LEN); |
1715 | out->name[DRM_DISPLAY_MODE_LEN-1] = 0; | |
1716 | ||
222ec161 SS |
1717 | /* Clearing picture aspect ratio bits from out flags, |
1718 | * as the aspect-ratio information is not stored in | |
1719 | * flags for kernel-mode, but in picture_aspect_ratio. | |
1720 | */ | |
1721 | out->flags &= ~DRM_MODE_FLAG_PIC_AR_MASK; | |
1722 | ||
1723 | switch (in->flags & DRM_MODE_FLAG_PIC_AR_MASK) { | |
1724 | case DRM_MODE_FLAG_PIC_AR_4_3: | |
1725 | out->picture_aspect_ratio |= HDMI_PICTURE_ASPECT_4_3; | |
1726 | break; | |
1727 | case DRM_MODE_FLAG_PIC_AR_16_9: | |
1728 | out->picture_aspect_ratio |= HDMI_PICTURE_ASPECT_16_9; | |
1729 | break; | |
900aa8ad SS |
1730 | case DRM_MODE_FLAG_PIC_AR_64_27: |
1731 | out->picture_aspect_ratio |= HDMI_PICTURE_ASPECT_64_27; | |
1732 | break; | |
1733 | case DRM_MODE_FLAG_PIC_AR_256_135: | |
1734 | out->picture_aspect_ratio |= HDMI_PICTURE_ASPECT_256_135; | |
1735 | break; | |
222ec161 SS |
1736 | default: |
1737 | out->picture_aspect_ratio = HDMI_PICTURE_ASPECT_NONE; | |
1738 | break; | |
1739 | } | |
1740 | ||
75a655e0 | 1741 | out->status = drm_mode_validate_driver(dev, out); |
934a8a89 | 1742 | if (out->status != MODE_OK) |
df550548 | 1743 | return -EINVAL; |
934a8a89 | 1744 | |
b201e743 TV |
1745 | drm_mode_set_crtcinfo(out, CRTC_INTERLACE_HALVE_V); |
1746 | ||
df550548 | 1747 | return 0; |
f03d8ede | 1748 | } |
2570fe25 SS |
1749 | |
1750 | /** | |
1751 | * drm_mode_is_420_only - if a given videomode can be only supported in YCBCR420 | |
1752 | * output format | |
1753 | * | |
8d0873a2 | 1754 | * @display: display under action |
2570fe25 SS |
1755 | * @mode: video mode to be tested. |
1756 | * | |
1757 | * Returns: | |
1758 | * true if the mode can be supported in YCBCR420 format | |
1759 | * false if not. | |
1760 | */ | |
1761 | bool drm_mode_is_420_only(const struct drm_display_info *display, | |
1762 | const struct drm_display_mode *mode) | |
1763 | { | |
1764 | u8 vic = drm_match_cea_mode(mode); | |
1765 | ||
1766 | return test_bit(vic, display->hdmi.y420_vdb_modes); | |
1767 | } | |
1768 | EXPORT_SYMBOL(drm_mode_is_420_only); | |
1769 | ||
1770 | /** | |
1771 | * drm_mode_is_420_also - if a given videomode can be supported in YCBCR420 | |
1772 | * output format also (along with RGB/YCBCR444/422) | |
1773 | * | |
1774 | * @display: display under action. | |
1775 | * @mode: video mode to be tested. | |
1776 | * | |
1777 | * Returns: | |
1778 | * true if the mode can be support YCBCR420 format | |
1779 | * false if not. | |
1780 | */ | |
1781 | bool drm_mode_is_420_also(const struct drm_display_info *display, | |
1782 | const struct drm_display_mode *mode) | |
1783 | { | |
1784 | u8 vic = drm_match_cea_mode(mode); | |
1785 | ||
1786 | return test_bit(vic, display->hdmi.y420_cmdb_modes); | |
1787 | } | |
1788 | EXPORT_SYMBOL(drm_mode_is_420_also); | |
1789 | /** | |
1790 | * drm_mode_is_420 - if a given videomode can be supported in YCBCR420 | |
1791 | * output format | |
1792 | * | |
1793 | * @display: display under action. | |
1794 | * @mode: video mode to be tested. | |
1795 | * | |
1796 | * Returns: | |
1797 | * true if the mode can be supported in YCBCR420 format | |
1798 | * false if not. | |
1799 | */ | |
1800 | bool drm_mode_is_420(const struct drm_display_info *display, | |
1801 | const struct drm_display_mode *mode) | |
1802 | { | |
1803 | return drm_mode_is_420_only(display, mode) || | |
1804 | drm_mode_is_420_also(display, mode); | |
1805 | } | |
1806 | EXPORT_SYMBOL(drm_mode_is_420); |