drm_edid.c 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794
  1. /*
  2. * Copyright (c) 2006 Luc Verhaegen (quirks list)
  3. * Copyright (c) 2007-2008 Intel Corporation
  4. * Jesse Barnes <jesse.barnes@intel.com>
  5. *
  6. * DDC probing routines (drm_ddc_read & drm_do_probe_ddc_edid) originally from
  7. * FB layer.
  8. * Copyright (C) 2006 Dennis Munsie <dmunsie@cecropia.com>
  9. *
  10. * Permission is hereby granted, free of charge, to any person obtaining a
  11. * copy of this software and associated documentation files (the "Software"),
  12. * to deal in the Software without restriction, including without limitation
  13. * the rights to use, copy, modify, merge, publish, distribute, sub license,
  14. * and/or sell copies of the Software, and to permit persons to whom the
  15. * Software is furnished to do so, subject to the following conditions:
  16. *
  17. * The above copyright notice and this permission notice (including the
  18. * next paragraph) shall be included in all copies or substantial portions
  19. * of the Software.
  20. *
  21. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  22. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  23. * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
  24. * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  25. * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  26. * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
  27. * DEALINGS IN THE SOFTWARE.
  28. */
  29. #include <linux/kernel.h>
  30. #include <linux/i2c.h>
  31. #include <linux/i2c-algo-bit.h>
  32. #include "drmP.h"
  33. #include "drm_edid.h"
  34. /*
  35. * TODO:
  36. * - support EDID 1.4 (incl. CE blocks)
  37. */
  38. /*
  39. * EDID blocks out in the wild have a variety of bugs, try to collect
  40. * them here (note that userspace may work around broken monitors first,
  41. * but fixes should make their way here so that the kernel "just works"
  42. * on as many displays as possible).
  43. */
  44. /* First detailed mode wrong, use largest 60Hz mode */
  45. #define EDID_QUIRK_PREFER_LARGE_60 (1 << 0)
  46. /* Reported 135MHz pixel clock is too high, needs adjustment */
  47. #define EDID_QUIRK_135_CLOCK_TOO_HIGH (1 << 1)
  48. /* Prefer the largest mode at 75 Hz */
  49. #define EDID_QUIRK_PREFER_LARGE_75 (1 << 2)
  50. /* Detail timing is in cm not mm */
  51. #define EDID_QUIRK_DETAILED_IN_CM (1 << 3)
  52. /* Detailed timing descriptors have bogus size values, so just take the
  53. * maximum size and use that.
  54. */
  55. #define EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE (1 << 4)
  56. /* Monitor forgot to set the first detailed is preferred bit. */
  57. #define EDID_QUIRK_FIRST_DETAILED_PREFERRED (1 << 5)
  58. /* use +hsync +vsync for detailed mode */
  59. #define EDID_QUIRK_DETAILED_SYNC_PP (1 << 6)
  60. static struct edid_quirk {
  61. char *vendor;
  62. int product_id;
  63. u32 quirks;
  64. } edid_quirk_list[] = {
  65. /* Acer AL1706 */
  66. { "ACR", 44358, EDID_QUIRK_PREFER_LARGE_60 },
  67. /* Acer F51 */
  68. { "API", 0x7602, EDID_QUIRK_PREFER_LARGE_60 },
  69. /* Unknown Acer */
  70. { "ACR", 2423, EDID_QUIRK_FIRST_DETAILED_PREFERRED },
  71. /* Belinea 10 15 55 */
  72. { "MAX", 1516, EDID_QUIRK_PREFER_LARGE_60 },
  73. { "MAX", 0x77e, EDID_QUIRK_PREFER_LARGE_60 },
  74. /* Envision Peripherals, Inc. EN-7100e */
  75. { "EPI", 59264, EDID_QUIRK_135_CLOCK_TOO_HIGH },
  76. /* Funai Electronics PM36B */
  77. { "FCM", 13600, EDID_QUIRK_PREFER_LARGE_75 |
  78. EDID_QUIRK_DETAILED_IN_CM },
  79. /* LG Philips LCD LP154W01-A5 */
  80. { "LPL", 0, EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE },
  81. { "LPL", 0x2a00, EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE },
  82. /* Philips 107p5 CRT */
  83. { "PHL", 57364, EDID_QUIRK_FIRST_DETAILED_PREFERRED },
  84. /* Proview AY765C */
  85. { "PTS", 765, EDID_QUIRK_FIRST_DETAILED_PREFERRED },
  86. /* Samsung SyncMaster 205BW. Note: irony */
  87. { "SAM", 541, EDID_QUIRK_DETAILED_SYNC_PP },
  88. /* Samsung SyncMaster 22[5-6]BW */
  89. { "SAM", 596, EDID_QUIRK_PREFER_LARGE_60 },
  90. { "SAM", 638, EDID_QUIRK_PREFER_LARGE_60 },
  91. };
  92. /* Valid EDID header has these bytes */
  93. static u8 edid_header[] = { 0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00 };
  94. /**
  95. * edid_is_valid - sanity check EDID data
  96. * @edid: EDID data
  97. *
  98. * Sanity check the EDID block by looking at the header, the version number
  99. * and the checksum. Return 0 if the EDID doesn't check out, or 1 if it's
  100. * valid.
  101. */
  102. static bool edid_is_valid(struct edid *edid)
  103. {
  104. int i;
  105. u8 csum = 0;
  106. u8 *raw_edid = (u8 *)edid;
  107. if (memcmp(edid->header, edid_header, sizeof(edid_header)))
  108. goto bad;
  109. if (edid->version != 1) {
  110. DRM_ERROR("EDID has major version %d, instead of 1\n", edid->version);
  111. goto bad;
  112. }
  113. if (edid->revision > 4)
  114. DRM_DEBUG("EDID minor > 4, assuming backward compatibility\n");
  115. for (i = 0; i < EDID_LENGTH; i++)
  116. csum += raw_edid[i];
  117. if (csum) {
  118. DRM_ERROR("EDID checksum is invalid, remainder is %d\n", csum);
  119. goto bad;
  120. }
  121. return 1;
  122. bad:
  123. if (raw_edid) {
  124. DRM_ERROR("Raw EDID:\n");
  125. print_hex_dump_bytes(KERN_ERR, DUMP_PREFIX_NONE, raw_edid, EDID_LENGTH);
  126. printk("\n");
  127. }
  128. return 0;
  129. }
  130. /**
  131. * edid_vendor - match a string against EDID's obfuscated vendor field
  132. * @edid: EDID to match
  133. * @vendor: vendor string
  134. *
  135. * Returns true if @vendor is in @edid, false otherwise
  136. */
  137. static bool edid_vendor(struct edid *edid, char *vendor)
  138. {
  139. char edid_vendor[3];
  140. edid_vendor[0] = ((edid->mfg_id[0] & 0x7c) >> 2) + '@';
  141. edid_vendor[1] = (((edid->mfg_id[0] & 0x3) << 3) |
  142. ((edid->mfg_id[1] & 0xe0) >> 5)) + '@';
  143. edid_vendor[2] = (edid->mfg_id[1] & 0x1f) + '@';
  144. return !strncmp(edid_vendor, vendor, 3);
  145. }
  146. /**
  147. * edid_get_quirks - return quirk flags for a given EDID
  148. * @edid: EDID to process
  149. *
  150. * This tells subsequent routines what fixes they need to apply.
  151. */
  152. static u32 edid_get_quirks(struct edid *edid)
  153. {
  154. struct edid_quirk *quirk;
  155. int i;
  156. for (i = 0; i < ARRAY_SIZE(edid_quirk_list); i++) {
  157. quirk = &edid_quirk_list[i];
  158. if (edid_vendor(edid, quirk->vendor) &&
  159. (EDID_PRODUCT_ID(edid) == quirk->product_id))
  160. return quirk->quirks;
  161. }
  162. return 0;
  163. }
  164. #define MODE_SIZE(m) ((m)->hdisplay * (m)->vdisplay)
  165. #define MODE_REFRESH_DIFF(m,r) (abs((m)->vrefresh - target_refresh))
  166. /**
  167. * edid_fixup_preferred - set preferred modes based on quirk list
  168. * @connector: has mode list to fix up
  169. * @quirks: quirks list
  170. *
  171. * Walk the mode list for @connector, clearing the preferred status
  172. * on existing modes and setting it anew for the right mode ala @quirks.
  173. */
  174. static void edid_fixup_preferred(struct drm_connector *connector,
  175. u32 quirks)
  176. {
  177. struct drm_display_mode *t, *cur_mode, *preferred_mode;
  178. int target_refresh = 0;
  179. if (list_empty(&connector->probed_modes))
  180. return;
  181. if (quirks & EDID_QUIRK_PREFER_LARGE_60)
  182. target_refresh = 60;
  183. if (quirks & EDID_QUIRK_PREFER_LARGE_75)
  184. target_refresh = 75;
  185. preferred_mode = list_first_entry(&connector->probed_modes,
  186. struct drm_display_mode, head);
  187. list_for_each_entry_safe(cur_mode, t, &connector->probed_modes, head) {
  188. cur_mode->type &= ~DRM_MODE_TYPE_PREFERRED;
  189. if (cur_mode == preferred_mode)
  190. continue;
  191. /* Largest mode is preferred */
  192. if (MODE_SIZE(cur_mode) > MODE_SIZE(preferred_mode))
  193. preferred_mode = cur_mode;
  194. /* At a given size, try to get closest to target refresh */
  195. if ((MODE_SIZE(cur_mode) == MODE_SIZE(preferred_mode)) &&
  196. MODE_REFRESH_DIFF(cur_mode, target_refresh) <
  197. MODE_REFRESH_DIFF(preferred_mode, target_refresh)) {
  198. preferred_mode = cur_mode;
  199. }
  200. }
  201. preferred_mode->type |= DRM_MODE_TYPE_PREFERRED;
  202. }
  203. /**
  204. * drm_mode_std - convert standard mode info (width, height, refresh) into mode
  205. * @t: standard timing params
  206. *
  207. * Take the standard timing params (in this case width, aspect, and refresh)
  208. * and convert them into a real mode using CVT.
  209. *
  210. * Punts for now, but should eventually use the FB layer's CVT based mode
  211. * generation code.
  212. */
  213. struct drm_display_mode *drm_mode_std(struct drm_device *dev,
  214. struct std_timing *t)
  215. {
  216. struct drm_display_mode *mode;
  217. int hsize = t->hsize * 8 + 248, vsize;
  218. unsigned aspect_ratio = (t->vfreq_aspect & EDID_TIMING_ASPECT_MASK)
  219. >> EDID_TIMING_ASPECT_SHIFT;
  220. mode = drm_mode_create(dev);
  221. if (!mode)
  222. return NULL;
  223. if (aspect_ratio == 0)
  224. vsize = (hsize * 10) / 16;
  225. else if (aspect_ratio == 1)
  226. vsize = (hsize * 3) / 4;
  227. else if (aspect_ratio == 2)
  228. vsize = (hsize * 4) / 5;
  229. else
  230. vsize = (hsize * 9) / 16;
  231. drm_mode_set_name(mode);
  232. return mode;
  233. }
  234. /**
  235. * drm_mode_detailed - create a new mode from an EDID detailed timing section
  236. * @dev: DRM device (needed to create new mode)
  237. * @edid: EDID block
  238. * @timing: EDID detailed timing info
  239. * @quirks: quirks to apply
  240. *
  241. * An EDID detailed timing block contains enough info for us to create and
  242. * return a new struct drm_display_mode.
  243. */
  244. static struct drm_display_mode *drm_mode_detailed(struct drm_device *dev,
  245. struct edid *edid,
  246. struct detailed_timing *timing,
  247. u32 quirks)
  248. {
  249. struct drm_display_mode *mode;
  250. struct detailed_pixel_timing *pt = &timing->data.pixel_data;
  251. unsigned hactive = (pt->hactive_hblank_hi & 0xf0) << 4 | pt->hactive_lo;
  252. unsigned vactive = (pt->vactive_vblank_hi & 0xf0) << 4 | pt->vactive_lo;
  253. unsigned hblank = (pt->hactive_hblank_hi & 0xf) << 8 | pt->hblank_lo;
  254. unsigned vblank = (pt->vactive_vblank_hi & 0xf) << 8 | pt->vblank_lo;
  255. unsigned hsync_offset = (pt->hsync_vsync_offset_pulse_width_hi & 0xc0) << 2 | pt->hsync_offset_lo;
  256. unsigned hsync_pulse_width = (pt->hsync_vsync_offset_pulse_width_hi & 0x30) << 4 | pt->hsync_pulse_width_lo;
  257. unsigned vsync_offset = (pt->hsync_vsync_offset_pulse_width_hi & 0xc) >> 2 | pt->vsync_offset_pulse_width_lo >> 4;
  258. unsigned vsync_pulse_width = (pt->hsync_vsync_offset_pulse_width_hi & 0x3) << 4 | (pt->vsync_offset_pulse_width_lo & 0xf);
  259. /* ignore tiny modes */
  260. if (hactive < 64 || vactive < 64)
  261. return NULL;
  262. if (pt->misc & DRM_EDID_PT_STEREO) {
  263. printk(KERN_WARNING "stereo mode not supported\n");
  264. return NULL;
  265. }
  266. if (!(pt->misc & DRM_EDID_PT_SEPARATE_SYNC)) {
  267. printk(KERN_WARNING "integrated sync not supported\n");
  268. return NULL;
  269. }
  270. mode = drm_mode_create(dev);
  271. if (!mode)
  272. return NULL;
  273. mode->type = DRM_MODE_TYPE_DRIVER;
  274. if (quirks & EDID_QUIRK_135_CLOCK_TOO_HIGH)
  275. timing->pixel_clock = cpu_to_le16(1088);
  276. mode->clock = le16_to_cpu(timing->pixel_clock) * 10;
  277. mode->hdisplay = hactive;
  278. mode->hsync_start = mode->hdisplay + hsync_offset;
  279. mode->hsync_end = mode->hsync_start + hsync_pulse_width;
  280. mode->htotal = mode->hdisplay + hblank;
  281. mode->vdisplay = vactive;
  282. mode->vsync_start = mode->vdisplay + vsync_offset;
  283. mode->vsync_end = mode->vsync_start + vsync_pulse_width;
  284. mode->vtotal = mode->vdisplay + vblank;
  285. drm_mode_set_name(mode);
  286. if (pt->misc & DRM_EDID_PT_INTERLACED)
  287. mode->flags |= DRM_MODE_FLAG_INTERLACE;
  288. if (quirks & EDID_QUIRK_DETAILED_SYNC_PP) {
  289. pt->misc |= DRM_EDID_PT_HSYNC_POSITIVE | DRM_EDID_PT_VSYNC_POSITIVE;
  290. }
  291. mode->flags |= (pt->misc & DRM_EDID_PT_HSYNC_POSITIVE) ?
  292. DRM_MODE_FLAG_PHSYNC : DRM_MODE_FLAG_NHSYNC;
  293. mode->flags |= (pt->misc & DRM_EDID_PT_VSYNC_POSITIVE) ?
  294. DRM_MODE_FLAG_PVSYNC : DRM_MODE_FLAG_NVSYNC;
  295. mode->width_mm = pt->width_mm_lo | (pt->width_height_mm_hi & 0xf0) << 4;
  296. mode->height_mm = pt->height_mm_lo | (pt->width_height_mm_hi & 0xf) << 8;
  297. if (quirks & EDID_QUIRK_DETAILED_IN_CM) {
  298. mode->width_mm *= 10;
  299. mode->height_mm *= 10;
  300. }
  301. if (quirks & EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE) {
  302. mode->width_mm = edid->width_cm * 10;
  303. mode->height_mm = edid->height_cm * 10;
  304. }
  305. return mode;
  306. }
  307. /*
  308. * Detailed mode info for the EDID "established modes" data to use.
  309. */
  310. static struct drm_display_mode edid_est_modes[] = {
  311. { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 40000, 800, 840,
  312. 968, 1056, 0, 600, 601, 605, 628, 0,
  313. DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 800x600@60Hz */
  314. { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 36000, 800, 824,
  315. 896, 1024, 0, 600, 601, 603, 625, 0,
  316. DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 800x600@56Hz */
  317. { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 31500, 640, 656,
  318. 720, 840, 0, 480, 481, 484, 500, 0,
  319. DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 640x480@75Hz */
  320. { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 31500, 640, 664,
  321. 704, 832, 0, 480, 489, 491, 520, 0,
  322. DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 640x480@72Hz */
  323. { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 30240, 640, 704,
  324. 768, 864, 0, 480, 483, 486, 525, 0,
  325. DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 640x480@67Hz */
  326. { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 25200, 640, 656,
  327. 752, 800, 0, 480, 490, 492, 525, 0,
  328. DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 640x480@60Hz */
  329. { DRM_MODE("720x400", DRM_MODE_TYPE_DRIVER, 35500, 720, 738,
  330. 846, 900, 0, 400, 421, 423, 449, 0,
  331. DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 720x400@88Hz */
  332. { DRM_MODE("720x400", DRM_MODE_TYPE_DRIVER, 28320, 720, 738,
  333. 846, 900, 0, 400, 412, 414, 449, 0,
  334. DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 720x400@70Hz */
  335. { DRM_MODE("1280x1024", DRM_MODE_TYPE_DRIVER, 135000, 1280, 1296,
  336. 1440, 1688, 0, 1024, 1025, 1028, 1066, 0,
  337. DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 1280x1024@75Hz */
  338. { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 78800, 1024, 1040,
  339. 1136, 1312, 0, 768, 769, 772, 800, 0,
  340. DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 1024x768@75Hz */
  341. { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 75000, 1024, 1048,
  342. 1184, 1328, 0, 768, 771, 777, 806, 0,
  343. DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 1024x768@70Hz */
  344. { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 65000, 1024, 1048,
  345. 1184, 1344, 0, 768, 771, 777, 806, 0,
  346. DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 1024x768@60Hz */
  347. { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER,44900, 1024, 1032,
  348. 1208, 1264, 0, 768, 768, 776, 817, 0,
  349. DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC | DRM_MODE_FLAG_INTERLACE) }, /* 1024x768@43Hz */
  350. { DRM_MODE("832x624", DRM_MODE_TYPE_DRIVER, 57284, 832, 864,
  351. 928, 1152, 0, 624, 625, 628, 667, 0,
  352. DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 832x624@75Hz */
  353. { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 49500, 800, 816,
  354. 896, 1056, 0, 600, 601, 604, 625, 0,
  355. DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 800x600@75Hz */
  356. { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 50000, 800, 856,
  357. 976, 1040, 0, 600, 637, 643, 666, 0,
  358. DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 800x600@72Hz */
  359. { DRM_MODE("1152x864", DRM_MODE_TYPE_DRIVER, 108000, 1152, 1216,
  360. 1344, 1600, 0, 864, 865, 868, 900, 0,
  361. DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 1152x864@75Hz */
  362. };
  363. #define EDID_EST_TIMINGS 16
  364. #define EDID_STD_TIMINGS 8
  365. #define EDID_DETAILED_TIMINGS 4
  366. /**
  367. * add_established_modes - get est. modes from EDID and add them
  368. * @edid: EDID block to scan
  369. *
  370. * Each EDID block contains a bitmap of the supported "established modes" list
  371. * (defined above). Tease them out and add them to the global modes list.
  372. */
  373. static int add_established_modes(struct drm_connector *connector, struct edid *edid)
  374. {
  375. struct drm_device *dev = connector->dev;
  376. unsigned long est_bits = edid->established_timings.t1 |
  377. (edid->established_timings.t2 << 8) |
  378. ((edid->established_timings.mfg_rsvd & 0x80) << 9);
  379. int i, modes = 0;
  380. for (i = 0; i <= EDID_EST_TIMINGS; i++)
  381. if (est_bits & (1<<i)) {
  382. struct drm_display_mode *newmode;
  383. newmode = drm_mode_duplicate(dev, &edid_est_modes[i]);
  384. if (newmode) {
  385. drm_mode_probed_add(connector, newmode);
  386. modes++;
  387. }
  388. }
  389. return modes;
  390. }
  391. /**
  392. * add_standard_modes - get std. modes from EDID and add them
  393. * @edid: EDID block to scan
  394. *
  395. * Standard modes can be calculated using the CVT standard. Grab them from
  396. * @edid, calculate them, and add them to the list.
  397. */
  398. static int add_standard_modes(struct drm_connector *connector, struct edid *edid)
  399. {
  400. struct drm_device *dev = connector->dev;
  401. int i, modes = 0;
  402. for (i = 0; i < EDID_STD_TIMINGS; i++) {
  403. struct std_timing *t = &edid->standard_timings[i];
  404. struct drm_display_mode *newmode;
  405. /* If std timings bytes are 1, 1 it's empty */
  406. if (t->hsize == 1 && t->vfreq_aspect == 1)
  407. continue;
  408. newmode = drm_mode_std(dev, &edid->standard_timings[i]);
  409. if (newmode) {
  410. drm_mode_probed_add(connector, newmode);
  411. modes++;
  412. }
  413. }
  414. return modes;
  415. }
  416. /**
  417. * add_detailed_modes - get detailed mode info from EDID data
  418. * @connector: attached connector
  419. * @edid: EDID block to scan
  420. * @quirks: quirks to apply
  421. *
  422. * Some of the detailed timing sections may contain mode information. Grab
  423. * it and add it to the list.
  424. */
  425. static int add_detailed_info(struct drm_connector *connector,
  426. struct edid *edid, u32 quirks)
  427. {
  428. struct drm_device *dev = connector->dev;
  429. int i, j, modes = 0;
  430. for (i = 0; i < EDID_DETAILED_TIMINGS; i++) {
  431. struct detailed_timing *timing = &edid->detailed_timings[i];
  432. struct detailed_non_pixel *data = &timing->data.other_data;
  433. struct drm_display_mode *newmode;
  434. /* EDID up to and including 1.2 may put monitor info here */
  435. if (edid->version == 1 && edid->revision < 3)
  436. continue;
  437. /* Detailed mode timing */
  438. if (timing->pixel_clock) {
  439. newmode = drm_mode_detailed(dev, edid, timing, quirks);
  440. if (!newmode)
  441. continue;
  442. /* First detailed mode is preferred */
  443. if (i == 0 && (edid->features & DRM_EDID_FEATURE_PREFERRED_TIMING))
  444. newmode->type |= DRM_MODE_TYPE_PREFERRED;
  445. drm_mode_probed_add(connector, newmode);
  446. modes++;
  447. continue;
  448. }
  449. /* Other timing or info */
  450. switch (data->type) {
  451. case EDID_DETAIL_MONITOR_SERIAL:
  452. break;
  453. case EDID_DETAIL_MONITOR_STRING:
  454. break;
  455. case EDID_DETAIL_MONITOR_RANGE:
  456. /* Get monitor range data */
  457. break;
  458. case EDID_DETAIL_MONITOR_NAME:
  459. break;
  460. case EDID_DETAIL_MONITOR_CPDATA:
  461. break;
  462. case EDID_DETAIL_STD_MODES:
  463. /* Five modes per detailed section */
  464. for (j = 0; j < 5; i++) {
  465. struct std_timing *std;
  466. struct drm_display_mode *newmode;
  467. std = &data->data.timings[j];
  468. newmode = drm_mode_std(dev, std);
  469. if (newmode) {
  470. drm_mode_probed_add(connector, newmode);
  471. modes++;
  472. }
  473. }
  474. break;
  475. default:
  476. break;
  477. }
  478. }
  479. return modes;
  480. }
  481. #define DDC_ADDR 0x50
  482. /**
  483. * Get EDID information via I2C.
  484. *
  485. * \param adapter : i2c device adaptor
  486. * \param buf : EDID data buffer to be filled
  487. * \param len : EDID data buffer length
  488. * \return 0 on success or -1 on failure.
  489. *
  490. * Try to fetch EDID information by calling i2c driver function.
  491. */
  492. int drm_do_probe_ddc_edid(struct i2c_adapter *adapter,
  493. unsigned char *buf, int len)
  494. {
  495. unsigned char start = 0x0;
  496. struct i2c_msg msgs[] = {
  497. {
  498. .addr = DDC_ADDR,
  499. .flags = 0,
  500. .len = 1,
  501. .buf = &start,
  502. }, {
  503. .addr = DDC_ADDR,
  504. .flags = I2C_M_RD,
  505. .len = len,
  506. .buf = buf,
  507. }
  508. };
  509. if (i2c_transfer(adapter, msgs, 2) == 2)
  510. return 0;
  511. dev_info(&adapter->dev, "unable to read EDID block.\n");
  512. return -1;
  513. }
  514. EXPORT_SYMBOL(drm_do_probe_ddc_edid);
  515. static int drm_ddc_read_edid(struct drm_connector *connector,
  516. struct i2c_adapter *adapter,
  517. char *buf, int len)
  518. {
  519. int ret;
  520. ret = drm_do_probe_ddc_edid(adapter, buf, len);
  521. if (ret != 0) {
  522. dev_info(&connector->dev->pdev->dev, "%s: no EDID data\n",
  523. drm_get_connector_name(connector));
  524. goto end;
  525. }
  526. if (!edid_is_valid((struct edid *)buf)) {
  527. dev_warn(&connector->dev->pdev->dev, "%s: EDID invalid.\n",
  528. drm_get_connector_name(connector));
  529. ret = -1;
  530. }
  531. end:
  532. return ret;
  533. }
  534. #define MAX_EDID_EXT_NUM 4
  535. /**
  536. * drm_get_edid - get EDID data, if available
  537. * @connector: connector we're probing
  538. * @adapter: i2c adapter to use for DDC
  539. *
  540. * Poke the given connector's i2c channel to grab EDID data if possible.
  541. *
  542. * Return edid data or NULL if we couldn't find any.
  543. */
  544. struct edid *drm_get_edid(struct drm_connector *connector,
  545. struct i2c_adapter *adapter)
  546. {
  547. int ret;
  548. struct edid *edid;
  549. edid = kmalloc(EDID_LENGTH * (MAX_EDID_EXT_NUM + 1),
  550. GFP_KERNEL);
  551. if (edid == NULL) {
  552. dev_warn(&connector->dev->pdev->dev,
  553. "Failed to allocate EDID\n");
  554. goto end;
  555. }
  556. /* Read first EDID block */
  557. ret = drm_ddc_read_edid(connector, adapter,
  558. (unsigned char *)edid, EDID_LENGTH);
  559. if (ret != 0)
  560. goto clean_up;
  561. /* There are EDID extensions to be read */
  562. if (edid->extensions != 0) {
  563. int edid_ext_num = edid->extensions;
  564. if (edid_ext_num > MAX_EDID_EXT_NUM) {
  565. dev_warn(&connector->dev->pdev->dev,
  566. "The number of extension(%d) is "
  567. "over max (%d), actually read number (%d)\n",
  568. edid_ext_num, MAX_EDID_EXT_NUM,
  569. MAX_EDID_EXT_NUM);
  570. /* Reset EDID extension number to be read */
  571. edid_ext_num = MAX_EDID_EXT_NUM;
  572. }
  573. /* Read EDID including extensions too */
  574. ret = drm_ddc_read_edid(connector, adapter, (char *)edid,
  575. EDID_LENGTH * (edid_ext_num + 1));
  576. if (ret != 0)
  577. goto clean_up;
  578. }
  579. connector->display_info.raw_edid = (char *)edid;
  580. goto end;
  581. clean_up:
  582. kfree(edid);
  583. edid = NULL;
  584. end:
  585. return edid;
  586. }
  587. EXPORT_SYMBOL(drm_get_edid);
  588. #define HDMI_IDENTIFIER 0x000C03
  589. #define VENDOR_BLOCK 0x03
  590. /**
  591. * drm_detect_hdmi_monitor - detect whether monitor is hdmi.
  592. * @edid: monitor EDID information
  593. *
  594. * Parse the CEA extension according to CEA-861-B.
  595. * Return true if HDMI, false if not or unknown.
  596. */
  597. bool drm_detect_hdmi_monitor(struct edid *edid)
  598. {
  599. char *edid_ext = NULL;
  600. int i, hdmi_id, edid_ext_num;
  601. int start_offset, end_offset;
  602. bool is_hdmi = false;
  603. /* No EDID or EDID extensions */
  604. if (edid == NULL || edid->extensions == 0)
  605. goto end;
  606. /* Chose real EDID extension number */
  607. edid_ext_num = edid->extensions > MAX_EDID_EXT_NUM ?
  608. MAX_EDID_EXT_NUM : edid->extensions;
  609. /* Find CEA extension */
  610. for (i = 0; i < edid_ext_num; i++) {
  611. edid_ext = (char *)edid + EDID_LENGTH * (i + 1);
  612. /* This block is CEA extension */
  613. if (edid_ext[0] == 0x02)
  614. break;
  615. }
  616. if (i == edid_ext_num)
  617. goto end;
  618. /* Data block offset in CEA extension block */
  619. start_offset = 4;
  620. end_offset = edid_ext[2];
  621. /*
  622. * Because HDMI identifier is in Vendor Specific Block,
  623. * search it from all data blocks of CEA extension.
  624. */
  625. for (i = start_offset; i < end_offset;
  626. /* Increased by data block len */
  627. i += ((edid_ext[i] & 0x1f) + 1)) {
  628. /* Find vendor specific block */
  629. if ((edid_ext[i] >> 5) == VENDOR_BLOCK) {
  630. hdmi_id = edid_ext[i + 1] | (edid_ext[i + 2] << 8) |
  631. edid_ext[i + 3] << 16;
  632. /* Find HDMI identifier */
  633. if (hdmi_id == HDMI_IDENTIFIER)
  634. is_hdmi = true;
  635. break;
  636. }
  637. }
  638. end:
  639. return is_hdmi;
  640. }
  641. EXPORT_SYMBOL(drm_detect_hdmi_monitor);
  642. /**
  643. * drm_add_edid_modes - add modes from EDID data, if available
  644. * @connector: connector we're probing
  645. * @edid: edid data
  646. *
  647. * Add the specified modes to the connector's mode list.
  648. *
  649. * Return number of modes added or 0 if we couldn't find any.
  650. */
  651. int drm_add_edid_modes(struct drm_connector *connector, struct edid *edid)
  652. {
  653. int num_modes = 0;
  654. u32 quirks;
  655. if (edid == NULL) {
  656. return 0;
  657. }
  658. if (!edid_is_valid(edid)) {
  659. dev_warn(&connector->dev->pdev->dev, "%s: EDID invalid.\n",
  660. drm_get_connector_name(connector));
  661. return 0;
  662. }
  663. quirks = edid_get_quirks(edid);
  664. num_modes += add_established_modes(connector, edid);
  665. num_modes += add_standard_modes(connector, edid);
  666. num_modes += add_detailed_info(connector, edid, quirks);
  667. if (quirks & (EDID_QUIRK_PREFER_LARGE_60 | EDID_QUIRK_PREFER_LARGE_75))
  668. edid_fixup_preferred(connector, quirks);
  669. connector->display_info.serration_vsync = (edid->input & DRM_EDID_INPUT_SERRATION_VSYNC) ? 1 : 0;
  670. connector->display_info.sync_on_green = (edid->input & DRM_EDID_INPUT_SYNC_ON_GREEN) ? 1 : 0;
  671. connector->display_info.composite_sync = (edid->input & DRM_EDID_INPUT_COMPOSITE_SYNC) ? 1 : 0;
  672. connector->display_info.separate_syncs = (edid->input & DRM_EDID_INPUT_SEPARATE_SYNCS) ? 1 : 0;
  673. connector->display_info.blank_to_black = (edid->input & DRM_EDID_INPUT_BLANK_TO_BLACK) ? 1 : 0;
  674. connector->display_info.video_level = (edid->input & DRM_EDID_INPUT_VIDEO_LEVEL) >> 5;
  675. connector->display_info.digital = (edid->input & DRM_EDID_INPUT_DIGITAL) ? 1 : 0;
  676. connector->display_info.width_mm = edid->width_cm * 10;
  677. connector->display_info.height_mm = edid->height_cm * 10;
  678. connector->display_info.gamma = edid->gamma;
  679. connector->display_info.gtf_supported = (edid->features & DRM_EDID_FEATURE_DEFAULT_GTF) ? 1 : 0;
  680. connector->display_info.standard_color = (edid->features & DRM_EDID_FEATURE_STANDARD_COLOR) ? 1 : 0;
  681. connector->display_info.display_type = (edid->features & DRM_EDID_FEATURE_DISPLAY_TYPE) >> 3;
  682. connector->display_info.active_off_supported = (edid->features & DRM_EDID_FEATURE_PM_ACTIVE_OFF) ? 1 : 0;
  683. connector->display_info.suspend_supported = (edid->features & DRM_EDID_FEATURE_PM_SUSPEND) ? 1 : 0;
  684. connector->display_info.standby_supported = (edid->features & DRM_EDID_FEATURE_PM_STANDBY) ? 1 : 0;
  685. connector->display_info.gamma = edid->gamma;
  686. return num_modes;
  687. }
  688. EXPORT_SYMBOL(drm_add_edid_modes);