2 * Copyright © 2013 Intel Corporation
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:
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
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
20 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
26 #include "intel_drv.h"
29 static int vlv_sideband_rw(struct drm_i915_private *dev_priv, u32 devfn,
30 u32 port, u32 opcode, u32 addr, u32 *val)
32 u32 cmd, be = 0xf, bar = 0;
33 bool is_read = (opcode == PUNIT_OPCODE_REG_READ ||
34 opcode == DPIO_OPCODE_REG_READ);
36 cmd = (devfn << IOSF_DEVFN_SHIFT) | (opcode << IOSF_OPCODE_SHIFT) |
37 (port << IOSF_PORT_SHIFT) | (be << IOSF_BYTE_ENABLES_SHIFT) |
38 (bar << IOSF_BAR_SHIFT);
40 WARN_ON(!mutex_is_locked(&dev_priv->dpio_lock));
42 if (wait_for((I915_READ(VLV_IOSF_DOORBELL_REQ) & IOSF_SB_BUSY) == 0, 5)) {
43 DRM_DEBUG_DRIVER("IOSF sideband idle wait (%s) timed out\n",
44 is_read ? "read" : "write");
48 I915_WRITE(VLV_IOSF_ADDR, addr);
50 I915_WRITE(VLV_IOSF_DATA, *val);
51 I915_WRITE(VLV_IOSF_DOORBELL_REQ, cmd);
53 if (wait_for((I915_READ(VLV_IOSF_DOORBELL_REQ) & IOSF_SB_BUSY) == 0, 5)) {
54 DRM_DEBUG_DRIVER("IOSF sideband finish wait (%s) timed out\n",
55 is_read ? "read" : "write");
60 *val = I915_READ(VLV_IOSF_DATA);
61 I915_WRITE(VLV_IOSF_DATA, 0);
66 u32 vlv_punit_read(struct drm_i915_private *dev_priv, u8 addr)
70 WARN_ON(!mutex_is_locked(&dev_priv->rps.hw_lock));
72 mutex_lock(&dev_priv->dpio_lock);
73 vlv_sideband_rw(dev_priv, PCI_DEVFN(2, 0), IOSF_PORT_PUNIT,
74 PUNIT_OPCODE_REG_READ, addr, &val);
75 mutex_unlock(&dev_priv->dpio_lock);
80 void vlv_punit_write(struct drm_i915_private *dev_priv, u8 addr, u32 val)
82 WARN_ON(!mutex_is_locked(&dev_priv->rps.hw_lock));
84 mutex_lock(&dev_priv->dpio_lock);
85 vlv_sideband_rw(dev_priv, PCI_DEVFN(2, 0), IOSF_PORT_PUNIT,
86 PUNIT_OPCODE_REG_WRITE, addr, &val);
87 mutex_unlock(&dev_priv->dpio_lock);
90 u32 vlv_nc_read(struct drm_i915_private *dev_priv, u8 addr)
94 WARN_ON(!mutex_is_locked(&dev_priv->rps.hw_lock));
96 mutex_lock(&dev_priv->dpio_lock);
97 vlv_sideband_rw(dev_priv, PCI_DEVFN(2, 0), IOSF_PORT_NC,
98 PUNIT_OPCODE_REG_READ, addr, &val);
99 mutex_unlock(&dev_priv->dpio_lock);
104 u32 vlv_gpio_nc_read(struct drm_i915_private *dev_priv, u32 reg)
107 vlv_sideband_rw(dev_priv, PCI_DEVFN(2, 0), IOSF_PORT_GPIO_NC,
108 PUNIT_OPCODE_REG_READ, reg, &val);
112 void vlv_gpio_nc_write(struct drm_i915_private *dev_priv, u32 reg, u32 val)
114 vlv_sideband_rw(dev_priv, PCI_DEVFN(2, 0), IOSF_PORT_GPIO_NC,
115 PUNIT_OPCODE_REG_WRITE, reg, &val);
118 u32 vlv_cck_read(struct drm_i915_private *dev_priv, u32 reg)
121 vlv_sideband_rw(dev_priv, PCI_DEVFN(2, 0), IOSF_PORT_CCK,
122 PUNIT_OPCODE_REG_READ, reg, &val);
126 void vlv_cck_write(struct drm_i915_private *dev_priv, u32 reg, u32 val)
128 vlv_sideband_rw(dev_priv, PCI_DEVFN(2, 0), IOSF_PORT_CCK,
129 PUNIT_OPCODE_REG_WRITE, reg, &val);
132 u32 vlv_ccu_read(struct drm_i915_private *dev_priv, u32 reg)
135 vlv_sideband_rw(dev_priv, PCI_DEVFN(2, 0), IOSF_PORT_CCU,
136 PUNIT_OPCODE_REG_READ, reg, &val);
140 void vlv_ccu_write(struct drm_i915_private *dev_priv, u32 reg, u32 val)
142 vlv_sideband_rw(dev_priv, PCI_DEVFN(2, 0), IOSF_PORT_CCU,
143 PUNIT_OPCODE_REG_WRITE, reg, &val);
146 u32 vlv_gps_core_read(struct drm_i915_private *dev_priv, u32 reg)
149 vlv_sideband_rw(dev_priv, PCI_DEVFN(2, 0), IOSF_PORT_GPS_CORE,
150 PUNIT_OPCODE_REG_READ, reg, &val);
154 void vlv_gps_core_write(struct drm_i915_private *dev_priv, u32 reg, u32 val)
156 vlv_sideband_rw(dev_priv, PCI_DEVFN(2, 0), IOSF_PORT_GPS_CORE,
157 PUNIT_OPCODE_REG_WRITE, reg, &val);
160 static u32 vlv_get_phy_port(enum pipe pipe)
162 u32 port = IOSF_PORT_DPIO;
164 WARN_ON ((pipe != PIPE_A) && (pipe != PIPE_B));
169 u32 vlv_dpio_read(struct drm_i915_private *dev_priv, enum pipe pipe, int reg)
173 vlv_sideband_rw(dev_priv, DPIO_DEVFN, vlv_get_phy_port(pipe),
174 DPIO_OPCODE_REG_READ, reg, &val);
178 void vlv_dpio_write(struct drm_i915_private *dev_priv, enum pipe pipe, int reg, u32 val)
180 vlv_sideband_rw(dev_priv, DPIO_DEVFN, vlv_get_phy_port(pipe),
181 DPIO_OPCODE_REG_WRITE, reg, &val);
185 u32 intel_sbi_read(struct drm_i915_private *dev_priv, u16 reg,
186 enum intel_sbi_destination destination)
189 WARN_ON(!mutex_is_locked(&dev_priv->dpio_lock));
191 if (wait_for((I915_READ(SBI_CTL_STAT) & SBI_BUSY) == 0,
193 DRM_ERROR("timeout waiting for SBI to become ready\n");
197 I915_WRITE(SBI_ADDR, (reg << 16));
199 if (destination == SBI_ICLK)
200 value = SBI_CTL_DEST_ICLK | SBI_CTL_OP_CRRD;
202 value = SBI_CTL_DEST_MPHY | SBI_CTL_OP_IORD;
203 I915_WRITE(SBI_CTL_STAT, value | SBI_BUSY);
205 if (wait_for((I915_READ(SBI_CTL_STAT) & (SBI_BUSY | SBI_RESPONSE_FAIL)) == 0,
207 DRM_ERROR("timeout waiting for SBI to complete read transaction\n");
211 return I915_READ(SBI_DATA);
214 void intel_sbi_write(struct drm_i915_private *dev_priv, u16 reg, u32 value,
215 enum intel_sbi_destination destination)
219 WARN_ON(!mutex_is_locked(&dev_priv->dpio_lock));
221 if (wait_for((I915_READ(SBI_CTL_STAT) & SBI_BUSY) == 0,
223 DRM_ERROR("timeout waiting for SBI to become ready\n");
227 I915_WRITE(SBI_ADDR, (reg << 16));
228 I915_WRITE(SBI_DATA, value);
230 if (destination == SBI_ICLK)
231 tmp = SBI_CTL_DEST_ICLK | SBI_CTL_OP_CRWR;
233 tmp = SBI_CTL_DEST_MPHY | SBI_CTL_OP_IOWR;
234 I915_WRITE(SBI_CTL_STAT, SBI_BUSY | tmp);
236 if (wait_for((I915_READ(SBI_CTL_STAT) & (SBI_BUSY | SBI_RESPONSE_FAIL)) == 0,
238 DRM_ERROR("timeout waiting for SBI to complete write transaction\n");