On Thu, Mar 22, 2012 at 02:38:50PM -0700, Jesse Barnes wrote:
> ValleyView and similar hardware (like CedarView) put some display
> related registers like the PLL controls and dividers on a DPIO bus.  Add
> simple indirect register access routines to get to those registers.
> 
> v2: move new wait_for macro to intel_drv.h (Ben)
>     fix DPIO_PKT double write (Ben)
>     add debugfs file
> 
> Signed-off-by: Jesse Barnes <jbar...@virtuousgeek.org>
> ---
>  drivers/gpu/drm/i915/i915_debugfs.c  |   48 ++++++++++++++++++++++++++
>  drivers/gpu/drm/i915/i915_drv.h      |    4 ++
>  drivers/gpu/drm/i915/i915_reg.h      |   55 ++++++++++++++++++++++++++++++
>  drivers/gpu/drm/i915/intel_display.c |   61 
> ++++++++++++++++++++++++++++++++++
>  drivers/gpu/drm/i915/intel_drv.h     |   14 ++++++++
>  5 files changed, 182 insertions(+), 0 deletions(-)
> 
> diff --git a/drivers/gpu/drm/i915/i915_debugfs.c 
> b/drivers/gpu/drm/i915/i915_debugfs.c
> index fdb7cce..5693de1 100644
> --- a/drivers/gpu/drm/i915/i915_debugfs.c
> +++ b/drivers/gpu/drm/i915/i915_debugfs.c
> @@ -1502,6 +1502,53 @@ static int i915_ppgtt_info(struct seq_file *m, void 
> *data)
>       return 0;
>  }
>  
> +static int i915_dpio_info(struct seq_file *m, void *data)
> +{
> +     struct drm_info_node *node = (struct drm_info_node *) m->private;
> +     struct drm_device *dev = node->minor->dev;
> +     struct drm_i915_private *dev_priv = dev->dev_private;
> +     int ret;
> +
> +
> +     ret = mutex_lock_interruptible(&dev->mode_config.mutex);
> +     if (ret)
> +             return ret;
> +
> +     if (!IS_VALLEYVIEW(dev)) {
> +             seq_printf(m, "unsupported\n");
> +             return 0;
> +     }

Chris already caught this bug. and I see it fixed in your repo.

> +
> +     seq_printf(m, "DPIO_CTL: 0x%08x\n", I915_READ(DPIO_CTL));
> +
> +     seq_printf(m, "DPIO_DIV_A: 0x%08x\n",
> +                intel_dpio_read(dev_priv, _DPIO_DIV_A));
> +     seq_printf(m, "DPIO_DIV_B: 0x%08x\n",
> +                intel_dpio_read(dev_priv, _DPIO_DIV_B));
> +
> +     seq_printf(m, "DPIO_REFSFR_A: 0x%08x\n",
> +                intel_dpio_read(dev_priv, _DPIO_REFSFR_A));
> +     seq_printf(m, "DPIO_REFSFR_B: 0x%08x\n",
> +                intel_dpio_read(dev_priv, _DPIO_REFSFR_B));
> +
> +     seq_printf(m, "DPIO_CORE_CLK_A: 0x%08x\n",
> +                intel_dpio_read(dev_priv, _DPIO_CORE_CLK_A));
> +     seq_printf(m, "DPIO_CORE_CLK_B: 0x%08x\n",
> +                intel_dpio_read(dev_priv, _DPIO_CORE_CLK_B));
> +
> +     seq_printf(m, "DPIO_LFP_COEFF_A: 0x%08x\n",
> +                intel_dpio_read(dev_priv, _DPIO_LFP_COEFF_A));
> +     seq_printf(m, "DPIO_LFP_COEFF_B: 0x%08x\n",
> +                intel_dpio_read(dev_priv, _DPIO_LFP_COEFF_B));
> +
> +     seq_printf(m, "DPIO_FASTCLK_DISABLE: 0x%08x\n",
> +                intel_dpio_read(dev_priv, DPIO_FASTCLK_DISABLE));
> +
> +     mutex_unlock(&dev->mode_config.mutex);
> +
> +     return 0;
> +}
> +
>  static int
>  i915_debugfs_common_open(struct inode *inode,
>                        struct file *filp)
> @@ -1844,6 +1891,7 @@ static struct drm_info_list i915_debugfs_list[] = {
>       {"i915_gen6_forcewake_count", i915_gen6_forcewake_count_info, 0},
>       {"i915_swizzle_info", i915_swizzle_info, 0},
>       {"i915_ppgtt_info", i915_ppgtt_info, 0},
> +     {"i915_dpio", i915_dpio_info, 0},
>  };
>  #define I915_DEBUGFS_ENTRIES ARRAY_SIZE(i915_debugfs_list)
>  
> diff --git a/drivers/gpu/drm/i915/i915_drv.h b/drivers/gpu/drm/i915/i915_drv.h
> index cacc8d3..2b8b32d 100644
> --- a/drivers/gpu/drm/i915/i915_drv.h
> +++ b/drivers/gpu/drm/i915/i915_drv.h
> @@ -355,6 +355,10 @@ typedef struct drm_i915_private {
>  
>       /* protects the irq masks */
>       spinlock_t irq_lock;
> +
> +     /* DPIO indirect register protection */
> +     spinlock_t dpio_lock;
> +
>       /** Cached value of IMR to avoid reads in updating the bitfield */
>       u32 pipestat[2];
>       u32 irq_mask;
> diff --git a/drivers/gpu/drm/i915/i915_reg.h b/drivers/gpu/drm/i915/i915_reg.h
> index 86de215..749e390 100644
> --- a/drivers/gpu/drm/i915/i915_reg.h
> +++ b/drivers/gpu/drm/i915/i915_reg.h
> @@ -301,6 +301,61 @@
>  #define  DEBUG_RESET_RENDER          (1<<8)
>  #define  DEBUG_RESET_DISPLAY         (1<<9)
>  
> +/*
> + * DPIO - a special bus for various display related registers to hide behind:
> + *  0x800c: m1, m2, n, p1, p2, k dividers
> + *  0x8014: REF and SFR select
> + *  0x8014: N divider, VCO select
> + *  0x801c/3c: core clock bits
> + *  0x8048/68: low pass filter coefficients
> + *  0x8100: fast clock controls
> + */
> +#define DPIO_PKT                     0x2100
> +#define  DPIO_RID                    (0<<24)
> +#define  DPIO_OP_WRITE                       (1<<16)
> +#define  DPIO_OP_READ                        (0<<16)
> +#define  DPIO_PORTID                 (0x12<<8)
> +#define  DPIO_BYTE                   (0xf<<4)
> +#define  DPIO_BUSY                   (1<<0) /* status only */
> +#define DPIO_DATA                    0x2104
> +#define DPIO_REG                     0x2108
> +#define DPIO_CTL                     0x2110
> +#define  DPIO_MODSEL1                        (1<<3) /* if ref clk b == 27 */
> +#define  DPIO_MODSEL0                        (1<<2) /* if ref clk a == 27 */
> +#define  DPIO_SFR_BYPASS             (1<<1)
> +#define  DPIO_RESET                  (1<<0)
> +
> +#define _DPIO_DIV_A                  0x800c
> +#define   DPIO_POST_DIV_SHIFT                (28) /* 3 bits */
> +#define   DPIO_K_SHIFT                       (24) /* 4 bits */
> +#define   DPIO_P1_SHIFT                      (21) /* 3 bits */
> +#define   DPIO_P2_SHIFT                      (16) /* 5 bits */
> +#define   DPIO_N_SHIFT                       (12) /* 4 bits */
> +#define   DPIO_ENABLE_CALIBRATION    (1<<11)
> +#define   DPIO_M1DIV_SHIFT           (8) /* 3 bits */
> +#define   DPIO_M2DIV_MASK            0xff
> +#define _DPIO_DIV_B                  0x802c
> +#define DPIO_DIV(pipe) _PIPE(pipe, _DPIO_DIV_A, _DPIO_DIV_B)
> +
> +#define _DPIO_REFSFR_A                       0x8014
> +#define   DPIO_REFSEL_OVERRIDE               27
> +#define   DPIO_PLL_MODESEL_SHIFT     24 /* 3 bits */
> +#define   DPIO_BIAS_CURRENT_CTL_SHIFT        21 /* 3 bits, always 0x7 */
> +#define   DPIO_PLL_REFCLK_SEL_SHIFT  16 /* 2 bits */
> +#define   DPIO_DRIVER_CTL_SHIFT              12 /* always set to 0x8 */
> +#define   DPIO_CLK_BIAS_CTL_SHIFT    8 /* always set to 0x5 */
> +#define _DPIO_REFSFR_B                       0x8034
> +#define DPIO_REFSFR(pipe) _PIPE(pipe, _DPIO_REFSFR_A, _DPIO_REFSFR_B)
> +
> +#define _DPIO_CORE_CLK_A             0x801c
> +#define _DPIO_CORE_CLK_B             0x803c
> +#define DPIO_CORE_CLK(pipe) _PIPE(pipe, _DPIO_CORE_CLK_A, _DPIO_CORE_CLK_B)
> +
> +#define _DPIO_LFP_COEFF_A            0x8048
> +#define _DPIO_LFP_COEFF_B            0x8068
> +#define DPIO_LFP_COEFF(pipe) _PIPE(pipe, _DPIO_LFP_COEFF_A, 
> _DPIO_LFP_COEFF_B)
> +
> +#define DPIO_FASTCLK_DISABLE         0x8100
>  
>  /*
>   * Fence registers
> diff --git a/drivers/gpu/drm/i915/intel_display.c 
> b/drivers/gpu/drm/i915/intel_display.c
> index 22619c6..f27728c 100644
> --- a/drivers/gpu/drm/i915/intel_display.c
> +++ b/drivers/gpu/drm/i915/intel_display.c
> @@ -360,6 +360,64 @@ static const intel_limit_t 
> intel_limits_ironlake_display_port = {
>       .find_pll = intel_find_pll_ironlake_dp,
>  };
>  
> +u32 intel_dpio_read(struct drm_i915_private *dev_priv, int reg)
> +{
> +     unsigned long flags;
> +     u32 val = 0;
> +
> +     spin_lock_irqsave(&dev_priv->dpio_lock, flags);
> +     if (wait_for_atomic_us((I915_READ(DPIO_PKT) & DPIO_BUSY) == 0, 100)) {
> +             DRM_ERROR("DPIO idle wait timed out\n");
> +             goto out_unlock;
> +     }
> +
> +     I915_WRITE(DPIO_REG, reg);
> +     I915_WRITE(DPIO_PKT, DPIO_RID | DPIO_OP_READ | DPIO_PORTID |
> +                DPIO_BYTE);
> +     if (wait_for_atomic_us((I915_READ(DPIO_PKT) & DPIO_BUSY) == 0, 100)) {
> +             DRM_ERROR("DPIO read wait timed out\n");
> +             goto out_unlock;
> +     }
> +     val = I915_READ(DPIO_DATA);
> +
> +out_unlock:
> +     spin_unlock_irqrestore(&dev_priv->dpio_lock, flags);
> +     return val;
> +}
> +
> +static void intel_dpio_write(struct drm_i915_private *dev_priv, int reg,
> +                          u32 val)
> +{
> +     unsigned long flags;
> +
> +     spin_lock_irqsave(&dev_priv->dpio_lock, flags);
> +     if (wait_for_atomic_us((I915_READ(DPIO_PKT) & DPIO_BUSY) == 0, 100)) {
> +             DRM_ERROR("DPIO idle wait timed out\n");
> +             goto out_unlock;
> +     }
> +
> +     I915_WRITE(DPIO_DATA, val);
> +     I915_WRITE(DPIO_REG, reg);
> +     I915_WRITE(DPIO_PKT, DPIO_RID | DPIO_OP_WRITE | DPIO_PORTID |
> +                DPIO_BYTE);
> +     if (wait_for_atomic_us((I915_READ(DPIO_PKT) & DPIO_BUSY) == 0, 100))
> +             DRM_ERROR("DPIO write wait timed out\n");
> +
> +out_unlock:
> +     spin_unlock_irqrestore(&dev_priv->dpio_lock, flags);
> +}
> +
> +static void vlv_init_dpio(struct drm_device *dev)
> +{
> +     struct drm_i915_private *dev_priv = dev->dev_private;
> +
> +     /* Reset the DPIO config */
> +     I915_WRITE(DPIO_CTL, 0);
> +     POSTING_READ(DPIO_CTL);
> +     I915_WRITE(DPIO_CTL, 1);
> +     POSTING_READ(DPIO_CTL);
> +}
> +
>  static const intel_limit_t *intel_ironlake_limit(struct drm_crtc *crtc,
>                                               int refclk)
>  {
> @@ -9306,6 +9364,9 @@ void intel_modeset_cleanup(struct drm_device *dev)

What do you think about checking the busy bit at init time, and if it's
not clear we assume things are screwed and don't use dpio?

>       if (IS_IRONLAKE_M(dev))
>               ironlake_disable_rc6(dev);
>  
> +     if (IS_VALLEYVIEW(dev))
> +             vlv_init_dpio(dev);
> +
>       mutex_unlock(&dev->struct_mutex);
>  
>       /* Disable the irq before mode object teardown, for the irq might
> diff --git a/drivers/gpu/drm/i915/intel_drv.h 
> b/drivers/gpu/drm/i915/intel_drv.h
> index 9cec6c3..07bcad0 100644
> --- a/drivers/gpu/drm/i915/intel_drv.h
> +++ b/drivers/gpu/drm/i915/intel_drv.h
> @@ -45,6 +45,18 @@
>       ret__;                                                          \
>  })
>  
> +#define wait_for_atomic_us(COND, US) ({ \
> +     int i, ret__ = -ETIMEDOUT;      \
> +     for (i = 0; i < (US); i++) {    \
> +             if ((COND)) {           \
> +                     ret__ = 0;      \
> +                     break;          \
> +             }                       \
> +             udelay(1);              \
> +     }                               \
> +     ret__;                          \
> +})
> +
>  #define wait_for(COND, MS) _wait_for(COND, MS, 1)
>  #define wait_for_atomic(COND, MS) _wait_for(COND, MS, 0)
>  
> @@ -419,4 +431,6 @@ extern int intel_sprite_set_colorkey(struct drm_device 
> *dev, void *data,
>  extern int intel_sprite_get_colorkey(struct drm_device *dev, void *data,
>                                    struct drm_file *file_priv);
>  
> +extern u32 intel_dpio_read(struct drm_i915_private *dev_priv, int reg);
> +
>  #endif /* __INTEL_DRV_H__ */

Reviewed-by: Ben Widawsky <b...@bwidawsk.net>
_______________________________________________
Intel-gfx mailing list
Intel-gfx@lists.freedesktop.org
http://lists.freedesktop.org/mailman/listinfo/intel-gfx

Reply via email to