Subversion Repositories Kolibri OS

Rev

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

  1. /*
  2.  * Copyright © 2006 Intel Corporation
  3.  *
  4.  * Permission is hereby granted, free of charge, to any person obtaining a
  5.  * copy of this software and associated documentation files (the "Software"),
  6.  * to deal in the Software without restriction, including without limitation
  7.  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  8.  * and/or sell copies of the Software, and to permit persons to whom the
  9.  * Software is furnished to do so, subject to the following conditions:
  10.  *
  11.  * The above copyright notice and this permission notice (including the next
  12.  * paragraph) shall be included in all copies or substantial portions of the
  13.  * Software.
  14.  *
  15.  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  16.  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  17.  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  18.  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  19.  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  20.  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  21.  * SOFTWARE.
  22.  *
  23.  * Authors:
  24.  *    Eric Anholt <eric@anholt.net>
  25.  *
  26.  */
  27. #include <linux/dmi.h>
  28. #include <drm/drm_dp_helper.h>
  29. #include <drm/drmP.h>
  30. #include <drm/i915_drm.h>
  31. #include "i915_drv.h"
  32. #include "intel_bios.h"
  33.  
  34. #define SLAVE_ADDR1     0x70
  35. #define SLAVE_ADDR2     0x72
  36.  
  37. static int panel_type;
  38.  
  39. static const void *
  40. find_section(const void *_bdb, int section_id)
  41. {
  42.         const struct bdb_header *bdb = _bdb;
  43.         const u8 *base = _bdb;
  44.         int index = 0;
  45.         u32 total, current_size;
  46.         u8 current_id;
  47.  
  48.         /* skip to first section */
  49.         index += bdb->header_size;
  50.         total = bdb->bdb_size;
  51.  
  52.         /* walk the sections looking for section_id */
  53.         while (index + 3 < total) {
  54.                 current_id = *(base + index);
  55.                 index++;
  56.  
  57.                 current_size = *((const u16 *)(base + index));
  58.                 index += 2;
  59.  
  60.                 /* The MIPI Sequence Block v3+ has a separate size field. */
  61.                 if (current_id == BDB_MIPI_SEQUENCE && *(base + index) >= 3)
  62.                         current_size = *((const u32 *)(base + index + 1));
  63.  
  64.                 if (index + current_size > total)
  65.                         return NULL;
  66.  
  67.                 if (current_id == section_id)
  68.                         return base + index;
  69.  
  70.                 index += current_size;
  71.         }
  72.  
  73.         return NULL;
  74. }
  75.  
  76. static u16
  77. get_blocksize(const void *p)
  78. {
  79.         u16 *block_ptr, block_size;
  80.  
  81.         block_ptr = (u16 *)((char *)p - 2);
  82.         block_size = *block_ptr;
  83.         return block_size;
  84. }
  85.  
  86. static void
  87. fill_detail_timing_data(struct drm_display_mode *panel_fixed_mode,
  88.                         const struct lvds_dvo_timing *dvo_timing)
  89. {
  90.         panel_fixed_mode->hdisplay = (dvo_timing->hactive_hi << 8) |
  91.                 dvo_timing->hactive_lo;
  92.         panel_fixed_mode->hsync_start = panel_fixed_mode->hdisplay +
  93.                 ((dvo_timing->hsync_off_hi << 8) | dvo_timing->hsync_off_lo);
  94.         panel_fixed_mode->hsync_end = panel_fixed_mode->hsync_start +
  95.                 dvo_timing->hsync_pulse_width;
  96.         panel_fixed_mode->htotal = panel_fixed_mode->hdisplay +
  97.                 ((dvo_timing->hblank_hi << 8) | dvo_timing->hblank_lo);
  98.  
  99.         panel_fixed_mode->vdisplay = (dvo_timing->vactive_hi << 8) |
  100.                 dvo_timing->vactive_lo;
  101.         panel_fixed_mode->vsync_start = panel_fixed_mode->vdisplay +
  102.                 dvo_timing->vsync_off;
  103.         panel_fixed_mode->vsync_end = panel_fixed_mode->vsync_start +
  104.                 dvo_timing->vsync_pulse_width;
  105.         panel_fixed_mode->vtotal = panel_fixed_mode->vdisplay +
  106.                 ((dvo_timing->vblank_hi << 8) | dvo_timing->vblank_lo);
  107.         panel_fixed_mode->clock = dvo_timing->clock * 10;
  108.         panel_fixed_mode->type = DRM_MODE_TYPE_PREFERRED;
  109.  
  110.         if (dvo_timing->hsync_positive)
  111.                 panel_fixed_mode->flags |= DRM_MODE_FLAG_PHSYNC;
  112.         else
  113.                 panel_fixed_mode->flags |= DRM_MODE_FLAG_NHSYNC;
  114.  
  115.         if (dvo_timing->vsync_positive)
  116.                 panel_fixed_mode->flags |= DRM_MODE_FLAG_PVSYNC;
  117.         else
  118.                 panel_fixed_mode->flags |= DRM_MODE_FLAG_NVSYNC;
  119.  
  120.         /* Some VBTs have bogus h/vtotal values */
  121.         if (panel_fixed_mode->hsync_end > panel_fixed_mode->htotal)
  122.                 panel_fixed_mode->htotal = panel_fixed_mode->hsync_end + 1;
  123.         if (panel_fixed_mode->vsync_end > panel_fixed_mode->vtotal)
  124.                 panel_fixed_mode->vtotal = panel_fixed_mode->vsync_end + 1;
  125.  
  126.         drm_mode_set_name(panel_fixed_mode);
  127. }
  128.  
  129. static const struct lvds_dvo_timing *
  130. get_lvds_dvo_timing(const struct bdb_lvds_lfp_data *lvds_lfp_data,
  131.                     const struct bdb_lvds_lfp_data_ptrs *lvds_lfp_data_ptrs,
  132.                     int index)
  133. {
  134.         /*
  135.          * the size of fp_timing varies on the different platform.
  136.          * So calculate the DVO timing relative offset in LVDS data
  137.          * entry to get the DVO timing entry
  138.          */
  139.  
  140.         int lfp_data_size =
  141.                 lvds_lfp_data_ptrs->ptr[1].dvo_timing_offset -
  142.                 lvds_lfp_data_ptrs->ptr[0].dvo_timing_offset;
  143.         int dvo_timing_offset =
  144.                 lvds_lfp_data_ptrs->ptr[0].dvo_timing_offset -
  145.                 lvds_lfp_data_ptrs->ptr[0].fp_timing_offset;
  146.         char *entry = (char *)lvds_lfp_data->data + lfp_data_size * index;
  147.  
  148.         return (struct lvds_dvo_timing *)(entry + dvo_timing_offset);
  149. }
  150.  
  151. /* get lvds_fp_timing entry
  152.  * this function may return NULL if the corresponding entry is invalid
  153.  */
  154. static const struct lvds_fp_timing *
  155. get_lvds_fp_timing(const struct bdb_header *bdb,
  156.                    const struct bdb_lvds_lfp_data *data,
  157.                    const struct bdb_lvds_lfp_data_ptrs *ptrs,
  158.                    int index)
  159. {
  160.         size_t data_ofs = (const u8 *)data - (const u8 *)bdb;
  161.         u16 data_size = ((const u16 *)data)[-1]; /* stored in header */
  162.         size_t ofs;
  163.  
  164.         if (index >= ARRAY_SIZE(ptrs->ptr))
  165.                 return NULL;
  166.         ofs = ptrs->ptr[index].fp_timing_offset;
  167.         if (ofs < data_ofs ||
  168.             ofs + sizeof(struct lvds_fp_timing) > data_ofs + data_size)
  169.                 return NULL;
  170.         return (const struct lvds_fp_timing *)((const u8 *)bdb + ofs);
  171. }
  172.  
  173. /* Try to find integrated panel data */
  174. static void
  175. parse_lfp_panel_data(struct drm_i915_private *dev_priv,
  176.                      const struct bdb_header *bdb)
  177. {
  178.         const struct bdb_lvds_options *lvds_options;
  179.         const struct bdb_lvds_lfp_data *lvds_lfp_data;
  180.         const struct bdb_lvds_lfp_data_ptrs *lvds_lfp_data_ptrs;
  181.         const struct lvds_dvo_timing *panel_dvo_timing;
  182.         const struct lvds_fp_timing *fp_timing;
  183.         struct drm_display_mode *panel_fixed_mode;
  184.         int drrs_mode;
  185.  
  186.         lvds_options = find_section(bdb, BDB_LVDS_OPTIONS);
  187.         if (!lvds_options)
  188.                 return;
  189.  
  190.         dev_priv->vbt.lvds_dither = lvds_options->pixel_dither;
  191.         if (lvds_options->panel_type == 0xff)
  192.                 return;
  193.  
  194.         panel_type = lvds_options->panel_type;
  195.  
  196.         drrs_mode = (lvds_options->dps_panel_type_bits
  197.                                 >> (panel_type * 2)) & MODE_MASK;
  198.         /*
  199.          * VBT has static DRRS = 0 and seamless DRRS = 2.
  200.          * The below piece of code is required to adjust vbt.drrs_type
  201.          * to match the enum drrs_support_type.
  202.          */
  203.         switch (drrs_mode) {
  204.         case 0:
  205.                 dev_priv->vbt.drrs_type = STATIC_DRRS_SUPPORT;
  206.                 DRM_DEBUG_KMS("DRRS supported mode is static\n");
  207.                 break;
  208.         case 2:
  209.                 dev_priv->vbt.drrs_type = SEAMLESS_DRRS_SUPPORT;
  210.                 DRM_DEBUG_KMS("DRRS supported mode is seamless\n");
  211.                 break;
  212.         default:
  213.                 dev_priv->vbt.drrs_type = DRRS_NOT_SUPPORTED;
  214.                 DRM_DEBUG_KMS("DRRS not supported (VBT input)\n");
  215.                 break;
  216.         }
  217.  
  218.         lvds_lfp_data = find_section(bdb, BDB_LVDS_LFP_DATA);
  219.         if (!lvds_lfp_data)
  220.                 return;
  221.  
  222.         lvds_lfp_data_ptrs = find_section(bdb, BDB_LVDS_LFP_DATA_PTRS);
  223.         if (!lvds_lfp_data_ptrs)
  224.                 return;
  225.  
  226.         dev_priv->vbt.lvds_vbt = 1;
  227.  
  228.         panel_dvo_timing = get_lvds_dvo_timing(lvds_lfp_data,
  229.                                                lvds_lfp_data_ptrs,
  230.                                                lvds_options->panel_type);
  231.  
  232.         panel_fixed_mode = kzalloc(sizeof(*panel_fixed_mode), GFP_KERNEL);
  233.         if (!panel_fixed_mode)
  234.                 return;
  235.  
  236.         fill_detail_timing_data(panel_fixed_mode, panel_dvo_timing);
  237.  
  238.         dev_priv->vbt.lfp_lvds_vbt_mode = panel_fixed_mode;
  239.  
  240.         DRM_DEBUG_KMS("Found panel mode in BIOS VBT tables:\n");
  241.         drm_mode_debug_printmodeline(panel_fixed_mode);
  242.  
  243.         fp_timing = get_lvds_fp_timing(bdb, lvds_lfp_data,
  244.                                        lvds_lfp_data_ptrs,
  245.                                        lvds_options->panel_type);
  246.         if (fp_timing) {
  247.                 /* check the resolution, just to be sure */
  248.                 if (fp_timing->x_res == panel_fixed_mode->hdisplay &&
  249.                     fp_timing->y_res == panel_fixed_mode->vdisplay) {
  250.                         dev_priv->vbt.bios_lvds_val = fp_timing->lvds_reg_val;
  251.                         DRM_DEBUG_KMS("VBT initial LVDS value %x\n",
  252.                                       dev_priv->vbt.bios_lvds_val);
  253.                 }
  254.         }
  255. }
  256.  
  257. static void
  258. parse_lfp_backlight(struct drm_i915_private *dev_priv,
  259.                     const struct bdb_header *bdb)
  260. {
  261.         const struct bdb_lfp_backlight_data *backlight_data;
  262.         const struct bdb_lfp_backlight_data_entry *entry;
  263.  
  264.         backlight_data = find_section(bdb, BDB_LVDS_BACKLIGHT);
  265.         if (!backlight_data)
  266.                 return;
  267.  
  268.         if (backlight_data->entry_size != sizeof(backlight_data->data[0])) {
  269.                 DRM_DEBUG_KMS("Unsupported backlight data entry size %u\n",
  270.                               backlight_data->entry_size);
  271.                 return;
  272.         }
  273.  
  274.         entry = &backlight_data->data[panel_type];
  275.  
  276.         dev_priv->vbt.backlight.present = entry->type == BDB_BACKLIGHT_TYPE_PWM;
  277.         if (!dev_priv->vbt.backlight.present) {
  278.                 DRM_DEBUG_KMS("PWM backlight not present in VBT (type %u)\n",
  279.                               entry->type);
  280.                 return;
  281.         }
  282.  
  283.         dev_priv->vbt.backlight.pwm_freq_hz = entry->pwm_freq_hz;
  284.         dev_priv->vbt.backlight.active_low_pwm = entry->active_low_pwm;
  285.         dev_priv->vbt.backlight.min_brightness = entry->min_brightness;
  286.         DRM_DEBUG_KMS("VBT backlight PWM modulation frequency %u Hz, "
  287.                       "active %s, min brightness %u, level %u\n",
  288.                       dev_priv->vbt.backlight.pwm_freq_hz,
  289.                       dev_priv->vbt.backlight.active_low_pwm ? "low" : "high",
  290.                       dev_priv->vbt.backlight.min_brightness,
  291.                       backlight_data->level[panel_type]);
  292. }
  293.  
  294. /* Try to find sdvo panel data */
  295. static void
  296. parse_sdvo_panel_data(struct drm_i915_private *dev_priv,
  297.                       const struct bdb_header *bdb)
  298. {
  299.         const struct lvds_dvo_timing *dvo_timing;
  300.         struct drm_display_mode *panel_fixed_mode;
  301.         int index;
  302.  
  303.         index = i915.vbt_sdvo_panel_type;
  304.         if (index == -2) {
  305.                 DRM_DEBUG_KMS("Ignore SDVO panel mode from BIOS VBT tables.\n");
  306.                 return;
  307.         }
  308.  
  309.         if (index == -1) {
  310.                 const struct bdb_sdvo_lvds_options *sdvo_lvds_options;
  311.  
  312.                 sdvo_lvds_options = find_section(bdb, BDB_SDVO_LVDS_OPTIONS);
  313.                 if (!sdvo_lvds_options)
  314.                         return;
  315.  
  316.                 index = sdvo_lvds_options->panel_type;
  317.         }
  318.  
  319.         dvo_timing = find_section(bdb, BDB_SDVO_PANEL_DTDS);
  320.         if (!dvo_timing)
  321.                 return;
  322.  
  323.         panel_fixed_mode = kzalloc(sizeof(*panel_fixed_mode), GFP_KERNEL);
  324.         if (!panel_fixed_mode)
  325.                 return;
  326.  
  327.         fill_detail_timing_data(panel_fixed_mode, dvo_timing + index);
  328.  
  329.         dev_priv->vbt.sdvo_lvds_vbt_mode = panel_fixed_mode;
  330.  
  331.         DRM_DEBUG_KMS("Found SDVO panel mode in BIOS VBT tables:\n");
  332.         drm_mode_debug_printmodeline(panel_fixed_mode);
  333. }
  334.  
  335. static int intel_bios_ssc_frequency(struct drm_device *dev,
  336.                                     bool alternate)
  337. {
  338.         switch (INTEL_INFO(dev)->gen) {
  339.         case 2:
  340.                 return alternate ? 66667 : 48000;
  341.         case 3:
  342.         case 4:
  343.                 return alternate ? 100000 : 96000;
  344.         default:
  345.                 return alternate ? 100000 : 120000;
  346.         }
  347. }
  348.  
  349. static void
  350. parse_general_features(struct drm_i915_private *dev_priv,
  351.                        const struct bdb_header *bdb)
  352. {
  353.         struct drm_device *dev = dev_priv->dev;
  354.         const struct bdb_general_features *general;
  355.  
  356.         general = find_section(bdb, BDB_GENERAL_FEATURES);
  357.         if (general) {
  358.                 dev_priv->vbt.int_tv_support = general->int_tv_support;
  359.                 dev_priv->vbt.int_crt_support = general->int_crt_support;
  360.                 dev_priv->vbt.lvds_use_ssc = general->enable_ssc;
  361.                 dev_priv->vbt.lvds_ssc_freq =
  362.                         intel_bios_ssc_frequency(dev, general->ssc_freq);
  363.                 dev_priv->vbt.display_clock_mode = general->display_clock_mode;
  364.                 dev_priv->vbt.fdi_rx_polarity_inverted = general->fdi_rx_polarity_inverted;
  365.                 DRM_DEBUG_KMS("BDB_GENERAL_FEATURES int_tv_support %d int_crt_support %d lvds_use_ssc %d lvds_ssc_freq %d display_clock_mode %d fdi_rx_polarity_inverted %d\n",
  366.                               dev_priv->vbt.int_tv_support,
  367.                               dev_priv->vbt.int_crt_support,
  368.                               dev_priv->vbt.lvds_use_ssc,
  369.                               dev_priv->vbt.lvds_ssc_freq,
  370.                               dev_priv->vbt.display_clock_mode,
  371.                               dev_priv->vbt.fdi_rx_polarity_inverted);
  372.         }
  373. }
  374.  
  375. static void
  376. parse_general_definitions(struct drm_i915_private *dev_priv,
  377.                           const struct bdb_header *bdb)
  378. {
  379.         const struct bdb_general_definitions *general;
  380.  
  381.         general = find_section(bdb, BDB_GENERAL_DEFINITIONS);
  382.         if (general) {
  383.                 u16 block_size = get_blocksize(general);
  384.                 if (block_size >= sizeof(*general)) {
  385.                         int bus_pin = general->crt_ddc_gmbus_pin;
  386.                         DRM_DEBUG_KMS("crt_ddc_bus_pin: %d\n", bus_pin);
  387.                         if (intel_gmbus_is_valid_pin(dev_priv, bus_pin))
  388.                                 dev_priv->vbt.crt_ddc_pin = bus_pin;
  389.                 } else {
  390.                         DRM_DEBUG_KMS("BDB_GD too small (%d). Invalid.\n",
  391.                                       block_size);
  392.                 }
  393.         }
  394. }
  395.  
  396. static const union child_device_config *
  397. child_device_ptr(const struct bdb_general_definitions *p_defs, int i)
  398. {
  399.         return (const void *) &p_defs->devices[i * p_defs->child_dev_size];
  400. }
  401.  
  402. static void
  403. parse_sdvo_device_mapping(struct drm_i915_private *dev_priv,
  404.                           const struct bdb_header *bdb)
  405. {
  406.         struct sdvo_device_mapping *p_mapping;
  407.         const struct bdb_general_definitions *p_defs;
  408.         const struct old_child_dev_config *child; /* legacy */
  409.         int i, child_device_num, count;
  410.         u16     block_size;
  411.  
  412.         p_defs = find_section(bdb, BDB_GENERAL_DEFINITIONS);
  413.         if (!p_defs) {
  414.                 DRM_DEBUG_KMS("No general definition block is found, unable to construct sdvo mapping.\n");
  415.                 return;
  416.         }
  417.  
  418.         /*
  419.          * Only parse SDVO mappings when the general definitions block child
  420.          * device size matches that of the *legacy* child device config
  421.          * struct. Thus, SDVO mapping will be skipped for newer VBT.
  422.          */
  423.         if (p_defs->child_dev_size != sizeof(*child)) {
  424.                 DRM_DEBUG_KMS("Unsupported child device size for SDVO mapping.\n");
  425.                 return;
  426.         }
  427.         /* get the block size of general definitions */
  428.         block_size = get_blocksize(p_defs);
  429.         /* get the number of child device */
  430.         child_device_num = (block_size - sizeof(*p_defs)) /
  431.                 p_defs->child_dev_size;
  432.         count = 0;
  433.         for (i = 0; i < child_device_num; i++) {
  434.                 child = &child_device_ptr(p_defs, i)->old;
  435.                 if (!child->device_type) {
  436.                         /* skip the device block if device type is invalid */
  437.                         continue;
  438.                 }
  439.                 if (child->slave_addr != SLAVE_ADDR1 &&
  440.                     child->slave_addr != SLAVE_ADDR2) {
  441.                         /*
  442.                          * If the slave address is neither 0x70 nor 0x72,
  443.                          * it is not a SDVO device. Skip it.
  444.                          */
  445.                         continue;
  446.                 }
  447.                 if (child->dvo_port != DEVICE_PORT_DVOB &&
  448.                     child->dvo_port != DEVICE_PORT_DVOC) {
  449.                         /* skip the incorrect SDVO port */
  450.                         DRM_DEBUG_KMS("Incorrect SDVO port. Skip it\n");
  451.                         continue;
  452.                 }
  453.                 DRM_DEBUG_KMS("the SDVO device with slave addr %2x is found on"
  454.                               " %s port\n",
  455.                               child->slave_addr,
  456.                               (child->dvo_port == DEVICE_PORT_DVOB) ?
  457.                               "SDVOB" : "SDVOC");
  458.                 p_mapping = &(dev_priv->sdvo_mappings[child->dvo_port - 1]);
  459.                 if (!p_mapping->initialized) {
  460.                         p_mapping->dvo_port = child->dvo_port;
  461.                         p_mapping->slave_addr = child->slave_addr;
  462.                         p_mapping->dvo_wiring = child->dvo_wiring;
  463.                         p_mapping->ddc_pin = child->ddc_pin;
  464.                         p_mapping->i2c_pin = child->i2c_pin;
  465.                         p_mapping->initialized = 1;
  466.                         DRM_DEBUG_KMS("SDVO device: dvo=%x, addr=%x, wiring=%d, ddc_pin=%d, i2c_pin=%d\n",
  467.                                       p_mapping->dvo_port,
  468.                                       p_mapping->slave_addr,
  469.                                       p_mapping->dvo_wiring,
  470.                                       p_mapping->ddc_pin,
  471.                                       p_mapping->i2c_pin);
  472.                 } else {
  473.                         DRM_DEBUG_KMS("Maybe one SDVO port is shared by "
  474.                                          "two SDVO device.\n");
  475.                 }
  476.                 if (child->slave2_addr) {
  477.                         /* Maybe this is a SDVO device with multiple inputs */
  478.                         /* And the mapping info is not added */
  479.                         DRM_DEBUG_KMS("there exists the slave2_addr. Maybe this"
  480.                                 " is a SDVO device with multiple inputs.\n");
  481.                 }
  482.                 count++;
  483.         }
  484.  
  485.         if (!count) {
  486.                 /* No SDVO device info is found */
  487.                 DRM_DEBUG_KMS("No SDVO device info is found in VBT\n");
  488.         }
  489.         return;
  490. }
  491.  
  492. static void
  493. parse_driver_features(struct drm_i915_private *dev_priv,
  494.                       const struct bdb_header *bdb)
  495. {
  496.         const struct bdb_driver_features *driver;
  497.  
  498.         driver = find_section(bdb, BDB_DRIVER_FEATURES);
  499.         if (!driver)
  500.                 return;
  501.  
  502.         if (driver->lvds_config == BDB_DRIVER_FEATURE_EDP)
  503.                 dev_priv->vbt.edp_support = 1;
  504.  
  505.         if (driver->dual_frequency)
  506.                 dev_priv->render_reclock_avail = true;
  507.  
  508.         DRM_DEBUG_KMS("DRRS State Enabled:%d\n", driver->drrs_enabled);
  509.         /*
  510.          * If DRRS is not supported, drrs_type has to be set to 0.
  511.          * This is because, VBT is configured in such a way that
  512.          * static DRRS is 0 and DRRS not supported is represented by
  513.          * driver->drrs_enabled=false
  514.          */
  515.         if (!driver->drrs_enabled)
  516.                 dev_priv->vbt.drrs_type = DRRS_NOT_SUPPORTED;
  517. }
  518.  
  519. static void
  520. parse_edp(struct drm_i915_private *dev_priv, const struct bdb_header *bdb)
  521. {
  522.         const struct bdb_edp *edp;
  523.         const struct edp_power_seq *edp_pps;
  524.         const struct edp_link_params *edp_link_params;
  525.  
  526.         edp = find_section(bdb, BDB_EDP);
  527.         if (!edp) {
  528.                 if (dev_priv->vbt.edp_support)
  529.                         DRM_DEBUG_KMS("No eDP BDB found but eDP panel supported.\n");
  530.                 return;
  531.         }
  532.  
  533.         switch ((edp->color_depth >> (panel_type * 2)) & 3) {
  534.         case EDP_18BPP:
  535.                 dev_priv->vbt.edp_bpp = 18;
  536.                 break;
  537.         case EDP_24BPP:
  538.                 dev_priv->vbt.edp_bpp = 24;
  539.                 break;
  540.         case EDP_30BPP:
  541.                 dev_priv->vbt.edp_bpp = 30;
  542.                 break;
  543.         }
  544.  
  545.         /* Get the eDP sequencing and link info */
  546.         edp_pps = &edp->power_seqs[panel_type];
  547.         edp_link_params = &edp->link_params[panel_type];
  548.  
  549.         dev_priv->vbt.edp_pps = *edp_pps;
  550.  
  551.         switch (edp_link_params->rate) {
  552.         case EDP_RATE_1_62:
  553.                 dev_priv->vbt.edp_rate = DP_LINK_BW_1_62;
  554.                 break;
  555.         case EDP_RATE_2_7:
  556.                 dev_priv->vbt.edp_rate = DP_LINK_BW_2_7;
  557.                 break;
  558.         default:
  559.                 DRM_DEBUG_KMS("VBT has unknown eDP link rate value %u\n",
  560.                               edp_link_params->rate);
  561.                 break;
  562.         }
  563.  
  564.         switch (edp_link_params->lanes) {
  565.         case EDP_LANE_1:
  566.                 dev_priv->vbt.edp_lanes = 1;
  567.                 break;
  568.         case EDP_LANE_2:
  569.                 dev_priv->vbt.edp_lanes = 2;
  570.                 break;
  571.         case EDP_LANE_4:
  572.                 dev_priv->vbt.edp_lanes = 4;
  573.                 break;
  574.         default:
  575.                 DRM_DEBUG_KMS("VBT has unknown eDP lane count value %u\n",
  576.                               edp_link_params->lanes);
  577.                 break;
  578.         }
  579.  
  580.         switch (edp_link_params->preemphasis) {
  581.         case EDP_PREEMPHASIS_NONE:
  582.                 dev_priv->vbt.edp_preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_0;
  583.                 break;
  584.         case EDP_PREEMPHASIS_3_5dB:
  585.                 dev_priv->vbt.edp_preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_1;
  586.                 break;
  587.         case EDP_PREEMPHASIS_6dB:
  588.                 dev_priv->vbt.edp_preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_2;
  589.                 break;
  590.         case EDP_PREEMPHASIS_9_5dB:
  591.                 dev_priv->vbt.edp_preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_3;
  592.                 break;
  593.         default:
  594.                 DRM_DEBUG_KMS("VBT has unknown eDP pre-emphasis value %u\n",
  595.                               edp_link_params->preemphasis);
  596.                 break;
  597.         }
  598.  
  599.         switch (edp_link_params->vswing) {
  600.         case EDP_VSWING_0_4V:
  601.                 dev_priv->vbt.edp_vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_0;
  602.                 break;
  603.         case EDP_VSWING_0_6V:
  604.                 dev_priv->vbt.edp_vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_1;
  605.                 break;
  606.         case EDP_VSWING_0_8V:
  607.                 dev_priv->vbt.edp_vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_2;
  608.                 break;
  609.         case EDP_VSWING_1_2V:
  610.                 dev_priv->vbt.edp_vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_3;
  611.                 break;
  612.         default:
  613.                 DRM_DEBUG_KMS("VBT has unknown eDP voltage swing value %u\n",
  614.                               edp_link_params->vswing);
  615.                 break;
  616.         }
  617.  
  618.         if (bdb->version >= 173) {
  619.                 uint8_t vswing;
  620.  
  621.                 /* Don't read from VBT if module parameter has valid value*/
  622.                 if (i915.edp_vswing) {
  623.                         dev_priv->edp_low_vswing = i915.edp_vswing == 1;
  624.                 } else {
  625.                         vswing = (edp->edp_vswing_preemph >> (panel_type * 4)) & 0xF;
  626.                         dev_priv->edp_low_vswing = vswing == 0;
  627.                 }
  628.         }
  629. }
  630.  
  631. static void
  632. parse_psr(struct drm_i915_private *dev_priv, const struct bdb_header *bdb)
  633. {
  634.         const struct bdb_psr *psr;
  635.         const struct psr_table *psr_table;
  636.  
  637.         psr = find_section(bdb, BDB_PSR);
  638.         if (!psr) {
  639.                 DRM_DEBUG_KMS("No PSR BDB found.\n");
  640.                 return;
  641.         }
  642.  
  643.         psr_table = &psr->psr_table[panel_type];
  644.  
  645.         dev_priv->vbt.psr.full_link = psr_table->full_link;
  646.         dev_priv->vbt.psr.require_aux_wakeup = psr_table->require_aux_to_wakeup;
  647.  
  648.         /* Allowed VBT values goes from 0 to 15 */
  649.         dev_priv->vbt.psr.idle_frames = psr_table->idle_frames < 0 ? 0 :
  650.                 psr_table->idle_frames > 15 ? 15 : psr_table->idle_frames;
  651.  
  652.         switch (psr_table->lines_to_wait) {
  653.         case 0:
  654.                 dev_priv->vbt.psr.lines_to_wait = PSR_0_LINES_TO_WAIT;
  655.                 break;
  656.         case 1:
  657.                 dev_priv->vbt.psr.lines_to_wait = PSR_1_LINE_TO_WAIT;
  658.                 break;
  659.         case 2:
  660.                 dev_priv->vbt.psr.lines_to_wait = PSR_4_LINES_TO_WAIT;
  661.                 break;
  662.         case 3:
  663.                 dev_priv->vbt.psr.lines_to_wait = PSR_8_LINES_TO_WAIT;
  664.                 break;
  665.         default:
  666.                 DRM_DEBUG_KMS("VBT has unknown PSR lines to wait %u\n",
  667.                               psr_table->lines_to_wait);
  668.                 break;
  669.         }
  670.  
  671.         dev_priv->vbt.psr.tp1_wakeup_time = psr_table->tp1_wakeup_time;
  672.         dev_priv->vbt.psr.tp2_tp3_wakeup_time = psr_table->tp2_tp3_wakeup_time;
  673. }
  674.  
  675. static u8 *goto_next_sequence(u8 *data, int *size)
  676. {
  677.         u16 len;
  678.         int tmp = *size;
  679.  
  680.         if (--tmp < 0)
  681.                 return NULL;
  682.  
  683.         /* goto first element */
  684.         data++;
  685.         while (1) {
  686.                 switch (*data) {
  687.                 case MIPI_SEQ_ELEM_SEND_PKT:
  688.                         /*
  689.                          * skip by this element payload size
  690.                          * skip elem id, command flag and data type
  691.                          */
  692.                         tmp -= 5;
  693.                         if (tmp < 0)
  694.                                 return NULL;
  695.  
  696.                         data += 3;
  697.                         len = *((u16 *)data);
  698.  
  699.                         tmp -= len;
  700.                         if (tmp < 0)
  701.                                 return NULL;
  702.  
  703.                         /* skip by len */
  704.                         data = data + 2 + len;
  705.                         break;
  706.                 case MIPI_SEQ_ELEM_DELAY:
  707.                         /* skip by elem id, and delay is 4 bytes */
  708.                         tmp -= 5;
  709.                         if (tmp < 0)
  710.                                 return NULL;
  711.  
  712.                         data += 5;
  713.                         break;
  714.                 case MIPI_SEQ_ELEM_GPIO:
  715.                         tmp -= 3;
  716.                         if (tmp < 0)
  717.                                 return NULL;
  718.  
  719.                         data += 3;
  720.                         break;
  721.                 default:
  722.                         DRM_ERROR("Unknown element\n");
  723.                         return NULL;
  724.                 }
  725.  
  726.                 /* end of sequence ? */
  727.                 if (*data == 0)
  728.                         break;
  729.         }
  730.  
  731.         /* goto next sequence or end of block byte */
  732.         if (--tmp < 0)
  733.                 return NULL;
  734.  
  735.         data++;
  736.  
  737.         /* update amount of data left for the sequence block to be parsed */
  738.         *size = tmp;
  739.         return data;
  740. }
  741.  
  742. static void
  743. parse_mipi(struct drm_i915_private *dev_priv, const struct bdb_header *bdb)
  744. {
  745.         const struct bdb_mipi_config *start;
  746.         const struct bdb_mipi_sequence *sequence;
  747.         const struct mipi_config *config;
  748.         const struct mipi_pps_data *pps;
  749.         u8 *data;
  750.         const u8 *seq_data;
  751.         int i, panel_id, seq_size;
  752.         u16 block_size;
  753.  
  754.         /* parse MIPI blocks only if LFP type is MIPI */
  755.         if (!dev_priv->vbt.has_mipi)
  756.                 return;
  757.  
  758.         /* Initialize this to undefined indicating no generic MIPI support */
  759.         dev_priv->vbt.dsi.panel_id = MIPI_DSI_UNDEFINED_PANEL_ID;
  760.  
  761.         /* Block #40 is already parsed and panel_fixed_mode is
  762.          * stored in dev_priv->lfp_lvds_vbt_mode
  763.          * resuse this when needed
  764.          */
  765.  
  766.         /* Parse #52 for panel index used from panel_type already
  767.          * parsed
  768.          */
  769.         start = find_section(bdb, BDB_MIPI_CONFIG);
  770.         if (!start) {
  771.                 DRM_DEBUG_KMS("No MIPI config BDB found");
  772.                 return;
  773.         }
  774.  
  775.         DRM_DEBUG_DRIVER("Found MIPI Config block, panel index = %d\n",
  776.                                                                 panel_type);
  777.  
  778.         /*
  779.          * get hold of the correct configuration block and pps data as per
  780.          * the panel_type as index
  781.          */
  782.         config = &start->config[panel_type];
  783.         pps = &start->pps[panel_type];
  784.  
  785.         /* store as of now full data. Trim when we realise all is not needed */
  786.         dev_priv->vbt.dsi.config = kmemdup(config, sizeof(struct mipi_config), GFP_KERNEL);
  787.         if (!dev_priv->vbt.dsi.config)
  788.                 return;
  789.  
  790.         dev_priv->vbt.dsi.pps = kmemdup(pps, sizeof(struct mipi_pps_data), GFP_KERNEL);
  791.         if (!dev_priv->vbt.dsi.pps) {
  792.                 kfree(dev_priv->vbt.dsi.config);
  793.                 return;
  794.         }
  795.  
  796.         /* We have mandatory mipi config blocks. Initialize as generic panel */
  797.         dev_priv->vbt.dsi.panel_id = MIPI_DSI_GENERIC_PANEL_ID;
  798.  
  799.         /* Check if we have sequence block as well */
  800.         sequence = find_section(bdb, BDB_MIPI_SEQUENCE);
  801.         if (!sequence) {
  802.                 DRM_DEBUG_KMS("No MIPI Sequence found, parsing complete\n");
  803.                 return;
  804.         }
  805.  
  806.         /* Fail gracefully for forward incompatible sequence block. */
  807.         if (sequence->version >= 3) {
  808.                 DRM_ERROR("Unable to parse MIPI Sequence Block v3+\n");
  809.                 return;
  810.         }
  811.  
  812.         DRM_DEBUG_DRIVER("Found MIPI sequence block\n");
  813.  
  814.         block_size = get_blocksize(sequence);
  815.  
  816.         /*
  817.          * parse the sequence block for individual sequences
  818.          */
  819.         dev_priv->vbt.dsi.seq_version = sequence->version;
  820.  
  821.         seq_data = &sequence->data[0];
  822.  
  823.         /*
  824.          * sequence block is variable length and hence we need to parse and
  825.          * get the sequence data for specific panel id
  826.          */
  827.         for (i = 0; i < MAX_MIPI_CONFIGURATIONS; i++) {
  828.                 panel_id = *seq_data;
  829.                 seq_size = *((u16 *) (seq_data + 1));
  830.                 if (panel_id == panel_type)
  831.                         break;
  832.  
  833.                 /* skip the sequence including seq header of 3 bytes */
  834.                 seq_data = seq_data + 3 + seq_size;
  835.                 if ((seq_data - &sequence->data[0]) > block_size) {
  836.                         DRM_ERROR("Sequence start is beyond sequence block size, corrupted sequence block\n");
  837.                         return;
  838.                 }
  839.         }
  840.  
  841.         if (i == MAX_MIPI_CONFIGURATIONS) {
  842.                 DRM_ERROR("Sequence block detected but no valid configuration\n");
  843.                 return;
  844.         }
  845.  
  846.         /* check if found sequence is completely within the sequence block
  847.          * just being paranoid */
  848.         if (seq_size > block_size) {
  849.                 DRM_ERROR("Corrupted sequence/size, bailing out\n");
  850.                 return;
  851.         }
  852.  
  853.         /* skip the panel id(1 byte) and seq size(2 bytes) */
  854.         dev_priv->vbt.dsi.data = kmemdup(seq_data + 3, seq_size, GFP_KERNEL);
  855.         if (!dev_priv->vbt.dsi.data)
  856.                 return;
  857.  
  858.         /*
  859.          * loop into the sequence data and split into multiple sequneces
  860.          * There are only 5 types of sequences as of now
  861.          */
  862.         data = dev_priv->vbt.dsi.data;
  863.         dev_priv->vbt.dsi.size = seq_size;
  864.  
  865.         /* two consecutive 0x00 indicate end of all sequences */
  866.         while (1) {
  867.                 int seq_id = *data;
  868.                 if (MIPI_SEQ_MAX > seq_id && seq_id > MIPI_SEQ_UNDEFINED) {
  869.                         dev_priv->vbt.dsi.sequence[seq_id] = data;
  870.                         DRM_DEBUG_DRIVER("Found mipi sequence - %d\n", seq_id);
  871.                 } else {
  872.                         DRM_ERROR("undefined sequence\n");
  873.                         goto err;
  874.                 }
  875.  
  876.                 /* partial parsing to skip elements */
  877.                 data = goto_next_sequence(data, &seq_size);
  878.  
  879.                 if (data == NULL) {
  880.                         DRM_ERROR("Sequence elements going beyond block itself. Sequence block parsing failed\n");
  881.                         goto err;
  882.                 }
  883.  
  884.                 if (*data == 0)
  885.                         break; /* end of sequence reached */
  886.         }
  887.  
  888.         DRM_DEBUG_DRIVER("MIPI related vbt parsing complete\n");
  889.         return;
  890. err:
  891.         kfree(dev_priv->vbt.dsi.data);
  892.         dev_priv->vbt.dsi.data = NULL;
  893.  
  894.         /* error during parsing so set all pointers to null
  895.          * because of partial parsing */
  896.         memset(dev_priv->vbt.dsi.sequence, 0, sizeof(dev_priv->vbt.dsi.sequence));
  897. }
  898.  
  899. static u8 translate_iboost(u8 val)
  900. {
  901.         static const u8 mapping[] = { 1, 3, 7 }; /* See VBT spec */
  902.  
  903.         if (val >= ARRAY_SIZE(mapping)) {
  904.                 DRM_DEBUG_KMS("Unsupported I_boost value found in VBT (%d), display may not work properly\n", val);
  905.                 return 0;
  906.         }
  907.         return mapping[val];
  908. }
  909.  
  910. static void parse_ddi_port(struct drm_i915_private *dev_priv, enum port port,
  911.                            const struct bdb_header *bdb)
  912. {
  913.         union child_device_config *it, *child = NULL;
  914.         struct ddi_vbt_port_info *info = &dev_priv->vbt.ddi_port_info[port];
  915.         uint8_t hdmi_level_shift;
  916.         int i, j;
  917.         bool is_dvi, is_hdmi, is_dp, is_edp, is_crt;
  918.         uint8_t aux_channel, ddc_pin;
  919.         /* Each DDI port can have more than one value on the "DVO Port" field,
  920.          * so look for all the possible values for each port and abort if more
  921.          * than one is found. */
  922.         int dvo_ports[][3] = {
  923.                 {DVO_PORT_HDMIA, DVO_PORT_DPA, -1},
  924.                 {DVO_PORT_HDMIB, DVO_PORT_DPB, -1},
  925.                 {DVO_PORT_HDMIC, DVO_PORT_DPC, -1},
  926.                 {DVO_PORT_HDMID, DVO_PORT_DPD, -1},
  927.                 {DVO_PORT_CRT, DVO_PORT_HDMIE, DVO_PORT_DPE},
  928.         };
  929.  
  930.         /* Find the child device to use, abort if more than one found. */
  931.         for (i = 0; i < dev_priv->vbt.child_dev_num; i++) {
  932.                 it = dev_priv->vbt.child_dev + i;
  933.  
  934.                 for (j = 0; j < 3; j++) {
  935.                         if (dvo_ports[port][j] == -1)
  936.                                 break;
  937.  
  938.                         if (it->common.dvo_port == dvo_ports[port][j]) {
  939.                                 if (child) {
  940.                                         DRM_DEBUG_KMS("More than one child device for port %c in VBT.\n",
  941.                                                       port_name(port));
  942.                                         return;
  943.                                 }
  944.                                 child = it;
  945.                         }
  946.                 }
  947.         }
  948.         if (!child)
  949.                 return;
  950.  
  951.         aux_channel = child->raw[25];
  952.         ddc_pin = child->common.ddc_pin;
  953.  
  954.         is_dvi = child->common.device_type & DEVICE_TYPE_TMDS_DVI_SIGNALING;
  955.         is_dp = child->common.device_type & DEVICE_TYPE_DISPLAYPORT_OUTPUT;
  956.         is_crt = child->common.device_type & DEVICE_TYPE_ANALOG_OUTPUT;
  957.         is_hdmi = is_dvi && (child->common.device_type & DEVICE_TYPE_NOT_HDMI_OUTPUT) == 0;
  958.         is_edp = is_dp && (child->common.device_type & DEVICE_TYPE_INTERNAL_CONNECTOR);
  959.  
  960.         info->supports_dvi = is_dvi;
  961.         info->supports_hdmi = is_hdmi;
  962.         info->supports_dp = is_dp;
  963.  
  964.         DRM_DEBUG_KMS("Port %c VBT info: DP:%d HDMI:%d DVI:%d EDP:%d CRT:%d\n",
  965.                       port_name(port), is_dp, is_hdmi, is_dvi, is_edp, is_crt);
  966.  
  967.         if (is_edp && is_dvi)
  968.                 DRM_DEBUG_KMS("Internal DP port %c is TMDS compatible\n",
  969.                               port_name(port));
  970.         if (is_crt && port != PORT_E)
  971.                 DRM_DEBUG_KMS("Port %c is analog\n", port_name(port));
  972.         if (is_crt && (is_dvi || is_dp))
  973.                 DRM_DEBUG_KMS("Analog port %c is also DP or TMDS compatible\n",
  974.                               port_name(port));
  975.         if (is_dvi && (port == PORT_A || port == PORT_E))
  976.                 DRM_DEBUG_KMS("Port %c is TMDS compatible\n", port_name(port));
  977.         if (!is_dvi && !is_dp && !is_crt)
  978.                 DRM_DEBUG_KMS("Port %c is not DP/TMDS/CRT compatible\n",
  979.                               port_name(port));
  980.         if (is_edp && (port == PORT_B || port == PORT_C || port == PORT_E))
  981.                 DRM_DEBUG_KMS("Port %c is internal DP\n", port_name(port));
  982.  
  983.         if (is_dvi) {
  984.                 if (port == PORT_E) {
  985.                         info->alternate_ddc_pin = ddc_pin;
  986.                         /* if DDIE share ddc pin with other port, then
  987.                          * dvi/hdmi couldn't exist on the shared port.
  988.                          * Otherwise they share the same ddc bin and system
  989.                          * couldn't communicate with them seperately. */
  990.                         if (ddc_pin == DDC_PIN_B) {
  991.                                 dev_priv->vbt.ddi_port_info[PORT_B].supports_dvi = 0;
  992.                                 dev_priv->vbt.ddi_port_info[PORT_B].supports_hdmi = 0;
  993.                         } else if (ddc_pin == DDC_PIN_C) {
  994.                                 dev_priv->vbt.ddi_port_info[PORT_C].supports_dvi = 0;
  995.                                 dev_priv->vbt.ddi_port_info[PORT_C].supports_hdmi = 0;
  996.                         } else if (ddc_pin == DDC_PIN_D) {
  997.                                 dev_priv->vbt.ddi_port_info[PORT_D].supports_dvi = 0;
  998.                                 dev_priv->vbt.ddi_port_info[PORT_D].supports_hdmi = 0;
  999.                         }
  1000.                 } else if (ddc_pin == DDC_PIN_B && port != PORT_B)
  1001.                         DRM_DEBUG_KMS("Unexpected DDC pin for port B\n");
  1002.                 else if (ddc_pin == DDC_PIN_C && port != PORT_C)
  1003.                         DRM_DEBUG_KMS("Unexpected DDC pin for port C\n");
  1004.                 else if (ddc_pin == DDC_PIN_D && port != PORT_D)
  1005.                         DRM_DEBUG_KMS("Unexpected DDC pin for port D\n");
  1006.         }
  1007.  
  1008.         if (is_dp) {
  1009.                 if (port == PORT_E) {
  1010.                         info->alternate_aux_channel = aux_channel;
  1011.                         /* if DDIE share aux channel with other port, then
  1012.                          * DP couldn't exist on the shared port. Otherwise
  1013.                          * they share the same aux channel and system
  1014.                          * couldn't communicate with them seperately. */
  1015.                         if (aux_channel == DP_AUX_A)
  1016.                                 dev_priv->vbt.ddi_port_info[PORT_A].supports_dp = 0;
  1017.                         else if (aux_channel == DP_AUX_B)
  1018.                                 dev_priv->vbt.ddi_port_info[PORT_B].supports_dp = 0;
  1019.                         else if (aux_channel == DP_AUX_C)
  1020.                                 dev_priv->vbt.ddi_port_info[PORT_C].supports_dp = 0;
  1021.                         else if (aux_channel == DP_AUX_D)
  1022.                                 dev_priv->vbt.ddi_port_info[PORT_D].supports_dp = 0;
  1023.                 }
  1024.                 else if (aux_channel == DP_AUX_A && port != PORT_A)
  1025.                         DRM_DEBUG_KMS("Unexpected AUX channel for port A\n");
  1026.                 else if (aux_channel == DP_AUX_B && port != PORT_B)
  1027.                         DRM_DEBUG_KMS("Unexpected AUX channel for port B\n");
  1028.                 else if (aux_channel == DP_AUX_C && port != PORT_C)
  1029.                         DRM_DEBUG_KMS("Unexpected AUX channel for port C\n");
  1030.                 else if (aux_channel == DP_AUX_D && port != PORT_D)
  1031.                         DRM_DEBUG_KMS("Unexpected AUX channel for port D\n");
  1032.         }
  1033.  
  1034.         if (bdb->version >= 158) {
  1035.                 /* The VBT HDMI level shift values match the table we have. */
  1036.                 hdmi_level_shift = child->raw[7] & 0xF;
  1037.                 DRM_DEBUG_KMS("VBT HDMI level shift for port %c: %d\n",
  1038.                               port_name(port),
  1039.                               hdmi_level_shift);
  1040.                 info->hdmi_level_shift = hdmi_level_shift;
  1041.         }
  1042.  
  1043.         /* Parse the I_boost config for SKL and above */
  1044.         if (bdb->version >= 196 && (child->common.flags_1 & IBOOST_ENABLE)) {
  1045.                 info->dp_boost_level = translate_iboost(child->common.iboost_level & 0xF);
  1046.                 DRM_DEBUG_KMS("VBT (e)DP boost level for port %c: %d\n",
  1047.                               port_name(port), info->dp_boost_level);
  1048.                 info->hdmi_boost_level = translate_iboost(child->common.iboost_level >> 4);
  1049.                 DRM_DEBUG_KMS("VBT HDMI boost level for port %c: %d\n",
  1050.                               port_name(port), info->hdmi_boost_level);
  1051.         }
  1052. }
  1053.  
  1054. static void parse_ddi_ports(struct drm_i915_private *dev_priv,
  1055.                             const struct bdb_header *bdb)
  1056. {
  1057.         struct drm_device *dev = dev_priv->dev;
  1058.         enum port port;
  1059.  
  1060.         if (!HAS_DDI(dev))
  1061.                 return;
  1062.  
  1063.         if (!dev_priv->vbt.child_dev_num)
  1064.                 return;
  1065.  
  1066.         if (bdb->version < 155)
  1067.                 return;
  1068.  
  1069.         for (port = PORT_A; port < I915_MAX_PORTS; port++)
  1070.                 parse_ddi_port(dev_priv, port, bdb);
  1071. }
  1072.  
  1073. static void
  1074. parse_device_mapping(struct drm_i915_private *dev_priv,
  1075.                      const struct bdb_header *bdb)
  1076. {
  1077.         const struct bdb_general_definitions *p_defs;
  1078.         const union child_device_config *p_child;
  1079.         union child_device_config *child_dev_ptr;
  1080.         int i, child_device_num, count;
  1081.         u8 expected_size;
  1082.         u16 block_size;
  1083.  
  1084.         p_defs = find_section(bdb, BDB_GENERAL_DEFINITIONS);
  1085.         if (!p_defs) {
  1086.                 DRM_DEBUG_KMS("No general definition block is found, no devices defined.\n");
  1087.                 return;
  1088.         }
  1089.         if (bdb->version < 195) {
  1090.                 expected_size = sizeof(struct old_child_dev_config);
  1091.         } else if (bdb->version == 195) {
  1092.                 expected_size = 37;
  1093.         } else if (bdb->version <= 197) {
  1094.                 expected_size = 38;
  1095.         } else {
  1096.                 expected_size = 38;
  1097.                 BUILD_BUG_ON(sizeof(*p_child) < 38);
  1098.                 DRM_DEBUG_DRIVER("Expected child device config size for VBT version %u not known; assuming %u\n",
  1099.                                  bdb->version, expected_size);
  1100.         }
  1101.  
  1102.         /* The legacy sized child device config is the minimum we need. */
  1103.         if (p_defs->child_dev_size < sizeof(struct old_child_dev_config)) {
  1104.                 DRM_ERROR("Child device config size %u is too small.\n",
  1105.                           p_defs->child_dev_size);
  1106.                 return;
  1107.         }
  1108.  
  1109.         /* Flag an error for unexpected size, but continue anyway. */
  1110.         if (p_defs->child_dev_size != expected_size)
  1111.                 DRM_ERROR("Unexpected child device config size %u (expected %u for VBT version %u)\n",
  1112.                           p_defs->child_dev_size, expected_size, bdb->version);
  1113.  
  1114.         /* get the block size of general definitions */
  1115.         block_size = get_blocksize(p_defs);
  1116.         /* get the number of child device */
  1117.         child_device_num = (block_size - sizeof(*p_defs)) /
  1118.                                 p_defs->child_dev_size;
  1119.         count = 0;
  1120.         /* get the number of child device that is present */
  1121.         for (i = 0; i < child_device_num; i++) {
  1122.                 p_child = child_device_ptr(p_defs, i);
  1123.                 if (!p_child->common.device_type) {
  1124.                         /* skip the device block if device type is invalid */
  1125.                         continue;
  1126.                 }
  1127.                 count++;
  1128.         }
  1129.         if (!count) {
  1130.                 DRM_DEBUG_KMS("no child dev is parsed from VBT\n");
  1131.                 return;
  1132.         }
  1133.         dev_priv->vbt.child_dev = kcalloc(count, sizeof(*p_child), GFP_KERNEL);
  1134.         if (!dev_priv->vbt.child_dev) {
  1135.                 DRM_DEBUG_KMS("No memory space for child device\n");
  1136.                 return;
  1137.         }
  1138.  
  1139.         dev_priv->vbt.child_dev_num = count;
  1140.         count = 0;
  1141.         for (i = 0; i < child_device_num; i++) {
  1142.                 p_child = child_device_ptr(p_defs, i);
  1143.                 if (!p_child->common.device_type) {
  1144.                         /* skip the device block if device type is invalid */
  1145.                         continue;
  1146.                 }
  1147.  
  1148.                 if (p_child->common.dvo_port >= DVO_PORT_MIPIA
  1149.                     && p_child->common.dvo_port <= DVO_PORT_MIPID
  1150.                     &&p_child->common.device_type & DEVICE_TYPE_MIPI_OUTPUT) {
  1151.                         DRM_DEBUG_KMS("Found MIPI as LFP\n");
  1152.                         dev_priv->vbt.has_mipi = 1;
  1153.                         dev_priv->vbt.dsi.port = p_child->common.dvo_port;
  1154.                 }
  1155.  
  1156.                 child_dev_ptr = dev_priv->vbt.child_dev + count;
  1157.                 count++;
  1158.  
  1159.                 /*
  1160.                  * Copy as much as we know (sizeof) and is available
  1161.                  * (child_dev_size) of the child device. Accessing the data must
  1162.                  * depend on VBT version.
  1163.                  */
  1164.                 memcpy(child_dev_ptr, p_child,
  1165.                        min_t(size_t, p_defs->child_dev_size, sizeof(*p_child)));
  1166.         }
  1167.         return;
  1168. }
  1169.  
  1170. static void
  1171. init_vbt_defaults(struct drm_i915_private *dev_priv)
  1172. {
  1173.         struct drm_device *dev = dev_priv->dev;
  1174.         enum port port;
  1175.  
  1176.         dev_priv->vbt.crt_ddc_pin = GMBUS_PIN_VGADDC;
  1177.  
  1178.         /* Default to having backlight */
  1179.         dev_priv->vbt.backlight.present = true;
  1180.  
  1181.         /* LFP panel data */
  1182.         dev_priv->vbt.lvds_dither = 1;
  1183.         dev_priv->vbt.lvds_vbt = 0;
  1184.  
  1185.         /* SDVO panel data */
  1186.         dev_priv->vbt.sdvo_lvds_vbt_mode = NULL;
  1187.  
  1188.         /* general features */
  1189.         dev_priv->vbt.int_tv_support = 1;
  1190.         dev_priv->vbt.int_crt_support = 1;
  1191.  
  1192.         /* Default to using SSC */
  1193.         dev_priv->vbt.lvds_use_ssc = 1;
  1194.         /*
  1195.          * Core/SandyBridge/IvyBridge use alternative (120MHz) reference
  1196.          * clock for LVDS.
  1197.          */
  1198.         dev_priv->vbt.lvds_ssc_freq = intel_bios_ssc_frequency(dev,
  1199.                         !HAS_PCH_SPLIT(dev));
  1200.         DRM_DEBUG_KMS("Set default to SSC at %d kHz\n", dev_priv->vbt.lvds_ssc_freq);
  1201.  
  1202.         for (port = PORT_A; port < I915_MAX_PORTS; port++) {
  1203.                 struct ddi_vbt_port_info *info =
  1204.                         &dev_priv->vbt.ddi_port_info[port];
  1205.  
  1206.                 info->hdmi_level_shift = HDMI_LEVEL_SHIFT_UNKNOWN;
  1207.  
  1208.                 info->supports_dvi = (port != PORT_A && port != PORT_E);
  1209.                 info->supports_hdmi = info->supports_dvi;
  1210.                 info->supports_dp = (port != PORT_E);
  1211.         }
  1212. }
  1213.  
  1214. static int intel_no_opregion_vbt_callback(const struct dmi_system_id *id)
  1215. {
  1216.         DRM_DEBUG_KMS("Falling back to manually reading VBT from "
  1217.                       "VBIOS ROM for %s\n",
  1218.                       id->ident);
  1219.         return 1;
  1220. }
  1221.  
  1222. static const struct dmi_system_id intel_no_opregion_vbt[] = {
  1223.         {
  1224.                 .callback = intel_no_opregion_vbt_callback,
  1225.                 .ident = "ThinkCentre A57",
  1226.                 .matches = {
  1227.                         DMI_MATCH(DMI_SYS_VENDOR, "LENOVO"),
  1228.                         DMI_MATCH(DMI_PRODUCT_NAME, "97027RG"),
  1229.                 },
  1230.         },
  1231.         { }
  1232. };
  1233.  
  1234. static const struct bdb_header *validate_vbt(const void *base,
  1235.                                              size_t size,
  1236.                                              const void *_vbt,
  1237.                                              const char *source)
  1238. {
  1239.         size_t offset = _vbt - base;
  1240.         const struct vbt_header *vbt = _vbt;
  1241.         const struct bdb_header *bdb;
  1242.  
  1243.         if (offset + sizeof(struct vbt_header) > size) {
  1244.                 DRM_DEBUG_DRIVER("VBT header incomplete\n");
  1245.                 return NULL;
  1246.         }
  1247.  
  1248.         if (memcmp(vbt->signature, "$VBT", 4)) {
  1249.                 DRM_DEBUG_DRIVER("VBT invalid signature\n");
  1250.                 return NULL;
  1251.         }
  1252.  
  1253.         offset += vbt->bdb_offset;
  1254.         if (offset + sizeof(struct bdb_header) > size) {
  1255.                 DRM_DEBUG_DRIVER("BDB header incomplete\n");
  1256.                 return NULL;
  1257.         }
  1258.  
  1259.         bdb = base + offset;
  1260.         if (offset + bdb->bdb_size > size) {
  1261.                 DRM_DEBUG_DRIVER("BDB incomplete\n");
  1262.                 return NULL;
  1263.         }
  1264.  
  1265.         DRM_DEBUG_KMS("Using VBT from %s: %20s\n",
  1266.                       source, vbt->signature);
  1267.         return bdb;
  1268. }
  1269.  
  1270. static const struct bdb_header *find_vbt(void __iomem *bios, size_t size)
  1271. {
  1272.         const struct bdb_header *bdb = NULL;
  1273.         size_t i;
  1274.  
  1275.         /* Scour memory looking for the VBT signature. */
  1276.         for (i = 0; i + 4 < size; i++) {
  1277.                 if (ioread32(bios + i) == *((const u32 *) "$VBT")) {
  1278.                         /*
  1279.                          * This is the one place where we explicitly discard the
  1280.                          * address space (__iomem) of the BIOS/VBT. From now on
  1281.                          * everything is based on 'base', and treated as regular
  1282.                          * memory.
  1283.                          */
  1284.                         void *_bios = (void __force *) bios;
  1285.  
  1286.                         bdb = validate_vbt(_bios, size, _bios + i, "PCI ROM");
  1287.                         break;
  1288.                 }
  1289.         }
  1290.  
  1291.         return bdb;
  1292. }
  1293.  
  1294. /**
  1295.  * intel_parse_bios - find VBT and initialize settings from the BIOS
  1296.  * @dev: DRM device
  1297.  *
  1298.  * Loads the Video BIOS and checks that the VBT exists.  Sets scratch registers
  1299.  * to appropriate values.
  1300.  *
  1301.  * Returns 0 on success, nonzero on failure.
  1302.  */
  1303. int
  1304. intel_parse_bios(struct drm_device *dev)
  1305. {
  1306.         struct drm_i915_private *dev_priv = dev->dev_private;
  1307.         struct pci_dev *pdev = dev->pdev;
  1308.         const struct bdb_header *bdb = NULL;
  1309.         u8 __iomem *bios = NULL;
  1310.  
  1311.         if (HAS_PCH_NOP(dev))
  1312.                 return -ENODEV;
  1313.  
  1314.         init_vbt_defaults(dev_priv);
  1315.  
  1316.         /* XXX Should this validation be moved to intel_opregion.c? */
  1317.         if (!dmi_check_system(intel_no_opregion_vbt) && dev_priv->opregion.vbt)
  1318.                 bdb = validate_vbt(dev_priv->opregion.header, OPREGION_SIZE,
  1319.                                    dev_priv->opregion.vbt, "OpRegion");
  1320.  
  1321.         if (bdb == NULL) {
  1322.                 size_t size;
  1323.  
  1324.                 bios = pci_map_rom(pdev, &size);
  1325.                 if (!bios)
  1326.                         return -1;
  1327.  
  1328.                 bdb = find_vbt(bios, size);
  1329.                 if (!bdb) {
  1330.                         pci_unmap_rom(pdev, bios);
  1331.                         return -1;
  1332.                 }
  1333.         }
  1334.  
  1335.         /* Grab useful general definitions */
  1336.         parse_general_features(dev_priv, bdb);
  1337.         parse_general_definitions(dev_priv, bdb);
  1338.         parse_lfp_panel_data(dev_priv, bdb);
  1339.         parse_lfp_backlight(dev_priv, bdb);
  1340.         parse_sdvo_panel_data(dev_priv, bdb);
  1341.         parse_sdvo_device_mapping(dev_priv, bdb);
  1342.         parse_device_mapping(dev_priv, bdb);
  1343.         parse_driver_features(dev_priv, bdb);
  1344.         parse_edp(dev_priv, bdb);
  1345.         parse_psr(dev_priv, bdb);
  1346.         parse_mipi(dev_priv, bdb);
  1347.         parse_ddi_ports(dev_priv, bdb);
  1348.  
  1349.         if (bios)
  1350.                 pci_unmap_rom(pdev, bios);
  1351.  
  1352.         return 0;
  1353. }
  1354.