v4l2-dv-timings.c 20 KB

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