v4l2-dv-timings.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609
  1. /*
  2. * v4l2-dv-timings - dv-timings helper functions
  3. *
  4. * Copyright 2013 Cisco Systems, Inc. and/or its affiliates. All rights reserved.
  5. *
  6. * This program is free software; you may redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation; version 2 of the License.
  9. *
  10. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  11. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  12. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  13. * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  14. * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  15. * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  16. * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  17. * SOFTWARE.
  18. *
  19. */
  20. #include <linux/module.h>
  21. #include <linux/types.h>
  22. #include <linux/kernel.h>
  23. #include <linux/errno.h>
  24. #include <linux/videodev2.h>
  25. #include <linux/v4l2-dv-timings.h>
  26. #include <media/v4l2-dv-timings.h>
  27. const struct v4l2_dv_timings v4l2_dv_timings_presets[] = {
  28. V4L2_DV_BT_CEA_640X480P59_94,
  29. V4L2_DV_BT_CEA_720X480I59_94,
  30. V4L2_DV_BT_CEA_720X480P59_94,
  31. V4L2_DV_BT_CEA_720X576I50,
  32. V4L2_DV_BT_CEA_720X576P50,
  33. V4L2_DV_BT_CEA_1280X720P24,
  34. V4L2_DV_BT_CEA_1280X720P25,
  35. V4L2_DV_BT_CEA_1280X720P30,
  36. V4L2_DV_BT_CEA_1280X720P50,
  37. V4L2_DV_BT_CEA_1280X720P60,
  38. V4L2_DV_BT_CEA_1920X1080P24,
  39. V4L2_DV_BT_CEA_1920X1080P25,
  40. V4L2_DV_BT_CEA_1920X1080P30,
  41. V4L2_DV_BT_CEA_1920X1080I50,
  42. V4L2_DV_BT_CEA_1920X1080P50,
  43. V4L2_DV_BT_CEA_1920X1080I60,
  44. V4L2_DV_BT_CEA_1920X1080P60,
  45. V4L2_DV_BT_DMT_640X350P85,
  46. V4L2_DV_BT_DMT_640X400P85,
  47. V4L2_DV_BT_DMT_720X400P85,
  48. V4L2_DV_BT_DMT_640X480P72,
  49. V4L2_DV_BT_DMT_640X480P75,
  50. V4L2_DV_BT_DMT_640X480P85,
  51. V4L2_DV_BT_DMT_800X600P56,
  52. V4L2_DV_BT_DMT_800X600P60,
  53. V4L2_DV_BT_DMT_800X600P72,
  54. V4L2_DV_BT_DMT_800X600P75,
  55. V4L2_DV_BT_DMT_800X600P85,
  56. V4L2_DV_BT_DMT_800X600P120_RB,
  57. V4L2_DV_BT_DMT_848X480P60,
  58. V4L2_DV_BT_DMT_1024X768I43,
  59. V4L2_DV_BT_DMT_1024X768P60,
  60. V4L2_DV_BT_DMT_1024X768P70,
  61. V4L2_DV_BT_DMT_1024X768P75,
  62. V4L2_DV_BT_DMT_1024X768P85,
  63. V4L2_DV_BT_DMT_1024X768P120_RB,
  64. V4L2_DV_BT_DMT_1152X864P75,
  65. V4L2_DV_BT_DMT_1280X768P60_RB,
  66. V4L2_DV_BT_DMT_1280X768P60,
  67. V4L2_DV_BT_DMT_1280X768P75,
  68. V4L2_DV_BT_DMT_1280X768P85,
  69. V4L2_DV_BT_DMT_1280X768P120_RB,
  70. V4L2_DV_BT_DMT_1280X800P60_RB,
  71. V4L2_DV_BT_DMT_1280X800P60,
  72. V4L2_DV_BT_DMT_1280X800P75,
  73. V4L2_DV_BT_DMT_1280X800P85,
  74. V4L2_DV_BT_DMT_1280X800P120_RB,
  75. V4L2_DV_BT_DMT_1280X960P60,
  76. V4L2_DV_BT_DMT_1280X960P85,
  77. V4L2_DV_BT_DMT_1280X960P120_RB,
  78. V4L2_DV_BT_DMT_1280X1024P60,
  79. V4L2_DV_BT_DMT_1280X1024P75,
  80. V4L2_DV_BT_DMT_1280X1024P85,
  81. V4L2_DV_BT_DMT_1280X1024P120_RB,
  82. V4L2_DV_BT_DMT_1360X768P60,
  83. V4L2_DV_BT_DMT_1360X768P120_RB,
  84. V4L2_DV_BT_DMT_1366X768P60,
  85. V4L2_DV_BT_DMT_1366X768P60_RB,
  86. V4L2_DV_BT_DMT_1400X1050P60_RB,
  87. V4L2_DV_BT_DMT_1400X1050P60,
  88. V4L2_DV_BT_DMT_1400X1050P75,
  89. V4L2_DV_BT_DMT_1400X1050P85,
  90. V4L2_DV_BT_DMT_1400X1050P120_RB,
  91. V4L2_DV_BT_DMT_1440X900P60_RB,
  92. V4L2_DV_BT_DMT_1440X900P60,
  93. V4L2_DV_BT_DMT_1440X900P75,
  94. V4L2_DV_BT_DMT_1440X900P85,
  95. V4L2_DV_BT_DMT_1440X900P120_RB,
  96. V4L2_DV_BT_DMT_1600X900P60_RB,
  97. V4L2_DV_BT_DMT_1600X1200P60,
  98. V4L2_DV_BT_DMT_1600X1200P65,
  99. V4L2_DV_BT_DMT_1600X1200P70,
  100. V4L2_DV_BT_DMT_1600X1200P75,
  101. V4L2_DV_BT_DMT_1600X1200P85,
  102. V4L2_DV_BT_DMT_1600X1200P120_RB,
  103. V4L2_DV_BT_DMT_1680X1050P60_RB,
  104. V4L2_DV_BT_DMT_1680X1050P60,
  105. V4L2_DV_BT_DMT_1680X1050P75,
  106. V4L2_DV_BT_DMT_1680X1050P85,
  107. V4L2_DV_BT_DMT_1680X1050P120_RB,
  108. V4L2_DV_BT_DMT_1792X1344P60,
  109. V4L2_DV_BT_DMT_1792X1344P75,
  110. V4L2_DV_BT_DMT_1792X1344P120_RB,
  111. V4L2_DV_BT_DMT_1856X1392P60,
  112. V4L2_DV_BT_DMT_1856X1392P75,
  113. V4L2_DV_BT_DMT_1856X1392P120_RB,
  114. V4L2_DV_BT_DMT_1920X1200P60_RB,
  115. V4L2_DV_BT_DMT_1920X1200P60,
  116. V4L2_DV_BT_DMT_1920X1200P75,
  117. V4L2_DV_BT_DMT_1920X1200P85,
  118. V4L2_DV_BT_DMT_1920X1200P120_RB,
  119. V4L2_DV_BT_DMT_1920X1440P60,
  120. V4L2_DV_BT_DMT_1920X1440P75,
  121. V4L2_DV_BT_DMT_1920X1440P120_RB,
  122. V4L2_DV_BT_DMT_2048X1152P60_RB,
  123. V4L2_DV_BT_DMT_2560X1600P60_RB,
  124. V4L2_DV_BT_DMT_2560X1600P60,
  125. V4L2_DV_BT_DMT_2560X1600P75,
  126. V4L2_DV_BT_DMT_2560X1600P85,
  127. V4L2_DV_BT_DMT_2560X1600P120_RB,
  128. { }
  129. };
  130. EXPORT_SYMBOL_GPL(v4l2_dv_timings_presets);
  131. bool v4l2_valid_dv_timings(const struct v4l2_dv_timings *t,
  132. const struct v4l2_dv_timings_cap *dvcap,
  133. v4l2_check_dv_timings_fnc fnc,
  134. void *fnc_handle)
  135. {
  136. const struct v4l2_bt_timings *bt = &t->bt;
  137. const struct v4l2_bt_timings_cap *cap = &dvcap->bt;
  138. u32 caps = cap->capabilities;
  139. if (t->type != V4L2_DV_BT_656_1120)
  140. return false;
  141. if (t->type != dvcap->type ||
  142. bt->height < cap->min_height ||
  143. bt->height > cap->max_height ||
  144. bt->width < cap->min_width ||
  145. bt->width > cap->max_width ||
  146. bt->pixelclock < cap->min_pixelclock ||
  147. bt->pixelclock > cap->max_pixelclock ||
  148. (cap->standards && !(bt->standards & cap->standards)) ||
  149. (bt->interlaced && !(caps & V4L2_DV_BT_CAP_INTERLACED)) ||
  150. (!bt->interlaced && !(caps & V4L2_DV_BT_CAP_PROGRESSIVE)))
  151. return false;
  152. return fnc == NULL || fnc(t, fnc_handle);
  153. }
  154. EXPORT_SYMBOL_GPL(v4l2_valid_dv_timings);
  155. int v4l2_enum_dv_timings_cap(struct v4l2_enum_dv_timings *t,
  156. const struct v4l2_dv_timings_cap *cap,
  157. v4l2_check_dv_timings_fnc fnc,
  158. void *fnc_handle)
  159. {
  160. u32 i, idx;
  161. memset(t->reserved, 0, sizeof(t->reserved));
  162. for (i = idx = 0; v4l2_dv_timings_presets[i].bt.width; i++) {
  163. if (v4l2_valid_dv_timings(v4l2_dv_timings_presets + i, cap,
  164. fnc, fnc_handle) &&
  165. idx++ == t->index) {
  166. t->timings = v4l2_dv_timings_presets[i];
  167. return 0;
  168. }
  169. }
  170. return -EINVAL;
  171. }
  172. EXPORT_SYMBOL_GPL(v4l2_enum_dv_timings_cap);
  173. bool v4l2_find_dv_timings_cap(struct v4l2_dv_timings *t,
  174. const struct v4l2_dv_timings_cap *cap,
  175. unsigned pclock_delta,
  176. v4l2_check_dv_timings_fnc fnc,
  177. void *fnc_handle)
  178. {
  179. int i;
  180. if (!v4l2_valid_dv_timings(t, cap, fnc, fnc_handle))
  181. return false;
  182. for (i = 0; i < v4l2_dv_timings_presets[i].bt.width; i++) {
  183. if (v4l2_valid_dv_timings(v4l2_dv_timings_presets + i, cap,
  184. fnc, fnc_handle) &&
  185. v4l2_match_dv_timings(t, v4l2_dv_timings_presets + i,
  186. pclock_delta)) {
  187. *t = v4l2_dv_timings_presets[i];
  188. return true;
  189. }
  190. }
  191. return false;
  192. }
  193. EXPORT_SYMBOL_GPL(v4l2_find_dv_timings_cap);
  194. /**
  195. * v4l2_match_dv_timings - check if two timings match
  196. * @t1 - compare this v4l2_dv_timings struct...
  197. * @t2 - with this struct.
  198. * @pclock_delta - the allowed pixelclock deviation.
  199. *
  200. * Compare t1 with t2 with a given margin of error for the pixelclock.
  201. */
  202. bool v4l2_match_dv_timings(const struct v4l2_dv_timings *t1,
  203. const struct v4l2_dv_timings *t2,
  204. unsigned pclock_delta)
  205. {
  206. if (t1->type != t2->type || t1->type != V4L2_DV_BT_656_1120)
  207. return false;
  208. if (t1->bt.width == t2->bt.width &&
  209. t1->bt.height == t2->bt.height &&
  210. t1->bt.interlaced == t2->bt.interlaced &&
  211. t1->bt.polarities == t2->bt.polarities &&
  212. t1->bt.pixelclock >= t2->bt.pixelclock - pclock_delta &&
  213. t1->bt.pixelclock <= t2->bt.pixelclock + pclock_delta &&
  214. t1->bt.hfrontporch == t2->bt.hfrontporch &&
  215. t1->bt.vfrontporch == t2->bt.vfrontporch &&
  216. t1->bt.vsync == t2->bt.vsync &&
  217. t1->bt.vbackporch == t2->bt.vbackporch &&
  218. (!t1->bt.interlaced ||
  219. (t1->bt.il_vfrontporch == t2->bt.il_vfrontporch &&
  220. t1->bt.il_vsync == t2->bt.il_vsync &&
  221. t1->bt.il_vbackporch == t2->bt.il_vbackporch)))
  222. return true;
  223. return false;
  224. }
  225. EXPORT_SYMBOL_GPL(v4l2_match_dv_timings);
  226. void v4l2_print_dv_timings(const char *dev_prefix, const char *prefix,
  227. const struct v4l2_dv_timings *t, bool detailed)
  228. {
  229. const struct v4l2_bt_timings *bt = &t->bt;
  230. u32 htot, vtot;
  231. if (t->type != V4L2_DV_BT_656_1120)
  232. return;
  233. htot = V4L2_DV_BT_FRAME_WIDTH(bt);
  234. vtot = V4L2_DV_BT_FRAME_HEIGHT(bt);
  235. if (prefix == NULL)
  236. prefix = "";
  237. pr_info("%s: %s%ux%u%s%u (%ux%u)\n", dev_prefix, prefix,
  238. bt->width, bt->height, bt->interlaced ? "i" : "p",
  239. (htot * vtot) > 0 ? ((u32)bt->pixelclock / (htot * vtot)) : 0,
  240. htot, vtot);
  241. if (!detailed)
  242. return;
  243. pr_info("%s: horizontal: fp = %u, %ssync = %u, bp = %u\n",
  244. dev_prefix, bt->hfrontporch,
  245. (bt->polarities & V4L2_DV_HSYNC_POS_POL) ? "+" : "-",
  246. bt->hsync, bt->hbackporch);
  247. pr_info("%s: vertical: fp = %u, %ssync = %u, bp = %u\n",
  248. dev_prefix, bt->vfrontporch,
  249. (bt->polarities & V4L2_DV_VSYNC_POS_POL) ? "+" : "-",
  250. bt->vsync, bt->vbackporch);
  251. pr_info("%s: pixelclock: %llu\n", dev_prefix, bt->pixelclock);
  252. pr_info("%s: flags (0x%x):%s%s%s%s\n", dev_prefix, bt->flags,
  253. (bt->flags & V4L2_DV_FL_REDUCED_BLANKING) ?
  254. " REDUCED_BLANKING" : "",
  255. (bt->flags & V4L2_DV_FL_CAN_REDUCE_FPS) ?
  256. " CAN_REDUCE_FPS" : "",
  257. (bt->flags & V4L2_DV_FL_REDUCED_FPS) ?
  258. " REDUCED_FPS" : "",
  259. (bt->flags & V4L2_DV_FL_HALF_LINE) ?
  260. " HALF_LINE" : "");
  261. pr_info("%s: standards (0x%x):%s%s%s%s\n", dev_prefix, bt->standards,
  262. (bt->standards & V4L2_DV_BT_STD_CEA861) ? " CEA" : "",
  263. (bt->standards & V4L2_DV_BT_STD_DMT) ? " DMT" : "",
  264. (bt->standards & V4L2_DV_BT_STD_CVT) ? " CVT" : "",
  265. (bt->standards & V4L2_DV_BT_STD_GTF) ? " GTF" : "");
  266. }
  267. EXPORT_SYMBOL_GPL(v4l2_print_dv_timings);
  268. /*
  269. * CVT defines
  270. * Based on Coordinated Video Timings Standard
  271. * version 1.1 September 10, 2003
  272. */
  273. #define CVT_PXL_CLK_GRAN 250000 /* pixel clock granularity */
  274. /* Normal blanking */
  275. #define CVT_MIN_V_BPORCH 7 /* lines */
  276. #define CVT_MIN_V_PORCH_RND 3 /* lines */
  277. #define CVT_MIN_VSYNC_BP 550 /* min time of vsync + back porch (us) */
  278. /* Normal blanking for CVT uses GTF to calculate horizontal blanking */
  279. #define CVT_CELL_GRAN 8 /* character cell granularity */
  280. #define CVT_M 600 /* blanking formula gradient */
  281. #define CVT_C 40 /* blanking formula offset */
  282. #define CVT_K 128 /* blanking formula scaling factor */
  283. #define CVT_J 20 /* blanking formula scaling factor */
  284. #define CVT_C_PRIME (((CVT_C - CVT_J) * CVT_K / 256) + CVT_J)
  285. #define CVT_M_PRIME (CVT_K * CVT_M / 256)
  286. /* Reduced Blanking */
  287. #define CVT_RB_MIN_V_BPORCH 7 /* lines */
  288. #define CVT_RB_V_FPORCH 3 /* lines */
  289. #define CVT_RB_MIN_V_BLANK 460 /* us */
  290. #define CVT_RB_H_SYNC 32 /* pixels */
  291. #define CVT_RB_H_BPORCH 80 /* pixels */
  292. #define CVT_RB_H_BLANK 160 /* pixels */
  293. /** v4l2_detect_cvt - detect if the given timings follow the CVT standard
  294. * @frame_height - the total height of the frame (including blanking) in lines.
  295. * @hfreq - the horizontal frequency in Hz.
  296. * @vsync - the height of the vertical sync in lines.
  297. * @polarities - the horizontal and vertical polarities (same as struct
  298. * v4l2_bt_timings polarities).
  299. * @fmt - the resulting timings.
  300. *
  301. * This function will attempt to detect if the given values correspond to a
  302. * valid CVT format. If so, then it will return true, and fmt will be filled
  303. * in with the found CVT timings.
  304. */
  305. bool v4l2_detect_cvt(unsigned frame_height, unsigned hfreq, unsigned vsync,
  306. u32 polarities, struct v4l2_dv_timings *fmt)
  307. {
  308. int v_fp, v_bp, h_fp, h_bp, hsync;
  309. int frame_width, image_height, image_width;
  310. bool reduced_blanking;
  311. unsigned pix_clk;
  312. if (vsync < 4 || vsync > 7)
  313. return false;
  314. if (polarities == V4L2_DV_VSYNC_POS_POL)
  315. reduced_blanking = false;
  316. else if (polarities == V4L2_DV_HSYNC_POS_POL)
  317. reduced_blanking = true;
  318. else
  319. return false;
  320. /* Vertical */
  321. if (reduced_blanking) {
  322. v_fp = CVT_RB_V_FPORCH;
  323. v_bp = (CVT_RB_MIN_V_BLANK * hfreq + 1999999) / 1000000;
  324. v_bp -= vsync + v_fp;
  325. if (v_bp < CVT_RB_MIN_V_BPORCH)
  326. v_bp = CVT_RB_MIN_V_BPORCH;
  327. } else {
  328. v_fp = CVT_MIN_V_PORCH_RND;
  329. v_bp = (CVT_MIN_VSYNC_BP * hfreq + 1999999) / 1000000 - vsync;
  330. if (v_bp < CVT_MIN_V_BPORCH)
  331. v_bp = CVT_MIN_V_BPORCH;
  332. }
  333. image_height = (frame_height - v_fp - vsync - v_bp + 1) & ~0x1;
  334. /* Aspect ratio based on vsync */
  335. switch (vsync) {
  336. case 4:
  337. image_width = (image_height * 4) / 3;
  338. break;
  339. case 5:
  340. image_width = (image_height * 16) / 9;
  341. break;
  342. case 6:
  343. image_width = (image_height * 16) / 10;
  344. break;
  345. case 7:
  346. /* special case */
  347. if (image_height == 1024)
  348. image_width = (image_height * 5) / 4;
  349. else if (image_height == 768)
  350. image_width = (image_height * 15) / 9;
  351. else
  352. return false;
  353. break;
  354. default:
  355. return false;
  356. }
  357. image_width = image_width & ~7;
  358. /* Horizontal */
  359. if (reduced_blanking) {
  360. pix_clk = (image_width + CVT_RB_H_BLANK) * hfreq;
  361. pix_clk = (pix_clk / CVT_PXL_CLK_GRAN) * CVT_PXL_CLK_GRAN;
  362. h_bp = CVT_RB_H_BPORCH;
  363. hsync = CVT_RB_H_SYNC;
  364. h_fp = CVT_RB_H_BLANK - h_bp - hsync;
  365. frame_width = image_width + CVT_RB_H_BLANK;
  366. } else {
  367. unsigned ideal_duty_cycle_per_myriad =
  368. 100 * CVT_C_PRIME - (CVT_M_PRIME * 100000) / hfreq;
  369. int h_blank;
  370. if (ideal_duty_cycle_per_myriad < 2000)
  371. ideal_duty_cycle_per_myriad = 2000;
  372. h_blank = image_width * ideal_duty_cycle_per_myriad /
  373. (10000 - ideal_duty_cycle_per_myriad);
  374. h_blank = (h_blank / (2 * CVT_CELL_GRAN)) * 2 * CVT_CELL_GRAN;
  375. pix_clk = (image_width + h_blank) * hfreq;
  376. pix_clk = (pix_clk / CVT_PXL_CLK_GRAN) * CVT_PXL_CLK_GRAN;
  377. h_bp = h_blank / 2;
  378. frame_width = image_width + h_blank;
  379. hsync = (frame_width * 8 + 50) / 100;
  380. hsync = hsync - hsync % CVT_CELL_GRAN;
  381. h_fp = h_blank - hsync - h_bp;
  382. }
  383. fmt->type = V4L2_DV_BT_656_1120;
  384. fmt->bt.polarities = polarities;
  385. fmt->bt.width = image_width;
  386. fmt->bt.height = image_height;
  387. fmt->bt.hfrontporch = h_fp;
  388. fmt->bt.vfrontporch = v_fp;
  389. fmt->bt.hsync = hsync;
  390. fmt->bt.vsync = vsync;
  391. fmt->bt.hbackporch = frame_width - image_width - h_fp - hsync;
  392. fmt->bt.vbackporch = frame_height - image_height - v_fp - vsync;
  393. fmt->bt.pixelclock = pix_clk;
  394. fmt->bt.standards = V4L2_DV_BT_STD_CVT;
  395. if (reduced_blanking)
  396. fmt->bt.flags |= V4L2_DV_FL_REDUCED_BLANKING;
  397. return true;
  398. }
  399. EXPORT_SYMBOL_GPL(v4l2_detect_cvt);
  400. /*
  401. * GTF defines
  402. * Based on Generalized Timing Formula Standard
  403. * Version 1.1 September 2, 1999
  404. */
  405. #define GTF_PXL_CLK_GRAN 250000 /* pixel clock granularity */
  406. #define GTF_MIN_VSYNC_BP 550 /* min time of vsync + back porch (us) */
  407. #define GTF_V_FP 1 /* vertical front porch (lines) */
  408. #define GTF_CELL_GRAN 8 /* character cell granularity */
  409. /* Default */
  410. #define GTF_D_M 600 /* blanking formula gradient */
  411. #define GTF_D_C 40 /* blanking formula offset */
  412. #define GTF_D_K 128 /* blanking formula scaling factor */
  413. #define GTF_D_J 20 /* blanking formula scaling factor */
  414. #define GTF_D_C_PRIME ((((GTF_D_C - GTF_D_J) * GTF_D_K) / 256) + GTF_D_J)
  415. #define GTF_D_M_PRIME ((GTF_D_K * GTF_D_M) / 256)
  416. /* Secondary */
  417. #define GTF_S_M 3600 /* blanking formula gradient */
  418. #define GTF_S_C 40 /* blanking formula offset */
  419. #define GTF_S_K 128 /* blanking formula scaling factor */
  420. #define GTF_S_J 35 /* blanking formula scaling factor */
  421. #define GTF_S_C_PRIME ((((GTF_S_C - GTF_S_J) * GTF_S_K) / 256) + GTF_S_J)
  422. #define GTF_S_M_PRIME ((GTF_S_K * GTF_S_M) / 256)
  423. /** v4l2_detect_gtf - detect if the given timings follow the GTF standard
  424. * @frame_height - the total height of the frame (including blanking) in lines.
  425. * @hfreq - the horizontal frequency in Hz.
  426. * @vsync - the height of the vertical sync in lines.
  427. * @polarities - the horizontal and vertical polarities (same as struct
  428. * v4l2_bt_timings polarities).
  429. * @aspect - preferred aspect ratio. GTF has no method of determining the
  430. * aspect ratio in order to derive the image width from the
  431. * image height, so it has to be passed explicitly. Usually
  432. * the native screen aspect ratio is used for this. If it
  433. * is not filled in correctly, then 16:9 will be assumed.
  434. * @fmt - the resulting timings.
  435. *
  436. * This function will attempt to detect if the given values correspond to a
  437. * valid GTF format. If so, then it will return true, and fmt will be filled
  438. * in with the found GTF timings.
  439. */
  440. bool v4l2_detect_gtf(unsigned frame_height,
  441. unsigned hfreq,
  442. unsigned vsync,
  443. u32 polarities,
  444. struct v4l2_fract aspect,
  445. struct v4l2_dv_timings *fmt)
  446. {
  447. int pix_clk;
  448. int v_fp, v_bp, h_fp, hsync;
  449. int frame_width, image_height, image_width;
  450. bool default_gtf;
  451. int h_blank;
  452. if (vsync != 3)
  453. return false;
  454. if (polarities == V4L2_DV_VSYNC_POS_POL)
  455. default_gtf = true;
  456. else if (polarities == V4L2_DV_HSYNC_POS_POL)
  457. default_gtf = false;
  458. else
  459. return false;
  460. /* Vertical */
  461. v_fp = GTF_V_FP;
  462. v_bp = (GTF_MIN_VSYNC_BP * hfreq + 999999) / 1000000 - vsync;
  463. image_height = (frame_height - v_fp - vsync - v_bp + 1) & ~0x1;
  464. if (aspect.numerator == 0 || aspect.denominator == 0) {
  465. aspect.numerator = 16;
  466. aspect.denominator = 9;
  467. }
  468. image_width = ((image_height * aspect.numerator) / aspect.denominator);
  469. /* Horizontal */
  470. if (default_gtf)
  471. h_blank = ((image_width * GTF_D_C_PRIME * hfreq) -
  472. (image_width * GTF_D_M_PRIME * 1000) +
  473. (hfreq * (100 - GTF_D_C_PRIME) + GTF_D_M_PRIME * 1000) / 2) /
  474. (hfreq * (100 - GTF_D_C_PRIME) + GTF_D_M_PRIME * 1000);
  475. else
  476. h_blank = ((image_width * GTF_S_C_PRIME * hfreq) -
  477. (image_width * GTF_S_M_PRIME * 1000) +
  478. (hfreq * (100 - GTF_S_C_PRIME) + GTF_S_M_PRIME * 1000) / 2) /
  479. (hfreq * (100 - GTF_S_C_PRIME) + GTF_S_M_PRIME * 1000);
  480. h_blank = h_blank - h_blank % (2 * GTF_CELL_GRAN);
  481. frame_width = image_width + h_blank;
  482. pix_clk = (image_width + h_blank) * hfreq;
  483. pix_clk = pix_clk / GTF_PXL_CLK_GRAN * GTF_PXL_CLK_GRAN;
  484. hsync = (frame_width * 8 + 50) / 100;
  485. hsync = hsync - hsync % GTF_CELL_GRAN;
  486. h_fp = h_blank / 2 - hsync;
  487. fmt->type = V4L2_DV_BT_656_1120;
  488. fmt->bt.polarities = polarities;
  489. fmt->bt.width = image_width;
  490. fmt->bt.height = image_height;
  491. fmt->bt.hfrontporch = h_fp;
  492. fmt->bt.vfrontporch = v_fp;
  493. fmt->bt.hsync = hsync;
  494. fmt->bt.vsync = vsync;
  495. fmt->bt.hbackporch = frame_width - image_width - h_fp - hsync;
  496. fmt->bt.vbackporch = frame_height - image_height - v_fp - vsync;
  497. fmt->bt.pixelclock = pix_clk;
  498. fmt->bt.standards = V4L2_DV_BT_STD_GTF;
  499. if (!default_gtf)
  500. fmt->bt.flags |= V4L2_DV_FL_REDUCED_BLANKING;
  501. return true;
  502. }
  503. EXPORT_SYMBOL_GPL(v4l2_detect_gtf);
  504. /** v4l2_calc_aspect_ratio - calculate the aspect ratio based on bytes
  505. * 0x15 and 0x16 from the EDID.
  506. * @hor_landscape - byte 0x15 from the EDID.
  507. * @vert_portrait - byte 0x16 from the EDID.
  508. *
  509. * Determines the aspect ratio from the EDID.
  510. * See VESA Enhanced EDID standard, release A, rev 2, section 3.6.2:
  511. * "Horizontal and Vertical Screen Size or Aspect Ratio"
  512. */
  513. struct v4l2_fract v4l2_calc_aspect_ratio(u8 hor_landscape, u8 vert_portrait)
  514. {
  515. struct v4l2_fract aspect = { 16, 9 };
  516. u32 tmp;
  517. u8 ratio;
  518. /* Nothing filled in, fallback to 16:9 */
  519. if (!hor_landscape && !vert_portrait)
  520. return aspect;
  521. /* Both filled in, so they are interpreted as the screen size in cm */
  522. if (hor_landscape && vert_portrait) {
  523. aspect.numerator = hor_landscape;
  524. aspect.denominator = vert_portrait;
  525. return aspect;
  526. }
  527. /* Only one is filled in, so interpret them as a ratio:
  528. (val + 99) / 100 */
  529. ratio = hor_landscape | vert_portrait;
  530. /* Change some rounded values into the exact aspect ratio */
  531. if (ratio == 79) {
  532. aspect.numerator = 16;
  533. aspect.denominator = 9;
  534. } else if (ratio == 34) {
  535. aspect.numerator = 4;
  536. aspect.numerator = 3;
  537. } else if (ratio == 68) {
  538. aspect.numerator = 15;
  539. aspect.numerator = 9;
  540. } else {
  541. aspect.numerator = hor_landscape + 99;
  542. aspect.denominator = 100;
  543. }
  544. if (hor_landscape)
  545. return aspect;
  546. /* The aspect ratio is for portrait, so swap numerator and denominator */
  547. tmp = aspect.denominator;
  548. aspect.denominator = aspect.numerator;
  549. aspect.numerator = tmp;
  550. return aspect;
  551. }
  552. EXPORT_SYMBOL_GPL(v4l2_calc_aspect_ratio);