Add some VLV limit structures and update the PLL code.

v2: resolve conflicts, Vijay to re-post with PLL valid checks and fixed limits

Signed-off-by: Shobhit Kumar <shobhit.ku...@intel.com>
Signed-off-by: Vijay Purushothaman <vijay.a.purushotha...@intel.com>
---
 drivers/gpu/drm/i915/i915_reg.h      |    1 +
 drivers/gpu/drm/i915/intel_display.c |  231 +++++++++++++++++++++++++++++++++-
 2 files changed, 229 insertions(+), 3 deletions(-)

diff --git a/drivers/gpu/drm/i915/i915_reg.h b/drivers/gpu/drm/i915/i915_reg.h
index 749e390..be11d39 100644
--- a/drivers/gpu/drm/i915/i915_reg.h
+++ b/drivers/gpu/drm/i915/i915_reg.h
@@ -869,6 +869,7 @@
 #define   DPLL_P2_CLOCK_DIV_MASK       0x03000000 /* i915 */
 #define   DPLL_FPA01_P1_POST_DIV_MASK  0x00ff0000 /* i915 */
 #define   DPLL_FPA01_P1_POST_DIV_MASK_PINEVIEW 0x00ff8000 /* Pineview */
+#define   DPLL_LOCK_VLV                        (1<<15)
 #define   DPLL_VOLTAGE_LDO_VLV         (1<<14)
 #define   DPLL_INTEGRATED_CLOCK_VLV    (1<<13)
 #define   DPLL_RATE_SWITCH_VLV         (1<<8)
diff --git a/drivers/gpu/drm/i915/intel_display.c 
b/drivers/gpu/drm/i915/intel_display.c
index adfa19b..6bed629 100644
--- a/drivers/gpu/drm/i915/intel_display.c
+++ b/drivers/gpu/drm/i915/intel_display.c
@@ -98,6 +98,10 @@ static bool
 intel_find_pll_ironlake_dp(const intel_limit_t *, struct drm_crtc *crtc,
                           int target, int refclk, intel_clock_t *match_clock,
                           intel_clock_t *best_clock);
+static bool
+intel_vlv_find_best_pll(const intel_limit_t *limit, struct drm_crtc *crtc,
+                       int target, int refclk, intel_clock_t *match_clock,
+                       intel_clock_t *best_clock);
 
 static inline u32 /* units of 100MHz */
 intel_fdi_link_freq(struct drm_device *dev)
@@ -360,6 +364,48 @@ static const intel_limit_t 
intel_limits_ironlake_display_port = {
        .find_pll = intel_find_pll_ironlake_dp,
 };
 
