UPSTREAM: drm/edid: index CEA/HDMI mode tables using the VIC

[firefly-linux-kernel-4.4.55.git] / drivers / gpu / drm / drm_edid.c

diff --git a/drivers/gpu/drm/drm_edid.c b/drivers/gpu/drm/drm_edid.c
index 2d6932c9a351223b26aec2a0cc0edbb3dc2a7cfb..5d42e20f87521a670f1f9d9475289df7019a96a6 100644 (file)
--- a/drivers/gpu/drm/drm_edid.c
+++ b/drivers/gpu/drm/drm_edid.c
@@ -642,8 +642,12 @@ static const struct minimode extra_modes[] = {
 /*
  * Probably taken from CEA-861 spec.
  * This table is converted from xorg's hw/xfree86/modes/xf86EdidModes.c.
+ *
+ * Index using the VIC.
  */
 static const struct drm_display_mode edid_cea_modes[] = {
+       /* 0 - dummy, VICs start at 1 */
+       { },
        /* 1 - 640x480@60Hz */
        { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 25175, 640, 656,
                   752, 800, 0, 480, 490, 492, 525, 0,
@@ -992,9 +996,11 @@ static const struct drm_display_mode edid_cea_modes[] = {
 };
 
 /*
- * HDMI 1.4 4k modes.
+ * HDMI 1.4 4k modes. Index using the VIC.
  */
 static const struct drm_display_mode edid_4k_modes[] = {
+       /* 0 - dummy, VICs start at 1 */
+       { },
        /* 1 - 3840x2160@30Hz */
        { DRM_MODE("3840x2160", DRM_MODE_TYPE_DRIVER, 297000,
                   3840, 4016, 4104, 4400, 0,
@@ -2559,13 +2565,13 @@ cea_mode_alternate_clock(const struct drm_display_mode *cea_mode)
 static u8 drm_match_cea_mode_clock_tolerance(const struct drm_display_mode *to_match,
                                             unsigned int clock_tolerance)
 {
-       u8 mode;
+       u8 vic;
 
        if (!to_match->clock)
                return 0;
 
-       for (mode = 0; mode < ARRAY_SIZE(edid_cea_modes); mode++) {
-               const struct drm_display_mode *cea_mode = &edid_cea_modes[mode];
+       for (vic = 1; vic < ARRAY_SIZE(edid_cea_modes); vic++) {
+               const struct drm_display_mode *cea_mode = &edid_cea_modes[vic];
                unsigned int clock1, clock2;
 
                /* Check both 60Hz and 59.94Hz */
@@ -2577,7 +2583,7 @@ static u8 drm_match_cea_mode_clock_tolerance(const struct drm_display_mode *to_m
                        continue;
 
                if (drm_mode_equal_no_clocks(to_match, cea_mode))
-                       return mode + 1;
+                       return vic;
        }
 
        return 0;
@@ -2592,13 +2598,13 @@ static u8 drm_match_cea_mode_clock_tolerance(const struct drm_display_mode *to_m
  */
 u8 drm_match_cea_mode(const struct drm_display_mode *to_match)
 {
-       u8 mode;
+       u8 vic;
 
        if (!to_match->clock)
                return 0;
 
-       for (mode = 0; mode < ARRAY_SIZE(edid_cea_modes); mode++) {
-               const struct drm_display_mode *cea_mode = &edid_cea_modes[mode];
+       for (vic = 1; vic < ARRAY_SIZE(edid_cea_modes); vic++) {
+               const struct drm_display_mode *cea_mode = &edid_cea_modes[vic];
                unsigned int clock1, clock2;
 
                /* Check both 60Hz and 59.94Hz */
@@ -2608,12 +2614,17 @@ u8 drm_match_cea_mode(const struct drm_display_mode *to_match)
                if ((KHZ2PICOS(to_match->clock) == KHZ2PICOS(clock1) ||
                     KHZ2PICOS(to_match->clock) == KHZ2PICOS(clock2)) &&
                    drm_mode_equal_no_clocks_no_stereo(to_match, cea_mode))
-                       return mode + 1;
+                       return vic;
        }
        return 0;
 }
 EXPORT_SYMBOL(drm_match_cea_mode);
 
+static bool drm_valid_cea_vic(u8 vic)
+{
+       return vic > 0 && vic < ARRAY_SIZE(edid_cea_modes);
+}
+
 /**
  * drm_get_cea_aspect_ratio - get the picture aspect ratio corresponding to
  * the input VIC from the CEA mode list
@@ -2623,10 +2634,7 @@ EXPORT_SYMBOL(drm_match_cea_mode);
  */
 enum hdmi_picture_aspect drm_get_cea_aspect_ratio(const u8 video_code)
 {
-       /* return picture aspect ratio for video_code - 1 to access the
-        * right array element
-       */
-       return edid_cea_modes[video_code-1].picture_aspect_ratio;
+       return edid_cea_modes[video_code].picture_aspect_ratio;
 }
 EXPORT_SYMBOL(drm_get_cea_aspect_ratio);
 
@@ -2650,13 +2658,13 @@ hdmi_mode_alternate_clock(const struct drm_display_mode *hdmi_mode)
 static u8 drm_match_hdmi_mode_clock_tolerance(const struct drm_display_mode *to_match,
                                              unsigned int clock_tolerance)
 {
-       u8 mode;
+       u8 vic;
 
        if (!to_match->clock)
                return 0;
 
-       for (mode = 0; mode < ARRAY_SIZE(edid_4k_modes); mode++) {
-               const struct drm_display_mode *hdmi_mode = &edid_4k_modes[mode];
+       for (vic = 1; vic < ARRAY_SIZE(edid_4k_modes); vic++) {
+               const struct drm_display_mode *hdmi_mode = &edid_4k_modes[vic];
                unsigned int clock1, clock2;
 
                /* Make sure to also match alternate clocks */
@@ -2668,7 +2676,7 @@ static u8 drm_match_hdmi_mode_clock_tolerance(const struct drm_display_mode *to_
                        continue;
 
                if (drm_mode_equal_no_clocks(to_match, hdmi_mode))
-                       return mode + 1;
+                       return vic;
        }
 
        return 0;
@@ -2684,13 +2692,13 @@ static u8 drm_match_hdmi_mode_clock_tolerance(const struct drm_display_mode *to_
  */
 static u8 drm_match_hdmi_mode(const struct drm_display_mode *to_match)
 {
-       u8 mode;
+       u8 vic;
 
        if (!to_match->clock)
                return 0;
 
-       for (mode = 0; mode < ARRAY_SIZE(edid_4k_modes); mode++) {
-               const struct drm_display_mode *hdmi_mode = &edid_4k_modes[mode];
+       for (vic = 1; vic < ARRAY_SIZE(edid_4k_modes); vic++) {
+               const struct drm_display_mode *hdmi_mode = &edid_4k_modes[vic];
                unsigned int clock1, clock2;
 
                /* Make sure to also match alternate clocks */
@@ -2700,11 +2708,16 @@ static u8 drm_match_hdmi_mode(const struct drm_display_mode *to_match)
                if ((KHZ2PICOS(to_match->clock) == KHZ2PICOS(clock1) ||
                     KHZ2PICOS(to_match->clock) == KHZ2PICOS(clock2)) &&
                    drm_mode_equal_no_clocks_no_stereo(to_match, hdmi_mode))
-                       return mode + 1;
+                       return vic;
        }
        return 0;
 }
 
+static bool drm_valid_hdmi_vic(u8 vic)
+{
+       return vic > 0 && vic < ARRAY_SIZE(edid_4k_modes);
+}
+
 static int
 add_alternate_cea_modes(struct drm_connector *connector, struct edid *edid)
 {
@@ -2724,16 +2737,16 @@ add_alternate_cea_modes(struct drm_connector *connector, struct edid *edid)
        list_for_each_entry(mode, &connector->probed_modes, head) {
                const struct drm_display_mode *cea_mode = NULL;
                struct drm_display_mode *newmode;
-               u8 mode_idx = drm_match_cea_mode(mode) - 1;
+               u8 vic = drm_match_cea_mode(mode);
                unsigned int clock1, clock2;
 
-               if (mode_idx < ARRAY_SIZE(edid_cea_modes)) {
-                       cea_mode = &edid_cea_modes[mode_idx];
+               if (drm_valid_cea_vic(vic)) {
+                       cea_mode = &edid_cea_modes[vic];
                        clock2 = cea_mode_alternate_clock(cea_mode);
                } else {
-                       mode_idx = drm_match_hdmi_mode(mode) - 1;
-                       if (mode_idx < ARRAY_SIZE(edid_4k_modes)) {
-                               cea_mode = &edid_4k_modes[mode_idx];
+                       vic = drm_match_hdmi_mode(mode);
+                       if (drm_valid_hdmi_vic(vic)) {
+                               cea_mode = &edid_4k_modes[vic];
                                clock2 = hdmi_mode_alternate_clock(cea_mode);
                        }
                }
@@ -2784,17 +2797,17 @@ drm_display_mode_from_vic_index(struct drm_connector *connector,
 {
        struct drm_device *dev = connector->dev;
        struct drm_display_mode *newmode;
-       u8 cea_mode;
+       u8 vic;
 
        if (video_db == NULL || video_index >= video_len)
                return NULL;
 
        /* CEA modes are numbered 1..127 */
-       cea_mode = (video_db[video_index] & 127) - 1;
-       if (cea_mode >= ARRAY_SIZE(edid_cea_modes))
+       vic = (video_db[video_index] & 127);
+       if (!drm_valid_cea_vic(vic))
                return NULL;
 
-       newmode = drm_mode_duplicate(dev, &edid_cea_modes[cea_mode]);
+       newmode = drm_mode_duplicate(dev, &edid_cea_modes[vic]);
        if (!newmode)
                return NULL;
 
@@ -2889,8 +2902,7 @@ static int add_hdmi_mode(struct drm_connector *connector, u8 vic)
        struct drm_device *dev = connector->dev;
        struct drm_display_mode *newmode;
 
-       vic--; /* VICs start at 1 */
-       if (vic >= ARRAY_SIZE(edid_4k_modes)) {
+       if (!drm_valid_hdmi_vic(vic)) {
                DRM_ERROR("Unknown HDMI VIC: %d\n", vic);
                return 0;
        }
@@ -3196,24 +3208,24 @@ static void fixup_detailed_cea_mode_clock(struct drm_display_mode *mode)
 {
        const struct drm_display_mode *cea_mode;
        int clock1, clock2, clock;
-       u8 mode_idx;
+       u8 vic;
        const char *type;
 
        /*
         * allow 5kHz clock difference either way to account for
         * the 10kHz clock resolution limit of detailed timings.
         */
-       mode_idx = drm_match_cea_mode_clock_tolerance(mode, 5) - 1;
-       if (mode_idx < ARRAY_SIZE(edid_cea_modes)) {
+       vic = drm_match_cea_mode_clock_tolerance(mode, 5);
+       if (drm_valid_cea_vic(vic)) {
                type = "CEA";
-               cea_mode = &edid_cea_modes[mode_idx];
+               cea_mode = &edid_cea_modes[vic];
                clock1 = cea_mode->clock;
                clock2 = cea_mode_alternate_clock(cea_mode);
        } else {
-               mode_idx = drm_match_hdmi_mode_clock_tolerance(mode, 5) - 1;
-               if (mode_idx < ARRAY_SIZE(edid_4k_modes)) {
+               vic = drm_match_hdmi_mode_clock_tolerance(mode, 5);
+               if (drm_valid_hdmi_vic(vic)) {
                        type = "HDMI";
-                       cea_mode = &edid_4k_modes[mode_idx];
+                       cea_mode = &edid_4k_modes[vic];
                        clock1 = cea_mode->clock;
                        clock2 = hdmi_mode_alternate_clock(cea_mode);
                } else {
@@ -3231,7 +3243,7 @@ static void fixup_detailed_cea_mode_clock(struct drm_display_mode *mode)
                return;
 
        DRM_DEBUG("detailed mode matches %s VIC %d, adjusting clock %d -> %d\n",
-                 type, mode_idx + 1, mode->clock, clock);
+                 type, vic, mode->clock, clock);
        mode->clock = clock;
 }