Subversion Repositories Kolibri OS

Rev

Rev 6935 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. /*
  2.  * Copyright (c) 2006 Luc Verhaegen (quirks list)
  3.  * Copyright (c) 2007-2008 Intel Corporation
  4.  *   Jesse Barnes <jesse.barnes@intel.com>
  5.  * Copyright 2010 Red Hat, Inc.
  6.  *
  7.  * DDC probing routines (drm_ddc_read & drm_do_probe_ddc_edid) originally from
  8.  * FB layer.
  9.  *   Copyright (C) 2006 Dennis Munsie <dmunsie@cecropia.com>
  10.  *
  11.  * Permission is hereby granted, free of charge, to any person obtaining a
  12.  * copy of this software and associated documentation files (the "Software"),
  13.  * to deal in the Software without restriction, including without limitation
  14.  * the rights to use, copy, modify, merge, publish, distribute, sub license,
  15.  * and/or sell copies of the Software, and to permit persons to whom the
  16.  * Software is furnished to do so, subject to the following conditions:
  17.  *
  18.  * The above copyright notice and this permission notice (including the
  19.  * next paragraph) shall be included in all copies or substantial portions
  20.  * of the Software.
  21.  *
  22.  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  23.  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  24.  * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
  25.  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  26.  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  27.  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
  28.  * DEALINGS IN THE SOFTWARE.
  29.  */
  30. #include <linux/kernel.h>
  31. #include <linux/slab.h>
  32. #include <linux/hdmi.h>
  33. #include <linux/i2c.h>
  34. #include <linux/module.h>
  35. #include <drm/drmP.h>
  36. #include <drm/drm_edid.h>
  37. #include <drm/drm_displayid.h>
  38.  
  39. #define version_greater(edid, maj, min) \
  40.         (((edid)->version > (maj)) || \
  41.          ((edid)->version == (maj) && (edid)->revision > (min)))
  42.  
  43. #define EDID_EST_TIMINGS 16
  44. #define EDID_STD_TIMINGS 8
  45. #define EDID_DETAILED_TIMINGS 4
  46.  
  47. /*
  48.  * EDID blocks out in the wild have a variety of bugs, try to collect
  49.  * them here (note that userspace may work around broken monitors first,
  50.  * but fixes should make their way here so that the kernel "just works"
  51.  * on as many displays as possible).
  52.  */
  53.  
  54. /* First detailed mode wrong, use largest 60Hz mode */
  55. #define EDID_QUIRK_PREFER_LARGE_60              (1 << 0)
  56. /* Reported 135MHz pixel clock is too high, needs adjustment */
  57. #define EDID_QUIRK_135_CLOCK_TOO_HIGH           (1 << 1)
  58. /* Prefer the largest mode at 75 Hz */
  59. #define EDID_QUIRK_PREFER_LARGE_75              (1 << 2)
  60. /* Detail timing is in cm not mm */
  61. #define EDID_QUIRK_DETAILED_IN_CM               (1 << 3)
  62. /* Detailed timing descriptors have bogus size values, so just take the
  63.  * maximum size and use that.
  64.  */
  65. #define EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE    (1 << 4)
  66. /* Monitor forgot to set the first detailed is preferred bit. */
  67. #define EDID_QUIRK_FIRST_DETAILED_PREFERRED     (1 << 5)
  68. /* use +hsync +vsync for detailed mode */
  69. #define EDID_QUIRK_DETAILED_SYNC_PP             (1 << 6)
  70. /* Force reduced-blanking timings for detailed modes */
  71. #define EDID_QUIRK_FORCE_REDUCED_BLANKING       (1 << 7)
  72. /* Force 8bpc */
  73. #define EDID_QUIRK_FORCE_8BPC                   (1 << 8)
  74. /* Force 12bpc */
  75. #define EDID_QUIRK_FORCE_12BPC                  (1 << 9)
  76.  
  77. struct detailed_mode_closure {
  78.         struct drm_connector *connector;
  79.         struct edid *edid;
  80.         bool preferred;
  81.         u32 quirks;
  82.         int modes;
  83. };
  84.  
  85. #define LEVEL_DMT       0
  86. #define LEVEL_GTF       1
  87. #define LEVEL_GTF2      2
  88. #define LEVEL_CVT       3
  89.  
  90. static struct edid_quirk {
  91.         char vendor[4];
  92.         int product_id;
  93.         u32 quirks;
  94. } edid_quirk_list[] = {
  95.         /* Acer AL1706 */
  96.         { "ACR", 44358, EDID_QUIRK_PREFER_LARGE_60 },
  97.         /* Acer F51 */
  98.         { "API", 0x7602, EDID_QUIRK_PREFER_LARGE_60 },
  99.         /* Unknown Acer */
  100.         { "ACR", 2423, EDID_QUIRK_FIRST_DETAILED_PREFERRED },
  101.  
  102.         /* Belinea 10 15 55 */
  103.         { "MAX", 1516, EDID_QUIRK_PREFER_LARGE_60 },
  104.         { "MAX", 0x77e, EDID_QUIRK_PREFER_LARGE_60 },
  105.  
  106.         /* Envision Peripherals, Inc. EN-7100e */
  107.         { "EPI", 59264, EDID_QUIRK_135_CLOCK_TOO_HIGH },
  108.         /* Envision EN2028 */
  109.         { "EPI", 8232, EDID_QUIRK_PREFER_LARGE_60 },
  110.  
  111.         /* Funai Electronics PM36B */
  112.         { "FCM", 13600, EDID_QUIRK_PREFER_LARGE_75 |
  113.           EDID_QUIRK_DETAILED_IN_CM },
  114.  
  115.         /* LG Philips LCD LP154W01-A5 */
  116.         { "LPL", 0, EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE },
  117.         { "LPL", 0x2a00, EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE },
  118.  
  119.         /* Philips 107p5 CRT */
  120.         { "PHL", 57364, EDID_QUIRK_FIRST_DETAILED_PREFERRED },
  121.  
  122.         /* Proview AY765C */
  123.         { "PTS", 765, EDID_QUIRK_FIRST_DETAILED_PREFERRED },
  124.  
  125.         /* Samsung SyncMaster 205BW.  Note: irony */
  126.         { "SAM", 541, EDID_QUIRK_DETAILED_SYNC_PP },
  127.         /* Samsung SyncMaster 22[5-6]BW */
  128.         { "SAM", 596, EDID_QUIRK_PREFER_LARGE_60 },
  129.         { "SAM", 638, EDID_QUIRK_PREFER_LARGE_60 },
  130.  
  131.         /* Sony PVM-2541A does up to 12 bpc, but only reports max 8 bpc */
  132.         { "SNY", 0x2541, EDID_QUIRK_FORCE_12BPC },
  133.  
  134.         /* ViewSonic VA2026w */
  135.         { "VSC", 5020, EDID_QUIRK_FORCE_REDUCED_BLANKING },
  136.  
  137.         /* Medion MD 30217 PG */
  138.         { "MED", 0x7b8, EDID_QUIRK_PREFER_LARGE_75 },
  139.  
  140.         /* Panel in Samsung NP700G7A-S01PL notebook reports 6bpc */
  141.         { "SEC", 0xd033, EDID_QUIRK_FORCE_8BPC },
  142. };
  143.  
  144. /*
  145.  * Autogenerated from the DMT spec.
  146.  * This table is copied from xfree86/modes/xf86EdidModes.c.
  147.  */
  148. static const struct drm_display_mode drm_dmt_modes[] = {
  149.         /* 0x01 - 640x350@85Hz */
  150.         { DRM_MODE("640x350", DRM_MODE_TYPE_DRIVER, 31500, 640, 672,
  151.                    736, 832, 0, 350, 382, 385, 445, 0,
  152.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  153.         /* 0x02 - 640x400@85Hz */
  154.         { DRM_MODE("640x400", DRM_MODE_TYPE_DRIVER, 31500, 640, 672,
  155.                    736, 832, 0, 400, 401, 404, 445, 0,
  156.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  157.         /* 0x03 - 720x400@85Hz */
  158.         { DRM_MODE("720x400", DRM_MODE_TYPE_DRIVER, 35500, 720, 756,
  159.                    828, 936, 0, 400, 401, 404, 446, 0,
  160.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  161.         /* 0x04 - 640x480@60Hz */
  162.         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 25175, 640, 656,
  163.                    752, 800, 0, 480, 490, 492, 525, 0,
  164.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
  165.         /* 0x05 - 640x480@72Hz */
  166.         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 31500, 640, 664,
  167.                    704, 832, 0, 480, 489, 492, 520, 0,
  168.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
  169.         /* 0x06 - 640x480@75Hz */
  170.         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 31500, 640, 656,
  171.                    720, 840, 0, 480, 481, 484, 500, 0,
  172.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
  173.         /* 0x07 - 640x480@85Hz */
  174.         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 36000, 640, 696,
  175.                    752, 832, 0, 480, 481, 484, 509, 0,
  176.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
  177.         /* 0x08 - 800x600@56Hz */
  178.         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 36000, 800, 824,
  179.                    896, 1024, 0, 600, 601, 603, 625, 0,
  180.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  181.         /* 0x09 - 800x600@60Hz */
  182.         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 40000, 800, 840,
  183.                    968, 1056, 0, 600, 601, 605, 628, 0,
  184.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  185.         /* 0x0a - 800x600@72Hz */
  186.         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 50000, 800, 856,
  187.                    976, 1040, 0, 600, 637, 643, 666, 0,
  188.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  189.         /* 0x0b - 800x600@75Hz */
  190.         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 49500, 800, 816,
  191.                    896, 1056, 0, 600, 601, 604, 625, 0,
  192.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  193.         /* 0x0c - 800x600@85Hz */
  194.         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 56250, 800, 832,
  195.                    896, 1048, 0, 600, 601, 604, 631, 0,
  196.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  197.         /* 0x0d - 800x600@120Hz RB */
  198.         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 73250, 800, 848,
  199.                    880, 960, 0, 600, 603, 607, 636, 0,
  200.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  201.         /* 0x0e - 848x480@60Hz */
  202.         { DRM_MODE("848x480", DRM_MODE_TYPE_DRIVER, 33750, 848, 864,
  203.                    976, 1088, 0, 480, 486, 494, 517, 0,
  204.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  205.         /* 0x0f - 1024x768@43Hz, interlace */
  206.         { DRM_MODE("1024x768i", DRM_MODE_TYPE_DRIVER, 44900, 1024, 1032,
  207.                    1208, 1264, 0, 768, 768, 772, 817, 0,
  208.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
  209.                    DRM_MODE_FLAG_INTERLACE) },
  210.         /* 0x10 - 1024x768@60Hz */
  211.         { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 65000, 1024, 1048,
  212.                    1184, 1344, 0, 768, 771, 777, 806, 0,
  213.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
  214.         /* 0x11 - 1024x768@70Hz */
  215.         { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 75000, 1024, 1048,
  216.                    1184, 1328, 0, 768, 771, 777, 806, 0,
  217.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
  218.         /* 0x12 - 1024x768@75Hz */
  219.         { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 78750, 1024, 1040,
  220.                    1136, 1312, 0, 768, 769, 772, 800, 0,
  221.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  222.         /* 0x13 - 1024x768@85Hz */
  223.         { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 94500, 1024, 1072,
  224.                    1168, 1376, 0, 768, 769, 772, 808, 0,
  225.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  226.         /* 0x14 - 1024x768@120Hz RB */
  227.         { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 115500, 1024, 1072,
  228.                    1104, 1184, 0, 768, 771, 775, 813, 0,
  229.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  230.         /* 0x15 - 1152x864@75Hz */
  231.         { DRM_MODE("1152x864", DRM_MODE_TYPE_DRIVER, 108000, 1152, 1216,
  232.                    1344, 1600, 0, 864, 865, 868, 900, 0,
  233.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  234.         /* 0x55 - 1280x720@60Hz */
  235.         { DRM_MODE("1280x720", DRM_MODE_TYPE_DRIVER, 74250, 1280, 1390,
  236.                    1430, 1650, 0, 720, 725, 730, 750, 0,
  237.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  238.         /* 0x16 - 1280x768@60Hz RB */
  239.         { DRM_MODE("1280x768", DRM_MODE_TYPE_DRIVER, 68250, 1280, 1328,
  240.                    1360, 1440, 0, 768, 771, 778, 790, 0,
  241.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  242.         /* 0x17 - 1280x768@60Hz */
  243.         { DRM_MODE("1280x768", DRM_MODE_TYPE_DRIVER, 79500, 1280, 1344,
  244.                    1472, 1664, 0, 768, 771, 778, 798, 0,
  245.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  246.         /* 0x18 - 1280x768@75Hz */
  247.         { DRM_MODE("1280x768", DRM_MODE_TYPE_DRIVER, 102250, 1280, 1360,
  248.                    1488, 1696, 0, 768, 771, 778, 805, 0,
  249.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  250.         /* 0x19 - 1280x768@85Hz */
  251.         { DRM_MODE("1280x768", DRM_MODE_TYPE_DRIVER, 117500, 1280, 1360,
  252.                    1496, 1712, 0, 768, 771, 778, 809, 0,
  253.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  254.         /* 0x1a - 1280x768@120Hz RB */
  255.         { DRM_MODE("1280x768", DRM_MODE_TYPE_DRIVER, 140250, 1280, 1328,
  256.                    1360, 1440, 0, 768, 771, 778, 813, 0,
  257.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  258.         /* 0x1b - 1280x800@60Hz RB */
  259.         { DRM_MODE("1280x800", DRM_MODE_TYPE_DRIVER, 71000, 1280, 1328,
  260.                    1360, 1440, 0, 800, 803, 809, 823, 0,
  261.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  262.         /* 0x1c - 1280x800@60Hz */
  263.         { DRM_MODE("1280x800", DRM_MODE_TYPE_DRIVER, 83500, 1280, 1352,
  264.                    1480, 1680, 0, 800, 803, 809, 831, 0,
  265.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  266.         /* 0x1d - 1280x800@75Hz */
  267.         { DRM_MODE("1280x800", DRM_MODE_TYPE_DRIVER, 106500, 1280, 1360,
  268.                    1488, 1696, 0, 800, 803, 809, 838, 0,
  269.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  270.         /* 0x1e - 1280x800@85Hz */
  271.         { DRM_MODE("1280x800", DRM_MODE_TYPE_DRIVER, 122500, 1280, 1360,
  272.                    1496, 1712, 0, 800, 803, 809, 843, 0,
  273.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  274.         /* 0x1f - 1280x800@120Hz RB */
  275.         { DRM_MODE("1280x800", DRM_MODE_TYPE_DRIVER, 146250, 1280, 1328,
  276.                    1360, 1440, 0, 800, 803, 809, 847, 0,
  277.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  278.         /* 0x20 - 1280x960@60Hz */
  279.         { DRM_MODE("1280x960", DRM_MODE_TYPE_DRIVER, 108000, 1280, 1376,
  280.                    1488, 1800, 0, 960, 961, 964, 1000, 0,
  281.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  282.         /* 0x21 - 1280x960@85Hz */
  283.         { DRM_MODE("1280x960", DRM_MODE_TYPE_DRIVER, 148500, 1280, 1344,
  284.                    1504, 1728, 0, 960, 961, 964, 1011, 0,
  285.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  286.         /* 0x22 - 1280x960@120Hz RB */
  287.         { DRM_MODE("1280x960", DRM_MODE_TYPE_DRIVER, 175500, 1280, 1328,
  288.                    1360, 1440, 0, 960, 963, 967, 1017, 0,
  289.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  290.         /* 0x23 - 1280x1024@60Hz */
  291.         { DRM_MODE("1280x1024", DRM_MODE_TYPE_DRIVER, 108000, 1280, 1328,
  292.                    1440, 1688, 0, 1024, 1025, 1028, 1066, 0,
  293.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  294.         /* 0x24 - 1280x1024@75Hz */
  295.         { DRM_MODE("1280x1024", DRM_MODE_TYPE_DRIVER, 135000, 1280, 1296,
  296.                    1440, 1688, 0, 1024, 1025, 1028, 1066, 0,
  297.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  298.         /* 0x25 - 1280x1024@85Hz */
  299.         { DRM_MODE("1280x1024", DRM_MODE_TYPE_DRIVER, 157500, 1280, 1344,
  300.                    1504, 1728, 0, 1024, 1025, 1028, 1072, 0,
  301.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  302.         /* 0x26 - 1280x1024@120Hz RB */
  303.         { DRM_MODE("1280x1024", DRM_MODE_TYPE_DRIVER, 187250, 1280, 1328,
  304.                    1360, 1440, 0, 1024, 1027, 1034, 1084, 0,
  305.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  306.         /* 0x27 - 1360x768@60Hz */
  307.         { DRM_MODE("1360x768", DRM_MODE_TYPE_DRIVER, 85500, 1360, 1424,
  308.                    1536, 1792, 0, 768, 771, 777, 795, 0,
  309.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  310.         /* 0x28 - 1360x768@120Hz RB */
  311.         { DRM_MODE("1360x768", DRM_MODE_TYPE_DRIVER, 148250, 1360, 1408,
  312.                    1440, 1520, 0, 768, 771, 776, 813, 0,
  313.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  314.         /* 0x51 - 1366x768@60Hz */
  315.         { DRM_MODE("1366x768", DRM_MODE_TYPE_DRIVER, 85500, 1366, 1436,
  316.                    1579, 1792, 0, 768, 771, 774, 798, 0,
  317.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  318.         /* 0x56 - 1366x768@60Hz */
  319.         { DRM_MODE("1366x768", DRM_MODE_TYPE_DRIVER, 72000, 1366, 1380,
  320.                    1436, 1500, 0, 768, 769, 772, 800, 0,
  321.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  322.         /* 0x29 - 1400x1050@60Hz RB */
  323.         { DRM_MODE("1400x1050", DRM_MODE_TYPE_DRIVER, 101000, 1400, 1448,
  324.                    1480, 1560, 0, 1050, 1053, 1057, 1080, 0,
  325.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  326.         /* 0x2a - 1400x1050@60Hz */
  327.         { DRM_MODE("1400x1050", DRM_MODE_TYPE_DRIVER, 121750, 1400, 1488,
  328.                    1632, 1864, 0, 1050, 1053, 1057, 1089, 0,
  329.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  330.         /* 0x2b - 1400x1050@75Hz */
  331.         { DRM_MODE("1400x1050", DRM_MODE_TYPE_DRIVER, 156000, 1400, 1504,
  332.                    1648, 1896, 0, 1050, 1053, 1057, 1099, 0,
  333.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  334.         /* 0x2c - 1400x1050@85Hz */
  335.         { DRM_MODE("1400x1050", DRM_MODE_TYPE_DRIVER, 179500, 1400, 1504,
  336.                    1656, 1912, 0, 1050, 1053, 1057, 1105, 0,
  337.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  338.         /* 0x2d - 1400x1050@120Hz RB */
  339.         { DRM_MODE("1400x1050", DRM_MODE_TYPE_DRIVER, 208000, 1400, 1448,
  340.                    1480, 1560, 0, 1050, 1053, 1057, 1112, 0,
  341.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  342.         /* 0x2e - 1440x900@60Hz RB */
  343.         { DRM_MODE("1440x900", DRM_MODE_TYPE_DRIVER, 88750, 1440, 1488,
  344.                    1520, 1600, 0, 900, 903, 909, 926, 0,
  345.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  346.         /* 0x2f - 1440x900@60Hz */
  347.         { DRM_MODE("1440x900", DRM_MODE_TYPE_DRIVER, 106500, 1440, 1520,
  348.                    1672, 1904, 0, 900, 903, 909, 934, 0,
  349.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  350.         /* 0x30 - 1440x900@75Hz */
  351.         { DRM_MODE("1440x900", DRM_MODE_TYPE_DRIVER, 136750, 1440, 1536,
  352.                    1688, 1936, 0, 900, 903, 909, 942, 0,
  353.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  354.         /* 0x31 - 1440x900@85Hz */
  355.         { DRM_MODE("1440x900", DRM_MODE_TYPE_DRIVER, 157000, 1440, 1544,
  356.                    1696, 1952, 0, 900, 903, 909, 948, 0,
  357.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  358.         /* 0x32 - 1440x900@120Hz RB */
  359.         { DRM_MODE("1440x900", DRM_MODE_TYPE_DRIVER, 182750, 1440, 1488,
  360.                    1520, 1600, 0, 900, 903, 909, 953, 0,
  361.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  362.         /* 0x53 - 1600x900@60Hz */
  363.         { DRM_MODE("1600x900", DRM_MODE_TYPE_DRIVER, 108000, 1600, 1624,
  364.                    1704, 1800, 0, 900, 901, 904, 1000, 0,
  365.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  366.         /* 0x33 - 1600x1200@60Hz */
  367.         { DRM_MODE("1600x1200", DRM_MODE_TYPE_DRIVER, 162000, 1600, 1664,
  368.                    1856, 2160, 0, 1200, 1201, 1204, 1250, 0,
  369.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  370.         /* 0x34 - 1600x1200@65Hz */
  371.         { DRM_MODE("1600x1200", DRM_MODE_TYPE_DRIVER, 175500, 1600, 1664,
  372.                    1856, 2160, 0, 1200, 1201, 1204, 1250, 0,
  373.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  374.         /* 0x35 - 1600x1200@70Hz */
  375.         { DRM_MODE("1600x1200", DRM_MODE_TYPE_DRIVER, 189000, 1600, 1664,
  376.                    1856, 2160, 0, 1200, 1201, 1204, 1250, 0,
  377.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  378.         /* 0x36 - 1600x1200@75Hz */
  379.         { DRM_MODE("1600x1200", DRM_MODE_TYPE_DRIVER, 202500, 1600, 1664,
  380.                    1856, 2160, 0, 1200, 1201, 1204, 1250, 0,
  381.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  382.         /* 0x37 - 1600x1200@85Hz */
  383.         { DRM_MODE("1600x1200", DRM_MODE_TYPE_DRIVER, 229500, 1600, 1664,
  384.                    1856, 2160, 0, 1200, 1201, 1204, 1250, 0,
  385.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  386.         /* 0x38 - 1600x1200@120Hz RB */
  387.         { DRM_MODE("1600x1200", DRM_MODE_TYPE_DRIVER, 268250, 1600, 1648,
  388.                    1680, 1760, 0, 1200, 1203, 1207, 1271, 0,
  389.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  390.         /* 0x39 - 1680x1050@60Hz RB */
  391.         { DRM_MODE("1680x1050", DRM_MODE_TYPE_DRIVER, 119000, 1680, 1728,
  392.                    1760, 1840, 0, 1050, 1053, 1059, 1080, 0,
  393.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  394.         /* 0x3a - 1680x1050@60Hz */
  395.         { DRM_MODE("1680x1050", DRM_MODE_TYPE_DRIVER, 146250, 1680, 1784,
  396.                    1960, 2240, 0, 1050, 1053, 1059, 1089, 0,
  397.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  398.         /* 0x3b - 1680x1050@75Hz */
  399.         { DRM_MODE("1680x1050", DRM_MODE_TYPE_DRIVER, 187000, 1680, 1800,
  400.                    1976, 2272, 0, 1050, 1053, 1059, 1099, 0,
  401.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  402.         /* 0x3c - 1680x1050@85Hz */
  403.         { DRM_MODE("1680x1050", DRM_MODE_TYPE_DRIVER, 214750, 1680, 1808,
  404.                    1984, 2288, 0, 1050, 1053, 1059, 1105, 0,
  405.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  406.         /* 0x3d - 1680x1050@120Hz RB */
  407.         { DRM_MODE("1680x1050", DRM_MODE_TYPE_DRIVER, 245500, 1680, 1728,
  408.                    1760, 1840, 0, 1050, 1053, 1059, 1112, 0,
  409.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  410.         /* 0x3e - 1792x1344@60Hz */
  411.         { DRM_MODE("1792x1344", DRM_MODE_TYPE_DRIVER, 204750, 1792, 1920,
  412.                    2120, 2448, 0, 1344, 1345, 1348, 1394, 0,
  413.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  414.         /* 0x3f - 1792x1344@75Hz */
  415.         { DRM_MODE("1792x1344", DRM_MODE_TYPE_DRIVER, 261000, 1792, 1888,
  416.                    2104, 2456, 0, 1344, 1345, 1348, 1417, 0,
  417.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  418.         /* 0x40 - 1792x1344@120Hz RB */
  419.         { DRM_MODE("1792x1344", DRM_MODE_TYPE_DRIVER, 333250, 1792, 1840,
  420.                    1872, 1952, 0, 1344, 1347, 1351, 1423, 0,
  421.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  422.         /* 0x41 - 1856x1392@60Hz */
  423.         { DRM_MODE("1856x1392", DRM_MODE_TYPE_DRIVER, 218250, 1856, 1952,
  424.                    2176, 2528, 0, 1392, 1393, 1396, 1439, 0,
  425.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  426.         /* 0x42 - 1856x1392@75Hz */
  427.         { DRM_MODE("1856x1392", DRM_MODE_TYPE_DRIVER, 288000, 1856, 1984,
  428.                    2208, 2560, 0, 1392, 1393, 1396, 1500, 0,
  429.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  430.         /* 0x43 - 1856x1392@120Hz RB */
  431.         { DRM_MODE("1856x1392", DRM_MODE_TYPE_DRIVER, 356500, 1856, 1904,
  432.                    1936, 2016, 0, 1392, 1395, 1399, 1474, 0,
  433.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  434.         /* 0x52 - 1920x1080@60Hz */
  435.         { DRM_MODE("1920x1080", DRM_MODE_TYPE_DRIVER, 148500, 1920, 2008,
  436.                    2052, 2200, 0, 1080, 1084, 1089, 1125, 0,
  437.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
  438.         /* 0x44 - 1920x1200@60Hz RB */
  439.         { DRM_MODE("1920x1200", DRM_MODE_TYPE_DRIVER, 154000, 1920, 1968,
  440.                    2000, 2080, 0, 1200, 1203, 1209, 1235, 0,
  441.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  442.         /* 0x45 - 1920x1200@60Hz */
  443.         { DRM_MODE("1920x1200", DRM_MODE_TYPE_DRIVER, 193250, 1920, 2056,
  444.                    2256, 2592, 0, 1200, 1203, 1209, 1245, 0,
  445.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  446.         /* 0x46 - 1920x1200@75Hz */
  447.         { DRM_MODE("1920x1200", DRM_MODE_TYPE_DRIVER, 245250, 1920, 2056,
  448.                    2264, 2608, 0, 1200, 1203, 1209, 1255, 0,
  449.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  450.         /* 0x47 - 1920x1200@85Hz */
  451.         { DRM_MODE("1920x1200", DRM_MODE_TYPE_DRIVER, 281250, 1920, 2064,
  452.                    2272, 2624, 0, 1200, 1203, 1209, 1262, 0,
  453.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  454.         /* 0x48 - 1920x1200@120Hz RB */
  455.         { DRM_MODE("1920x1200", DRM_MODE_TYPE_DRIVER, 317000, 1920, 1968,
  456.                    2000, 2080, 0, 1200, 1203, 1209, 1271, 0,
  457.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  458.         /* 0x49 - 1920x1440@60Hz */
  459.         { DRM_MODE("1920x1440", DRM_MODE_TYPE_DRIVER, 234000, 1920, 2048,
  460.                    2256, 2600, 0, 1440, 1441, 1444, 1500, 0,
  461.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  462.         /* 0x4a - 1920x1440@75Hz */
  463.         { DRM_MODE("1920x1440", DRM_MODE_TYPE_DRIVER, 297000, 1920, 2064,
  464.                    2288, 2640, 0, 1440, 1441, 1444, 1500, 0,
  465.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  466.         /* 0x4b - 1920x1440@120Hz RB */
  467.         { DRM_MODE("1920x1440", DRM_MODE_TYPE_DRIVER, 380500, 1920, 1968,
  468.                    2000, 2080, 0, 1440, 1443, 1447, 1525, 0,
  469.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  470.         /* 0x54 - 2048x1152@60Hz */
  471.         { DRM_MODE("2048x1152", DRM_MODE_TYPE_DRIVER, 162000, 2048, 2074,
  472.                    2154, 2250, 0, 1152, 1153, 1156, 1200, 0,
  473.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
  474.         /* 0x4c - 2560x1600@60Hz RB */
  475.         { DRM_MODE("2560x1600", DRM_MODE_TYPE_DRIVER, 268500, 2560, 2608,
  476.                    2640, 2720, 0, 1600, 1603, 1609, 1646, 0,
  477.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  478.         /* 0x4d - 2560x1600@60Hz */
  479.         { DRM_MODE("2560x1600", DRM_MODE_TYPE_DRIVER, 348500, 2560, 2752,
  480.                    3032, 3504, 0, 1600, 1603, 1609, 1658, 0,
  481.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  482.         /* 0x4e - 2560x1600@75Hz */
  483.         { DRM_MODE("2560x1600", DRM_MODE_TYPE_DRIVER, 443250, 2560, 2768,
  484.                    3048, 3536, 0, 1600, 1603, 1609, 1672, 0,
  485.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  486.         /* 0x4f - 2560x1600@85Hz */
  487.         { DRM_MODE("2560x1600", DRM_MODE_TYPE_DRIVER, 505250, 2560, 2768,
  488.                    3048, 3536, 0, 1600, 1603, 1609, 1682, 0,
  489.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
  490.         /* 0x50 - 2560x1600@120Hz RB */
  491.         { DRM_MODE("2560x1600", DRM_MODE_TYPE_DRIVER, 552750, 2560, 2608,
  492.                    2640, 2720, 0, 1600, 1603, 1609, 1694, 0,
  493.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  494.         /* 0x57 - 4096x2160@60Hz RB */
  495.         { DRM_MODE("4096x2160", DRM_MODE_TYPE_DRIVER, 556744, 4096, 4104,
  496.                    4136, 4176, 0, 2160, 2208, 2216, 2222, 0,
  497.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  498.         /* 0x58 - 4096x2160@59.94Hz RB */
  499.         { DRM_MODE("4096x2160", DRM_MODE_TYPE_DRIVER, 556188, 4096, 4104,
  500.                    4136, 4176, 0, 2160, 2208, 2216, 2222, 0,
  501.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
  502. };
  503.  
  504. /*
  505.  * These more or less come from the DMT spec.  The 720x400 modes are
  506.  * inferred from historical 80x25 practice.  The 640x480@67 and 832x624@75
  507.  * modes are old-school Mac modes.  The EDID spec says the 1152x864@75 mode
  508.  * should be 1152x870, again for the Mac, but instead we use the x864 DMT
  509.  * mode.
  510.  *
  511.  * The DMT modes have been fact-checked; the rest are mild guesses.
  512.  */
  513. static const struct drm_display_mode edid_est_modes[] = {
  514.         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 40000, 800, 840,
  515.                    968, 1056, 0, 600, 601, 605, 628, 0,
  516.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 800x600@60Hz */
  517.         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 36000, 800, 824,
  518.                    896, 1024, 0, 600, 601, 603,  625, 0,
  519.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 800x600@56Hz */
  520.         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 31500, 640, 656,
  521.                    720, 840, 0, 480, 481, 484, 500, 0,
  522.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 640x480@75Hz */
  523.         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 31500, 640, 664,
  524.                    704,  832, 0, 480, 489, 491, 520, 0,
  525.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 640x480@72Hz */
  526.         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 30240, 640, 704,
  527.                    768,  864, 0, 480, 483, 486, 525, 0,
  528.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 640x480@67Hz */
  529.         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 25200, 640, 656,
  530.                    752, 800, 0, 480, 490, 492, 525, 0,
  531.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 640x480@60Hz */
  532.         { DRM_MODE("720x400", DRM_MODE_TYPE_DRIVER, 35500, 720, 738,
  533.                    846, 900, 0, 400, 421, 423,  449, 0,
  534.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 720x400@88Hz */
  535.         { DRM_MODE("720x400", DRM_MODE_TYPE_DRIVER, 28320, 720, 738,
  536.                    846,  900, 0, 400, 412, 414, 449, 0,
  537.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 720x400@70Hz */
  538.         { DRM_MODE("1280x1024", DRM_MODE_TYPE_DRIVER, 135000, 1280, 1296,
  539.                    1440, 1688, 0, 1024, 1025, 1028, 1066, 0,
  540.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 1280x1024@75Hz */
  541.         { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 78800, 1024, 1040,
  542.                    1136, 1312, 0,  768, 769, 772, 800, 0,
  543.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 1024x768@75Hz */
  544.         { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 75000, 1024, 1048,
  545.                    1184, 1328, 0,  768, 771, 777, 806, 0,
  546.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 1024x768@70Hz */
  547.         { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 65000, 1024, 1048,
  548.                    1184, 1344, 0,  768, 771, 777, 806, 0,
  549.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 1024x768@60Hz */
  550.         { DRM_MODE("1024x768i", DRM_MODE_TYPE_DRIVER,44900, 1024, 1032,
  551.                    1208, 1264, 0, 768, 768, 776, 817, 0,
  552.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC | DRM_MODE_FLAG_INTERLACE) }, /* 1024x768@43Hz */
  553.         { DRM_MODE("832x624", DRM_MODE_TYPE_DRIVER, 57284, 832, 864,
  554.                    928, 1152, 0, 624, 625, 628, 667, 0,
  555.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 832x624@75Hz */
  556.         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 49500, 800, 816,
  557.                    896, 1056, 0, 600, 601, 604,  625, 0,
  558.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 800x600@75Hz */
  559.         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 50000, 800, 856,
  560.                    976, 1040, 0, 600, 637, 643, 666, 0,
  561.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 800x600@72Hz */
  562.         { DRM_MODE("1152x864", DRM_MODE_TYPE_DRIVER, 108000, 1152, 1216,
  563.                    1344, 1600, 0,  864, 865, 868, 900, 0,
  564.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 1152x864@75Hz */
  565. };
  566.  
  567. struct minimode {
  568.         short w;
  569.         short h;
  570.         short r;
  571.         short rb;
  572. };
  573.  
  574. static const struct minimode est3_modes[] = {
  575.         /* byte 6 */
  576.         { 640, 350, 85, 0 },
  577.         { 640, 400, 85, 0 },
  578.         { 720, 400, 85, 0 },
  579.         { 640, 480, 85, 0 },
  580.         { 848, 480, 60, 0 },
  581.         { 800, 600, 85, 0 },
  582.         { 1024, 768, 85, 0 },
  583.         { 1152, 864, 75, 0 },
  584.         /* byte 7 */
  585.         { 1280, 768, 60, 1 },
  586.         { 1280, 768, 60, 0 },
  587.         { 1280, 768, 75, 0 },
  588.         { 1280, 768, 85, 0 },
  589.         { 1280, 960, 60, 0 },
  590.         { 1280, 960, 85, 0 },
  591.         { 1280, 1024, 60, 0 },
  592.         { 1280, 1024, 85, 0 },
  593.         /* byte 8 */
  594.         { 1360, 768, 60, 0 },
  595.         { 1440, 900, 60, 1 },
  596.         { 1440, 900, 60, 0 },
  597.         { 1440, 900, 75, 0 },
  598.         { 1440, 900, 85, 0 },
  599.         { 1400, 1050, 60, 1 },
  600.         { 1400, 1050, 60, 0 },
  601.         { 1400, 1050, 75, 0 },
  602.         /* byte 9 */
  603.         { 1400, 1050, 85, 0 },
  604.         { 1680, 1050, 60, 1 },
  605.         { 1680, 1050, 60, 0 },
  606.         { 1680, 1050, 75, 0 },
  607.         { 1680, 1050, 85, 0 },
  608.         { 1600, 1200, 60, 0 },
  609.         { 1600, 1200, 65, 0 },
  610.         { 1600, 1200, 70, 0 },
  611.         /* byte 10 */
  612.         { 1600, 1200, 75, 0 },
  613.         { 1600, 1200, 85, 0 },
  614.         { 1792, 1344, 60, 0 },
  615.         { 1792, 1344, 75, 0 },
  616.         { 1856, 1392, 60, 0 },
  617.         { 1856, 1392, 75, 0 },
  618.         { 1920, 1200, 60, 1 },
  619.         { 1920, 1200, 60, 0 },
  620.         /* byte 11 */
  621.         { 1920, 1200, 75, 0 },
  622.         { 1920, 1200, 85, 0 },
  623.         { 1920, 1440, 60, 0 },
  624.         { 1920, 1440, 75, 0 },
  625. };
  626.  
  627. static const struct minimode extra_modes[] = {
  628.         { 1024, 576,  60, 0 },
  629.         { 1366, 768,  60, 0 },
  630.         { 1600, 900,  60, 0 },
  631.         { 1680, 945,  60, 0 },
  632.         { 1920, 1080, 60, 0 },
  633.         { 2048, 1152, 60, 0 },
  634.         { 2048, 1536, 60, 0 },
  635. };
  636.  
  637. /*
  638.  * Probably taken from CEA-861 spec.
  639.  * This table is converted from xorg's hw/xfree86/modes/xf86EdidModes.c.
  640.  *
  641.  * Index using the VIC.
  642.  */
  643. static const struct drm_display_mode edid_cea_modes[] = {
  644.         /* 0 - dummy, VICs start at 1 */
  645.         { },
  646.         /* 1 - 640x480@60Hz */
  647.         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 25175, 640, 656,
  648.                    752, 800, 0, 480, 490, 492, 525, 0,
  649.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  650.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  651.         /* 2 - 720x480@60Hz */
  652.         { DRM_MODE("720x480", DRM_MODE_TYPE_DRIVER, 27000, 720, 736,
  653.                    798, 858, 0, 480, 489, 495, 525, 0,
  654.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  655.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  656.         /* 3 - 720x480@60Hz */
  657.         { DRM_MODE("720x480", DRM_MODE_TYPE_DRIVER, 27000, 720, 736,
  658.                    798, 858, 0, 480, 489, 495, 525, 0,
  659.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  660.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  661.         /* 4 - 1280x720@60Hz */
  662.         { DRM_MODE("1280x720", DRM_MODE_TYPE_DRIVER, 74250, 1280, 1390,
  663.                    1430, 1650, 0, 720, 725, 730, 750, 0,
  664.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  665.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  666.         /* 5 - 1920x1080i@60Hz */
  667.         { DRM_MODE("1920x1080i", DRM_MODE_TYPE_DRIVER, 74250, 1920, 2008,
  668.                    2052, 2200, 0, 1080, 1084, 1094, 1125, 0,
  669.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
  670.                         DRM_MODE_FLAG_INTERLACE),
  671.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  672.         /* 6 - 720(1440)x480i@60Hz */
  673.         { DRM_MODE("720x480i", DRM_MODE_TYPE_DRIVER, 13500, 720, 739,
  674.                    801, 858, 0, 480, 488, 494, 525, 0,
  675.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  676.                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
  677.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  678.         /* 7 - 720(1440)x480i@60Hz */
  679.         { DRM_MODE("720x480i", DRM_MODE_TYPE_DRIVER, 13500, 720, 739,
  680.                    801, 858, 0, 480, 488, 494, 525, 0,
  681.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  682.                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
  683.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  684.         /* 8 - 720(1440)x240@60Hz */
  685.         { DRM_MODE("720x240", DRM_MODE_TYPE_DRIVER, 13500, 720, 739,
  686.                    801, 858, 0, 240, 244, 247, 262, 0,
  687.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  688.                         DRM_MODE_FLAG_DBLCLK),
  689.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  690.         /* 9 - 720(1440)x240@60Hz */
  691.         { DRM_MODE("720x240", DRM_MODE_TYPE_DRIVER, 13500, 720, 739,
  692.                    801, 858, 0, 240, 244, 247, 262, 0,
  693.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  694.                         DRM_MODE_FLAG_DBLCLK),
  695.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  696.         /* 10 - 2880x480i@60Hz */
  697.         { DRM_MODE("2880x480i", DRM_MODE_TYPE_DRIVER, 54000, 2880, 2956,
  698.                    3204, 3432, 0, 480, 488, 494, 525, 0,
  699.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  700.                         DRM_MODE_FLAG_INTERLACE),
  701.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  702.         /* 11 - 2880x480i@60Hz */
  703.         { DRM_MODE("2880x480i", DRM_MODE_TYPE_DRIVER, 54000, 2880, 2956,
  704.                    3204, 3432, 0, 480, 488, 494, 525, 0,
  705.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  706.                         DRM_MODE_FLAG_INTERLACE),
  707.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  708.         /* 12 - 2880x240@60Hz */
  709.         { DRM_MODE("2880x240", DRM_MODE_TYPE_DRIVER, 54000, 2880, 2956,
  710.                    3204, 3432, 0, 240, 244, 247, 262, 0,
  711.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  712.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  713.         /* 13 - 2880x240@60Hz */
  714.         { DRM_MODE("2880x240", DRM_MODE_TYPE_DRIVER, 54000, 2880, 2956,
  715.                    3204, 3432, 0, 240, 244, 247, 262, 0,
  716.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  717.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  718.         /* 14 - 1440x480@60Hz */
  719.         { DRM_MODE("1440x480", DRM_MODE_TYPE_DRIVER, 54000, 1440, 1472,
  720.                    1596, 1716, 0, 480, 489, 495, 525, 0,
  721.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  722.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  723.         /* 15 - 1440x480@60Hz */
  724.         { DRM_MODE("1440x480", DRM_MODE_TYPE_DRIVER, 54000, 1440, 1472,
  725.                    1596, 1716, 0, 480, 489, 495, 525, 0,
  726.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  727.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  728.         /* 16 - 1920x1080@60Hz */
  729.         { DRM_MODE("1920x1080", DRM_MODE_TYPE_DRIVER, 148500, 1920, 2008,
  730.                    2052, 2200, 0, 1080, 1084, 1089, 1125, 0,
  731.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  732.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  733.         /* 17 - 720x576@50Hz */
  734.         { DRM_MODE("720x576", DRM_MODE_TYPE_DRIVER, 27000, 720, 732,
  735.                    796, 864, 0, 576, 581, 586, 625, 0,
  736.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  737.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  738.         /* 18 - 720x576@50Hz */
  739.         { DRM_MODE("720x576", DRM_MODE_TYPE_DRIVER, 27000, 720, 732,
  740.                    796, 864, 0, 576, 581, 586, 625, 0,
  741.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  742.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  743.         /* 19 - 1280x720@50Hz */
  744.         { DRM_MODE("1280x720", DRM_MODE_TYPE_DRIVER, 74250, 1280, 1720,
  745.                    1760, 1980, 0, 720, 725, 730, 750, 0,
  746.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  747.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  748.         /* 20 - 1920x1080i@50Hz */
  749.         { DRM_MODE("1920x1080i", DRM_MODE_TYPE_DRIVER, 74250, 1920, 2448,
  750.                    2492, 2640, 0, 1080, 1084, 1094, 1125, 0,
  751.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
  752.                         DRM_MODE_FLAG_INTERLACE),
  753.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  754.         /* 21 - 720(1440)x576i@50Hz */
  755.         { DRM_MODE("720x576i", DRM_MODE_TYPE_DRIVER, 13500, 720, 732,
  756.                    795, 864, 0, 576, 580, 586, 625, 0,
  757.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  758.                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
  759.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  760.         /* 22 - 720(1440)x576i@50Hz */
  761.         { DRM_MODE("720x576i", DRM_MODE_TYPE_DRIVER, 13500, 720, 732,
  762.                    795, 864, 0, 576, 580, 586, 625, 0,
  763.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  764.                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
  765.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  766.         /* 23 - 720(1440)x288@50Hz */
  767.         { DRM_MODE("720x288", DRM_MODE_TYPE_DRIVER, 13500, 720, 732,
  768.                    795, 864, 0, 288, 290, 293, 312, 0,
  769.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  770.                         DRM_MODE_FLAG_DBLCLK),
  771.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  772.         /* 24 - 720(1440)x288@50Hz */
  773.         { DRM_MODE("720x288", DRM_MODE_TYPE_DRIVER, 13500, 720, 732,
  774.                    795, 864, 0, 288, 290, 293, 312, 0,
  775.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  776.                         DRM_MODE_FLAG_DBLCLK),
  777.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  778.         /* 25 - 2880x576i@50Hz */
  779.         { DRM_MODE("2880x576i", DRM_MODE_TYPE_DRIVER, 54000, 2880, 2928,
  780.                    3180, 3456, 0, 576, 580, 586, 625, 0,
  781.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  782.                         DRM_MODE_FLAG_INTERLACE),
  783.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  784.         /* 26 - 2880x576i@50Hz */
  785.         { DRM_MODE("2880x576i", DRM_MODE_TYPE_DRIVER, 54000, 2880, 2928,
  786.                    3180, 3456, 0, 576, 580, 586, 625, 0,
  787.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  788.                         DRM_MODE_FLAG_INTERLACE),
  789.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  790.         /* 27 - 2880x288@50Hz */
  791.         { DRM_MODE("2880x288", DRM_MODE_TYPE_DRIVER, 54000, 2880, 2928,
  792.                    3180, 3456, 0, 288, 290, 293, 312, 0,
  793.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  794.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  795.         /* 28 - 2880x288@50Hz */
  796.         { DRM_MODE("2880x288", DRM_MODE_TYPE_DRIVER, 54000, 2880, 2928,
  797.                    3180, 3456, 0, 288, 290, 293, 312, 0,
  798.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  799.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  800.         /* 29 - 1440x576@50Hz */
  801.         { DRM_MODE("1440x576", DRM_MODE_TYPE_DRIVER, 54000, 1440, 1464,
  802.                    1592, 1728, 0, 576, 581, 586, 625, 0,
  803.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  804.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  805.         /* 30 - 1440x576@50Hz */
  806.         { DRM_MODE("1440x576", DRM_MODE_TYPE_DRIVER, 54000, 1440, 1464,
  807.                    1592, 1728, 0, 576, 581, 586, 625, 0,
  808.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  809.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  810.         /* 31 - 1920x1080@50Hz */
  811.         { DRM_MODE("1920x1080", DRM_MODE_TYPE_DRIVER, 148500, 1920, 2448,
  812.                    2492, 2640, 0, 1080, 1084, 1089, 1125, 0,
  813.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  814.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  815.         /* 32 - 1920x1080@24Hz */
  816.         { DRM_MODE("1920x1080", DRM_MODE_TYPE_DRIVER, 74250, 1920, 2558,
  817.                    2602, 2750, 0, 1080, 1084, 1089, 1125, 0,
  818.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  819.           .vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  820.         /* 33 - 1920x1080@25Hz */
  821.         { DRM_MODE("1920x1080", DRM_MODE_TYPE_DRIVER, 74250, 1920, 2448,
  822.                    2492, 2640, 0, 1080, 1084, 1089, 1125, 0,
  823.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  824.           .vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  825.         /* 34 - 1920x1080@30Hz */
  826.         { DRM_MODE("1920x1080", DRM_MODE_TYPE_DRIVER, 74250, 1920, 2008,
  827.                    2052, 2200, 0, 1080, 1084, 1089, 1125, 0,
  828.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  829.           .vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  830.         /* 35 - 2880x480@60Hz */
  831.         { DRM_MODE("2880x480", DRM_MODE_TYPE_DRIVER, 108000, 2880, 2944,
  832.                    3192, 3432, 0, 480, 489, 495, 525, 0,
  833.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  834.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  835.         /* 36 - 2880x480@60Hz */
  836.         { DRM_MODE("2880x480", DRM_MODE_TYPE_DRIVER, 108000, 2880, 2944,
  837.                    3192, 3432, 0, 480, 489, 495, 525, 0,
  838.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  839.           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  840.         /* 37 - 2880x576@50Hz */
  841.         { DRM_MODE("2880x576", DRM_MODE_TYPE_DRIVER, 108000, 2880, 2928,
  842.                    3184, 3456, 0, 576, 581, 586, 625, 0,
  843.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  844.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  845.         /* 38 - 2880x576@50Hz */
  846.         { DRM_MODE("2880x576", DRM_MODE_TYPE_DRIVER, 108000, 2880, 2928,
  847.                    3184, 3456, 0, 576, 581, 586, 625, 0,
  848.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  849.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  850.         /* 39 - 1920x1080i@50Hz */
  851.         { DRM_MODE("1920x1080i", DRM_MODE_TYPE_DRIVER, 72000, 1920, 1952,
  852.                    2120, 2304, 0, 1080, 1126, 1136, 1250, 0,
  853.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC |
  854.                         DRM_MODE_FLAG_INTERLACE),
  855.           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  856.         /* 40 - 1920x1080i@100Hz */
  857.         { DRM_MODE("1920x1080i", DRM_MODE_TYPE_DRIVER, 148500, 1920, 2448,
  858.                    2492, 2640, 0, 1080, 1084, 1094, 1125, 0,
  859.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
  860.                         DRM_MODE_FLAG_INTERLACE),
  861.           .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  862.         /* 41 - 1280x720@100Hz */
  863.         { DRM_MODE("1280x720", DRM_MODE_TYPE_DRIVER, 148500, 1280, 1720,
  864.                    1760, 1980, 0, 720, 725, 730, 750, 0,
  865.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  866.           .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  867.         /* 42 - 720x576@100Hz */
  868.         { DRM_MODE("720x576", DRM_MODE_TYPE_DRIVER, 54000, 720, 732,
  869.                    796, 864, 0, 576, 581, 586, 625, 0,
  870.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  871.           .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  872.         /* 43 - 720x576@100Hz */
  873.         { DRM_MODE("720x576", DRM_MODE_TYPE_DRIVER, 54000, 720, 732,
  874.                    796, 864, 0, 576, 581, 586, 625, 0,
  875.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  876.           .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  877.         /* 44 - 720(1440)x576i@100Hz */
  878.         { DRM_MODE("720x576i", DRM_MODE_TYPE_DRIVER, 27000, 720, 732,
  879.                    795, 864, 0, 576, 580, 586, 625, 0,
  880.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  881.                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
  882.           .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  883.         /* 45 - 720(1440)x576i@100Hz */
  884.         { DRM_MODE("720x576i", DRM_MODE_TYPE_DRIVER, 27000, 720, 732,
  885.                    795, 864, 0, 576, 580, 586, 625, 0,
  886.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  887.                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
  888.           .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  889.         /* 46 - 1920x1080i@120Hz */
  890.         { DRM_MODE("1920x1080i", DRM_MODE_TYPE_DRIVER, 148500, 1920, 2008,
  891.                    2052, 2200, 0, 1080, 1084, 1094, 1125, 0,
  892.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
  893.                         DRM_MODE_FLAG_INTERLACE),
  894.           .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  895.         /* 47 - 1280x720@120Hz */
  896.         { DRM_MODE("1280x720", DRM_MODE_TYPE_DRIVER, 148500, 1280, 1390,
  897.                    1430, 1650, 0, 720, 725, 730, 750, 0,
  898.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  899.           .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  900.         /* 48 - 720x480@120Hz */
  901.         { DRM_MODE("720x480", DRM_MODE_TYPE_DRIVER, 54000, 720, 736,
  902.                    798, 858, 0, 480, 489, 495, 525, 0,
  903.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  904.           .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  905.         /* 49 - 720x480@120Hz */
  906.         { DRM_MODE("720x480", DRM_MODE_TYPE_DRIVER, 54000, 720, 736,
  907.                    798, 858, 0, 480, 489, 495, 525, 0,
  908.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  909.           .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  910.         /* 50 - 720(1440)x480i@120Hz */
  911.         { DRM_MODE("720x480i", DRM_MODE_TYPE_DRIVER, 27000, 720, 739,
  912.                    801, 858, 0, 480, 488, 494, 525, 0,
  913.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  914.                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
  915.           .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  916.         /* 51 - 720(1440)x480i@120Hz */
  917.         { DRM_MODE("720x480i", DRM_MODE_TYPE_DRIVER, 27000, 720, 739,
  918.                    801, 858, 0, 480, 488, 494, 525, 0,
  919.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  920.                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
  921.           .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  922.         /* 52 - 720x576@200Hz */
  923.         { DRM_MODE("720x576", DRM_MODE_TYPE_DRIVER, 108000, 720, 732,
  924.                    796, 864, 0, 576, 581, 586, 625, 0,
  925.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  926.           .vrefresh = 200, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  927.         /* 53 - 720x576@200Hz */
  928.         { DRM_MODE("720x576", DRM_MODE_TYPE_DRIVER, 108000, 720, 732,
  929.                    796, 864, 0, 576, 581, 586, 625, 0,
  930.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  931.           .vrefresh = 200, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  932.         /* 54 - 720(1440)x576i@200Hz */
  933.         { DRM_MODE("720x576i", DRM_MODE_TYPE_DRIVER, 54000, 720, 732,
  934.                    795, 864, 0, 576, 580, 586, 625, 0,
  935.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  936.                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
  937.           .vrefresh = 200, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  938.         /* 55 - 720(1440)x576i@200Hz */
  939.         { DRM_MODE("720x576i", DRM_MODE_TYPE_DRIVER, 54000, 720, 732,
  940.                    795, 864, 0, 576, 580, 586, 625, 0,
  941.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  942.                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
  943.           .vrefresh = 200, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  944.         /* 56 - 720x480@240Hz */
  945.         { DRM_MODE("720x480", DRM_MODE_TYPE_DRIVER, 108000, 720, 736,
  946.                    798, 858, 0, 480, 489, 495, 525, 0,
  947.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  948.           .vrefresh = 240, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  949.         /* 57 - 720x480@240Hz */
  950.         { DRM_MODE("720x480", DRM_MODE_TYPE_DRIVER, 108000, 720, 736,
  951.                    798, 858, 0, 480, 489, 495, 525, 0,
  952.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
  953.           .vrefresh = 240, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  954.         /* 58 - 720(1440)x480i@240 */
  955.         { DRM_MODE("720x480i", DRM_MODE_TYPE_DRIVER, 54000, 720, 739,
  956.                    801, 858, 0, 480, 488, 494, 525, 0,
  957.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  958.                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
  959.           .vrefresh = 240, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
  960.         /* 59 - 720(1440)x480i@240 */
  961.         { DRM_MODE("720x480i", DRM_MODE_TYPE_DRIVER, 54000, 720, 739,
  962.                    801, 858, 0, 480, 488, 494, 525, 0,
  963.                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
  964.                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
  965.           .vrefresh = 240, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  966.         /* 60 - 1280x720@24Hz */
  967.         { DRM_MODE("1280x720", DRM_MODE_TYPE_DRIVER, 59400, 1280, 3040,
  968.                    3080, 3300, 0, 720, 725, 730, 750, 0,
  969.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  970.           .vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  971.         /* 61 - 1280x720@25Hz */
  972.         { DRM_MODE("1280x720", DRM_MODE_TYPE_DRIVER, 74250, 1280, 3700,
  973.                    3740, 3960, 0, 720, 725, 730, 750, 0,
  974.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  975.           .vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  976.         /* 62 - 1280x720@30Hz */
  977.         { DRM_MODE("1280x720", DRM_MODE_TYPE_DRIVER, 74250, 1280, 3040,
  978.                    3080, 3300, 0, 720, 725, 730, 750, 0,
  979.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  980.           .vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  981.         /* 63 - 1920x1080@120Hz */
  982.         { DRM_MODE("1920x1080", DRM_MODE_TYPE_DRIVER, 297000, 1920, 2008,
  983.                    2052, 2200, 0, 1080, 1084, 1089, 1125, 0,
  984.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  985.          .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  986.         /* 64 - 1920x1080@100Hz */
  987.         { DRM_MODE("1920x1080", DRM_MODE_TYPE_DRIVER, 297000, 1920, 2448,
  988.                    2492, 2640, 0, 1080, 1084, 1094, 1125, 0,
  989.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  990.          .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
  991. };
  992.  
  993. /*
  994.  * HDMI 1.4 4k modes. Index using the VIC.
  995.  */
  996. static const struct drm_display_mode edid_4k_modes[] = {
  997.         /* 0 - dummy, VICs start at 1 */
  998.         { },
  999.         /* 1 - 3840x2160@30Hz */
  1000.         { DRM_MODE("3840x2160", DRM_MODE_TYPE_DRIVER, 297000,
  1001.                    3840, 4016, 4104, 4400, 0,
  1002.                    2160, 2168, 2178, 2250, 0,
  1003.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  1004.           .vrefresh = 30, },
  1005.         /* 2 - 3840x2160@25Hz */
  1006.         { DRM_MODE("3840x2160", DRM_MODE_TYPE_DRIVER, 297000,
  1007.                    3840, 4896, 4984, 5280, 0,
  1008.                    2160, 2168, 2178, 2250, 0,
  1009.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  1010.           .vrefresh = 25, },
  1011.         /* 3 - 3840x2160@24Hz */
  1012.         { DRM_MODE("3840x2160", DRM_MODE_TYPE_DRIVER, 297000,
  1013.                    3840, 5116, 5204, 5500, 0,
  1014.                    2160, 2168, 2178, 2250, 0,
  1015.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  1016.           .vrefresh = 24, },
  1017.         /* 4 - 4096x2160@24Hz (SMPTE) */
  1018.         { DRM_MODE("4096x2160", DRM_MODE_TYPE_DRIVER, 297000,
  1019.                    4096, 5116, 5204, 5500, 0,
  1020.                    2160, 2168, 2178, 2250, 0,
  1021.                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
  1022.           .vrefresh = 24, },
  1023. };
  1024.  
  1025. /*** DDC fetch and block validation ***/
  1026.  
  1027. static const u8 edid_header[] = {
  1028.         0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00
  1029. };
  1030.  
  1031. /**
  1032.  * drm_edid_header_is_valid - sanity check the header of the base EDID block
  1033.  * @raw_edid: pointer to raw base EDID block
  1034.  *
  1035.  * Sanity check the header of the base EDID block.
  1036.  *
  1037.  * Return: 8 if the header is perfect, down to 0 if it's totally wrong.
  1038.  */
  1039. int drm_edid_header_is_valid(const u8 *raw_edid)
  1040. {
  1041.         int i, score = 0;
  1042.  
  1043.         for (i = 0; i < sizeof(edid_header); i++)
  1044.                 if (raw_edid[i] == edid_header[i])
  1045.                         score++;
  1046.  
  1047.         return score;
  1048. }
  1049. EXPORT_SYMBOL(drm_edid_header_is_valid);
  1050.  
  1051. static int edid_fixup __read_mostly = 6;
  1052. module_param_named(edid_fixup, edid_fixup, int, 0400);
  1053. MODULE_PARM_DESC(edid_fixup,
  1054.                  "Minimum number of valid EDID header bytes (0-8, default 6)");
  1055.  
  1056. static void drm_get_displayid(struct drm_connector *connector,
  1057.                               struct edid *edid);
  1058.  
  1059. static int drm_edid_block_checksum(const u8 *raw_edid)
  1060. {
  1061.         int i;
  1062.         u8 csum = 0;
  1063.         for (i = 0; i < EDID_LENGTH; i++)
  1064.                 csum += raw_edid[i];
  1065.  
  1066.         return csum;
  1067. }
  1068.  
  1069. static bool drm_edid_is_zero(const u8 *in_edid, int length)
  1070. {
  1071.         if (memchr_inv(in_edid, 0, length))
  1072.                 return false;
  1073.  
  1074.         return true;
  1075. }
  1076.  
  1077. /**
  1078.  * drm_edid_block_valid - Sanity check the EDID block (base or extension)
  1079.  * @raw_edid: pointer to raw EDID block
  1080.  * @block: type of block to validate (0 for base, extension otherwise)
  1081.  * @print_bad_edid: if true, dump bad EDID blocks to the console
  1082.  * @edid_corrupt: if true, the header or checksum is invalid
  1083.  *
  1084.  * Validate a base or extension EDID block and optionally dump bad blocks to
  1085.  * the console.
  1086.  *
  1087.  * Return: True if the block is valid, false otherwise.
  1088.  */
  1089. bool drm_edid_block_valid(u8 *raw_edid, int block, bool print_bad_edid,
  1090.                           bool *edid_corrupt)
  1091. {
  1092.         u8 csum;
  1093.         struct edid *edid = (struct edid *)raw_edid;
  1094.  
  1095.         if (WARN_ON(!raw_edid))
  1096.                 return false;
  1097.  
  1098.         if (edid_fixup > 8 || edid_fixup < 0)
  1099.                 edid_fixup = 6;
  1100.  
  1101.         if (block == 0) {
  1102.                 int score = drm_edid_header_is_valid(raw_edid);
  1103.                 if (score == 8) {
  1104.                         if (edid_corrupt)
  1105.                                 *edid_corrupt = false;
  1106.                 } else if (score >= edid_fixup) {
  1107.                         /* Displayport Link CTS Core 1.2 rev1.1 test 4.2.2.6
  1108.                          * The corrupt flag needs to be set here otherwise, the
  1109.                          * fix-up code here will correct the problem, the
  1110.                          * checksum is correct and the test fails
  1111.                          */
  1112.                         if (edid_corrupt)
  1113.                                 *edid_corrupt = true;
  1114.                         DRM_DEBUG("Fixing EDID header, your hardware may be failing\n");
  1115.                         memcpy(raw_edid, edid_header, sizeof(edid_header));
  1116.                 } else {
  1117.                         if (edid_corrupt)
  1118.                                 *edid_corrupt = true;
  1119.                         goto bad;
  1120.                 }
  1121.         }
  1122.  
  1123.         csum = drm_edid_block_checksum(raw_edid);
  1124.         if (csum) {
  1125.                 if (print_bad_edid) {
  1126.                         DRM_ERROR("EDID checksum is invalid, remainder is %d\n", csum);
  1127.                 }
  1128.  
  1129.                 if (edid_corrupt)
  1130.                         *edid_corrupt = true;
  1131.  
  1132.                 /* allow CEA to slide through, switches mangle this */
  1133.                 if (raw_edid[0] != 0x02)
  1134.                         goto bad;
  1135.         }
  1136.  
  1137.         /* per-block-type checks */
  1138.         switch (raw_edid[0]) {
  1139.         case 0: /* base */
  1140.                 if (edid->version != 1) {
  1141.                         DRM_ERROR("EDID has major version %d, instead of 1\n", edid->version);
  1142.                         goto bad;
  1143.                 }
  1144.  
  1145.                 if (edid->revision > 4)
  1146.                         DRM_DEBUG("EDID minor > 4, assuming backward compatibility\n");
  1147.                 break;
  1148.  
  1149.         default:
  1150.                 break;
  1151.         }
  1152.  
  1153.         return true;
  1154.  
  1155. bad:
  1156.         if (print_bad_edid) {
  1157.                 if (drm_edid_is_zero(raw_edid, EDID_LENGTH)) {
  1158.                         printk(KERN_ERR "EDID block is all zeroes\n");
  1159.                 } else {
  1160.                         printk(KERN_ERR "Raw EDID:\n");
  1161.                         print_hex_dump(KERN_ERR, " \t", DUMP_PREFIX_NONE, 16, 1,
  1162.                                raw_edid, EDID_LENGTH, false);
  1163.                 }
  1164.         }
  1165.         return false;
  1166. }
  1167. EXPORT_SYMBOL(drm_edid_block_valid);
  1168.  
  1169. /**
  1170.  * drm_edid_is_valid - sanity check EDID data
  1171.  * @edid: EDID data
  1172.  *
  1173.  * Sanity-check an entire EDID record (including extensions)
  1174.  *
  1175.  * Return: True if the EDID data is valid, false otherwise.
  1176.  */
  1177. bool drm_edid_is_valid(struct edid *edid)
  1178. {
  1179.         int i;
  1180.         u8 *raw = (u8 *)edid;
  1181.  
  1182.         if (!edid)
  1183.                 return false;
  1184.  
  1185.         for (i = 0; i <= edid->extensions; i++)
  1186.                 if (!drm_edid_block_valid(raw + i * EDID_LENGTH, i, true, NULL))
  1187.                         return false;
  1188.  
  1189.         return true;
  1190. }
  1191. EXPORT_SYMBOL(drm_edid_is_valid);
  1192.  
  1193. #define DDC_SEGMENT_ADDR 0x30
  1194. /**
  1195.  * drm_do_probe_ddc_edid() - get EDID information via I2C
  1196.  * @data: I2C device adapter
  1197.  * @buf: EDID data buffer to be filled
  1198.  * @block: 128 byte EDID block to start fetching from
  1199.  * @len: EDID data buffer length to fetch
  1200.  *
  1201.  * Try to fetch EDID information by calling I2C driver functions.
  1202.  *
  1203.  * Return: 0 on success or -1 on failure.
  1204.  */
  1205. static int
  1206. drm_do_probe_ddc_edid(void *data, u8 *buf, unsigned int block, size_t len)
  1207. {
  1208.         struct i2c_adapter *adapter = data;
  1209.         unsigned char start = block * EDID_LENGTH;
  1210.         unsigned char segment = block >> 1;
  1211.         unsigned char xfers = segment ? 3 : 2;
  1212.         int ret, retries = 5;
  1213.  
  1214.         /*
  1215.          * The core I2C driver will automatically retry the transfer if the
  1216.          * adapter reports EAGAIN. However, we find that bit-banging transfers
  1217.          * are susceptible to errors under a heavily loaded machine and
  1218.          * generate spurious NAKs and timeouts. Retrying the transfer
  1219.          * of the individual block a few times seems to overcome this.
  1220.          */
  1221.         do {
  1222.                 struct i2c_msg msgs[] = {
  1223.                         {
  1224.                                 .addr   = DDC_SEGMENT_ADDR,
  1225.                                 .flags  = 0,
  1226.                                 .len    = 1,
  1227.                                 .buf    = &segment,
  1228.                         }, {
  1229.                                 .addr   = DDC_ADDR,
  1230.                                 .flags  = 0,
  1231.                                 .len    = 1,
  1232.                                 .buf    = &start,
  1233.                         }, {
  1234.                                 .addr   = DDC_ADDR,
  1235.                                 .flags  = I2C_M_RD,
  1236.                                 .len    = len,
  1237.                                 .buf    = buf,
  1238.                         }
  1239.                 };
  1240.  
  1241.                 /*
  1242.                  * Avoid sending the segment addr to not upset non-compliant
  1243.                  * DDC monitors.
  1244.                  */
  1245.                 ret = i2c_transfer(adapter, &msgs[3 - xfers], xfers);
  1246.  
  1247.                 if (ret == -ENXIO) {
  1248.                         DRM_DEBUG_KMS("drm: skipping non-existent adapter %s\n",
  1249.                                         adapter->name);
  1250.                         break;
  1251.                 }
  1252.         } while (ret != xfers && --retries);
  1253.  
  1254.         return ret == xfers ? 0 : -1;
  1255. }
  1256.  
  1257. /**
  1258.  * drm_do_get_edid - get EDID data using a custom EDID block read function
  1259.  * @connector: connector we're probing
  1260.  * @get_edid_block: EDID block read function
  1261.  * @data: private data passed to the block read function
  1262.  *
  1263.  * When the I2C adapter connected to the DDC bus is hidden behind a device that
  1264.  * exposes a different interface to read EDID blocks this function can be used
  1265.  * to get EDID data using a custom block read function.
  1266.  *
  1267.  * As in the general case the DDC bus is accessible by the kernel at the I2C
  1268.  * level, drivers must make all reasonable efforts to expose it as an I2C
  1269.  * adapter and use drm_get_edid() instead of abusing this function.
  1270.  *
  1271.  * Return: Pointer to valid EDID or NULL if we couldn't find any.
  1272.  */
  1273. struct edid *drm_do_get_edid(struct drm_connector *connector,
  1274.         int (*get_edid_block)(void *data, u8 *buf, unsigned int block,
  1275.                               size_t len),
  1276.         void *data)
  1277. {
  1278.         int i, j = 0, valid_extensions = 0;
  1279.         u8 *block, *new;
  1280.         bool print_bad_edid = !connector->bad_edid_counter || (drm_debug & DRM_UT_KMS);
  1281.  
  1282.         if ((block = kmalloc(EDID_LENGTH, GFP_KERNEL)) == NULL)
  1283.                 return NULL;
  1284.  
  1285.         /* base block fetch */
  1286.         for (i = 0; i < 4; i++) {
  1287.                 if (get_edid_block(data, block, 0, EDID_LENGTH))
  1288.                         goto out;
  1289.                 if (drm_edid_block_valid(block, 0, print_bad_edid,
  1290.                                          &connector->edid_corrupt))
  1291.                         break;
  1292.                 if (i == 0 && drm_edid_is_zero(block, EDID_LENGTH)) {
  1293.                         connector->null_edid_counter++;
  1294.                         goto carp;
  1295.                 }
  1296.         }
  1297.         if (i == 4)
  1298.                 goto carp;
  1299.  
  1300.         /* if there's no extensions, we're done */
  1301.         if (block[0x7e] == 0)
  1302.                 return (struct edid *)block;
  1303.  
  1304.         new = krealloc(block, (block[0x7e] + 1) * EDID_LENGTH, GFP_KERNEL);
  1305.         if (!new)
  1306.                 goto out;
  1307.         block = new;
  1308.  
  1309.         for (j = 1; j <= block[0x7e]; j++) {
  1310.                 for (i = 0; i < 4; i++) {
  1311.                         if (get_edid_block(data,
  1312.                                   block + (valid_extensions + 1) * EDID_LENGTH,
  1313.                                   j, EDID_LENGTH))
  1314.                                 goto out;
  1315.                         if (drm_edid_block_valid(block + (valid_extensions + 1)
  1316.                                                  * EDID_LENGTH, j,
  1317.                                                  print_bad_edid,
  1318.                                                  NULL)) {
  1319.                                 valid_extensions++;
  1320.                                 break;
  1321.                         }
  1322.                 }
  1323.  
  1324.                 if (i == 4 && print_bad_edid) {
  1325.                         dev_warn(connector->dev->dev,
  1326.                          "%s: Ignoring invalid EDID block %d.\n",
  1327.                          connector->name, j);
  1328.  
  1329.                         connector->bad_edid_counter++;
  1330.                 }
  1331.         }
  1332.  
  1333.         if (valid_extensions != block[0x7e]) {
  1334.                 block[EDID_LENGTH-1] += block[0x7e] - valid_extensions;
  1335.                 block[0x7e] = valid_extensions;
  1336.                 new = krealloc(block, (valid_extensions + 1) * EDID_LENGTH, GFP_KERNEL);
  1337.                 if (!new)
  1338.                         goto out;
  1339.                 block = new;
  1340.         }
  1341.  
  1342.         return (struct edid *)block;
  1343.  
  1344. carp:
  1345.         if (print_bad_edid) {
  1346.                 dev_warn(connector->dev->dev, "%s: EDID block %d invalid.\n",
  1347.                          connector->name, j);
  1348.         }
  1349.         connector->bad_edid_counter++;
  1350.  
  1351. out:
  1352.         kfree(block);
  1353.         return NULL;
  1354. }
  1355. EXPORT_SYMBOL_GPL(drm_do_get_edid);
  1356.  
  1357. /**
  1358.  * drm_probe_ddc() - probe DDC presence
  1359.  * @adapter: I2C adapter to probe
  1360.  *
  1361.  * Return: True on success, false on failure.
  1362.  */
  1363. bool
  1364. drm_probe_ddc(struct i2c_adapter *adapter)
  1365. {
  1366.         unsigned char out;
  1367.  
  1368.         return (drm_do_probe_ddc_edid(adapter, &out, 0, 1) == 0);
  1369. }
  1370. EXPORT_SYMBOL(drm_probe_ddc);
  1371.  
  1372. /**
  1373.  * drm_get_edid - get EDID data, if available
  1374.  * @connector: connector we're probing
  1375.  * @adapter: I2C adapter to use for DDC
  1376.  *
  1377.  * Poke the given I2C channel to grab EDID data if possible.  If found,
  1378.  * attach it to the connector.
  1379.  *
  1380.  * Return: Pointer to valid EDID or NULL if we couldn't find any.
  1381.  */
  1382. struct edid *drm_get_edid(struct drm_connector *connector,
  1383.                           struct i2c_adapter *adapter)
  1384. {
  1385.         struct edid *edid;
  1386.  
  1387.         if (!drm_probe_ddc(adapter))
  1388.                 return NULL;
  1389.  
  1390.         edid = drm_do_get_edid(connector, drm_do_probe_ddc_edid, adapter);
  1391.         if (edid)
  1392.                 drm_get_displayid(connector, edid);
  1393.         return edid;
  1394. }
  1395. EXPORT_SYMBOL(drm_get_edid);
  1396.  
  1397. /**
  1398.  * drm_edid_duplicate - duplicate an EDID and the extensions
  1399.  * @edid: EDID to duplicate
  1400.  *
  1401.  * Return: Pointer to duplicated EDID or NULL on allocation failure.
  1402.  */
  1403. struct edid *drm_edid_duplicate(const struct edid *edid)
  1404. {
  1405.         return kmemdup(edid, (edid->extensions + 1) * EDID_LENGTH, GFP_KERNEL);
  1406. }
  1407. EXPORT_SYMBOL(drm_edid_duplicate);
  1408.  
  1409. /*** EDID parsing ***/
  1410.  
  1411. /**
  1412.  * edid_vendor - match a string against EDID's obfuscated vendor field
  1413.  * @edid: EDID to match
  1414.  * @vendor: vendor string
  1415.  *
  1416.  * Returns true if @vendor is in @edid, false otherwise
  1417.  */
  1418. static bool edid_vendor(struct edid *edid, char *vendor)
  1419. {
  1420.         char edid_vendor[3];
  1421.  
  1422.         edid_vendor[0] = ((edid->mfg_id[0] & 0x7c) >> 2) + '@';
  1423.         edid_vendor[1] = (((edid->mfg_id[0] & 0x3) << 3) |
  1424.                           ((edid->mfg_id[1] & 0xe0) >> 5)) + '@';
  1425.         edid_vendor[2] = (edid->mfg_id[1] & 0x1f) + '@';
  1426.  
  1427.         return !strncmp(edid_vendor, vendor, 3);
  1428. }
  1429.  
  1430. /**
  1431.  * edid_get_quirks - return quirk flags for a given EDID
  1432.  * @edid: EDID to process
  1433.  *
  1434.  * This tells subsequent routines what fixes they need to apply.
  1435.  */
  1436. static u32 edid_get_quirks(struct edid *edid)
  1437. {
  1438.         struct edid_quirk *quirk;
  1439.         int i;
  1440.  
  1441.         for (i = 0; i < ARRAY_SIZE(edid_quirk_list); i++) {
  1442.                 quirk = &edid_quirk_list[i];
  1443.  
  1444.                 if (edid_vendor(edid, quirk->vendor) &&
  1445.                     (EDID_PRODUCT_ID(edid) == quirk->product_id))
  1446.                         return quirk->quirks;
  1447.         }
  1448.  
  1449.         return 0;
  1450. }
  1451.  
  1452. #define MODE_SIZE(m) ((m)->hdisplay * (m)->vdisplay)
  1453. #define MODE_REFRESH_DIFF(c,t) (abs((c) - (t)))
  1454.  
  1455. /**
  1456.  * edid_fixup_preferred - set preferred modes based on quirk list
  1457.  * @connector: has mode list to fix up
  1458.  * @quirks: quirks list
  1459.  *
  1460.  * Walk the mode list for @connector, clearing the preferred status
  1461.  * on existing modes and setting it anew for the right mode ala @quirks.
  1462.  */
  1463. static void edid_fixup_preferred(struct drm_connector *connector,
  1464.                                  u32 quirks)
  1465. {
  1466.         struct drm_display_mode *t, *cur_mode, *preferred_mode;
  1467.         int target_refresh = 0;
  1468.         int cur_vrefresh, preferred_vrefresh;
  1469.  
  1470.         if (list_empty(&connector->probed_modes))
  1471.                 return;
  1472.  
  1473.         if (quirks & EDID_QUIRK_PREFER_LARGE_60)
  1474.                 target_refresh = 60;
  1475.         if (quirks & EDID_QUIRK_PREFER_LARGE_75)
  1476.                 target_refresh = 75;
  1477.  
  1478.         preferred_mode = list_first_entry(&connector->probed_modes,
  1479.                                           struct drm_display_mode, head);
  1480.  
  1481.         list_for_each_entry_safe(cur_mode, t, &connector->probed_modes, head) {
  1482.                 cur_mode->type &= ~DRM_MODE_TYPE_PREFERRED;
  1483.  
  1484.                 if (cur_mode == preferred_mode)
  1485.                         continue;
  1486.  
  1487.                 /* Largest mode is preferred */
  1488.                 if (MODE_SIZE(cur_mode) > MODE_SIZE(preferred_mode))
  1489.                         preferred_mode = cur_mode;
  1490.  
  1491.                 cur_vrefresh = cur_mode->vrefresh ?
  1492.                         cur_mode->vrefresh : drm_mode_vrefresh(cur_mode);
  1493.                 preferred_vrefresh = preferred_mode->vrefresh ?
  1494.                         preferred_mode->vrefresh : drm_mode_vrefresh(preferred_mode);
  1495.                 /* At a given size, try to get closest to target refresh */
  1496.                 if ((MODE_SIZE(cur_mode) == MODE_SIZE(preferred_mode)) &&
  1497.                     MODE_REFRESH_DIFF(cur_vrefresh, target_refresh) <
  1498.                     MODE_REFRESH_DIFF(preferred_vrefresh, target_refresh)) {
  1499.                         preferred_mode = cur_mode;
  1500.                 }
  1501.         }
  1502.  
  1503.         preferred_mode->type |= DRM_MODE_TYPE_PREFERRED;
  1504. }
  1505.  
  1506. static bool
  1507. mode_is_rb(const struct drm_display_mode *mode)
  1508. {
  1509.         return (mode->htotal - mode->hdisplay == 160) &&
  1510.                (mode->hsync_end - mode->hdisplay == 80) &&
  1511.                (mode->hsync_end - mode->hsync_start == 32) &&
  1512.                (mode->vsync_start - mode->vdisplay == 3);
  1513. }
  1514.  
  1515. /*
  1516.  * drm_mode_find_dmt - Create a copy of a mode if present in DMT
  1517.  * @dev: Device to duplicate against
  1518.  * @hsize: Mode width
  1519.  * @vsize: Mode height
  1520.  * @fresh: Mode refresh rate
  1521.  * @rb: Mode reduced-blanking-ness
  1522.  *
  1523.  * Walk the DMT mode list looking for a match for the given parameters.
  1524.  *
  1525.  * Return: A newly allocated copy of the mode, or NULL if not found.
  1526.  */
  1527. struct drm_display_mode *drm_mode_find_dmt(struct drm_device *dev,
  1528.                                            int hsize, int vsize, int fresh,
  1529.                                            bool rb)
  1530. {
  1531.         int i;
  1532.  
  1533.         for (i = 0; i < ARRAY_SIZE(drm_dmt_modes); i++) {
  1534.                 const struct drm_display_mode *ptr = &drm_dmt_modes[i];
  1535.                 if (hsize != ptr->hdisplay)
  1536.                         continue;
  1537.                 if (vsize != ptr->vdisplay)
  1538.                         continue;
  1539.                 if (fresh != drm_mode_vrefresh(ptr))
  1540.                         continue;
  1541.                 if (rb != mode_is_rb(ptr))
  1542.                         continue;
  1543.  
  1544.                 return drm_mode_duplicate(dev, ptr);
  1545.         }
  1546.  
  1547.         return NULL;
  1548. }
  1549. EXPORT_SYMBOL(drm_mode_find_dmt);
  1550.  
  1551. typedef void detailed_cb(struct detailed_timing *timing, void *closure);
  1552.  
  1553. static void
  1554. cea_for_each_detailed_block(u8 *ext, detailed_cb *cb, void *closure)
  1555. {
  1556.         int i, n = 0;
  1557.         u8 d = ext[0x02];
  1558.         u8 *det_base = ext + d;
  1559.  
  1560.         n = (127 - d) / 18;
  1561.         for (i = 0; i < n; i++)
  1562.                 cb((struct detailed_timing *)(det_base + 18 * i), closure);
  1563. }
  1564.  
  1565. static void
  1566. vtb_for_each_detailed_block(u8 *ext, detailed_cb *cb, void *closure)
  1567. {
  1568.         unsigned int i, n = min((int)ext[0x02], 6);
  1569.         u8 *det_base = ext + 5;
  1570.  
  1571.         if (ext[0x01] != 1)
  1572.                 return; /* unknown version */
  1573.  
  1574.         for (i = 0; i < n; i++)
  1575.                 cb((struct detailed_timing *)(det_base + 18 * i), closure);
  1576. }
  1577.  
  1578. static void
  1579. drm_for_each_detailed_block(u8 *raw_edid, detailed_cb *cb, void *closure)
  1580. {
  1581.         int i;
  1582.         struct edid *edid = (struct edid *)raw_edid;
  1583.  
  1584.         if (edid == NULL)
  1585.                 return;
  1586.  
  1587.         for (i = 0; i < EDID_DETAILED_TIMINGS; i++)
  1588.                 cb(&(edid->detailed_timings[i]), closure);
  1589.  
  1590.         for (i = 1; i <= raw_edid[0x7e]; i++) {
  1591.                 u8 *ext = raw_edid + (i * EDID_LENGTH);
  1592.                 switch (*ext) {
  1593.                 case CEA_EXT:
  1594.                         cea_for_each_detailed_block(ext, cb, closure);
  1595.                         break;
  1596.                 case VTB_EXT:
  1597.                         vtb_for_each_detailed_block(ext, cb, closure);
  1598.                         break;
  1599.                 default:
  1600.                         break;
  1601.                 }
  1602.         }
  1603. }
  1604.  
  1605. static void
  1606. is_rb(struct detailed_timing *t, void *data)
  1607. {
  1608.         u8 *r = (u8 *)t;
  1609.         if (r[3] == EDID_DETAIL_MONITOR_RANGE)
  1610.                 if (r[15] & 0x10)
  1611.                         *(bool *)data = true;
  1612. }
  1613.  
  1614. /* EDID 1.4 defines this explicitly.  For EDID 1.3, we guess, badly. */
  1615. static bool
  1616. drm_monitor_supports_rb(struct edid *edid)
  1617. {
  1618.         if (edid->revision >= 4) {
  1619.                 bool ret = false;
  1620.                 drm_for_each_detailed_block((u8 *)edid, is_rb, &ret);
  1621.                 return ret;
  1622.         }
  1623.  
  1624.         return ((edid->input & DRM_EDID_INPUT_DIGITAL) != 0);
  1625. }
  1626.  
  1627. static void
  1628. find_gtf2(struct detailed_timing *t, void *data)
  1629. {
  1630.         u8 *r = (u8 *)t;
  1631.         if (r[3] == EDID_DETAIL_MONITOR_RANGE && r[10] == 0x02)
  1632.                 *(u8 **)data = r;
  1633. }
  1634.  
  1635. /* Secondary GTF curve kicks in above some break frequency */
  1636. static int
  1637. drm_gtf2_hbreak(struct edid *edid)
  1638. {
  1639.         u8 *r = NULL;
  1640.         drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
  1641.         return r ? (r[12] * 2) : 0;
  1642. }
  1643.  
  1644. static int
  1645. drm_gtf2_2c(struct edid *edid)
  1646. {
  1647.         u8 *r = NULL;
  1648.         drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
  1649.         return r ? r[13] : 0;
  1650. }
  1651.  
  1652. static int
  1653. drm_gtf2_m(struct edid *edid)
  1654. {
  1655.         u8 *r = NULL;
  1656.         drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
  1657.         return r ? (r[15] << 8) + r[14] : 0;
  1658. }
  1659.  
  1660. static int
  1661. drm_gtf2_k(struct edid *edid)
  1662. {
  1663.         u8 *r = NULL;
  1664.         drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
  1665.         return r ? r[16] : 0;
  1666. }
  1667.  
  1668. static int
  1669. drm_gtf2_2j(struct edid *edid)
  1670. {
  1671.         u8 *r = NULL;
  1672.         drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
  1673.         return r ? r[17] : 0;
  1674. }
  1675.  
  1676. /**
  1677.  * standard_timing_level - get std. timing level(CVT/GTF/DMT)
  1678.  * @edid: EDID block to scan
  1679.  */
  1680. static int standard_timing_level(struct edid *edid)
  1681. {
  1682.         if (edid->revision >= 2) {
  1683.                 if (edid->revision >= 4 && (edid->features & DRM_EDID_FEATURE_DEFAULT_GTF))
  1684.                         return LEVEL_CVT;
  1685.                 if (drm_gtf2_hbreak(edid))
  1686.                         return LEVEL_GTF2;
  1687.                 return LEVEL_GTF;
  1688.         }
  1689.         return LEVEL_DMT;
  1690. }
  1691.  
  1692. /*
  1693.  * 0 is reserved.  The spec says 0x01 fill for unused timings.  Some old
  1694.  * monitors fill with ascii space (0x20) instead.
  1695.  */
  1696. static int
  1697. bad_std_timing(u8 a, u8 b)
  1698. {
  1699.         return (a == 0x00 && b == 0x00) ||
  1700.                (a == 0x01 && b == 0x01) ||
  1701.                (a == 0x20 && b == 0x20);
  1702. }
  1703.  
  1704. /**
  1705.  * drm_mode_std - convert standard mode info (width, height, refresh) into mode
  1706.  * @connector: connector of for the EDID block
  1707.  * @edid: EDID block to scan
  1708.  * @t: standard timing params
  1709.  *
  1710.  * Take the standard timing params (in this case width, aspect, and refresh)
  1711.  * and convert them into a real mode using CVT/GTF/DMT.
  1712.  */
  1713. static struct drm_display_mode *
  1714. drm_mode_std(struct drm_connector *connector, struct edid *edid,
  1715.              struct std_timing *t)
  1716. {
  1717.         struct drm_device *dev = connector->dev;
  1718.         struct drm_display_mode *m, *mode = NULL;
  1719.         int hsize, vsize;
  1720.         int vrefresh_rate;
  1721.         unsigned aspect_ratio = (t->vfreq_aspect & EDID_TIMING_ASPECT_MASK)
  1722.                 >> EDID_TIMING_ASPECT_SHIFT;
  1723.         unsigned vfreq = (t->vfreq_aspect & EDID_TIMING_VFREQ_MASK)
  1724.                 >> EDID_TIMING_VFREQ_SHIFT;
  1725.         int timing_level = standard_timing_level(edid);
  1726.  
  1727.         if (bad_std_timing(t->hsize, t->vfreq_aspect))
  1728.                 return NULL;
  1729.  
  1730.         /* According to the EDID spec, the hdisplay = hsize * 8 + 248 */
  1731.         hsize = t->hsize * 8 + 248;
  1732.         /* vrefresh_rate = vfreq + 60 */
  1733.         vrefresh_rate = vfreq + 60;
  1734.         /* the vdisplay is calculated based on the aspect ratio */
  1735.         if (aspect_ratio == 0) {
  1736.                 if (edid->revision < 3)
  1737.                         vsize = hsize;
  1738.                 else
  1739.                         vsize = (hsize * 10) / 16;
  1740.         } else if (aspect_ratio == 1)
  1741.                 vsize = (hsize * 3) / 4;
  1742.         else if (aspect_ratio == 2)
  1743.                 vsize = (hsize * 4) / 5;
  1744.         else
  1745.                 vsize = (hsize * 9) / 16;
  1746.  
  1747.         /* HDTV hack, part 1 */
  1748.         if (vrefresh_rate == 60 &&
  1749.             ((hsize == 1360 && vsize == 765) ||
  1750.              (hsize == 1368 && vsize == 769))) {
  1751.                 hsize = 1366;
  1752.                 vsize = 768;
  1753.         }
  1754.  
  1755.         /*
  1756.          * If this connector already has a mode for this size and refresh
  1757.          * rate (because it came from detailed or CVT info), use that
  1758.          * instead.  This way we don't have to guess at interlace or
  1759.          * reduced blanking.
  1760.          */
  1761.         list_for_each_entry(m, &connector->probed_modes, head)
  1762.                 if (m->hdisplay == hsize && m->vdisplay == vsize &&
  1763.                     drm_mode_vrefresh(m) == vrefresh_rate)
  1764.                         return NULL;
  1765.  
  1766.         /* HDTV hack, part 2 */
  1767.         if (hsize == 1366 && vsize == 768 && vrefresh_rate == 60) {
  1768.                 mode = drm_cvt_mode(dev, 1366, 768, vrefresh_rate, 0, 0,
  1769.                                     false);
  1770.                 mode->hdisplay = 1366;
  1771.                 mode->hsync_start = mode->hsync_start - 1;
  1772.                 mode->hsync_end = mode->hsync_end - 1;
  1773.                 return mode;
  1774.         }
  1775.  
  1776.         /* check whether it can be found in default mode table */
  1777.         if (drm_monitor_supports_rb(edid)) {
  1778.                 mode = drm_mode_find_dmt(dev, hsize, vsize, vrefresh_rate,
  1779.                                          true);
  1780.                 if (mode)
  1781.                         return mode;
  1782.         }
  1783.         mode = drm_mode_find_dmt(dev, hsize, vsize, vrefresh_rate, false);
  1784.         if (mode)
  1785.                 return mode;
  1786.  
  1787.         /* okay, generate it */
  1788.         switch (timing_level) {
  1789.         case LEVEL_DMT:
  1790.                 break;
  1791.         case LEVEL_GTF:
  1792.                 mode = drm_gtf_mode(dev, hsize, vsize, vrefresh_rate, 0, 0);
  1793.                 break;
  1794.         case LEVEL_GTF2:
  1795.                 /*
  1796.                  * This is potentially wrong if there's ever a monitor with
  1797.                  * more than one ranges section, each claiming a different
  1798.                  * secondary GTF curve.  Please don't do that.
  1799.                  */
  1800.                 mode = drm_gtf_mode(dev, hsize, vsize, vrefresh_rate, 0, 0);
  1801.                 if (!mode)
  1802.                         return NULL;
  1803.                 if (drm_mode_hsync(mode) > drm_gtf2_hbreak(edid)) {
  1804.                         drm_mode_destroy(dev, mode);
  1805.                         mode = drm_gtf_mode_complex(dev, hsize, vsize,
  1806.                                                     vrefresh_rate, 0, 0,
  1807.                                                     drm_gtf2_m(edid),
  1808.                                                     drm_gtf2_2c(edid),
  1809.                                                     drm_gtf2_k(edid),
  1810.                                                     drm_gtf2_2j(edid));
  1811.                 }
  1812.                 break;
  1813.         case LEVEL_CVT:
  1814.                 mode = drm_cvt_mode(dev, hsize, vsize, vrefresh_rate, 0, 0,
  1815.                                     false);
  1816.                 break;
  1817.         }
  1818.         return mode;
  1819. }
  1820.  
  1821. /*
  1822.  * EDID is delightfully ambiguous about how interlaced modes are to be
  1823.  * encoded.  Our internal representation is of frame height, but some
  1824.  * HDTV detailed timings are encoded as field height.
  1825.  *
  1826.  * The format list here is from CEA, in frame size.  Technically we
  1827.  * should be checking refresh rate too.  Whatever.
  1828.  */
  1829. static void
  1830. drm_mode_do_interlace_quirk(struct drm_display_mode *mode,
  1831.                             struct detailed_pixel_timing *pt)
  1832. {
  1833.         int i;
  1834.         static const struct {
  1835.                 int w, h;
  1836.         } cea_interlaced[] = {
  1837.                 { 1920, 1080 },
  1838.                 {  720,  480 },
  1839.                 { 1440,  480 },
  1840.                 { 2880,  480 },
  1841.                 {  720,  576 },
  1842.                 { 1440,  576 },
  1843.                 { 2880,  576 },
  1844.         };
  1845.  
  1846.         if (!(pt->misc & DRM_EDID_PT_INTERLACED))
  1847.                 return;
  1848.  
  1849.         for (i = 0; i < ARRAY_SIZE(cea_interlaced); i++) {
  1850.                 if ((mode->hdisplay == cea_interlaced[i].w) &&
  1851.                     (mode->vdisplay == cea_interlaced[i].h / 2)) {
  1852.                         mode->vdisplay *= 2;
  1853.                         mode->vsync_start *= 2;
  1854.                         mode->vsync_end *= 2;
  1855.                         mode->vtotal *= 2;
  1856.                         mode->vtotal |= 1;
  1857.                 }
  1858.         }
  1859.  
  1860.         mode->flags |= DRM_MODE_FLAG_INTERLACE;
  1861. }
  1862.  
  1863. /**
  1864.  * drm_mode_detailed - create a new mode from an EDID detailed timing section
  1865.  * @dev: DRM device (needed to create new mode)
  1866.  * @edid: EDID block
  1867.  * @timing: EDID detailed timing info
  1868.  * @quirks: quirks to apply
  1869.  *
  1870.  * An EDID detailed timing block contains enough info for us to create and
  1871.  * return a new struct drm_display_mode.
  1872.  */
  1873. static struct drm_display_mode *drm_mode_detailed(struct drm_device *dev,
  1874.                                                   struct edid *edid,
  1875.                                                   struct detailed_timing *timing,
  1876.                                                   u32 quirks)
  1877. {
  1878.         struct drm_display_mode *mode;
  1879.         struct detailed_pixel_timing *pt = &timing->data.pixel_data;
  1880.         unsigned hactive = (pt->hactive_hblank_hi & 0xf0) << 4 | pt->hactive_lo;
  1881.         unsigned vactive = (pt->vactive_vblank_hi & 0xf0) << 4 | pt->vactive_lo;
  1882.         unsigned hblank = (pt->hactive_hblank_hi & 0xf) << 8 | pt->hblank_lo;
  1883.         unsigned vblank = (pt->vactive_vblank_hi & 0xf) << 8 | pt->vblank_lo;
  1884.         unsigned hsync_offset = (pt->hsync_vsync_offset_pulse_width_hi & 0xc0) << 2 | pt->hsync_offset_lo;
  1885.         unsigned hsync_pulse_width = (pt->hsync_vsync_offset_pulse_width_hi & 0x30) << 4 | pt->hsync_pulse_width_lo;
  1886.         unsigned vsync_offset = (pt->hsync_vsync_offset_pulse_width_hi & 0xc) << 2 | pt->vsync_offset_pulse_width_lo >> 4;
  1887.         unsigned vsync_pulse_width = (pt->hsync_vsync_offset_pulse_width_hi & 0x3) << 4 | (pt->vsync_offset_pulse_width_lo & 0xf);
  1888.  
  1889.         /* ignore tiny modes */
  1890.         if (hactive < 64 || vactive < 64)
  1891.                 return NULL;
  1892.  
  1893.         if (pt->misc & DRM_EDID_PT_STEREO) {
  1894.                 DRM_DEBUG_KMS("stereo mode not supported\n");
  1895.                 return NULL;
  1896.         }
  1897.         if (!(pt->misc & DRM_EDID_PT_SEPARATE_SYNC)) {
  1898.                 DRM_DEBUG_KMS("composite sync not supported\n");
  1899.         }
  1900.  
  1901.         /* it is incorrect if hsync/vsync width is zero */
  1902.         if (!hsync_pulse_width || !vsync_pulse_width) {
  1903.                 DRM_DEBUG_KMS("Incorrect Detailed timing. "
  1904.                                 "Wrong Hsync/Vsync pulse width\n");
  1905.                 return NULL;
  1906.         }
  1907.  
  1908.         if (quirks & EDID_QUIRK_FORCE_REDUCED_BLANKING) {
  1909.                 mode = drm_cvt_mode(dev, hactive, vactive, 60, true, false, false);
  1910.                 if (!mode)
  1911.                         return NULL;
  1912.  
  1913.                 goto set_size;
  1914.         }
  1915.  
  1916.         mode = drm_mode_create(dev);
  1917.         if (!mode)
  1918.                 return NULL;
  1919.  
  1920.         if (quirks & EDID_QUIRK_135_CLOCK_TOO_HIGH)
  1921.                 timing->pixel_clock = cpu_to_le16(1088);
  1922.  
  1923.         mode->clock = le16_to_cpu(timing->pixel_clock) * 10;
  1924.  
  1925.         mode->hdisplay = hactive;
  1926.         mode->hsync_start = mode->hdisplay + hsync_offset;
  1927.         mode->hsync_end = mode->hsync_start + hsync_pulse_width;
  1928.         mode->htotal = mode->hdisplay + hblank;
  1929.  
  1930.         mode->vdisplay = vactive;
  1931.         mode->vsync_start = mode->vdisplay + vsync_offset;
  1932.         mode->vsync_end = mode->vsync_start + vsync_pulse_width;
  1933.         mode->vtotal = mode->vdisplay + vblank;
  1934.  
  1935.         /* Some EDIDs have bogus h/vtotal values */
  1936.         if (mode->hsync_end > mode->htotal)
  1937.                 mode->htotal = mode->hsync_end + 1;
  1938.         if (mode->vsync_end > mode->vtotal)
  1939.                 mode->vtotal = mode->vsync_end + 1;
  1940.  
  1941.         drm_mode_do_interlace_quirk(mode, pt);
  1942.  
  1943.         if (quirks & EDID_QUIRK_DETAILED_SYNC_PP) {
  1944.                 pt->misc |= DRM_EDID_PT_HSYNC_POSITIVE | DRM_EDID_PT_VSYNC_POSITIVE;
  1945.         }
  1946.  
  1947.         mode->flags |= (pt->misc & DRM_EDID_PT_HSYNC_POSITIVE) ?
  1948.                 DRM_MODE_FLAG_PHSYNC : DRM_MODE_FLAG_NHSYNC;
  1949.         mode->flags |= (pt->misc & DRM_EDID_PT_VSYNC_POSITIVE) ?
  1950.                 DRM_MODE_FLAG_PVSYNC : DRM_MODE_FLAG_NVSYNC;
  1951.  
  1952. set_size:
  1953.         mode->width_mm = pt->width_mm_lo | (pt->width_height_mm_hi & 0xf0) << 4;
  1954.         mode->height_mm = pt->height_mm_lo | (pt->width_height_mm_hi & 0xf) << 8;
  1955.  
  1956.         if (quirks & EDID_QUIRK_DETAILED_IN_CM) {
  1957.                 mode->width_mm *= 10;
  1958.                 mode->height_mm *= 10;
  1959.         }
  1960.  
  1961.         if (quirks & EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE) {
  1962.                 mode->width_mm = edid->width_cm * 10;
  1963.                 mode->height_mm = edid->height_cm * 10;
  1964.         }
  1965.  
  1966.         mode->type = DRM_MODE_TYPE_DRIVER;
  1967.         mode->vrefresh = drm_mode_vrefresh(mode);
  1968.         drm_mode_set_name(mode);
  1969.  
  1970.         return mode;
  1971. }
  1972.  
  1973. static bool
  1974. mode_in_hsync_range(const struct drm_display_mode *mode,
  1975.                     struct edid *edid, u8 *t)
  1976. {
  1977.         int hsync, hmin, hmax;
  1978.  
  1979.         hmin = t[7];
  1980.         if (edid->revision >= 4)
  1981.             hmin += ((t[4] & 0x04) ? 255 : 0);
  1982.         hmax = t[8];
  1983.         if (edid->revision >= 4)
  1984.             hmax += ((t[4] & 0x08) ? 255 : 0);
  1985.         hsync = drm_mode_hsync(mode);
  1986.  
  1987.         return (hsync <= hmax && hsync >= hmin);
  1988. }
  1989.  
  1990. static bool
  1991. mode_in_vsync_range(const struct drm_display_mode *mode,
  1992.                     struct edid *edid, u8 *t)
  1993. {
  1994.         int vsync, vmin, vmax;
  1995.  
  1996.         vmin = t[5];
  1997.         if (edid->revision >= 4)
  1998.             vmin += ((t[4] & 0x01) ? 255 : 0);
  1999.         vmax = t[6];
  2000.         if (edid->revision >= 4)
  2001.             vmax += ((t[4] & 0x02) ? 255 : 0);
  2002.         vsync = drm_mode_vrefresh(mode);
  2003.  
  2004.         return (vsync <= vmax && vsync >= vmin);
  2005. }
  2006.  
  2007. static u32
  2008. range_pixel_clock(struct edid *edid, u8 *t)
  2009. {
  2010.         /* unspecified */
  2011.         if (t[9] == 0 || t[9] == 255)
  2012.                 return 0;
  2013.  
  2014.         /* 1.4 with CVT support gives us real precision, yay */
  2015.         if (edid->revision >= 4 && t[10] == 0x04)
  2016.                 return (t[9] * 10000) - ((t[12] >> 2) * 250);
  2017.  
  2018.         /* 1.3 is pathetic, so fuzz up a bit */
  2019.         return t[9] * 10000 + 5001;
  2020. }
  2021.  
  2022. static bool
  2023. mode_in_range(const struct drm_display_mode *mode, struct edid *edid,
  2024.               struct detailed_timing *timing)
  2025. {
  2026.         u32 max_clock;
  2027.         u8 *t = (u8 *)timing;
  2028.  
  2029.         if (!mode_in_hsync_range(mode, edid, t))
  2030.                 return false;
  2031.  
  2032.         if (!mode_in_vsync_range(mode, edid, t))
  2033.                 return false;
  2034.  
  2035.         if ((max_clock = range_pixel_clock(edid, t)))
  2036.                 if (mode->clock > max_clock)
  2037.                         return false;
  2038.  
  2039.         /* 1.4 max horizontal check */
  2040.         if (edid->revision >= 4 && t[10] == 0x04)
  2041.                 if (t[13] && mode->hdisplay > 8 * (t[13] + (256 * (t[12]&0x3))))
  2042.                         return false;
  2043.  
  2044.         if (mode_is_rb(mode) && !drm_monitor_supports_rb(edid))
  2045.                 return false;
  2046.  
  2047.         return true;
  2048. }
  2049.  
  2050. static bool valid_inferred_mode(const struct drm_connector *connector,
  2051.                                 const struct drm_display_mode *mode)
  2052. {
  2053.         const struct drm_display_mode *m;
  2054.         bool ok = false;
  2055.  
  2056.         list_for_each_entry(m, &connector->probed_modes, head) {
  2057.                 if (mode->hdisplay == m->hdisplay &&
  2058.                     mode->vdisplay == m->vdisplay &&
  2059.                     drm_mode_vrefresh(mode) == drm_mode_vrefresh(m))
  2060.                         return false; /* duplicated */
  2061.                 if (mode->hdisplay <= m->hdisplay &&
  2062.                     mode->vdisplay <= m->vdisplay)
  2063.                         ok = true;
  2064.         }
  2065.         return ok;
  2066. }
  2067.  
  2068. static int
  2069. drm_dmt_modes_for_range(struct drm_connector *connector, struct edid *edid,
  2070.                         struct detailed_timing *timing)
  2071. {
  2072.         int i, modes = 0;
  2073.         struct drm_display_mode *newmode;
  2074.         struct drm_device *dev = connector->dev;
  2075.  
  2076.         for (i = 0; i < ARRAY_SIZE(drm_dmt_modes); i++) {
  2077.                 if (mode_in_range(drm_dmt_modes + i, edid, timing) &&
  2078.                     valid_inferred_mode(connector, drm_dmt_modes + i)) {
  2079.                         newmode = drm_mode_duplicate(dev, &drm_dmt_modes[i]);
  2080.                         if (newmode) {
  2081.                                 drm_mode_probed_add(connector, newmode);
  2082.                                 modes++;
  2083.                         }
  2084.                 }
  2085.         }
  2086.  
  2087.         return modes;
  2088. }
  2089.  
  2090. /* fix up 1366x768 mode from 1368x768;
  2091.  * GFT/CVT can't express 1366 width which isn't dividable by 8
  2092.  */
  2093. static void fixup_mode_1366x768(struct drm_display_mode *mode)
  2094. {
  2095.         if (mode->hdisplay == 1368 && mode->vdisplay == 768) {
  2096.                 mode->hdisplay = 1366;
  2097.                 mode->hsync_start--;
  2098.                 mode->hsync_end--;
  2099.                 drm_mode_set_name(mode);
  2100.         }
  2101. }
  2102.  
  2103. static int
  2104. drm_gtf_modes_for_range(struct drm_connector *connector, struct edid *edid,
  2105.                         struct detailed_timing *timing)
  2106. {
  2107.         int i, modes = 0;
  2108.         struct drm_display_mode *newmode;
  2109.         struct drm_device *dev = connector->dev;
  2110.  
  2111.         for (i = 0; i < ARRAY_SIZE(extra_modes); i++) {
  2112.                 const struct minimode *m = &extra_modes[i];
  2113.                 newmode = drm_gtf_mode(dev, m->w, m->h, m->r, 0, 0);
  2114.                 if (!newmode)
  2115.                         return modes;
  2116.  
  2117.                 fixup_mode_1366x768(newmode);
  2118.                 if (!mode_in_range(newmode, edid, timing) ||
  2119.                     !valid_inferred_mode(connector, newmode)) {
  2120.                         drm_mode_destroy(dev, newmode);
  2121.                         continue;
  2122.                 }
  2123.  
  2124.                 drm_mode_probed_add(connector, newmode);
  2125.                 modes++;
  2126.         }
  2127.  
  2128.         return modes;
  2129. }
  2130.  
  2131. static int
  2132. drm_cvt_modes_for_range(struct drm_connector *connector, struct edid *edid,
  2133.                         struct detailed_timing *timing)
  2134. {
  2135.         int i, modes = 0;
  2136.         struct drm_display_mode *newmode;
  2137.         struct drm_device *dev = connector->dev;
  2138.         bool rb = drm_monitor_supports_rb(edid);
  2139.  
  2140.         for (i = 0; i < ARRAY_SIZE(extra_modes); i++) {
  2141.                 const struct minimode *m = &extra_modes[i];
  2142.                 newmode = drm_cvt_mode(dev, m->w, m->h, m->r, rb, 0, 0);
  2143.                 if (!newmode)
  2144.                         return modes;
  2145.  
  2146.                 fixup_mode_1366x768(newmode);
  2147.                 if (!mode_in_range(newmode, edid, timing) ||
  2148.                     !valid_inferred_mode(connector, newmode)) {
  2149.                         drm_mode_destroy(dev, newmode);
  2150.                         continue;
  2151.                 }
  2152.  
  2153.                 drm_mode_probed_add(connector, newmode);
  2154.                 modes++;
  2155.         }
  2156.  
  2157.         return modes;
  2158. }
  2159.  
  2160. static void
  2161. do_inferred_modes(struct detailed_timing *timing, void *c)
  2162. {
  2163.         struct detailed_mode_closure *closure = c;
  2164.         struct detailed_non_pixel *data = &timing->data.other_data;
  2165.         struct detailed_data_monitor_range *range = &data->data.range;
  2166.  
  2167.         if (data->type != EDID_DETAIL_MONITOR_RANGE)
  2168.                 return;
  2169.  
  2170.         closure->modes += drm_dmt_modes_for_range(closure->connector,
  2171.                                                   closure->edid,
  2172.                                                   timing);
  2173.        
  2174.         if (!version_greater(closure->edid, 1, 1))
  2175.                 return; /* GTF not defined yet */
  2176.  
  2177.         switch (range->flags) {
  2178.         case 0x02: /* secondary gtf, XXX could do more */
  2179.         case 0x00: /* default gtf */
  2180.                 closure->modes += drm_gtf_modes_for_range(closure->connector,
  2181.                                                           closure->edid,
  2182.                                                           timing);
  2183.                 break;
  2184.         case 0x04: /* cvt, only in 1.4+ */
  2185.                 if (!version_greater(closure->edid, 1, 3))
  2186.                         break;
  2187.  
  2188.                 closure->modes += drm_cvt_modes_for_range(closure->connector,
  2189.                                                           closure->edid,
  2190.                                                           timing);
  2191.                 break;
  2192.         case 0x01: /* just the ranges, no formula */
  2193.         default:
  2194.                 break;
  2195.         }
  2196. }
  2197.  
  2198. static int
  2199. add_inferred_modes(struct drm_connector *connector, struct edid *edid)
  2200. {
  2201.         struct detailed_mode_closure closure = {
  2202.                 .connector = connector,
  2203.                 .edid = edid,
  2204.         };
  2205.  
  2206.         if (version_greater(edid, 1, 0))
  2207.                 drm_for_each_detailed_block((u8 *)edid, do_inferred_modes,
  2208.                                             &closure);
  2209.  
  2210.         return closure.modes;
  2211. }
  2212.  
  2213. static int
  2214. drm_est3_modes(struct drm_connector *connector, struct detailed_timing *timing)
  2215. {
  2216.         int i, j, m, modes = 0;
  2217.         struct drm_display_mode *mode;
  2218.         u8 *est = ((u8 *)timing) + 5;
  2219.  
  2220.         for (i = 0; i < 6; i++) {
  2221.                 for (j = 7; j >= 0; j--) {
  2222.                         m = (i * 8) + (7 - j);
  2223.                         if (m >= ARRAY_SIZE(est3_modes))
  2224.                                 break;
  2225.                         if (est[i] & (1 << j)) {
  2226.                                 mode = drm_mode_find_dmt(connector->dev,
  2227.                                                          est3_modes[m].w,
  2228.                                                          est3_modes[m].h,
  2229.                                                          est3_modes[m].r,
  2230.                                                          est3_modes[m].rb);
  2231.                                 if (mode) {
  2232.                                         drm_mode_probed_add(connector, mode);
  2233.                                         modes++;
  2234.                                 }
  2235.                         }
  2236.                 }
  2237.         }
  2238.  
  2239.         return modes;
  2240. }
  2241.  
  2242. static void
  2243. do_established_modes(struct detailed_timing *timing, void *c)
  2244. {
  2245.         struct detailed_mode_closure *closure = c;
  2246.         struct detailed_non_pixel *data = &timing->data.other_data;
  2247.  
  2248.         if (data->type == EDID_DETAIL_EST_TIMINGS)
  2249.                 closure->modes += drm_est3_modes(closure->connector, timing);
  2250. }
  2251.  
  2252. /**
  2253.  * add_established_modes - get est. modes from EDID and add them
  2254.  * @connector: connector to add mode(s) to
  2255.  * @edid: EDID block to scan
  2256.  *
  2257.  * Each EDID block contains a bitmap of the supported "established modes" list
  2258.  * (defined above).  Tease them out and add them to the global modes list.
  2259.  */
  2260. static int
  2261. add_established_modes(struct drm_connector *connector, struct edid *edid)
  2262. {
  2263.         struct drm_device *dev = connector->dev;
  2264.         unsigned long est_bits = edid->established_timings.t1 |
  2265.                 (edid->established_timings.t2 << 8) |
  2266.                 ((edid->established_timings.mfg_rsvd & 0x80) << 9);
  2267.         int i, modes = 0;
  2268.         struct detailed_mode_closure closure = {
  2269.                 .connector = connector,
  2270.                 .edid = edid,
  2271.         };
  2272.  
  2273.         for (i = 0; i <= EDID_EST_TIMINGS; i++) {
  2274.                 if (est_bits & (1<<i)) {
  2275.                         struct drm_display_mode *newmode;
  2276.                         newmode = drm_mode_duplicate(dev, &edid_est_modes[i]);
  2277.                         if (newmode) {
  2278.                                 drm_mode_probed_add(connector, newmode);
  2279.                                 modes++;
  2280.                         }
  2281.                 }
  2282.         }
  2283.  
  2284.         if (version_greater(edid, 1, 0))
  2285.                     drm_for_each_detailed_block((u8 *)edid,
  2286.                                                 do_established_modes, &closure);
  2287.  
  2288.         return modes + closure.modes;
  2289. }
  2290.  
  2291. static void
  2292. do_standard_modes(struct detailed_timing *timing, void *c)
  2293. {
  2294.         struct detailed_mode_closure *closure = c;
  2295.         struct detailed_non_pixel *data = &timing->data.other_data;
  2296.         struct drm_connector *connector = closure->connector;
  2297.         struct edid *edid = closure->edid;
  2298.  
  2299.         if (data->type == EDID_DETAIL_STD_MODES) {
  2300.                 int i;
  2301.                 for (i = 0; i < 6; i++) {
  2302.                         struct std_timing *std;
  2303.                         struct drm_display_mode *newmode;
  2304.  
  2305.                         std = &data->data.timings[i];
  2306.                         newmode = drm_mode_std(connector, edid, std);
  2307.                         if (newmode) {
  2308.                                 drm_mode_probed_add(connector, newmode);
  2309.                                 closure->modes++;
  2310.                         }
  2311.                 }
  2312.         }
  2313. }
  2314.  
  2315. /**
  2316.  * add_standard_modes - get std. modes from EDID and add them
  2317.  * @connector: connector to add mode(s) to
  2318.  * @edid: EDID block to scan
  2319.  *
  2320.  * Standard modes can be calculated using the appropriate standard (DMT,
  2321.  * GTF or CVT. Grab them from @edid and add them to the list.
  2322.  */
  2323. static int
  2324. add_standard_modes(struct drm_connector *connector, struct edid *edid)
  2325. {
  2326.         int i, modes = 0;
  2327.         struct detailed_mode_closure closure = {
  2328.                 .connector = connector,
  2329.                 .edid = edid,
  2330.         };
  2331.  
  2332.         for (i = 0; i < EDID_STD_TIMINGS; i++) {
  2333.                 struct drm_display_mode *newmode;
  2334.  
  2335.                 newmode = drm_mode_std(connector, edid,
  2336.                                        &edid->standard_timings[i]);
  2337.                 if (newmode) {
  2338.                         drm_mode_probed_add(connector, newmode);
  2339.                         modes++;
  2340.                 }
  2341.         }
  2342.  
  2343.         if (version_greater(edid, 1, 0))
  2344.                 drm_for_each_detailed_block((u8 *)edid, do_standard_modes,
  2345.                                             &closure);
  2346.  
  2347.         /* XXX should also look for standard codes in VTB blocks */
  2348.  
  2349.         return modes + closure.modes;
  2350. }
  2351.  
  2352. static int drm_cvt_modes(struct drm_connector *connector,
  2353.                          struct detailed_timing *timing)
  2354. {
  2355.         int i, j, modes = 0;
  2356.         struct drm_display_mode *newmode;
  2357.         struct drm_device *dev = connector->dev;
  2358.         struct cvt_timing *cvt;
  2359.         const int rates[] = { 60, 85, 75, 60, 50 };
  2360.         const u8 empty[3] = { 0, 0, 0 };
  2361.  
  2362.         for (i = 0; i < 4; i++) {
  2363.                 int uninitialized_var(width), height;
  2364.                 cvt = &(timing->data.other_data.data.cvt[i]);
  2365.  
  2366.                 if (!memcmp(cvt->code, empty, 3))
  2367.                         continue;
  2368.  
  2369.                 height = (cvt->code[0] + ((cvt->code[1] & 0xf0) << 4) + 1) * 2;
  2370.                 switch (cvt->code[1] & 0x0c) {
  2371.                 case 0x00:
  2372.                         width = height * 4 / 3;
  2373.                         break;
  2374.                 case 0x04:
  2375.                         width = height * 16 / 9;
  2376.                         break;
  2377.                 case 0x08:
  2378.                         width = height * 16 / 10;
  2379.                         break;
  2380.                 case 0x0c:
  2381.                         width = height * 15 / 9;
  2382.                         break;
  2383.                 }
  2384.  
  2385.                 for (j = 1; j < 5; j++) {
  2386.                         if (cvt->code[2] & (1 << j)) {
  2387.                                 newmode = drm_cvt_mode(dev, width, height,
  2388.                                                        rates[j], j == 0,
  2389.                                                        false, false);
  2390.                                 if (newmode) {
  2391.                                         drm_mode_probed_add(connector, newmode);
  2392.                                         modes++;
  2393.                                 }
  2394.                         }
  2395.                 }
  2396.         }
  2397.  
  2398.         return modes;
  2399. }
  2400.  
  2401. static void
  2402. do_cvt_mode(struct detailed_timing *timing, void *c)
  2403. {
  2404.         struct detailed_mode_closure *closure = c;
  2405.         struct detailed_non_pixel *data = &timing->data.other_data;
  2406.  
  2407.         if (data->type == EDID_DETAIL_CVT_3BYTE)
  2408.                 closure->modes += drm_cvt_modes(closure->connector, timing);
  2409. }
  2410.  
  2411. static int
  2412. add_cvt_modes(struct drm_connector *connector, struct edid *edid)
  2413. {      
  2414.         struct detailed_mode_closure closure = {
  2415.                 .connector = connector,
  2416.                 .edid = edid,
  2417.         };
  2418.  
  2419.         if (version_greater(edid, 1, 2))
  2420.                 drm_for_each_detailed_block((u8 *)edid, do_cvt_mode, &closure);
  2421.  
  2422.         /* XXX should also look for CVT codes in VTB blocks */
  2423.  
  2424.         return closure.modes;
  2425. }
  2426.  
  2427. static void fixup_detailed_cea_mode_clock(struct drm_display_mode *mode);
  2428.  
  2429. static void
  2430. do_detailed_mode(struct detailed_timing *timing, void *c)
  2431. {
  2432.         struct detailed_mode_closure *closure = c;
  2433.         struct drm_display_mode *newmode;
  2434.  
  2435.         if (timing->pixel_clock) {
  2436.                 newmode = drm_mode_detailed(closure->connector->dev,
  2437.                                             closure->edid, timing,
  2438.                                             closure->quirks);
  2439.                 if (!newmode)
  2440.                         return;
  2441.  
  2442.                 if (closure->preferred)
  2443.                         newmode->type |= DRM_MODE_TYPE_PREFERRED;
  2444.  
  2445.                 /*
  2446.                  * Detailed modes are limited to 10kHz pixel clock resolution,
  2447.                  * so fix up anything that looks like CEA/HDMI mode, but the clock
  2448.                  * is just slightly off.
  2449.                  */
  2450.                 fixup_detailed_cea_mode_clock(newmode);
  2451.  
  2452.                 drm_mode_probed_add(closure->connector, newmode);
  2453.                 closure->modes++;
  2454.                 closure->preferred = 0;
  2455.         }
  2456. }
  2457.  
  2458. /*
  2459.  * add_detailed_modes - Add modes from detailed timings
  2460.  * @connector: attached connector
  2461.  * @edid: EDID block to scan
  2462.  * @quirks: quirks to apply
  2463.  */
  2464. static int
  2465. add_detailed_modes(struct drm_connector *connector, struct edid *edid,
  2466.                    u32 quirks)
  2467. {
  2468.         struct detailed_mode_closure closure = {
  2469.                 .connector = connector,
  2470.                 .edid = edid,
  2471.                 .preferred = 1,
  2472.                 .quirks = quirks,
  2473.         };
  2474.  
  2475.         if (closure.preferred && !version_greater(edid, 1, 3))
  2476.                 closure.preferred =
  2477.                     (edid->features & DRM_EDID_FEATURE_PREFERRED_TIMING);
  2478.  
  2479.         drm_for_each_detailed_block((u8 *)edid, do_detailed_mode, &closure);
  2480.  
  2481.         return closure.modes;
  2482. }
  2483.  
  2484. #define AUDIO_BLOCK     0x01
  2485. #define VIDEO_BLOCK     0x02
  2486. #define VENDOR_BLOCK    0x03
  2487. #define SPEAKER_BLOCK   0x04
  2488. #define VIDEO_CAPABILITY_BLOCK  0x07
  2489. #define EDID_BASIC_AUDIO        (1 << 6)
  2490. #define EDID_CEA_YCRCB444       (1 << 5)
  2491. #define EDID_CEA_YCRCB422       (1 << 4)
  2492. #define EDID_CEA_VCDB_QS        (1 << 6)
  2493.  
  2494. /*
  2495.  * Search EDID for CEA extension block.
  2496.  */
  2497. static u8 *drm_find_edid_extension(struct edid *edid, int ext_id)
  2498. {
  2499.         u8 *edid_ext = NULL;
  2500.         int i;
  2501.  
  2502.         /* No EDID or EDID extensions */
  2503.         if (edid == NULL || edid->extensions == 0)
  2504.                 return NULL;
  2505.  
  2506.         /* Find CEA extension */
  2507.         for (i = 0; i < edid->extensions; i++) {
  2508.                 edid_ext = (u8 *)edid + EDID_LENGTH * (i + 1);
  2509.                 if (edid_ext[0] == ext_id)
  2510.                         break;
  2511.         }
  2512.  
  2513.         if (i == edid->extensions)
  2514.                 return NULL;
  2515.  
  2516.         return edid_ext;
  2517. }
  2518.  
  2519. static u8 *drm_find_cea_extension(struct edid *edid)
  2520. {
  2521.         return drm_find_edid_extension(edid, CEA_EXT);
  2522. }
  2523.  
  2524. static u8 *drm_find_displayid_extension(struct edid *edid)
  2525. {
  2526.         return drm_find_edid_extension(edid, DISPLAYID_EXT);
  2527. }
  2528.  
  2529. /*
  2530.  * Calculate the alternate clock for the CEA mode
  2531.  * (60Hz vs. 59.94Hz etc.)
  2532.  */
  2533. static unsigned int
  2534. cea_mode_alternate_clock(const struct drm_display_mode *cea_mode)
  2535. {
  2536.         unsigned int clock = cea_mode->clock;
  2537.  
  2538.         if (cea_mode->vrefresh % 6 != 0)
  2539.                 return clock;
  2540.  
  2541.         /*
  2542.          * edid_cea_modes contains the 59.94Hz
  2543.          * variant for 240 and 480 line modes,
  2544.          * and the 60Hz variant otherwise.
  2545.          */
  2546.         if (cea_mode->vdisplay == 240 || cea_mode->vdisplay == 480)
  2547.                 clock = DIV_ROUND_CLOSEST(clock * 1001, 1000);
  2548.         else
  2549.                 clock = DIV_ROUND_CLOSEST(clock * 1000, 1001);
  2550.  
  2551.         return clock;
  2552. }
  2553.  
  2554. static u8 drm_match_cea_mode_clock_tolerance(const struct drm_display_mode *to_match,
  2555.                                              unsigned int clock_tolerance)
  2556. {
  2557.         u8 vic;
  2558.  
  2559.         if (!to_match->clock)
  2560.                 return 0;
  2561.  
  2562.         for (vic = 1; vic < ARRAY_SIZE(edid_cea_modes); vic++) {
  2563.                 const struct drm_display_mode *cea_mode = &edid_cea_modes[vic];
  2564.                 unsigned int clock1, clock2;
  2565.  
  2566.                 /* Check both 60Hz and 59.94Hz */
  2567.                 clock1 = cea_mode->clock;
  2568.                 clock2 = cea_mode_alternate_clock(cea_mode);
  2569.  
  2570.                 if (abs(to_match->clock - clock1) > clock_tolerance &&
  2571.                     abs(to_match->clock - clock2) > clock_tolerance)
  2572.                         continue;
  2573.  
  2574.                 if (drm_mode_equal_no_clocks(to_match, cea_mode))
  2575.                         return vic;
  2576.         }
  2577.  
  2578.         return 0;
  2579. }
  2580.  
  2581. /**
  2582.  * drm_match_cea_mode - look for a CEA mode matching given mode
  2583.  * @to_match: display mode
  2584.  *
  2585.  * Return: The CEA Video ID (VIC) of the mode or 0 if it isn't a CEA-861
  2586.  * mode.
  2587.  */
  2588. u8 drm_match_cea_mode(const struct drm_display_mode *to_match)
  2589. {
  2590.         u8 vic;
  2591.  
  2592.         if (!to_match->clock)
  2593.                 return 0;
  2594.  
  2595.         for (vic = 1; vic < ARRAY_SIZE(edid_cea_modes); vic++) {
  2596.                 const struct drm_display_mode *cea_mode = &edid_cea_modes[vic];
  2597.                 unsigned int clock1, clock2;
  2598.  
  2599.                 /* Check both 60Hz and 59.94Hz */
  2600.                 clock1 = cea_mode->clock;
  2601.                 clock2 = cea_mode_alternate_clock(cea_mode);
  2602.  
  2603.                 if ((KHZ2PICOS(to_match->clock) == KHZ2PICOS(clock1) ||
  2604.                      KHZ2PICOS(to_match->clock) == KHZ2PICOS(clock2)) &&
  2605.                     drm_mode_equal_no_clocks_no_stereo(to_match, cea_mode))
  2606.                         return vic;
  2607.         }
  2608.         return 0;
  2609. }
  2610. EXPORT_SYMBOL(drm_match_cea_mode);
  2611.  
  2612. static bool drm_valid_cea_vic(u8 vic)
  2613. {
  2614.         return vic > 0 && vic < ARRAY_SIZE(edid_cea_modes);
  2615. }
  2616.  
  2617. /**
  2618.  * drm_get_cea_aspect_ratio - get the picture aspect ratio corresponding to
  2619.  * the input VIC from the CEA mode list
  2620.  * @video_code: ID given to each of the CEA modes
  2621.  *
  2622.  * Returns picture aspect ratio
  2623.  */
  2624. enum hdmi_picture_aspect drm_get_cea_aspect_ratio(const u8 video_code)
  2625. {
  2626.         return edid_cea_modes[video_code].picture_aspect_ratio;
  2627. }
  2628. EXPORT_SYMBOL(drm_get_cea_aspect_ratio);
  2629.  
  2630. /*
  2631.  * Calculate the alternate clock for HDMI modes (those from the HDMI vendor
  2632.  * specific block).
  2633.  *
  2634.  * It's almost like cea_mode_alternate_clock(), we just need to add an
  2635.  * exception for the VIC 4 mode (4096x2160@24Hz): no alternate clock for this
  2636.  * one.
  2637.  */
  2638. static unsigned int
  2639. hdmi_mode_alternate_clock(const struct drm_display_mode *hdmi_mode)
  2640. {
  2641.         if (hdmi_mode->vdisplay == 4096 && hdmi_mode->hdisplay == 2160)
  2642.                 return hdmi_mode->clock;
  2643.  
  2644.         return cea_mode_alternate_clock(hdmi_mode);
  2645. }
  2646.  
  2647. static u8 drm_match_hdmi_mode_clock_tolerance(const struct drm_display_mode *to_match,
  2648.                                               unsigned int clock_tolerance)
  2649. {
  2650.         u8 vic;
  2651.  
  2652.         if (!to_match->clock)
  2653.                 return 0;
  2654.  
  2655.         for (vic = 1; vic < ARRAY_SIZE(edid_4k_modes); vic++) {
  2656.                 const struct drm_display_mode *hdmi_mode = &edid_4k_modes[vic];
  2657.                 unsigned int clock1, clock2;
  2658.  
  2659.                 /* Make sure to also match alternate clocks */
  2660.                 clock1 = hdmi_mode->clock;
  2661.                 clock2 = hdmi_mode_alternate_clock(hdmi_mode);
  2662.  
  2663.                 if (abs(to_match->clock - clock1) > clock_tolerance &&
  2664.                     abs(to_match->clock - clock2) > clock_tolerance)
  2665.                         continue;
  2666.  
  2667.                 if (drm_mode_equal_no_clocks(to_match, hdmi_mode))
  2668.                         return vic;
  2669.         }
  2670.  
  2671.         return 0;
  2672. }
  2673.  
  2674. /*
  2675.  * drm_match_hdmi_mode - look for a HDMI mode matching given mode
  2676.  * @to_match: display mode
  2677.  *
  2678.  * An HDMI mode is one defined in the HDMI vendor specific block.
  2679.  *
  2680.  * Returns the HDMI Video ID (VIC) of the mode or 0 if it isn't one.
  2681.  */
  2682. static u8 drm_match_hdmi_mode(const struct drm_display_mode *to_match)
  2683. {
  2684.         u8 vic;
  2685.  
  2686.         if (!to_match->clock)
  2687.                 return 0;
  2688.  
  2689.         for (vic = 1; vic < ARRAY_SIZE(edid_4k_modes); vic++) {
  2690.                 const struct drm_display_mode *hdmi_mode = &edid_4k_modes[vic];
  2691.                 unsigned int clock1, clock2;
  2692.  
  2693.                 /* Make sure to also match alternate clocks */
  2694.                 clock1 = hdmi_mode->clock;
  2695.                 clock2 = hdmi_mode_alternate_clock(hdmi_mode);
  2696.  
  2697.                 if ((KHZ2PICOS(to_match->clock) == KHZ2PICOS(clock1) ||
  2698.                      KHZ2PICOS(to_match->clock) == KHZ2PICOS(clock2)) &&
  2699.                     drm_mode_equal_no_clocks_no_stereo(to_match, hdmi_mode))
  2700.                         return vic;
  2701.         }
  2702.         return 0;
  2703. }
  2704.  
  2705. static bool drm_valid_hdmi_vic(u8 vic)
  2706. {
  2707.         return vic > 0 && vic < ARRAY_SIZE(edid_4k_modes);
  2708. }
  2709.  
  2710. static int
  2711. add_alternate_cea_modes(struct drm_connector *connector, struct edid *edid)
  2712. {
  2713.         struct drm_device *dev = connector->dev;
  2714.         struct drm_display_mode *mode, *tmp;
  2715.         LIST_HEAD(list);
  2716.         int modes = 0;
  2717.  
  2718.         /* Don't add CEA modes if the CEA extension block is missing */
  2719.         if (!drm_find_cea_extension(edid))
  2720.                 return 0;
  2721.  
  2722.         /*
  2723.          * Go through all probed modes and create a new mode
  2724.          * with the alternate clock for certain CEA modes.
  2725.          */
  2726.         list_for_each_entry(mode, &connector->probed_modes, head) {
  2727.                 const struct drm_display_mode *cea_mode = NULL;
  2728.                 struct drm_display_mode *newmode;
  2729.                 u8 vic = drm_match_cea_mode(mode);
  2730.                 unsigned int clock1, clock2;
  2731.  
  2732.                 if (drm_valid_cea_vic(vic)) {
  2733.                         cea_mode = &edid_cea_modes[vic];
  2734.                         clock2 = cea_mode_alternate_clock(cea_mode);
  2735.                 } else {
  2736.                         vic = drm_match_hdmi_mode(mode);
  2737.                         if (drm_valid_hdmi_vic(vic)) {
  2738.                                 cea_mode = &edid_4k_modes[vic];
  2739.                                 clock2 = hdmi_mode_alternate_clock(cea_mode);
  2740.                         }
  2741.                 }
  2742.  
  2743.                 if (!cea_mode)
  2744.                         continue;
  2745.  
  2746.                 clock1 = cea_mode->clock;
  2747.  
  2748.                 if (clock1 == clock2)
  2749.                         continue;
  2750.  
  2751.                 if (mode->clock != clock1 && mode->clock != clock2)
  2752.                         continue;
  2753.  
  2754.                 newmode = drm_mode_duplicate(dev, cea_mode);
  2755.                 if (!newmode)
  2756.                         continue;
  2757.  
  2758.                 /* Carry over the stereo flags */
  2759.                 newmode->flags |= mode->flags & DRM_MODE_FLAG_3D_MASK;
  2760.  
  2761.                 /*
  2762.                  * The current mode could be either variant. Make
  2763.                  * sure to pick the "other" clock for the new mode.
  2764.                  */
  2765.                 if (mode->clock != clock1)
  2766.                         newmode->clock = clock1;
  2767.                 else
  2768.                         newmode->clock = clock2;
  2769.  
  2770.                 list_add_tail(&newmode->head, &list);
  2771.         }
  2772.  
  2773.         list_for_each_entry_safe(mode, tmp, &list, head) {
  2774.                 list_del(&mode->head);
  2775.                 drm_mode_probed_add(connector, mode);
  2776.                 modes++;
  2777.         }
  2778.  
  2779.         return modes;
  2780. }
  2781.  
  2782. static struct drm_display_mode *
  2783. drm_display_mode_from_vic_index(struct drm_connector *connector,
  2784.                                 const u8 *video_db, u8 video_len,
  2785.                                 u8 video_index)
  2786. {
  2787.         struct drm_device *dev = connector->dev;
  2788.         struct drm_display_mode *newmode;
  2789.         u8 vic;
  2790.  
  2791.         if (video_db == NULL || video_index >= video_len)
  2792.                 return NULL;
  2793.  
  2794.         /* CEA modes are numbered 1..127 */
  2795.         vic = (video_db[video_index] & 127);
  2796.         if (!drm_valid_cea_vic(vic))
  2797.                 return NULL;
  2798.  
  2799.         newmode = drm_mode_duplicate(dev, &edid_cea_modes[vic]);
  2800.         if (!newmode)
  2801.                 return NULL;
  2802.  
  2803.         newmode->vrefresh = 0;
  2804.  
  2805.         return newmode;
  2806. }
  2807.  
  2808. static int
  2809. do_cea_modes(struct drm_connector *connector, const u8 *db, u8 len)
  2810. {
  2811.         int i, modes = 0;
  2812.  
  2813.         for (i = 0; i < len; i++) {
  2814.                 struct drm_display_mode *mode;
  2815.                 mode = drm_display_mode_from_vic_index(connector, db, len, i);
  2816.                 if (mode) {
  2817.                         drm_mode_probed_add(connector, mode);
  2818.                         modes++;
  2819.                 }
  2820.         }
  2821.  
  2822.         return modes;
  2823. }
  2824.  
  2825. struct stereo_mandatory_mode {
  2826.         int width, height, vrefresh;
  2827.         unsigned int flags;
  2828. };
  2829.  
  2830. static const struct stereo_mandatory_mode stereo_mandatory_modes[] = {
  2831.         { 1920, 1080, 24, DRM_MODE_FLAG_3D_TOP_AND_BOTTOM },
  2832.         { 1920, 1080, 24, DRM_MODE_FLAG_3D_FRAME_PACKING },
  2833.         { 1920, 1080, 50,
  2834.           DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF },
  2835.         { 1920, 1080, 60,
  2836.           DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF },
  2837.         { 1280, 720,  50, DRM_MODE_FLAG_3D_TOP_AND_BOTTOM },
  2838.         { 1280, 720,  50, DRM_MODE_FLAG_3D_FRAME_PACKING },
  2839.         { 1280, 720,  60, DRM_MODE_FLAG_3D_TOP_AND_BOTTOM },
  2840.         { 1280, 720,  60, DRM_MODE_FLAG_3D_FRAME_PACKING }
  2841. };
  2842.  
  2843. static bool
  2844. stereo_match_mandatory(const struct drm_display_mode *mode,
  2845.                        const struct stereo_mandatory_mode *stereo_mode)
  2846. {
  2847.         unsigned int interlaced = mode->flags & DRM_MODE_FLAG_INTERLACE;
  2848.  
  2849.         return mode->hdisplay == stereo_mode->width &&
  2850.                mode->vdisplay == stereo_mode->height &&
  2851.                interlaced == (stereo_mode->flags & DRM_MODE_FLAG_INTERLACE) &&
  2852.                drm_mode_vrefresh(mode) == stereo_mode->vrefresh;
  2853. }
  2854.  
  2855. static int add_hdmi_mandatory_stereo_modes(struct drm_connector *connector)
  2856. {
  2857.         struct drm_device *dev = connector->dev;
  2858.         const struct drm_display_mode *mode;
  2859.         struct list_head stereo_modes;
  2860.         int modes = 0, i;
  2861.  
  2862.         INIT_LIST_HEAD(&stereo_modes);
  2863.  
  2864.         list_for_each_entry(mode, &connector->probed_modes, head) {
  2865.                 for (i = 0; i < ARRAY_SIZE(stereo_mandatory_modes); i++) {
  2866.                         const struct stereo_mandatory_mode *mandatory;
  2867.                         struct drm_display_mode *new_mode;
  2868.  
  2869.                         if (!stereo_match_mandatory(mode,
  2870.                                                     &stereo_mandatory_modes[i]))
  2871.                                 continue;
  2872.  
  2873.                         mandatory = &stereo_mandatory_modes[i];
  2874.                         new_mode = drm_mode_duplicate(dev, mode);
  2875.                         if (!new_mode)
  2876.                                 continue;
  2877.  
  2878.                         new_mode->flags |= mandatory->flags;
  2879.                         list_add_tail(&new_mode->head, &stereo_modes);
  2880.                         modes++;
  2881.                 }
  2882.         }
  2883.  
  2884.         list_splice_tail(&stereo_modes, &connector->probed_modes);
  2885.  
  2886.         return modes;
  2887. }
  2888.  
  2889. static int add_hdmi_mode(struct drm_connector *connector, u8 vic)
  2890. {
  2891.         struct drm_device *dev = connector->dev;
  2892.         struct drm_display_mode *newmode;
  2893.  
  2894.         if (!drm_valid_hdmi_vic(vic)) {
  2895.                 DRM_ERROR("Unknown HDMI VIC: %d\n", vic);
  2896.                 return 0;
  2897.         }
  2898.  
  2899.         newmode = drm_mode_duplicate(dev, &edid_4k_modes[vic]);
  2900.         if (!newmode)
  2901.                 return 0;
  2902.  
  2903.         drm_mode_probed_add(connector, newmode);
  2904.  
  2905.         return 1;
  2906. }
  2907.  
  2908. static int add_3d_struct_modes(struct drm_connector *connector, u16 structure,
  2909.                                const u8 *video_db, u8 video_len, u8 video_index)
  2910. {
  2911.         struct drm_display_mode *newmode;
  2912.         int modes = 0;
  2913.  
  2914.         if (structure & (1 << 0)) {
  2915.                 newmode = drm_display_mode_from_vic_index(connector, video_db,
  2916.                                                           video_len,
  2917.                                                           video_index);
  2918.                 if (newmode) {
  2919.                         newmode->flags |= DRM_MODE_FLAG_3D_FRAME_PACKING;
  2920.                         drm_mode_probed_add(connector, newmode);
  2921.                         modes++;
  2922.                 }
  2923.         }
  2924.         if (structure & (1 << 6)) {
  2925.                 newmode = drm_display_mode_from_vic_index(connector, video_db,
  2926.                                                           video_len,
  2927.                                                           video_index);
  2928.                 if (newmode) {
  2929.                         newmode->flags |= DRM_MODE_FLAG_3D_TOP_AND_BOTTOM;
  2930.                         drm_mode_probed_add(connector, newmode);
  2931.                         modes++;
  2932.                 }
  2933.         }
  2934.         if (structure & (1 << 8)) {
  2935.                 newmode = drm_display_mode_from_vic_index(connector, video_db,
  2936.                                                           video_len,
  2937.                                                           video_index);
  2938.                 if (newmode) {
  2939.                         newmode->flags |= DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF;
  2940.                         drm_mode_probed_add(connector, newmode);
  2941.                         modes++;
  2942.                 }
  2943.         }
  2944.  
  2945.         return modes;
  2946. }
  2947.  
  2948. /*
  2949.  * do_hdmi_vsdb_modes - Parse the HDMI Vendor Specific data block
  2950.  * @connector: connector corresponding to the HDMI sink
  2951.  * @db: start of the CEA vendor specific block
  2952.  * @len: length of the CEA block payload, ie. one can access up to db[len]
  2953.  *
  2954.  * Parses the HDMI VSDB looking for modes to add to @connector. This function
  2955.  * also adds the stereo 3d modes when applicable.
  2956.  */
  2957. static int
  2958. do_hdmi_vsdb_modes(struct drm_connector *connector, const u8 *db, u8 len,
  2959.                    const u8 *video_db, u8 video_len)
  2960. {
  2961.         int modes = 0, offset = 0, i, multi_present = 0, multi_len;
  2962.         u8 vic_len, hdmi_3d_len = 0;
  2963.         u16 mask;
  2964.         u16 structure_all;
  2965.  
  2966.         if (len < 8)
  2967.                 goto out;
  2968.  
  2969.         /* no HDMI_Video_Present */
  2970.         if (!(db[8] & (1 << 5)))
  2971.                 goto out;
  2972.  
  2973.         /* Latency_Fields_Present */
  2974.         if (db[8] & (1 << 7))
  2975.                 offset += 2;
  2976.  
  2977.         /* I_Latency_Fields_Present */
  2978.         if (db[8] & (1 << 6))
  2979.                 offset += 2;
  2980.  
  2981.         /* the declared length is not long enough for the 2 first bytes
  2982.          * of additional video format capabilities */
  2983.         if (len < (8 + offset + 2))
  2984.                 goto out;
  2985.  
  2986.         /* 3D_Present */
  2987.         offset++;
  2988.         if (db[8 + offset] & (1 << 7)) {
  2989.                 modes += add_hdmi_mandatory_stereo_modes(connector);
  2990.  
  2991.                 /* 3D_Multi_present */
  2992.                 multi_present = (db[8 + offset] & 0x60) >> 5;
  2993.         }
  2994.  
  2995.         offset++;
  2996.         vic_len = db[8 + offset] >> 5;
  2997.         hdmi_3d_len = db[8 + offset] & 0x1f;
  2998.  
  2999.         for (i = 0; i < vic_len && len >= (9 + offset + i); i++) {
  3000.                 u8 vic;
  3001.  
  3002.                 vic = db[9 + offset + i];
  3003.                 modes += add_hdmi_mode(connector, vic);
  3004.         }
  3005.         offset += 1 + vic_len;
  3006.  
  3007.         if (multi_present == 1)
  3008.                 multi_len = 2;
  3009.         else if (multi_present == 2)
  3010.                 multi_len = 4;
  3011.         else
  3012.                 multi_len = 0;
  3013.  
  3014.         if (len < (8 + offset + hdmi_3d_len - 1))
  3015.                 goto out;
  3016.  
  3017.         if (hdmi_3d_len < multi_len)
  3018.                 goto out;
  3019.  
  3020.         if (multi_present == 1 || multi_present == 2) {
  3021.                 /* 3D_Structure_ALL */
  3022.                 structure_all = (db[8 + offset] << 8) | db[9 + offset];
  3023.  
  3024.                 /* check if 3D_MASK is present */
  3025.                 if (multi_present == 2)
  3026.                         mask = (db[10 + offset] << 8) | db[11 + offset];
  3027.                 else
  3028.                         mask = 0xffff;
  3029.  
  3030.                 for (i = 0; i < 16; i++) {
  3031.                         if (mask & (1 << i))
  3032.                                 modes += add_3d_struct_modes(connector,
  3033.                                                 structure_all,
  3034.                                                 video_db,
  3035.                                                 video_len, i);
  3036.                 }
  3037.         }
  3038.  
  3039.         offset += multi_len;
  3040.  
  3041.         for (i = 0; i < (hdmi_3d_len - multi_len); i++) {
  3042.                 int vic_index;
  3043.                 struct drm_display_mode *newmode = NULL;
  3044.                 unsigned int newflag = 0;
  3045.                 bool detail_present;
  3046.  
  3047.                 detail_present = ((db[8 + offset + i] & 0x0f) > 7);
  3048.  
  3049.                 if (detail_present && (i + 1 == hdmi_3d_len - multi_len))
  3050.                         break;
  3051.  
  3052.                 /* 2D_VIC_order_X */
  3053.                 vic_index = db[8 + offset + i] >> 4;
  3054.  
  3055.                 /* 3D_Structure_X */
  3056.                 switch (db[8 + offset + i] & 0x0f) {
  3057.                 case 0:
  3058.                         newflag = DRM_MODE_FLAG_3D_FRAME_PACKING;
  3059.                         break;
  3060.                 case 6:
  3061.                         newflag = DRM_MODE_FLAG_3D_TOP_AND_BOTTOM;
  3062.                         break;
  3063.                 case 8:
  3064.                         /* 3D_Detail_X */
  3065.                         if ((db[9 + offset + i] >> 4) == 1)
  3066.                                 newflag = DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF;
  3067.                         break;
  3068.                 }
  3069.  
  3070.                 if (newflag != 0) {
  3071.                         newmode = drm_display_mode_from_vic_index(connector,
  3072.                                                                   video_db,
  3073.                                                                   video_len,
  3074.                                                                   vic_index);
  3075.  
  3076.                         if (newmode) {
  3077.                                 newmode->flags |= newflag;
  3078.                                 drm_mode_probed_add(connector, newmode);
  3079.                                 modes++;
  3080.                         }
  3081.                 }
  3082.  
  3083.                 if (detail_present)
  3084.                         i++;
  3085.         }
  3086.  
  3087. out:
  3088.         return modes;
  3089. }
  3090.  
  3091. static int
  3092. cea_db_payload_len(const u8 *db)
  3093. {
  3094.         return db[0] & 0x1f;
  3095. }
  3096.  
  3097. static int
  3098. cea_db_tag(const u8 *db)
  3099. {
  3100.         return db[0] >> 5;
  3101. }
  3102.  
  3103. static int
  3104. cea_revision(const u8 *cea)
  3105. {
  3106.         return cea[1];
  3107. }
  3108.  
  3109. static int
  3110. cea_db_offsets(const u8 *cea, int *start, int *end)
  3111. {
  3112.         /* Data block offset in CEA extension block */
  3113.         *start = 4;
  3114.         *end = cea[2];
  3115.         if (*end == 0)
  3116.                 *end = 127;
  3117.         if (*end < 4 || *end > 127)
  3118.                 return -ERANGE;
  3119.         return 0;
  3120. }
  3121.  
  3122. static bool cea_db_is_hdmi_vsdb(const u8 *db)
  3123. {
  3124.         int hdmi_id;
  3125.  
  3126.         if (cea_db_tag(db) != VENDOR_BLOCK)
  3127.                 return false;
  3128.  
  3129.         if (cea_db_payload_len(db) < 5)
  3130.                 return false;
  3131.  
  3132.         hdmi_id = db[1] | (db[2] << 8) | (db[3] << 16);
  3133.  
  3134.         return hdmi_id == HDMI_IEEE_OUI;
  3135. }
  3136.  
  3137. #define for_each_cea_db(cea, i, start, end) \
  3138.         for ((i) = (start); (i) < (end) && (i) + cea_db_payload_len(&(cea)[(i)]) < (end); (i) += cea_db_payload_len(&(cea)[(i)]) + 1)
  3139.  
  3140. static int
  3141. add_cea_modes(struct drm_connector *connector, struct edid *edid)
  3142. {
  3143.         const u8 *cea = drm_find_cea_extension(edid);
  3144.         const u8 *db, *hdmi = NULL, *video = NULL;
  3145.         u8 dbl, hdmi_len, video_len = 0;
  3146.         int modes = 0;
  3147.  
  3148.         if (cea && cea_revision(cea) >= 3) {
  3149.                 int i, start, end;
  3150.  
  3151.                 if (cea_db_offsets(cea, &start, &end))
  3152.                         return 0;
  3153.  
  3154.                 for_each_cea_db(cea, i, start, end) {
  3155.                         db = &cea[i];
  3156.                         dbl = cea_db_payload_len(db);
  3157.  
  3158.                         if (cea_db_tag(db) == VIDEO_BLOCK) {
  3159.                                 video = db + 1;
  3160.                                 video_len = dbl;
  3161.                                 modes += do_cea_modes(connector, video, dbl);
  3162.                         }
  3163.                         else if (cea_db_is_hdmi_vsdb(db)) {
  3164.                                 hdmi = db;
  3165.                                 hdmi_len = dbl;
  3166.                         }
  3167.                 }
  3168.         }
  3169.  
  3170.         /*
  3171.          * We parse the HDMI VSDB after having added the cea modes as we will
  3172.          * be patching their flags when the sink supports stereo 3D.
  3173.          */
  3174.         if (hdmi)
  3175.                 modes += do_hdmi_vsdb_modes(connector, hdmi, hdmi_len, video,
  3176.                                             video_len);
  3177.  
  3178.         return modes;
  3179. }
  3180.  
  3181. static void fixup_detailed_cea_mode_clock(struct drm_display_mode *mode)
  3182. {
  3183.         const struct drm_display_mode *cea_mode;
  3184.         int clock1, clock2, clock;
  3185.         u8 vic;
  3186.         const char *type;
  3187.  
  3188.         /*
  3189.          * allow 5kHz clock difference either way to account for
  3190.          * the 10kHz clock resolution limit of detailed timings.
  3191.          */
  3192.         vic = drm_match_cea_mode_clock_tolerance(mode, 5);
  3193.         if (drm_valid_cea_vic(vic)) {
  3194.                 type = "CEA";
  3195.                 cea_mode = &edid_cea_modes[vic];
  3196.                 clock1 = cea_mode->clock;
  3197.                 clock2 = cea_mode_alternate_clock(cea_mode);
  3198.         } else {
  3199.                 vic = drm_match_hdmi_mode_clock_tolerance(mode, 5);
  3200.                 if (drm_valid_hdmi_vic(vic)) {
  3201.                         type = "HDMI";
  3202.                         cea_mode = &edid_4k_modes[vic];
  3203.                         clock1 = cea_mode->clock;
  3204.                         clock2 = hdmi_mode_alternate_clock(cea_mode);
  3205.                 } else {
  3206.                         return;
  3207.                 }
  3208.         }
  3209.  
  3210.         /* pick whichever is closest */
  3211.         if (abs(mode->clock - clock1) < abs(mode->clock - clock2))
  3212.                 clock = clock1;
  3213.         else
  3214.                 clock = clock2;
  3215.  
  3216.         if (mode->clock == clock)
  3217.                 return;
  3218.  
  3219.         DRM_DEBUG("detailed mode matches %s VIC %d, adjusting clock %d -> %d\n",
  3220.                   type, vic, mode->clock, clock);
  3221.         mode->clock = clock;
  3222. }
  3223.  
  3224. static void
  3225. parse_hdmi_vsdb(struct drm_connector *connector, const u8 *db)
  3226. {
  3227.         u8 len = cea_db_payload_len(db);
  3228.  
  3229.         if (len >= 6) {
  3230.                 connector->eld[5] |= (db[6] >> 7) << 1;  /* Supports_AI */
  3231.                 connector->dvi_dual = db[6] & 1;
  3232.         }
  3233.         if (len >= 7)
  3234.                 connector->max_tmds_clock = db[7] * 5;
  3235.         if (len >= 8) {
  3236.                 connector->latency_present[0] = db[8] >> 7;
  3237.                 connector->latency_present[1] = (db[8] >> 6) & 1;
  3238.         }
  3239.         if (len >= 9)
  3240.                 connector->video_latency[0] = db[9];
  3241.         if (len >= 10)
  3242.                 connector->audio_latency[0] = db[10];
  3243.         if (len >= 11)
  3244.                 connector->video_latency[1] = db[11];
  3245.         if (len >= 12)
  3246.                 connector->audio_latency[1] = db[12];
  3247.  
  3248.         DRM_DEBUG_KMS("HDMI: DVI dual %d, "
  3249.                     "max TMDS clock %d, "
  3250.                     "latency present %d %d, "
  3251.                     "video latency %d %d, "
  3252.                     "audio latency %d %d\n",
  3253.                     connector->dvi_dual,
  3254.                     connector->max_tmds_clock,
  3255.               (int) connector->latency_present[0],
  3256.               (int) connector->latency_present[1],
  3257.                     connector->video_latency[0],
  3258.                     connector->video_latency[1],
  3259.                     connector->audio_latency[0],
  3260.                     connector->audio_latency[1]);
  3261. }
  3262.  
  3263. static void
  3264. monitor_name(struct detailed_timing *t, void *data)
  3265. {
  3266.         if (t->data.other_data.type == EDID_DETAIL_MONITOR_NAME)
  3267.                 *(u8 **)data = t->data.other_data.data.str.str;
  3268. }
  3269.  
  3270. /**
  3271.  * drm_edid_to_eld - build ELD from EDID
  3272.  * @connector: connector corresponding to the HDMI/DP sink
  3273.  * @edid: EDID to parse
  3274.  *
  3275.  * Fill the ELD (EDID-Like Data) buffer for passing to the audio driver. The
  3276.  * Conn_Type, HDCP and Port_ID ELD fields are left for the graphics driver to
  3277.  * fill in.
  3278.  */
  3279. void drm_edid_to_eld(struct drm_connector *connector, struct edid *edid)
  3280. {
  3281.         uint8_t *eld = connector->eld;
  3282.         u8 *cea;
  3283.         u8 *name;
  3284.         u8 *db;
  3285.         int sad_count = 0;
  3286.         int mnl;
  3287.         int dbl;
  3288.  
  3289.         memset(eld, 0, sizeof(connector->eld));
  3290.  
  3291.         cea = drm_find_cea_extension(edid);
  3292.         if (!cea) {
  3293.                 DRM_DEBUG_KMS("ELD: no CEA Extension found\n");
  3294.                 return;
  3295.         }
  3296.  
  3297.         name = NULL;
  3298.         drm_for_each_detailed_block((u8 *)edid, monitor_name, &name);
  3299.         for (mnl = 0; name && mnl < 13; mnl++) {
  3300.                 if (name[mnl] == 0x0a)
  3301.                         break;
  3302.                 eld[20 + mnl] = name[mnl];
  3303.         }
  3304.         eld[4] = (cea[1] << 5) | mnl;
  3305.         DRM_DEBUG_KMS("ELD monitor %s\n", eld + 20);
  3306.  
  3307.         eld[0] = 2 << 3;                /* ELD version: 2 */
  3308.  
  3309.         eld[16] = edid->mfg_id[0];
  3310.         eld[17] = edid->mfg_id[1];
  3311.         eld[18] = edid->prod_code[0];
  3312.         eld[19] = edid->prod_code[1];
  3313.  
  3314.         if (cea_revision(cea) >= 3) {
  3315.                 int i, start, end;
  3316.  
  3317.                 if (cea_db_offsets(cea, &start, &end)) {
  3318.                         start = 0;
  3319.                         end = 0;
  3320.                 }
  3321.  
  3322.                 for_each_cea_db(cea, i, start, end) {
  3323.                         db = &cea[i];
  3324.                         dbl = cea_db_payload_len(db);
  3325.  
  3326.                         switch (cea_db_tag(db)) {
  3327.                         case AUDIO_BLOCK:
  3328.                                 /* Audio Data Block, contains SADs */
  3329.                                 sad_count = dbl / 3;
  3330.                                 if (dbl >= 1)
  3331.                                         memcpy(eld + 20 + mnl, &db[1], dbl);
  3332.                                 break;
  3333.                         case SPEAKER_BLOCK:
  3334.                                 /* Speaker Allocation Data Block */
  3335.                                 if (dbl >= 1)
  3336.                                         eld[7] = db[1];
  3337.                                 break;
  3338.                         case VENDOR_BLOCK:
  3339.                                 /* HDMI Vendor-Specific Data Block */
  3340.                                 if (cea_db_is_hdmi_vsdb(db))
  3341.                                         parse_hdmi_vsdb(connector, db);
  3342.                                 break;
  3343.                         default:
  3344.                                 break;
  3345.                         }
  3346.                 }
  3347.         }
  3348.         eld[5] |= sad_count << 4;
  3349.  
  3350.         eld[DRM_ELD_BASELINE_ELD_LEN] =
  3351.                 DIV_ROUND_UP(drm_eld_calc_baseline_block_size(eld), 4);
  3352.  
  3353.         DRM_DEBUG_KMS("ELD size %d, SAD count %d\n",
  3354.                       drm_eld_size(eld), sad_count);
  3355. }
  3356. EXPORT_SYMBOL(drm_edid_to_eld);
  3357.  
  3358. /**
  3359.  * drm_edid_to_sad - extracts SADs from EDID
  3360.  * @edid: EDID to parse
  3361.  * @sads: pointer that will be set to the extracted SADs
  3362.  *
  3363.  * Looks for CEA EDID block and extracts SADs (Short Audio Descriptors) from it.
  3364.  *
  3365.  * Note: The returned pointer needs to be freed using kfree().
  3366.  *
  3367.  * Return: The number of found SADs or negative number on error.
  3368.  */
  3369. int drm_edid_to_sad(struct edid *edid, struct cea_sad **sads)
  3370. {
  3371.         int count = 0;
  3372.         int i, start, end, dbl;
  3373.         u8 *cea;
  3374.  
  3375.         cea = drm_find_cea_extension(edid);
  3376.         if (!cea) {
  3377.                 DRM_DEBUG_KMS("SAD: no CEA Extension found\n");
  3378.                 return -ENOENT;
  3379.         }
  3380.  
  3381.         if (cea_revision(cea) < 3) {
  3382.                 DRM_DEBUG_KMS("SAD: wrong CEA revision\n");
  3383.                 return -ENOTSUPP;
  3384.         }
  3385.  
  3386.         if (cea_db_offsets(cea, &start, &end)) {
  3387.                 DRM_DEBUG_KMS("SAD: invalid data block offsets\n");
  3388.                 return -EPROTO;
  3389.         }
  3390.  
  3391.         for_each_cea_db(cea, i, start, end) {
  3392.                 u8 *db = &cea[i];
  3393.  
  3394.                 if (cea_db_tag(db) == AUDIO_BLOCK) {
  3395.                         int j;
  3396.                         dbl = cea_db_payload_len(db);
  3397.  
  3398.                         count = dbl / 3; /* SAD is 3B */
  3399.                         *sads = kcalloc(count, sizeof(**sads), GFP_KERNEL);
  3400.                         if (!*sads)
  3401.                                 return -ENOMEM;
  3402.                         for (j = 0; j < count; j++) {
  3403.                                 u8 *sad = &db[1 + j * 3];
  3404.  
  3405.                                 (*sads)[j].format = (sad[0] & 0x78) >> 3;
  3406.                                 (*sads)[j].channels = sad[0] & 0x7;
  3407.                                 (*sads)[j].freq = sad[1] & 0x7F;
  3408.                                 (*sads)[j].byte2 = sad[2];
  3409.                         }
  3410.                         break;
  3411.                 }
  3412.         }
  3413.  
  3414.         return count;
  3415. }
  3416. EXPORT_SYMBOL(drm_edid_to_sad);
  3417.  
  3418. /**
  3419.  * drm_edid_to_speaker_allocation - extracts Speaker Allocation Data Blocks from EDID
  3420.  * @edid: EDID to parse
  3421.  * @sadb: pointer to the speaker block
  3422.  *
  3423.  * Looks for CEA EDID block and extracts the Speaker Allocation Data Block from it.
  3424.  *
  3425.  * Note: The returned pointer needs to be freed using kfree().
  3426.  *
  3427.  * Return: The number of found Speaker Allocation Blocks or negative number on
  3428.  * error.
  3429.  */
  3430. int drm_edid_to_speaker_allocation(struct edid *edid, u8 **sadb)
  3431. {
  3432.         int count = 0;
  3433.         int i, start, end, dbl;
  3434.         const u8 *cea;
  3435.  
  3436.         cea = drm_find_cea_extension(edid);
  3437.         if (!cea) {
  3438.                 DRM_DEBUG_KMS("SAD: no CEA Extension found\n");
  3439.                 return -ENOENT;
  3440.         }
  3441.  
  3442.         if (cea_revision(cea) < 3) {
  3443.                 DRM_DEBUG_KMS("SAD: wrong CEA revision\n");
  3444.                 return -ENOTSUPP;
  3445.         }
  3446.  
  3447.         if (cea_db_offsets(cea, &start, &end)) {
  3448.                 DRM_DEBUG_KMS("SAD: invalid data block offsets\n");
  3449.                 return -EPROTO;
  3450.         }
  3451.  
  3452.         for_each_cea_db(cea, i, start, end) {
  3453.                 const u8 *db = &cea[i];
  3454.  
  3455.                 if (cea_db_tag(db) == SPEAKER_BLOCK) {
  3456.                         dbl = cea_db_payload_len(db);
  3457.  
  3458.                         /* Speaker Allocation Data Block */
  3459.                         if (dbl == 3) {
  3460.                                 *sadb = kmemdup(&db[1], dbl, GFP_KERNEL);
  3461.                                 if (!*sadb)
  3462.                                         return -ENOMEM;
  3463.                                 count = dbl;
  3464.                                 break;
  3465.                         }
  3466.                 }
  3467.         }
  3468.  
  3469.         return count;
  3470. }
  3471. EXPORT_SYMBOL(drm_edid_to_speaker_allocation);
  3472.  
  3473. /**
  3474.  * drm_av_sync_delay - compute the HDMI/DP sink audio-video sync delay
  3475.  * @connector: connector associated with the HDMI/DP sink
  3476.  * @mode: the display mode
  3477.  *
  3478.  * Return: The HDMI/DP sink's audio-video sync delay in milliseconds or 0 if
  3479.  * the sink doesn't support audio or video.
  3480.  */
  3481. int drm_av_sync_delay(struct drm_connector *connector,
  3482.                       const struct drm_display_mode *mode)
  3483. {
  3484.         int i = !!(mode->flags & DRM_MODE_FLAG_INTERLACE);
  3485.         int a, v;
  3486.  
  3487.         if (!connector->latency_present[0])
  3488.                 return 0;
  3489.         if (!connector->latency_present[1])
  3490.                 i = 0;
  3491.  
  3492.         a = connector->audio_latency[i];
  3493.         v = connector->video_latency[i];
  3494.  
  3495.         /*
  3496.          * HDMI/DP sink doesn't support audio or video?
  3497.          */
  3498.         if (a == 255 || v == 255)
  3499.                 return 0;
  3500.  
  3501.         /*
  3502.          * Convert raw EDID values to millisecond.
  3503.          * Treat unknown latency as 0ms.
  3504.          */
  3505.         if (a)
  3506.                 a = min(2 * (a - 1), 500);
  3507.         if (v)
  3508.                 v = min(2 * (v - 1), 500);
  3509.  
  3510.         return max(v - a, 0);
  3511. }
  3512. EXPORT_SYMBOL(drm_av_sync_delay);
  3513.  
  3514. /**
  3515.  * drm_select_eld - select one ELD from multiple HDMI/DP sinks
  3516.  * @encoder: the encoder just changed display mode
  3517.  *
  3518.  * It's possible for one encoder to be associated with multiple HDMI/DP sinks.
  3519.  * The policy is now hard coded to simply use the first HDMI/DP sink's ELD.
  3520.  *
  3521.  * Return: The connector associated with the first HDMI/DP sink that has ELD
  3522.  * attached to it.
  3523.  */
  3524. struct drm_connector *drm_select_eld(struct drm_encoder *encoder)
  3525. {
  3526.         struct drm_connector *connector;
  3527.         struct drm_device *dev = encoder->dev;
  3528.  
  3529.         WARN_ON(!mutex_is_locked(&dev->mode_config.mutex));
  3530.         WARN_ON(!drm_modeset_is_locked(&dev->mode_config.connection_mutex));
  3531.  
  3532.         drm_for_each_connector(connector, dev)
  3533.                 if (connector->encoder == encoder && connector->eld[0])
  3534.                         return connector;
  3535.  
  3536.         return NULL;
  3537. }
  3538. EXPORT_SYMBOL(drm_select_eld);
  3539.  
  3540. /**
  3541.  * drm_detect_hdmi_monitor - detect whether monitor is HDMI
  3542.  * @edid: monitor EDID information
  3543.  *
  3544.  * Parse the CEA extension according to CEA-861-B.
  3545.  *
  3546.  * Return: True if the monitor is HDMI, false if not or unknown.
  3547.  */
  3548. bool drm_detect_hdmi_monitor(struct edid *edid)
  3549. {
  3550.         u8 *edid_ext;
  3551.         int i;
  3552.         int start_offset, end_offset;
  3553.  
  3554.         edid_ext = drm_find_cea_extension(edid);
  3555.         if (!edid_ext)
  3556.                 return false;
  3557.  
  3558.         if (cea_db_offsets(edid_ext, &start_offset, &end_offset))
  3559.                 return false;
  3560.  
  3561.         /*
  3562.          * Because HDMI identifier is in Vendor Specific Block,
  3563.          * search it from all data blocks of CEA extension.
  3564.          */
  3565.         for_each_cea_db(edid_ext, i, start_offset, end_offset) {
  3566.                 if (cea_db_is_hdmi_vsdb(&edid_ext[i]))
  3567.                         return true;
  3568.         }
  3569.  
  3570.         return false;
  3571. }
  3572. EXPORT_SYMBOL(drm_detect_hdmi_monitor);
  3573.  
  3574. /**
  3575.  * drm_detect_monitor_audio - check monitor audio capability
  3576.  * @edid: EDID block to scan
  3577.  *
  3578.  * Monitor should have CEA extension block.
  3579.  * If monitor has 'basic audio', but no CEA audio blocks, it's 'basic
  3580.  * audio' only. If there is any audio extension block and supported
  3581.  * audio format, assume at least 'basic audio' support, even if 'basic
  3582.  * audio' is not defined in EDID.
  3583.  *
  3584.  * Return: True if the monitor supports audio, false otherwise.
  3585.  */
  3586. bool drm_detect_monitor_audio(struct edid *edid)
  3587. {
  3588.         u8 *edid_ext;
  3589.         int i, j;
  3590.         bool has_audio = false;
  3591.         int start_offset, end_offset;
  3592.  
  3593.         edid_ext = drm_find_cea_extension(edid);
  3594.         if (!edid_ext)
  3595.                 goto end;
  3596.  
  3597.         has_audio = ((edid_ext[3] & EDID_BASIC_AUDIO) != 0);
  3598.  
  3599.         if (has_audio) {
  3600.                 DRM_DEBUG_KMS("Monitor has basic audio support\n");
  3601.                 goto end;
  3602.         }
  3603.  
  3604.         if (cea_db_offsets(edid_ext, &start_offset, &end_offset))
  3605.                 goto end;
  3606.  
  3607.         for_each_cea_db(edid_ext, i, start_offset, end_offset) {
  3608.                 if (cea_db_tag(&edid_ext[i]) == AUDIO_BLOCK) {
  3609.                         has_audio = true;
  3610.                         for (j = 1; j < cea_db_payload_len(&edid_ext[i]) + 1; j += 3)
  3611.                                 DRM_DEBUG_KMS("CEA audio format %d\n",
  3612.                                               (edid_ext[i + j] >> 3) & 0xf);
  3613.                         goto end;
  3614.                 }
  3615.         }
  3616. end:
  3617.         return has_audio;
  3618. }
  3619. EXPORT_SYMBOL(drm_detect_monitor_audio);
  3620.  
  3621. /**
  3622.  * drm_rgb_quant_range_selectable - is RGB quantization range selectable?
  3623.  * @edid: EDID block to scan
  3624.  *
  3625.  * Check whether the monitor reports the RGB quantization range selection
  3626.  * as supported. The AVI infoframe can then be used to inform the monitor
  3627.  * which quantization range (full or limited) is used.
  3628.  *
  3629.  * Return: True if the RGB quantization range is selectable, false otherwise.
  3630.  */
  3631. bool drm_rgb_quant_range_selectable(struct edid *edid)
  3632. {
  3633.         u8 *edid_ext;
  3634.         int i, start, end;
  3635.  
  3636.         edid_ext = drm_find_cea_extension(edid);
  3637.         if (!edid_ext)
  3638.                 return false;
  3639.  
  3640.         if (cea_db_offsets(edid_ext, &start, &end))
  3641.                 return false;
  3642.  
  3643.         for_each_cea_db(edid_ext, i, start, end) {
  3644.                 if (cea_db_tag(&edid_ext[i]) == VIDEO_CAPABILITY_BLOCK &&
  3645.                     cea_db_payload_len(&edid_ext[i]) == 2) {
  3646.                         DRM_DEBUG_KMS("CEA VCDB 0x%02x\n", edid_ext[i + 2]);
  3647.                         return edid_ext[i + 2] & EDID_CEA_VCDB_QS;
  3648.                 }
  3649.         }
  3650.  
  3651.         return false;
  3652. }
  3653. EXPORT_SYMBOL(drm_rgb_quant_range_selectable);
  3654.  
  3655. /**
  3656.  * drm_assign_hdmi_deep_color_info - detect whether monitor supports
  3657.  * hdmi deep color modes and update drm_display_info if so.
  3658.  * @edid: monitor EDID information
  3659.  * @info: Updated with maximum supported deep color bpc and color format
  3660.  *        if deep color supported.
  3661.  * @connector: DRM connector, used only for debug output
  3662.  *
  3663.  * Parse the CEA extension according to CEA-861-B.
  3664.  * Return true if HDMI deep color supported, false if not or unknown.
  3665.  */
  3666. static bool drm_assign_hdmi_deep_color_info(struct edid *edid,
  3667.                                             struct drm_display_info *info,
  3668.                                             struct drm_connector *connector)
  3669. {
  3670.         u8 *edid_ext, *hdmi;
  3671.         int i;
  3672.         int start_offset, end_offset;
  3673.         unsigned int dc_bpc = 0;
  3674.  
  3675.         edid_ext = drm_find_cea_extension(edid);
  3676.         if (!edid_ext)
  3677.                 return false;
  3678.  
  3679.         if (cea_db_offsets(edid_ext, &start_offset, &end_offset))
  3680.                 return false;
  3681.  
  3682.         /*
  3683.          * Because HDMI identifier is in Vendor Specific Block,
  3684.          * search it from all data blocks of CEA extension.
  3685.          */
  3686.         for_each_cea_db(edid_ext, i, start_offset, end_offset) {
  3687.                 if (cea_db_is_hdmi_vsdb(&edid_ext[i])) {
  3688.                         /* HDMI supports at least 8 bpc */
  3689.                         info->bpc = 8;
  3690.  
  3691.                         hdmi = &edid_ext[i];
  3692.                         if (cea_db_payload_len(hdmi) < 6)
  3693.                                 return false;
  3694.  
  3695.                         if (hdmi[6] & DRM_EDID_HDMI_DC_30) {
  3696.                                 dc_bpc = 10;
  3697.                                 info->edid_hdmi_dc_modes |= DRM_EDID_HDMI_DC_30;
  3698.                                 DRM_DEBUG("%s: HDMI sink does deep color 30.\n",
  3699.                                                   connector->name);
  3700.                         }
  3701.  
  3702.                         if (hdmi[6] & DRM_EDID_HDMI_DC_36) {
  3703.                                 dc_bpc = 12;
  3704.                                 info->edid_hdmi_dc_modes |= DRM_EDID_HDMI_DC_36;
  3705.                                 DRM_DEBUG("%s: HDMI sink does deep color 36.\n",
  3706.                                                   connector->name);
  3707.                         }
  3708.  
  3709.                         if (hdmi[6] & DRM_EDID_HDMI_DC_48) {
  3710.                                 dc_bpc = 16;
  3711.                                 info->edid_hdmi_dc_modes |= DRM_EDID_HDMI_DC_48;
  3712.                                 DRM_DEBUG("%s: HDMI sink does deep color 48.\n",
  3713.                                                   connector->name);
  3714.                         }
  3715.  
  3716.                         if (dc_bpc > 0) {
  3717.                                 DRM_DEBUG("%s: Assigning HDMI sink color depth as %d bpc.\n",
  3718.                                                   connector->name, dc_bpc);
  3719.                                 info->bpc = dc_bpc;
  3720.  
  3721.                                 /*
  3722.                                  * Deep color support mandates RGB444 support for all video
  3723.                                  * modes and forbids YCRCB422 support for all video modes per
  3724.                                  * HDMI 1.3 spec.
  3725.                                  */
  3726.                                 info->color_formats = DRM_COLOR_FORMAT_RGB444;
  3727.  
  3728.                                 /* YCRCB444 is optional according to spec. */
  3729.                                 if (hdmi[6] & DRM_EDID_HDMI_DC_Y444) {
  3730.                                         info->color_formats |= DRM_COLOR_FORMAT_YCRCB444;
  3731.                                         DRM_DEBUG("%s: HDMI sink does YCRCB444 in deep color.\n",
  3732.                                                           connector->name);
  3733.                                 }
  3734.  
  3735.                                 /*
  3736.                                  * Spec says that if any deep color mode is supported at all,
  3737.                                  * then deep color 36 bit must be supported.
  3738.                                  */
  3739.                                 if (!(hdmi[6] & DRM_EDID_HDMI_DC_36)) {
  3740.                                         DRM_DEBUG("%s: HDMI sink should do DC_36, but does not!\n",
  3741.                                                           connector->name);
  3742.                                 }
  3743.  
  3744.                                 return true;
  3745.                         }
  3746.                         else {
  3747.                                 DRM_DEBUG("%s: No deep color support on this HDMI sink.\n",
  3748.                                                   connector->name);
  3749.                         }
  3750.                 }
  3751.         }
  3752.  
  3753.         return false;
  3754. }
  3755.  
  3756. /**
  3757.  * drm_add_display_info - pull display info out if present
  3758.  * @edid: EDID data
  3759.  * @info: display info (attached to connector)
  3760.  * @connector: connector whose edid is used to build display info
  3761.  *
  3762.  * Grab any available display info and stuff it into the drm_display_info
  3763.  * structure that's part of the connector.  Useful for tracking bpp and
  3764.  * color spaces.
  3765.  */
  3766. static void drm_add_display_info(struct edid *edid,
  3767.                                  struct drm_display_info *info,
  3768.                                  struct drm_connector *connector)
  3769. {
  3770.         u8 *edid_ext;
  3771.  
  3772.         info->width_mm = edid->width_cm * 10;
  3773.         info->height_mm = edid->height_cm * 10;
  3774.  
  3775.         /* driver figures it out in this case */
  3776.         info->bpc = 0;
  3777.         info->color_formats = 0;
  3778.  
  3779.         if (edid->revision < 3)
  3780.                 return;
  3781.  
  3782.         if (!(edid->input & DRM_EDID_INPUT_DIGITAL))
  3783.                 return;
  3784.  
  3785.         /* Get data from CEA blocks if present */
  3786.         edid_ext = drm_find_cea_extension(edid);
  3787.         if (edid_ext) {
  3788.                 info->cea_rev = edid_ext[1];
  3789.  
  3790.                 /* The existence of a CEA block should imply RGB support */
  3791.                 info->color_formats = DRM_COLOR_FORMAT_RGB444;
  3792.                 if (edid_ext[3] & EDID_CEA_YCRCB444)
  3793.                         info->color_formats |= DRM_COLOR_FORMAT_YCRCB444;
  3794.                 if (edid_ext[3] & EDID_CEA_YCRCB422)
  3795.                         info->color_formats |= DRM_COLOR_FORMAT_YCRCB422;
  3796.         }
  3797.  
  3798.         /* HDMI deep color modes supported? Assign to info, if so */
  3799.         drm_assign_hdmi_deep_color_info(edid, info, connector);
  3800.  
  3801.         /* Only defined for 1.4 with digital displays */
  3802.         if (edid->revision < 4)
  3803.                 return;
  3804.  
  3805.         switch (edid->input & DRM_EDID_DIGITAL_DEPTH_MASK) {
  3806.         case DRM_EDID_DIGITAL_DEPTH_6:
  3807.                 info->bpc = 6;
  3808.                 break;
  3809.         case DRM_EDID_DIGITAL_DEPTH_8:
  3810.                 info->bpc = 8;
  3811.                 break;
  3812.         case DRM_EDID_DIGITAL_DEPTH_10:
  3813.                 info->bpc = 10;
  3814.                 break;
  3815.         case DRM_EDID_DIGITAL_DEPTH_12:
  3816.                 info->bpc = 12;
  3817.                 break;
  3818.         case DRM_EDID_DIGITAL_DEPTH_14:
  3819.                 info->bpc = 14;
  3820.                 break;
  3821.         case DRM_EDID_DIGITAL_DEPTH_16:
  3822.                 info->bpc = 16;
  3823.                 break;
  3824.         case DRM_EDID_DIGITAL_DEPTH_UNDEF:
  3825.         default:
  3826.                 info->bpc = 0;
  3827.                 break;
  3828.         }
  3829.  
  3830.         DRM_DEBUG("%s: Assigning EDID-1.4 digital sink color depth as %d bpc.\n",
  3831.                           connector->name, info->bpc);
  3832.  
  3833.         info->color_formats |= DRM_COLOR_FORMAT_RGB444;
  3834.         if (edid->features & DRM_EDID_FEATURE_RGB_YCRCB444)
  3835.                 info->color_formats |= DRM_COLOR_FORMAT_YCRCB444;
  3836.         if (edid->features & DRM_EDID_FEATURE_RGB_YCRCB422)
  3837.                 info->color_formats |= DRM_COLOR_FORMAT_YCRCB422;
  3838. }
  3839.  
  3840. /**
  3841.  * drm_add_edid_modes - add modes from EDID data, if available
  3842.  * @connector: connector we're probing
  3843.  * @edid: EDID data
  3844.  *
  3845.  * Add the specified modes to the connector's mode list.
  3846.  *
  3847.  * Return: The number of modes added or 0 if we couldn't find any.
  3848.  */
  3849. int drm_add_edid_modes(struct drm_connector *connector, struct edid *edid)
  3850. {
  3851.         int num_modes = 0;
  3852.         u32 quirks;
  3853.  
  3854.         if (edid == NULL) {
  3855.                 return 0;
  3856.         }
  3857.         if (!drm_edid_is_valid(edid)) {
  3858.                 dev_warn(connector->dev->dev, "%s: EDID invalid.\n",
  3859.                          connector->name);
  3860.                 return 0;
  3861.         }
  3862.  
  3863.         quirks = edid_get_quirks(edid);
  3864.  
  3865.         /*
  3866.          * EDID spec says modes should be preferred in this order:
  3867.          * - preferred detailed mode
  3868.          * - other detailed modes from base block
  3869.          * - detailed modes from extension blocks
  3870.          * - CVT 3-byte code modes
  3871.          * - standard timing codes
  3872.          * - established timing codes
  3873.          * - modes inferred from GTF or CVT range information
  3874.          *
  3875.          * We get this pretty much right.
  3876.          *
  3877.          * XXX order for additional mode types in extension blocks?
  3878.          */
  3879.         num_modes += add_detailed_modes(connector, edid, quirks);
  3880.         num_modes += add_cvt_modes(connector, edid);
  3881.         num_modes += add_standard_modes(connector, edid);
  3882.         num_modes += add_established_modes(connector, edid);
  3883.         num_modes += add_cea_modes(connector, edid);
  3884.         num_modes += add_alternate_cea_modes(connector, edid);
  3885.         if (edid->features & DRM_EDID_FEATURE_DEFAULT_GTF)
  3886.                 num_modes += add_inferred_modes(connector, edid);
  3887.  
  3888.         if (quirks & (EDID_QUIRK_PREFER_LARGE_60 | EDID_QUIRK_PREFER_LARGE_75))
  3889.                 edid_fixup_preferred(connector, quirks);
  3890.  
  3891.         drm_add_display_info(edid, &connector->display_info, connector);
  3892.  
  3893.         if (quirks & EDID_QUIRK_FORCE_8BPC)
  3894.                 connector->display_info.bpc = 8;
  3895.  
  3896.         if (quirks & EDID_QUIRK_FORCE_12BPC)
  3897.                 connector->display_info.bpc = 12;
  3898.  
  3899.         return num_modes;
  3900. }
  3901. EXPORT_SYMBOL(drm_add_edid_modes);
  3902.  
  3903. /**
  3904.  * drm_add_modes_noedid - add modes for the connectors without EDID
  3905.  * @connector: connector we're probing
  3906.  * @hdisplay: the horizontal display limit
  3907.  * @vdisplay: the vertical display limit
  3908.  *
  3909.  * Add the specified modes to the connector's mode list. Only when the
  3910.  * hdisplay/vdisplay is not beyond the given limit, it will be added.
  3911.  *
  3912.  * Return: The number of modes added or 0 if we couldn't find any.
  3913.  */
  3914. int drm_add_modes_noedid(struct drm_connector *connector,
  3915.                         int hdisplay, int vdisplay)
  3916. {
  3917.         int i, count, num_modes = 0;
  3918.         struct drm_display_mode *mode;
  3919.         struct drm_device *dev = connector->dev;
  3920.  
  3921.         count = ARRAY_SIZE(drm_dmt_modes);
  3922.         if (hdisplay < 0)
  3923.                 hdisplay = 0;
  3924.         if (vdisplay < 0)
  3925.                 vdisplay = 0;
  3926.  
  3927.         for (i = 0; i < count; i++) {
  3928.                 const struct drm_display_mode *ptr = &drm_dmt_modes[i];
  3929.                 if (hdisplay && vdisplay) {
  3930.                         /*
  3931.                          * Only when two are valid, they will be used to check
  3932.                          * whether the mode should be added to the mode list of
  3933.                          * the connector.
  3934.                          */
  3935.                         if (ptr->hdisplay > hdisplay ||
  3936.                                         ptr->vdisplay > vdisplay)
  3937.                                 continue;
  3938.                 }
  3939.                 if (drm_mode_vrefresh(ptr) > 61)
  3940.                         continue;
  3941.                 mode = drm_mode_duplicate(dev, ptr);
  3942.                 if (mode) {
  3943.                         drm_mode_probed_add(connector, mode);
  3944.                         num_modes++;
  3945.                 }
  3946.         }
  3947.         return num_modes;
  3948. }
  3949. EXPORT_SYMBOL(drm_add_modes_noedid);
  3950.  
  3951. /**
  3952.  * drm_set_preferred_mode - Sets the preferred mode of a connector
  3953.  * @connector: connector whose mode list should be processed
  3954.  * @hpref: horizontal resolution of preferred mode
  3955.  * @vpref: vertical resolution of preferred mode
  3956.  *
  3957.  * Marks a mode as preferred if it matches the resolution specified by @hpref
  3958.  * and @vpref.
  3959.  */
  3960. void drm_set_preferred_mode(struct drm_connector *connector,
  3961.                            int hpref, int vpref)
  3962. {
  3963.         struct drm_display_mode *mode;
  3964.  
  3965.         list_for_each_entry(mode, &connector->probed_modes, head) {
  3966.                 if (mode->hdisplay == hpref &&
  3967.                     mode->vdisplay == vpref)
  3968.                         mode->type |= DRM_MODE_TYPE_PREFERRED;
  3969.         }
  3970. }
  3971. EXPORT_SYMBOL(drm_set_preferred_mode);
  3972.  
  3973. /**
  3974.  * drm_hdmi_avi_infoframe_from_display_mode() - fill an HDMI AVI infoframe with
  3975.  *                                              data from a DRM display mode
  3976.  * @frame: HDMI AVI infoframe
  3977.  * @mode: DRM display mode
  3978.  *
  3979.  * Return: 0 on success or a negative error code on failure.
  3980.  */
  3981. int
  3982. drm_hdmi_avi_infoframe_from_display_mode(struct hdmi_avi_infoframe *frame,
  3983.                                          const struct drm_display_mode *mode)
  3984. {
  3985.         int err;
  3986.  
  3987.         if (!frame || !mode)
  3988.                 return -EINVAL;
  3989.  
  3990.         err = hdmi_avi_infoframe_init(frame);
  3991.         if (err < 0)
  3992.                 return err;
  3993.  
  3994.         if (mode->flags & DRM_MODE_FLAG_DBLCLK)
  3995.                 frame->pixel_repeat = 1;
  3996.  
  3997.         frame->video_code = drm_match_cea_mode(mode);
  3998.  
  3999.         frame->picture_aspect = HDMI_PICTURE_ASPECT_NONE;
  4000.  
  4001.         /*
  4002.          * Populate picture aspect ratio from either
  4003.          * user input (if specified) or from the CEA mode list.
  4004.          */
  4005.         if (mode->picture_aspect_ratio == HDMI_PICTURE_ASPECT_4_3 ||
  4006.                 mode->picture_aspect_ratio == HDMI_PICTURE_ASPECT_16_9)
  4007.                 frame->picture_aspect = mode->picture_aspect_ratio;
  4008.         else if (frame->video_code > 0)
  4009.                 frame->picture_aspect = drm_get_cea_aspect_ratio(
  4010.                                                 frame->video_code);
  4011.  
  4012.         frame->active_aspect = HDMI_ACTIVE_ASPECT_PICTURE;
  4013.         frame->scan_mode = HDMI_SCAN_MODE_UNDERSCAN;
  4014.  
  4015.         return 0;
  4016. }
  4017. EXPORT_SYMBOL(drm_hdmi_avi_infoframe_from_display_mode);
  4018.  
  4019. static enum hdmi_3d_structure
  4020. s3d_structure_from_display_mode(const struct drm_display_mode *mode)
  4021. {
  4022.         u32 layout = mode->flags & DRM_MODE_FLAG_3D_MASK;
  4023.  
  4024.         switch (layout) {
  4025.         case DRM_MODE_FLAG_3D_FRAME_PACKING:
  4026.                 return HDMI_3D_STRUCTURE_FRAME_PACKING;
  4027.         case DRM_MODE_FLAG_3D_FIELD_ALTERNATIVE:
  4028.                 return HDMI_3D_STRUCTURE_FIELD_ALTERNATIVE;
  4029.         case DRM_MODE_FLAG_3D_LINE_ALTERNATIVE:
  4030.                 return HDMI_3D_STRUCTURE_LINE_ALTERNATIVE;
  4031.         case DRM_MODE_FLAG_3D_SIDE_BY_SIDE_FULL:
  4032.                 return HDMI_3D_STRUCTURE_SIDE_BY_SIDE_FULL;
  4033.         case DRM_MODE_FLAG_3D_L_DEPTH:
  4034.                 return HDMI_3D_STRUCTURE_L_DEPTH;
  4035.         case DRM_MODE_FLAG_3D_L_DEPTH_GFX_GFX_DEPTH:
  4036.                 return HDMI_3D_STRUCTURE_L_DEPTH_GFX_GFX_DEPTH;
  4037.         case DRM_MODE_FLAG_3D_TOP_AND_BOTTOM:
  4038.                 return HDMI_3D_STRUCTURE_TOP_AND_BOTTOM;
  4039.         case DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF:
  4040.                 return HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF;
  4041.         default:
  4042.                 return HDMI_3D_STRUCTURE_INVALID;
  4043.         }
  4044. }
  4045.  
  4046. /**
  4047.  * drm_hdmi_vendor_infoframe_from_display_mode() - fill an HDMI infoframe with
  4048.  * data from a DRM display mode
  4049.  * @frame: HDMI vendor infoframe
  4050.  * @mode: DRM display mode
  4051.  *
  4052.  * Note that there's is a need to send HDMI vendor infoframes only when using a
  4053.  * 4k or stereoscopic 3D mode. So when giving any other mode as input this
  4054.  * function will return -EINVAL, error that can be safely ignored.
  4055.  *
  4056.  * Return: 0 on success or a negative error code on failure.
  4057.  */
  4058. int
  4059. drm_hdmi_vendor_infoframe_from_display_mode(struct hdmi_vendor_infoframe *frame,
  4060.                                             const struct drm_display_mode *mode)
  4061. {
  4062.         int err;
  4063.         u32 s3d_flags;
  4064.         u8 vic;
  4065.  
  4066.         if (!frame || !mode)
  4067.                 return -EINVAL;
  4068.  
  4069.         vic = drm_match_hdmi_mode(mode);
  4070.         s3d_flags = mode->flags & DRM_MODE_FLAG_3D_MASK;
  4071.  
  4072.         if (!vic && !s3d_flags)
  4073.                 return -EINVAL;
  4074.  
  4075.         if (vic && s3d_flags)
  4076.                 return -EINVAL;
  4077.  
  4078.         err = hdmi_vendor_infoframe_init(frame);
  4079.         if (err < 0)
  4080.                 return err;
  4081.  
  4082.         if (vic)
  4083.                 frame->vic = vic;
  4084.         else
  4085.                 frame->s3d_struct = s3d_structure_from_display_mode(mode);
  4086.  
  4087.         return 0;
  4088. }
  4089. EXPORT_SYMBOL(drm_hdmi_vendor_infoframe_from_display_mode);
  4090.  
  4091. static int drm_parse_display_id(struct drm_connector *connector,
  4092.                                 u8 *displayid, int length,
  4093.                                 bool is_edid_extension)
  4094. {
  4095.         /* if this is an EDID extension the first byte will be 0x70 */
  4096.         int idx = 0;
  4097.         struct displayid_hdr *base;
  4098.         struct displayid_block *block;
  4099.         u8 csum = 0;
  4100.         int i;
  4101.  
  4102.         if (is_edid_extension)
  4103.                 idx = 1;
  4104.  
  4105.         base = (struct displayid_hdr *)&displayid[idx];
  4106.  
  4107.         DRM_DEBUG_KMS("base revision 0x%x, length %d, %d %d\n",
  4108.                       base->rev, base->bytes, base->prod_id, base->ext_count);
  4109.  
  4110.         if (base->bytes + 5 > length - idx)
  4111.                 return -EINVAL;
  4112.  
  4113.         for (i = idx; i <= base->bytes + 5; i++) {
  4114.                 csum += displayid[i];
  4115.         }
  4116.         if (csum) {
  4117.                 DRM_ERROR("DisplayID checksum invalid, remainder is %d\n", csum);
  4118.                 return -EINVAL;
  4119.         }
  4120.  
  4121.         block = (struct displayid_block *)&displayid[idx + 4];
  4122.         DRM_DEBUG_KMS("block id %d, rev %d, len %d\n",
  4123.                       block->tag, block->rev, block->num_bytes);
  4124.  
  4125.         switch (block->tag) {
  4126.         case DATA_BLOCK_TILED_DISPLAY: {
  4127.                 struct displayid_tiled_block *tile = (struct displayid_tiled_block *)block;
  4128.  
  4129.                 u16 w, h;
  4130.                 u8 tile_v_loc, tile_h_loc;
  4131.                 u8 num_v_tile, num_h_tile;
  4132.                 struct drm_tile_group *tg;
  4133.  
  4134.                 w = tile->tile_size[0] | tile->tile_size[1] << 8;
  4135.                 h = tile->tile_size[2] | tile->tile_size[3] << 8;
  4136.  
  4137.                 num_v_tile = (tile->topo[0] & 0xf) | (tile->topo[2] & 0x30);
  4138.                 num_h_tile = (tile->topo[0] >> 4) | ((tile->topo[2] >> 2) & 0x30);
  4139.                 tile_v_loc = (tile->topo[1] & 0xf) | ((tile->topo[2] & 0x3) << 4);
  4140.                 tile_h_loc = (tile->topo[1] >> 4) | (((tile->topo[2] >> 2) & 0x3) << 4);
  4141.  
  4142.                 connector->has_tile = true;
  4143.                 if (tile->tile_cap & 0x80)
  4144.                         connector->tile_is_single_monitor = true;
  4145.  
  4146.                 connector->num_h_tile = num_h_tile + 1;
  4147.                 connector->num_v_tile = num_v_tile + 1;
  4148.                 connector->tile_h_loc = tile_h_loc;
  4149.                 connector->tile_v_loc = tile_v_loc;
  4150.                 connector->tile_h_size = w + 1;
  4151.                 connector->tile_v_size = h + 1;
  4152.  
  4153.                 DRM_DEBUG_KMS("tile cap 0x%x\n", tile->tile_cap);
  4154.                 DRM_DEBUG_KMS("tile_size %d x %d\n", w + 1, h + 1);
  4155.                 DRM_DEBUG_KMS("topo num tiles %dx%d, location %dx%d\n",
  4156.                        num_h_tile + 1, num_v_tile + 1, tile_h_loc, tile_v_loc);
  4157.                 DRM_DEBUG_KMS("vend %c%c%c\n", tile->topology_id[0], tile->topology_id[1], tile->topology_id[2]);
  4158.  
  4159.                 tg = drm_mode_get_tile_group(connector->dev, tile->topology_id);
  4160.                 if (!tg) {
  4161.                         tg = drm_mode_create_tile_group(connector->dev, tile->topology_id);
  4162.                 }
  4163.                 if (!tg)
  4164.                         return -ENOMEM;
  4165.  
  4166.                 if (connector->tile_group != tg) {
  4167.                         /* if we haven't got a pointer,
  4168.                            take the reference, drop ref to old tile group */
  4169.                         if (connector->tile_group) {
  4170.                                 drm_mode_put_tile_group(connector->dev, connector->tile_group);
  4171.                         }
  4172.                         connector->tile_group = tg;
  4173.                 } else
  4174.                         /* if same tile group, then release the ref we just took. */
  4175.                         drm_mode_put_tile_group(connector->dev, tg);
  4176.         }
  4177.                 break;
  4178.         default:
  4179.                 printk("unknown displayid tag %d\n", block->tag);
  4180.                 break;
  4181.         }
  4182.         return 0;
  4183. }
  4184.  
  4185. static void drm_get_displayid(struct drm_connector *connector,
  4186.                               struct edid *edid)
  4187. {
  4188.         void *displayid = NULL;
  4189.         int ret;
  4190.         connector->has_tile = false;
  4191.         displayid = drm_find_displayid_extension(edid);
  4192.         if (!displayid) {
  4193.                 /* drop reference to any tile group we had */
  4194.                 goto out_drop_ref;
  4195.         }
  4196.  
  4197.         ret = drm_parse_display_id(connector, displayid, EDID_LENGTH, true);
  4198.         if (ret < 0)
  4199.                 goto out_drop_ref;
  4200.         if (!connector->has_tile)
  4201.                 goto out_drop_ref;
  4202.         return;
  4203. out_drop_ref:
  4204.         if (connector->tile_group) {
  4205.                 drm_mode_put_tile_group(connector->dev, connector->tile_group);
  4206.                 connector->tile_group = NULL;
  4207.         }
  4208.         return;
  4209. }
  4210.