+static const intel_limit_t intel_limits_vlv_dac = {
+       .dot = { .min = 25000, .max = 270000 },
+       .vco = { .min = 4000000, .max = 6000000 },
+       .n = { .min = 1, .max = 7 },
+       .m = { .min = 22, .max = 450 }, /* guess */
+       .m1 = { .min = 2, .max = 3 },
+       .m2 = { .min = 11, .max = 156 },
+       .p = { .min = 10, .max = 30 },
+       .p1 = { .min = 2, .max = 3 },
+       .p2 = { .dot_limit = 270000,
+               .p2_slow = 10, .p2_fast = 5 },
+       .find_pll = intel_vlv_find_best_pll,
+};
+
+static const intel_limit_t intel_limits_vlv_hdmi = {
+       .dot = { .min = 20000, .max = 165000 },
+       .vco = { .min = 5994000, .max = 4000000 },
+       .n = { .min = 1, .max = 7 },
+       .m = { .min = 60, .max = 300 }, /* guess */
+       .m1 = { .min = 2, .max = 3 },
+       .m2 = { .min = 11, .max = 156 },
+       .p = { .min = 10, .max = 30 },
+       .p1 = { .min = 2, .max = 3 },
+       .p2 = { .dot_limit = 270000,
+               .p2_slow = 10, .p2_fast = 5 },
+       .find_pll = intel_vlv_find_best_pll,
+};
+
+static const intel_limit_t intel_limits_vlv_dp = {
+       .dot = { .min = 162000, .max = 270000 },
+       .vco = { .min = 5994000, .max = 4000000 },
+       .n = { .min = 1, .max = 7 },
+       .m = { .min = 60, .max = 300 }, /* guess */
+       .m1 = { .min = 2, .max = 3 },
+       .m2 = { .min = 11, .max = 156 },
+       .p = { .min = 10, .max = 30 },
+       .p1 = { .min = 2, .max = 3 },
+       .p2 = { .dot_limit = 270000,
+               .p2_slow = 10, .p2_fast = 5 },
+       .find_pll = intel_vlv_find_best_pll,
+};
+
 u32 intel_dpio_read(struct drm_i915_private *dev_priv, int reg)
 {
        unsigned long flags;
@@ -489,6 +535,13 @@ static const intel_limit_t *intel_limit(struct drm_crtc 
*crtc, int refclk)
                        limit = &intel_limits_pineview_lvds;
                else
                        limit = &intel_limits_pineview_sdvo;
+       } else if (IS_VALLEYVIEW(dev)) {
+               if (intel_pipe_has_type(crtc, INTEL_OUTPUT_ANALOG))
+                       limit = &intel_limits_vlv_dac;
+               else if (intel_pipe_has_type(crtc, INTEL_OUTPUT_HDMI))
+                       limit = &intel_limits_vlv_hdmi;
+               else
+                       limit = &intel_limits_vlv_dp;
        } else if (!IS_GEN2(dev)) {
                if (intel_pipe_has_type(crtc, INTEL_OUTPUT_LVDS))
                        limit = &intel_limits_i9xx_lvds;
@@ -764,6 +817,84 @@ intel_find_pll_g4x_dp(const intel_limit_t *limit, struct 
drm_crtc *crtc,
        return true;
 }
 
+static bool
+intel_vlv_find_best_pll(const intel_limit_t *limit, struct drm_crtc *crtc,
+                       int target, int refclk, intel_clock_t *match_clock,
+                       intel_clock_t *best_clock)
+{
+       u32 p1, p2, m1, m2, vco, bestn, bestm1, bestm2, bestp1, bestp2;
+       u32 m, n, fastclk, minvco, maxvco;
+       u32 updrate, minupdate, fracbits, p;
+       unsigned long bestppm, ppm, absppm;
+       int dotclk;
+
+       dotclk = target * 1000;
+
+       bestppm = 1000000;
+       ppm = 0;
+       absppm = 0;
+
+       fastclk = dotclk / (2*100);
+       minvco = limit->vco.min;
+       maxvco = limit->vco.max;
+       updrate = 0;
+       minupdate = 19200;
+       fracbits = 1;
+
+       n = p = p1 = p2 = m = m1 = m2 = vco = bestn = 0;
+       bestm1 = bestm2 = bestp1 = bestp2 = 0;
+
+       for(n = 1; n <= ((refclk) / minupdate); n++) {
+               updrate = refclk / n;
+               for (p1 = 3; p1 > 1; p1--) {
+                       for (p2 = 21; p2 > 0; p2--) {
+                               if (p2 > 10)
+                                       p2 = p2 - 1;
+                               p = p1 * p2;
+
+                               for( m1=2; m1 <= 3; m1++) {
+                                       m2 = (((2*(fastclk * p * n / m1 )) +
+                                              refclk) / (2*refclk));
+                                       m = m1 * m2;
+                                       vco = updrate * m;
+                                       if(vco >= minvco && vco < maxvco) {
+                                               ppm = 1000000 *((vco / p) -
+                                                               fastclk) /
+                                                       fastclk;
+                                               absppm = (ppm > 0)? ppm: (-ppm);
+                                               if (absppm < 100 &&
+                                                   ((p1 * p2) >
+                                                    (bestp1 * bestp2))) {
+                                                       bestppm = 0;
+                                                       bestn = n;
+                                                       bestm1 = m1;
+                                                       bestm2 = m2;
+                                                       bestp1 = p1;
+                                                       bestp2 = p2;
+                                               }
+                                               if (absppm < bestppm - 10) {
+                                                       bestppm = absppm;
+                                                       bestn = n;
+                                                       bestm1 = m1;
+                                                       bestm2 = m2;
+                                                       bestp1 = p1;
+                                                       bestp2 = p2;
+                                               }
+                                       }
+                               }
+                       } /* Next p2 */
+               } /* Next p1 */
+       }/* Next n */
+
+       best_clock->n = bestn;
+       best_clock->m1 = bestm1;
+       best_clock->m2 = bestm2;
+       best_clock->p1 = bestp1;
+       best_clock->p2 = bestp2;
+
+       return true;
+}
+
 /**
  * intel_wait_for_vblank - wait for vblank on a given pipe
  * @dev: drm device
@@ -1206,7 +1337,7 @@ static void intel_enable_pll(struct drm_i915_private 
*dev_priv, enum pipe pipe)
        u32 val;
 
        /* No really, not for ILK+ */
-       BUG_ON(dev_priv->info->gen >= 5);
+       BUG_ON(!IS_VALLEYVIEW(dev_priv->dev) && dev_priv->info->gen >= 5);
 
        /* PLL is protected by panel, make sure we can write it */
        if (IS_MOBILE(dev_priv->dev) && !IS_I830(dev_priv->dev))
@@ -2951,6 +3082,7 @@ static void intel_clear_scanline_wait(struct drm_device 
*dev)
                return;
 
        ring = LP_RING(dev_priv);
+
        tmp = I915_READ_CTL(ring);
        if (tmp & RING_WAIT)
                I915_WRITE_CTL(ring, tmp);
@@ -5154,14 +5286,38 @@ static bool intel_choose_pipe_bpp_dither(struct 
drm_crtc *crtc,
        return display_bpc != bpc;
 }
 
+static int vlv_get_refclk(struct drm_crtc *crtc)
+{
+       struct drm_device *dev = crtc->dev;
+       struct drm_i915_private *dev_priv = dev->dev_private;
+       int refclk = 27000; /* for DP & HDMI */
+
+       return 100000; /* only one validated so far */
+
+       if (intel_pipe_has_type(crtc, INTEL_OUTPUT_ANALOG)) {
+               refclk = 96000;
+       } else if (intel_pipe_has_type(crtc, INTEL_OUTPUT_LVDS)) {
+               if (intel_panel_use_ssc(dev_priv))
+                       refclk = 100000;
+               else
+                       refclk = 96000;
+       } else if (intel_pipe_has_type(crtc, INTEL_OUTPUT_EDP)) {
+               refclk = 100000;
+       }
+
+       return refclk;
+}
+
 static int i9xx_get_refclk(struct drm_crtc *crtc, int num_connectors)
 {
        struct drm_device *dev = crtc->dev;
        struct drm_i915_private *dev_priv = dev->dev_private;
        int refclk;
 
-       if (intel_pipe_has_type(crtc, INTEL_OUTPUT_LVDS) &&
-           intel_panel_use_ssc(dev_priv) && num_connectors < 2) {
+       if (IS_VALLEYVIEW(dev)) {
+               refclk = vlv_get_refclk(crtc);
+       } else if (intel_pipe_has_type(crtc, INTEL_OUTPUT_LVDS) &&
+                  intel_panel_use_ssc(dev_priv) && num_connectors < 2) {
                refclk = dev_priv->lvds_ssc_freq * 1000;
                DRM_DEBUG_KMS("using SSC reference clock of %d MHz\n",
                              refclk / 1000);
@@ -5286,6 +5442,72 @@ static void intel_update_lvds(struct drm_crtc *crtc, 
intel_clock_t *clock,
        I915_WRITE(LVDS, temp);
 }
 
+static void vlv_update_pll(struct drm_crtc *crtc,
+                          struct drm_display_mode *mode,
+                          struct drm_display_mode *adjusted_mode,
+                          intel_clock_t *clock, intel_clock_t *reduced_clock,
+                          int refclk, int num_connectors)
+{
+       struct drm_device *dev = crtc->dev;
+       struct drm_i915_private *dev_priv = dev->dev_private;
+       struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
+       int pipe = intel_crtc->pipe;
+       u32 dpll, mdiv, pdiv;
+       u32 bestn, bestm1, bestm2, bestp1, bestp2;
+       bool is_hdmi;
+
+       is_hdmi = intel_pipe_has_type(crtc, INTEL_OUTPUT_HDMI);
+
+       bestn = clock->n;
+       bestm1 = clock->m1;
+       bestm2 = clock->m2;
+       bestp1 = clock->p1;
+       bestp2 = clock->p2;
+
+       /* Enable DPIO clock input */
+       dpll = DPLL_EXT_BUFFER_ENABLE_VLV | DPLL_REFA_CLK_ENABLE_VLV |
+               DPLL_VGA_MODE_DIS | DPLL_INTEGRATED_CLOCK_VLV;
+       I915_WRITE(DPLL(pipe), dpll);
+       POSTING_READ(DPLL(pipe));
+
+       mdiv = ((bestm1 << DPIO_M1DIV_SHIFT) | (bestm2 & DPIO_M2DIV_MASK));
+       mdiv |= ((bestp1 << DPIO_P1_SHIFT) | (bestp2 << DPIO_P2_SHIFT));
+       mdiv |= ((bestn << DPIO_N_SHIFT));
+       mdiv |= (1 << DPIO_POST_DIV_SHIFT);
+       mdiv |= (1 << DPIO_K_SHIFT);
+       mdiv |= DPIO_ENABLE_CALIBRATION;
+       intel_dpio_write(dev_priv, DPIO_DIV(pipe), mdiv);
+
+       intel_dpio_write(dev_priv, DPIO_CORE_CLK(pipe), 0x01000000);
+
+       pdiv = DPIO_REFSEL_OVERRIDE | (5 << DPIO_PLL_MODESEL_SHIFT) |
+               (3 << DPIO_BIAS_CURRENT_CTL_SHIFT) | (1<<20) |
+               (8 << DPIO_DRIVER_CTL_SHIFT) | (5 << DPIO_CLK_BIAS_CTL_SHIFT);
+       intel_dpio_write(dev_priv, DPIO_REFSFR(pipe), pdiv);
+
+       intel_dpio_write(dev_priv, DPIO_LFP_COEFF(pipe), 0x009f0051);
+
+       dpll |= DPLL_VCO_ENABLE;
+       I915_WRITE(DPLL(pipe), dpll);
+       POSTING_READ(DPLL(pipe));
+       if (wait_for(((I915_READ(DPLL(pipe)) & DPLL_LOCK_VLV) == 
DPLL_LOCK_VLV), 1))
+               DRM_ERROR("DPLL %d failed to lock\n", pipe);
+
+       if (is_hdmi) {
+               u32 temp = intel_mode_get_pixel_multiplier(adjusted_mode);
+
+               if (temp > 1)
+                       temp = (temp - 1) << DPLL_MD_UDI_MULTIPLIER_SHIFT;
+               else
+                       temp = 0;
+
+               I915_WRITE(DPLL_MD(pipe), temp);
+               POSTING_READ(DPLL_MD(pipe));
+       }
+
+       intel_dpio_write(dev_priv, DPIO_FASTCLK_DISABLE, 0x641); /* ??? */
+}
+
 static void i9xx_update_pll(struct drm_crtc *crtc,
                            struct drm_display_mode *mode,
                            struct drm_display_mode *adjusted_mode,
@@ -5540,6 +5762,9 @@ static int i9xx_crtc_mode_set(struct drm_crtc *crtc,
 
        if (IS_GEN2(dev))
                i8xx_update_pll(crtc, adjusted_mode, &clock, num_connectors);
+       else if (IS_VALLEYVIEW(dev))
+               vlv_update_pll(crtc, mode, adjusted_mode, &clock, NULL,
+                              refclk, num_connectors);
        else
                i9xx_update_pll(crtc, mode, adjusted_mode, &clock,
                                has_reduced_clock ? &reduced_clock : NULL,
-- 
1.7.5.4

_______________________________________________
Intel-gfx mailing list
Intel-gfx@lists.freedesktop.org
http://lists.freedesktop.org/mailman/listinfo/intel-gfx

Reply via email to