xref: /OK3568_Linux_fs/kernel/drivers/gpu/drm/i915/intel_sideband.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * Copyright © 2013 Intel Corporation
3*4882a593Smuzhiyun  *
4*4882a593Smuzhiyun  * Permission is hereby granted, free of charge, to any person obtaining a
5*4882a593Smuzhiyun  * copy of this software and associated documentation files (the "Software"),
6*4882a593Smuzhiyun  * to deal in the Software without restriction, including without limitation
7*4882a593Smuzhiyun  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8*4882a593Smuzhiyun  * and/or sell copies of the Software, and to permit persons to whom the
9*4882a593Smuzhiyun  * Software is furnished to do so, subject to the following conditions:
10*4882a593Smuzhiyun  *
11*4882a593Smuzhiyun  * The above copyright notice and this permission notice (including the next
12*4882a593Smuzhiyun  * paragraph) shall be included in all copies or substantial portions of the
13*4882a593Smuzhiyun  * Software.
14*4882a593Smuzhiyun  *
15*4882a593Smuzhiyun  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16*4882a593Smuzhiyun  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17*4882a593Smuzhiyun  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
18*4882a593Smuzhiyun  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
19*4882a593Smuzhiyun  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
20*4882a593Smuzhiyun  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
21*4882a593Smuzhiyun  * IN THE SOFTWARE.
22*4882a593Smuzhiyun  *
23*4882a593Smuzhiyun  */
24*4882a593Smuzhiyun 
25*4882a593Smuzhiyun #include <asm/iosf_mbi.h>
26*4882a593Smuzhiyun 
27*4882a593Smuzhiyun #include "i915_drv.h"
28*4882a593Smuzhiyun #include "intel_sideband.h"
29*4882a593Smuzhiyun 
30*4882a593Smuzhiyun /*
31*4882a593Smuzhiyun  * IOSF sideband, see VLV2_SidebandMsg_HAS.docx and
32*4882a593Smuzhiyun  * VLV_VLV2_PUNIT_HAS_0.8.docx
33*4882a593Smuzhiyun  */
34*4882a593Smuzhiyun 
35*4882a593Smuzhiyun /* Standard MMIO read, non-posted */
36*4882a593Smuzhiyun #define SB_MRD_NP	0x00
37*4882a593Smuzhiyun /* Standard MMIO write, non-posted */
38*4882a593Smuzhiyun #define SB_MWR_NP	0x01
39*4882a593Smuzhiyun /* Private register read, double-word addressing, non-posted */
40*4882a593Smuzhiyun #define SB_CRRDDA_NP	0x06
41*4882a593Smuzhiyun /* Private register write, double-word addressing, non-posted */
42*4882a593Smuzhiyun #define SB_CRWRDA_NP	0x07
43*4882a593Smuzhiyun 
ping(void * info)44*4882a593Smuzhiyun static void ping(void *info)
45*4882a593Smuzhiyun {
46*4882a593Smuzhiyun }
47*4882a593Smuzhiyun 
__vlv_punit_get(struct drm_i915_private * i915)48*4882a593Smuzhiyun static void __vlv_punit_get(struct drm_i915_private *i915)
49*4882a593Smuzhiyun {
50*4882a593Smuzhiyun 	iosf_mbi_punit_acquire();
51*4882a593Smuzhiyun 
52*4882a593Smuzhiyun 	/*
53*4882a593Smuzhiyun 	 * Prevent the cpu from sleeping while we use this sideband, otherwise
54*4882a593Smuzhiyun 	 * the punit may cause a machine hang. The issue appears to be isolated
55*4882a593Smuzhiyun 	 * with changing the power state of the CPU package while changing
56*4882a593Smuzhiyun 	 * the power state via the punit, and we have only observed it
57*4882a593Smuzhiyun 	 * reliably on 4-core Baytail systems suggesting the issue is in the
58*4882a593Smuzhiyun 	 * power delivery mechanism and likely to be be board/function
59*4882a593Smuzhiyun 	 * specific. Hence we presume the workaround needs only be applied
60*4882a593Smuzhiyun 	 * to the Valleyview P-unit and not all sideband communications.
61*4882a593Smuzhiyun 	 */
62*4882a593Smuzhiyun 	if (IS_VALLEYVIEW(i915)) {
63*4882a593Smuzhiyun 		cpu_latency_qos_update_request(&i915->sb_qos, 0);
64*4882a593Smuzhiyun 		on_each_cpu(ping, NULL, 1);
65*4882a593Smuzhiyun 	}
66*4882a593Smuzhiyun }
67*4882a593Smuzhiyun 
__vlv_punit_put(struct drm_i915_private * i915)68*4882a593Smuzhiyun static void __vlv_punit_put(struct drm_i915_private *i915)
69*4882a593Smuzhiyun {
70*4882a593Smuzhiyun 	if (IS_VALLEYVIEW(i915))
71*4882a593Smuzhiyun 		cpu_latency_qos_update_request(&i915->sb_qos,
72*4882a593Smuzhiyun 					       PM_QOS_DEFAULT_VALUE);
73*4882a593Smuzhiyun 
74*4882a593Smuzhiyun 	iosf_mbi_punit_release();
75*4882a593Smuzhiyun }
76*4882a593Smuzhiyun 
vlv_iosf_sb_get(struct drm_i915_private * i915,unsigned long ports)77*4882a593Smuzhiyun void vlv_iosf_sb_get(struct drm_i915_private *i915, unsigned long ports)
78*4882a593Smuzhiyun {
79*4882a593Smuzhiyun 	if (ports & BIT(VLV_IOSF_SB_PUNIT))
80*4882a593Smuzhiyun 		__vlv_punit_get(i915);
81*4882a593Smuzhiyun 
82*4882a593Smuzhiyun 	mutex_lock(&i915->sb_lock);
83*4882a593Smuzhiyun }
84*4882a593Smuzhiyun 
vlv_iosf_sb_put(struct drm_i915_private * i915,unsigned long ports)85*4882a593Smuzhiyun void vlv_iosf_sb_put(struct drm_i915_private *i915, unsigned long ports)
86*4882a593Smuzhiyun {
87*4882a593Smuzhiyun 	mutex_unlock(&i915->sb_lock);
88*4882a593Smuzhiyun 
89*4882a593Smuzhiyun 	if (ports & BIT(VLV_IOSF_SB_PUNIT))
90*4882a593Smuzhiyun 		__vlv_punit_put(i915);
91*4882a593Smuzhiyun }
92*4882a593Smuzhiyun 
vlv_sideband_rw(struct drm_i915_private * i915,u32 devfn,u32 port,u32 opcode,u32 addr,u32 * val)93*4882a593Smuzhiyun static int vlv_sideband_rw(struct drm_i915_private *i915,
94*4882a593Smuzhiyun 			   u32 devfn, u32 port, u32 opcode,
95*4882a593Smuzhiyun 			   u32 addr, u32 *val)
96*4882a593Smuzhiyun {
97*4882a593Smuzhiyun 	struct intel_uncore *uncore = &i915->uncore;
98*4882a593Smuzhiyun 	const bool is_read = (opcode == SB_MRD_NP || opcode == SB_CRRDDA_NP);
99*4882a593Smuzhiyun 	int err;
100*4882a593Smuzhiyun 
101*4882a593Smuzhiyun 	lockdep_assert_held(&i915->sb_lock);
102*4882a593Smuzhiyun 	if (port == IOSF_PORT_PUNIT)
103*4882a593Smuzhiyun 		iosf_mbi_assert_punit_acquired();
104*4882a593Smuzhiyun 
105*4882a593Smuzhiyun 	/* Flush the previous comms, just in case it failed last time. */
106*4882a593Smuzhiyun 	if (intel_wait_for_register(uncore,
107*4882a593Smuzhiyun 				    VLV_IOSF_DOORBELL_REQ, IOSF_SB_BUSY, 0,
108*4882a593Smuzhiyun 				    5)) {
109*4882a593Smuzhiyun 		drm_dbg(&i915->drm, "IOSF sideband idle wait (%s) timed out\n",
110*4882a593Smuzhiyun 			is_read ? "read" : "write");
111*4882a593Smuzhiyun 		return -EAGAIN;
112*4882a593Smuzhiyun 	}
113*4882a593Smuzhiyun 
114*4882a593Smuzhiyun 	preempt_disable();
115*4882a593Smuzhiyun 
116*4882a593Smuzhiyun 	intel_uncore_write_fw(uncore, VLV_IOSF_ADDR, addr);
117*4882a593Smuzhiyun 	intel_uncore_write_fw(uncore, VLV_IOSF_DATA, is_read ? 0 : *val);
118*4882a593Smuzhiyun 	intel_uncore_write_fw(uncore, VLV_IOSF_DOORBELL_REQ,
119*4882a593Smuzhiyun 			      (devfn << IOSF_DEVFN_SHIFT) |
120*4882a593Smuzhiyun 			      (opcode << IOSF_OPCODE_SHIFT) |
121*4882a593Smuzhiyun 			      (port << IOSF_PORT_SHIFT) |
122*4882a593Smuzhiyun 			      (0xf << IOSF_BYTE_ENABLES_SHIFT) |
123*4882a593Smuzhiyun 			      (0 << IOSF_BAR_SHIFT) |
124*4882a593Smuzhiyun 			      IOSF_SB_BUSY);
125*4882a593Smuzhiyun 
126*4882a593Smuzhiyun 	if (__intel_wait_for_register_fw(uncore,
127*4882a593Smuzhiyun 					 VLV_IOSF_DOORBELL_REQ, IOSF_SB_BUSY, 0,
128*4882a593Smuzhiyun 					 10000, 0, NULL) == 0) {
129*4882a593Smuzhiyun 		if (is_read)
130*4882a593Smuzhiyun 			*val = intel_uncore_read_fw(uncore, VLV_IOSF_DATA);
131*4882a593Smuzhiyun 		err = 0;
132*4882a593Smuzhiyun 	} else {
133*4882a593Smuzhiyun 		drm_dbg(&i915->drm, "IOSF sideband finish wait (%s) timed out\n",
134*4882a593Smuzhiyun 			is_read ? "read" : "write");
135*4882a593Smuzhiyun 		err = -ETIMEDOUT;
136*4882a593Smuzhiyun 	}
137*4882a593Smuzhiyun 
138*4882a593Smuzhiyun 	preempt_enable();
139*4882a593Smuzhiyun 
140*4882a593Smuzhiyun 	return err;
141*4882a593Smuzhiyun }
142*4882a593Smuzhiyun 
vlv_punit_read(struct drm_i915_private * i915,u32 addr)143*4882a593Smuzhiyun u32 vlv_punit_read(struct drm_i915_private *i915, u32 addr)
144*4882a593Smuzhiyun {
145*4882a593Smuzhiyun 	u32 val = 0;
146*4882a593Smuzhiyun 
147*4882a593Smuzhiyun 	vlv_sideband_rw(i915, PCI_DEVFN(0, 0), IOSF_PORT_PUNIT,
148*4882a593Smuzhiyun 			SB_CRRDDA_NP, addr, &val);
149*4882a593Smuzhiyun 
150*4882a593Smuzhiyun 	return val;
151*4882a593Smuzhiyun }
152*4882a593Smuzhiyun 
vlv_punit_write(struct drm_i915_private * i915,u32 addr,u32 val)153*4882a593Smuzhiyun int vlv_punit_write(struct drm_i915_private *i915, u32 addr, u32 val)
154*4882a593Smuzhiyun {
155*4882a593Smuzhiyun 	return vlv_sideband_rw(i915, PCI_DEVFN(0, 0), IOSF_PORT_PUNIT,
156*4882a593Smuzhiyun 			       SB_CRWRDA_NP, addr, &val);
157*4882a593Smuzhiyun }
158*4882a593Smuzhiyun 
vlv_bunit_read(struct drm_i915_private * i915,u32 reg)159*4882a593Smuzhiyun u32 vlv_bunit_read(struct drm_i915_private *i915, u32 reg)
160*4882a593Smuzhiyun {
161*4882a593Smuzhiyun 	u32 val = 0;
162*4882a593Smuzhiyun 
163*4882a593Smuzhiyun 	vlv_sideband_rw(i915, PCI_DEVFN(0, 0), IOSF_PORT_BUNIT,
164*4882a593Smuzhiyun 			SB_CRRDDA_NP, reg, &val);
165*4882a593Smuzhiyun 
166*4882a593Smuzhiyun 	return val;
167*4882a593Smuzhiyun }
168*4882a593Smuzhiyun 
vlv_bunit_write(struct drm_i915_private * i915,u32 reg,u32 val)169*4882a593Smuzhiyun void vlv_bunit_write(struct drm_i915_private *i915, u32 reg, u32 val)
170*4882a593Smuzhiyun {
171*4882a593Smuzhiyun 	vlv_sideband_rw(i915, PCI_DEVFN(0, 0), IOSF_PORT_BUNIT,
172*4882a593Smuzhiyun 			SB_CRWRDA_NP, reg, &val);
173*4882a593Smuzhiyun }
174*4882a593Smuzhiyun 
vlv_nc_read(struct drm_i915_private * i915,u8 addr)175*4882a593Smuzhiyun u32 vlv_nc_read(struct drm_i915_private *i915, u8 addr)
176*4882a593Smuzhiyun {
177*4882a593Smuzhiyun 	u32 val = 0;
178*4882a593Smuzhiyun 
179*4882a593Smuzhiyun 	vlv_sideband_rw(i915, PCI_DEVFN(0, 0), IOSF_PORT_NC,
180*4882a593Smuzhiyun 			SB_CRRDDA_NP, addr, &val);
181*4882a593Smuzhiyun 
182*4882a593Smuzhiyun 	return val;
183*4882a593Smuzhiyun }
184*4882a593Smuzhiyun 
vlv_iosf_sb_read(struct drm_i915_private * i915,u8 port,u32 reg)185*4882a593Smuzhiyun u32 vlv_iosf_sb_read(struct drm_i915_private *i915, u8 port, u32 reg)
186*4882a593Smuzhiyun {
187*4882a593Smuzhiyun 	u32 val = 0;
188*4882a593Smuzhiyun 
189*4882a593Smuzhiyun 	vlv_sideband_rw(i915, PCI_DEVFN(0, 0), port,
190*4882a593Smuzhiyun 			SB_CRRDDA_NP, reg, &val);
191*4882a593Smuzhiyun 
192*4882a593Smuzhiyun 	return val;
193*4882a593Smuzhiyun }
194*4882a593Smuzhiyun 
vlv_iosf_sb_write(struct drm_i915_private * i915,u8 port,u32 reg,u32 val)195*4882a593Smuzhiyun void vlv_iosf_sb_write(struct drm_i915_private *i915,
196*4882a593Smuzhiyun 		       u8 port, u32 reg, u32 val)
197*4882a593Smuzhiyun {
198*4882a593Smuzhiyun 	vlv_sideband_rw(i915, PCI_DEVFN(0, 0), port,
199*4882a593Smuzhiyun 			SB_CRWRDA_NP, reg, &val);
200*4882a593Smuzhiyun }
201*4882a593Smuzhiyun 
vlv_cck_read(struct drm_i915_private * i915,u32 reg)202*4882a593Smuzhiyun u32 vlv_cck_read(struct drm_i915_private *i915, u32 reg)
203*4882a593Smuzhiyun {
204*4882a593Smuzhiyun 	u32 val = 0;
205*4882a593Smuzhiyun 
206*4882a593Smuzhiyun 	vlv_sideband_rw(i915, PCI_DEVFN(0, 0), IOSF_PORT_CCK,
207*4882a593Smuzhiyun 			SB_CRRDDA_NP, reg, &val);
208*4882a593Smuzhiyun 
209*4882a593Smuzhiyun 	return val;
210*4882a593Smuzhiyun }
211*4882a593Smuzhiyun 
vlv_cck_write(struct drm_i915_private * i915,u32 reg,u32 val)212*4882a593Smuzhiyun void vlv_cck_write(struct drm_i915_private *i915, u32 reg, u32 val)
213*4882a593Smuzhiyun {
214*4882a593Smuzhiyun 	vlv_sideband_rw(i915, PCI_DEVFN(0, 0), IOSF_PORT_CCK,
215*4882a593Smuzhiyun 			SB_CRWRDA_NP, reg, &val);
216*4882a593Smuzhiyun }
217*4882a593Smuzhiyun 
vlv_ccu_read(struct drm_i915_private * i915,u32 reg)218*4882a593Smuzhiyun u32 vlv_ccu_read(struct drm_i915_private *i915, u32 reg)
219*4882a593Smuzhiyun {
220*4882a593Smuzhiyun 	u32 val = 0;
221*4882a593Smuzhiyun 
222*4882a593Smuzhiyun 	vlv_sideband_rw(i915, PCI_DEVFN(0, 0), IOSF_PORT_CCU,
223*4882a593Smuzhiyun 			SB_CRRDDA_NP, reg, &val);
224*4882a593Smuzhiyun 
225*4882a593Smuzhiyun 	return val;
226*4882a593Smuzhiyun }
227*4882a593Smuzhiyun 
vlv_ccu_write(struct drm_i915_private * i915,u32 reg,u32 val)228*4882a593Smuzhiyun void vlv_ccu_write(struct drm_i915_private *i915, u32 reg, u32 val)
229*4882a593Smuzhiyun {
230*4882a593Smuzhiyun 	vlv_sideband_rw(i915, PCI_DEVFN(0, 0), IOSF_PORT_CCU,
231*4882a593Smuzhiyun 			SB_CRWRDA_NP, reg, &val);
232*4882a593Smuzhiyun }
233*4882a593Smuzhiyun 
vlv_dpio_phy_iosf_port(struct drm_i915_private * i915,enum dpio_phy phy)234*4882a593Smuzhiyun static u32 vlv_dpio_phy_iosf_port(struct drm_i915_private *i915, enum dpio_phy phy)
235*4882a593Smuzhiyun {
236*4882a593Smuzhiyun 	/*
237*4882a593Smuzhiyun 	 * IOSF_PORT_DPIO: VLV x2 PHY (DP/HDMI B and C), CHV x1 PHY (DP/HDMI D)
238*4882a593Smuzhiyun 	 * IOSF_PORT_DPIO_2: CHV x2 PHY (DP/HDMI B and C)
239*4882a593Smuzhiyun 	 */
240*4882a593Smuzhiyun 	if (IS_CHERRYVIEW(i915))
241*4882a593Smuzhiyun 		return phy == DPIO_PHY0 ? IOSF_PORT_DPIO_2 : IOSF_PORT_DPIO;
242*4882a593Smuzhiyun 	else
243*4882a593Smuzhiyun 		return IOSF_PORT_DPIO;
244*4882a593Smuzhiyun }
245*4882a593Smuzhiyun 
vlv_dpio_read(struct drm_i915_private * i915,enum pipe pipe,int reg)246*4882a593Smuzhiyun u32 vlv_dpio_read(struct drm_i915_private *i915, enum pipe pipe, int reg)
247*4882a593Smuzhiyun {
248*4882a593Smuzhiyun 	u32 port = vlv_dpio_phy_iosf_port(i915, DPIO_PHY(pipe));
249*4882a593Smuzhiyun 	u32 val = 0;
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun 	vlv_sideband_rw(i915, DPIO_DEVFN, port, SB_MRD_NP, reg, &val);
252*4882a593Smuzhiyun 
253*4882a593Smuzhiyun 	/*
254*4882a593Smuzhiyun 	 * FIXME: There might be some registers where all 1's is a valid value,
255*4882a593Smuzhiyun 	 * so ideally we should check the register offset instead...
256*4882a593Smuzhiyun 	 */
257*4882a593Smuzhiyun 	drm_WARN(&i915->drm, val == 0xffffffff,
258*4882a593Smuzhiyun 		 "DPIO read pipe %c reg 0x%x == 0x%x\n",
259*4882a593Smuzhiyun 		 pipe_name(pipe), reg, val);
260*4882a593Smuzhiyun 
261*4882a593Smuzhiyun 	return val;
262*4882a593Smuzhiyun }
263*4882a593Smuzhiyun 
vlv_dpio_write(struct drm_i915_private * i915,enum pipe pipe,int reg,u32 val)264*4882a593Smuzhiyun void vlv_dpio_write(struct drm_i915_private *i915,
265*4882a593Smuzhiyun 		    enum pipe pipe, int reg, u32 val)
266*4882a593Smuzhiyun {
267*4882a593Smuzhiyun 	u32 port = vlv_dpio_phy_iosf_port(i915, DPIO_PHY(pipe));
268*4882a593Smuzhiyun 
269*4882a593Smuzhiyun 	vlv_sideband_rw(i915, DPIO_DEVFN, port, SB_MWR_NP, reg, &val);
270*4882a593Smuzhiyun }
271*4882a593Smuzhiyun 
vlv_flisdsi_read(struct drm_i915_private * i915,u32 reg)272*4882a593Smuzhiyun u32 vlv_flisdsi_read(struct drm_i915_private *i915, u32 reg)
273*4882a593Smuzhiyun {
274*4882a593Smuzhiyun 	u32 val = 0;
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun 	vlv_sideband_rw(i915, DPIO_DEVFN, IOSF_PORT_FLISDSI, SB_CRRDDA_NP,
277*4882a593Smuzhiyun 			reg, &val);
278*4882a593Smuzhiyun 	return val;
279*4882a593Smuzhiyun }
280*4882a593Smuzhiyun 
vlv_flisdsi_write(struct drm_i915_private * i915,u32 reg,u32 val)281*4882a593Smuzhiyun void vlv_flisdsi_write(struct drm_i915_private *i915, u32 reg, u32 val)
282*4882a593Smuzhiyun {
283*4882a593Smuzhiyun 	vlv_sideband_rw(i915, DPIO_DEVFN, IOSF_PORT_FLISDSI, SB_CRWRDA_NP,
284*4882a593Smuzhiyun 			reg, &val);
285*4882a593Smuzhiyun }
286*4882a593Smuzhiyun 
287*4882a593Smuzhiyun /* SBI access */
intel_sbi_rw(struct drm_i915_private * i915,u16 reg,enum intel_sbi_destination destination,u32 * val,bool is_read)288*4882a593Smuzhiyun static int intel_sbi_rw(struct drm_i915_private *i915, u16 reg,
289*4882a593Smuzhiyun 			enum intel_sbi_destination destination,
290*4882a593Smuzhiyun 			u32 *val, bool is_read)
291*4882a593Smuzhiyun {
292*4882a593Smuzhiyun 	struct intel_uncore *uncore = &i915->uncore;
293*4882a593Smuzhiyun 	u32 cmd;
294*4882a593Smuzhiyun 
295*4882a593Smuzhiyun 	lockdep_assert_held(&i915->sb_lock);
296*4882a593Smuzhiyun 
297*4882a593Smuzhiyun 	if (intel_wait_for_register_fw(uncore,
298*4882a593Smuzhiyun 				       SBI_CTL_STAT, SBI_BUSY, 0,
299*4882a593Smuzhiyun 				       100)) {
300*4882a593Smuzhiyun 		drm_err(&i915->drm,
301*4882a593Smuzhiyun 			"timeout waiting for SBI to become ready\n");
302*4882a593Smuzhiyun 		return -EBUSY;
303*4882a593Smuzhiyun 	}
304*4882a593Smuzhiyun 
305*4882a593Smuzhiyun 	intel_uncore_write_fw(uncore, SBI_ADDR, (u32)reg << 16);
306*4882a593Smuzhiyun 	intel_uncore_write_fw(uncore, SBI_DATA, is_read ? 0 : *val);
307*4882a593Smuzhiyun 
308*4882a593Smuzhiyun 	if (destination == SBI_ICLK)
309*4882a593Smuzhiyun 		cmd = SBI_CTL_DEST_ICLK | SBI_CTL_OP_CRRD;
310*4882a593Smuzhiyun 	else
311*4882a593Smuzhiyun 		cmd = SBI_CTL_DEST_MPHY | SBI_CTL_OP_IORD;
312*4882a593Smuzhiyun 	if (!is_read)
313*4882a593Smuzhiyun 		cmd |= BIT(8);
314*4882a593Smuzhiyun 	intel_uncore_write_fw(uncore, SBI_CTL_STAT, cmd | SBI_BUSY);
315*4882a593Smuzhiyun 
316*4882a593Smuzhiyun 	if (__intel_wait_for_register_fw(uncore,
317*4882a593Smuzhiyun 					 SBI_CTL_STAT, SBI_BUSY, 0,
318*4882a593Smuzhiyun 					 100, 100, &cmd)) {
319*4882a593Smuzhiyun 		drm_err(&i915->drm,
320*4882a593Smuzhiyun 			"timeout waiting for SBI to complete read\n");
321*4882a593Smuzhiyun 		return -ETIMEDOUT;
322*4882a593Smuzhiyun 	}
323*4882a593Smuzhiyun 
324*4882a593Smuzhiyun 	if (cmd & SBI_RESPONSE_FAIL) {
325*4882a593Smuzhiyun 		drm_err(&i915->drm, "error during SBI read of reg %x\n", reg);
326*4882a593Smuzhiyun 		return -ENXIO;
327*4882a593Smuzhiyun 	}
328*4882a593Smuzhiyun 
329*4882a593Smuzhiyun 	if (is_read)
330*4882a593Smuzhiyun 		*val = intel_uncore_read_fw(uncore, SBI_DATA);
331*4882a593Smuzhiyun 
332*4882a593Smuzhiyun 	return 0;
333*4882a593Smuzhiyun }
334*4882a593Smuzhiyun 
intel_sbi_read(struct drm_i915_private * i915,u16 reg,enum intel_sbi_destination destination)335*4882a593Smuzhiyun u32 intel_sbi_read(struct drm_i915_private *i915, u16 reg,
336*4882a593Smuzhiyun 		   enum intel_sbi_destination destination)
337*4882a593Smuzhiyun {
338*4882a593Smuzhiyun 	u32 result = 0;
339*4882a593Smuzhiyun 
340*4882a593Smuzhiyun 	intel_sbi_rw(i915, reg, destination, &result, true);
341*4882a593Smuzhiyun 
342*4882a593Smuzhiyun 	return result;
343*4882a593Smuzhiyun }
344*4882a593Smuzhiyun 
intel_sbi_write(struct drm_i915_private * i915,u16 reg,u32 value,enum intel_sbi_destination destination)345*4882a593Smuzhiyun void intel_sbi_write(struct drm_i915_private *i915, u16 reg, u32 value,
346*4882a593Smuzhiyun 		     enum intel_sbi_destination destination)
347*4882a593Smuzhiyun {
348*4882a593Smuzhiyun 	intel_sbi_rw(i915, reg, destination, &value, false);
349*4882a593Smuzhiyun }
350*4882a593Smuzhiyun 
gen6_check_mailbox_status(u32 mbox)351*4882a593Smuzhiyun static int gen6_check_mailbox_status(u32 mbox)
352*4882a593Smuzhiyun {
353*4882a593Smuzhiyun 	switch (mbox & GEN6_PCODE_ERROR_MASK) {
354*4882a593Smuzhiyun 	case GEN6_PCODE_SUCCESS:
355*4882a593Smuzhiyun 		return 0;
356*4882a593Smuzhiyun 	case GEN6_PCODE_UNIMPLEMENTED_CMD:
357*4882a593Smuzhiyun 		return -ENODEV;
358*4882a593Smuzhiyun 	case GEN6_PCODE_ILLEGAL_CMD:
359*4882a593Smuzhiyun 		return -ENXIO;
360*4882a593Smuzhiyun 	case GEN6_PCODE_MIN_FREQ_TABLE_GT_RATIO_OUT_OF_RANGE:
361*4882a593Smuzhiyun 	case GEN7_PCODE_MIN_FREQ_TABLE_GT_RATIO_OUT_OF_RANGE:
362*4882a593Smuzhiyun 		return -EOVERFLOW;
363*4882a593Smuzhiyun 	case GEN6_PCODE_TIMEOUT:
364*4882a593Smuzhiyun 		return -ETIMEDOUT;
365*4882a593Smuzhiyun 	default:
366*4882a593Smuzhiyun 		MISSING_CASE(mbox & GEN6_PCODE_ERROR_MASK);
367*4882a593Smuzhiyun 		return 0;
368*4882a593Smuzhiyun 	}
369*4882a593Smuzhiyun }
370*4882a593Smuzhiyun 
gen7_check_mailbox_status(u32 mbox)371*4882a593Smuzhiyun static int gen7_check_mailbox_status(u32 mbox)
372*4882a593Smuzhiyun {
373*4882a593Smuzhiyun 	switch (mbox & GEN6_PCODE_ERROR_MASK) {
374*4882a593Smuzhiyun 	case GEN6_PCODE_SUCCESS:
375*4882a593Smuzhiyun 		return 0;
376*4882a593Smuzhiyun 	case GEN6_PCODE_ILLEGAL_CMD:
377*4882a593Smuzhiyun 		return -ENXIO;
378*4882a593Smuzhiyun 	case GEN7_PCODE_TIMEOUT:
379*4882a593Smuzhiyun 		return -ETIMEDOUT;
380*4882a593Smuzhiyun 	case GEN7_PCODE_ILLEGAL_DATA:
381*4882a593Smuzhiyun 		return -EINVAL;
382*4882a593Smuzhiyun 	case GEN11_PCODE_ILLEGAL_SUBCOMMAND:
383*4882a593Smuzhiyun 		return -ENXIO;
384*4882a593Smuzhiyun 	case GEN11_PCODE_LOCKED:
385*4882a593Smuzhiyun 		return -EBUSY;
386*4882a593Smuzhiyun 	case GEN11_PCODE_REJECTED:
387*4882a593Smuzhiyun 		return -EACCES;
388*4882a593Smuzhiyun 	case GEN7_PCODE_MIN_FREQ_TABLE_GT_RATIO_OUT_OF_RANGE:
389*4882a593Smuzhiyun 		return -EOVERFLOW;
390*4882a593Smuzhiyun 	default:
391*4882a593Smuzhiyun 		MISSING_CASE(mbox & GEN6_PCODE_ERROR_MASK);
392*4882a593Smuzhiyun 		return 0;
393*4882a593Smuzhiyun 	}
394*4882a593Smuzhiyun }
395*4882a593Smuzhiyun 
__sandybridge_pcode_rw(struct drm_i915_private * i915,u32 mbox,u32 * val,u32 * val1,int fast_timeout_us,int slow_timeout_ms,bool is_read)396*4882a593Smuzhiyun static int __sandybridge_pcode_rw(struct drm_i915_private *i915,
397*4882a593Smuzhiyun 				  u32 mbox, u32 *val, u32 *val1,
398*4882a593Smuzhiyun 				  int fast_timeout_us,
399*4882a593Smuzhiyun 				  int slow_timeout_ms,
400*4882a593Smuzhiyun 				  bool is_read)
401*4882a593Smuzhiyun {
402*4882a593Smuzhiyun 	struct intel_uncore *uncore = &i915->uncore;
403*4882a593Smuzhiyun 
404*4882a593Smuzhiyun 	lockdep_assert_held(&i915->sb_lock);
405*4882a593Smuzhiyun 
406*4882a593Smuzhiyun 	/*
407*4882a593Smuzhiyun 	 * GEN6_PCODE_* are outside of the forcewake domain, we can
408*4882a593Smuzhiyun 	 * use te fw I915_READ variants to reduce the amount of work
409*4882a593Smuzhiyun 	 * required when reading/writing.
410*4882a593Smuzhiyun 	 */
411*4882a593Smuzhiyun 
412*4882a593Smuzhiyun 	if (intel_uncore_read_fw(uncore, GEN6_PCODE_MAILBOX) & GEN6_PCODE_READY)
413*4882a593Smuzhiyun 		return -EAGAIN;
414*4882a593Smuzhiyun 
415*4882a593Smuzhiyun 	intel_uncore_write_fw(uncore, GEN6_PCODE_DATA, *val);
416*4882a593Smuzhiyun 	intel_uncore_write_fw(uncore, GEN6_PCODE_DATA1, val1 ? *val1 : 0);
417*4882a593Smuzhiyun 	intel_uncore_write_fw(uncore,
418*4882a593Smuzhiyun 			      GEN6_PCODE_MAILBOX, GEN6_PCODE_READY | mbox);
419*4882a593Smuzhiyun 
420*4882a593Smuzhiyun 	if (__intel_wait_for_register_fw(uncore,
421*4882a593Smuzhiyun 					 GEN6_PCODE_MAILBOX,
422*4882a593Smuzhiyun 					 GEN6_PCODE_READY, 0,
423*4882a593Smuzhiyun 					 fast_timeout_us,
424*4882a593Smuzhiyun 					 slow_timeout_ms,
425*4882a593Smuzhiyun 					 &mbox))
426*4882a593Smuzhiyun 		return -ETIMEDOUT;
427*4882a593Smuzhiyun 
428*4882a593Smuzhiyun 	if (is_read)
429*4882a593Smuzhiyun 		*val = intel_uncore_read_fw(uncore, GEN6_PCODE_DATA);
430*4882a593Smuzhiyun 	if (is_read && val1)
431*4882a593Smuzhiyun 		*val1 = intel_uncore_read_fw(uncore, GEN6_PCODE_DATA1);
432*4882a593Smuzhiyun 
433*4882a593Smuzhiyun 	if (INTEL_GEN(i915) > 6)
434*4882a593Smuzhiyun 		return gen7_check_mailbox_status(mbox);
435*4882a593Smuzhiyun 	else
436*4882a593Smuzhiyun 		return gen6_check_mailbox_status(mbox);
437*4882a593Smuzhiyun }
438*4882a593Smuzhiyun 
sandybridge_pcode_read(struct drm_i915_private * i915,u32 mbox,u32 * val,u32 * val1)439*4882a593Smuzhiyun int sandybridge_pcode_read(struct drm_i915_private *i915, u32 mbox,
440*4882a593Smuzhiyun 			   u32 *val, u32 *val1)
441*4882a593Smuzhiyun {
442*4882a593Smuzhiyun 	int err;
443*4882a593Smuzhiyun 
444*4882a593Smuzhiyun 	mutex_lock(&i915->sb_lock);
445*4882a593Smuzhiyun 	err = __sandybridge_pcode_rw(i915, mbox, val, val1,
446*4882a593Smuzhiyun 				     500, 20,
447*4882a593Smuzhiyun 				     true);
448*4882a593Smuzhiyun 	mutex_unlock(&i915->sb_lock);
449*4882a593Smuzhiyun 
450*4882a593Smuzhiyun 	if (err) {
451*4882a593Smuzhiyun 		drm_dbg(&i915->drm,
452*4882a593Smuzhiyun 			"warning: pcode (read from mbox %x) mailbox access failed for %ps: %d\n",
453*4882a593Smuzhiyun 			mbox, __builtin_return_address(0), err);
454*4882a593Smuzhiyun 	}
455*4882a593Smuzhiyun 
456*4882a593Smuzhiyun 	return err;
457*4882a593Smuzhiyun }
458*4882a593Smuzhiyun 
sandybridge_pcode_write_timeout(struct drm_i915_private * i915,u32 mbox,u32 val,int fast_timeout_us,int slow_timeout_ms)459*4882a593Smuzhiyun int sandybridge_pcode_write_timeout(struct drm_i915_private *i915,
460*4882a593Smuzhiyun 				    u32 mbox, u32 val,
461*4882a593Smuzhiyun 				    int fast_timeout_us,
462*4882a593Smuzhiyun 				    int slow_timeout_ms)
463*4882a593Smuzhiyun {
464*4882a593Smuzhiyun 	int err;
465*4882a593Smuzhiyun 
466*4882a593Smuzhiyun 	mutex_lock(&i915->sb_lock);
467*4882a593Smuzhiyun 	err = __sandybridge_pcode_rw(i915, mbox, &val, NULL,
468*4882a593Smuzhiyun 				     fast_timeout_us, slow_timeout_ms,
469*4882a593Smuzhiyun 				     false);
470*4882a593Smuzhiyun 	mutex_unlock(&i915->sb_lock);
471*4882a593Smuzhiyun 
472*4882a593Smuzhiyun 	if (err) {
473*4882a593Smuzhiyun 		drm_dbg(&i915->drm,
474*4882a593Smuzhiyun 			"warning: pcode (write of 0x%08x to mbox %x) mailbox access failed for %ps: %d\n",
475*4882a593Smuzhiyun 			val, mbox, __builtin_return_address(0), err);
476*4882a593Smuzhiyun 	}
477*4882a593Smuzhiyun 
478*4882a593Smuzhiyun 	return err;
479*4882a593Smuzhiyun }
480*4882a593Smuzhiyun 
skl_pcode_try_request(struct drm_i915_private * i915,u32 mbox,u32 request,u32 reply_mask,u32 reply,u32 * status)481*4882a593Smuzhiyun static bool skl_pcode_try_request(struct drm_i915_private *i915, u32 mbox,
482*4882a593Smuzhiyun 				  u32 request, u32 reply_mask, u32 reply,
483*4882a593Smuzhiyun 				  u32 *status)
484*4882a593Smuzhiyun {
485*4882a593Smuzhiyun 	*status = __sandybridge_pcode_rw(i915, mbox, &request, NULL,
486*4882a593Smuzhiyun 					 500, 0,
487*4882a593Smuzhiyun 					 true);
488*4882a593Smuzhiyun 
489*4882a593Smuzhiyun 	return *status || ((request & reply_mask) == reply);
490*4882a593Smuzhiyun }
491*4882a593Smuzhiyun 
492*4882a593Smuzhiyun /**
493*4882a593Smuzhiyun  * skl_pcode_request - send PCODE request until acknowledgment
494*4882a593Smuzhiyun  * @i915: device private
495*4882a593Smuzhiyun  * @mbox: PCODE mailbox ID the request is targeted for
496*4882a593Smuzhiyun  * @request: request ID
497*4882a593Smuzhiyun  * @reply_mask: mask used to check for request acknowledgment
498*4882a593Smuzhiyun  * @reply: value used to check for request acknowledgment
499*4882a593Smuzhiyun  * @timeout_base_ms: timeout for polling with preemption enabled
500*4882a593Smuzhiyun  *
501*4882a593Smuzhiyun  * Keep resending the @request to @mbox until PCODE acknowledges it, PCODE
502*4882a593Smuzhiyun  * reports an error or an overall timeout of @timeout_base_ms+50 ms expires.
503*4882a593Smuzhiyun  * The request is acknowledged once the PCODE reply dword equals @reply after
504*4882a593Smuzhiyun  * applying @reply_mask. Polling is first attempted with preemption enabled
505*4882a593Smuzhiyun  * for @timeout_base_ms and if this times out for another 50 ms with
506*4882a593Smuzhiyun  * preemption disabled.
507*4882a593Smuzhiyun  *
508*4882a593Smuzhiyun  * Returns 0 on success, %-ETIMEDOUT in case of a timeout, <0 in case of some
509*4882a593Smuzhiyun  * other error as reported by PCODE.
510*4882a593Smuzhiyun  */
skl_pcode_request(struct drm_i915_private * i915,u32 mbox,u32 request,u32 reply_mask,u32 reply,int timeout_base_ms)511*4882a593Smuzhiyun int skl_pcode_request(struct drm_i915_private *i915, u32 mbox, u32 request,
512*4882a593Smuzhiyun 		      u32 reply_mask, u32 reply, int timeout_base_ms)
513*4882a593Smuzhiyun {
514*4882a593Smuzhiyun 	u32 status;
515*4882a593Smuzhiyun 	int ret;
516*4882a593Smuzhiyun 
517*4882a593Smuzhiyun 	mutex_lock(&i915->sb_lock);
518*4882a593Smuzhiyun 
519*4882a593Smuzhiyun #define COND \
520*4882a593Smuzhiyun 	skl_pcode_try_request(i915, mbox, request, reply_mask, reply, &status)
521*4882a593Smuzhiyun 
522*4882a593Smuzhiyun 	/*
523*4882a593Smuzhiyun 	 * Prime the PCODE by doing a request first. Normally it guarantees
524*4882a593Smuzhiyun 	 * that a subsequent request, at most @timeout_base_ms later, succeeds.
525*4882a593Smuzhiyun 	 * _wait_for() doesn't guarantee when its passed condition is evaluated
526*4882a593Smuzhiyun 	 * first, so send the first request explicitly.
527*4882a593Smuzhiyun 	 */
528*4882a593Smuzhiyun 	if (COND) {
529*4882a593Smuzhiyun 		ret = 0;
530*4882a593Smuzhiyun 		goto out;
531*4882a593Smuzhiyun 	}
532*4882a593Smuzhiyun 	ret = _wait_for(COND, timeout_base_ms * 1000, 10, 10);
533*4882a593Smuzhiyun 	if (!ret)
534*4882a593Smuzhiyun 		goto out;
535*4882a593Smuzhiyun 
536*4882a593Smuzhiyun 	/*
537*4882a593Smuzhiyun 	 * The above can time out if the number of requests was low (2 in the
538*4882a593Smuzhiyun 	 * worst case) _and_ PCODE was busy for some reason even after a
539*4882a593Smuzhiyun 	 * (queued) request and @timeout_base_ms delay. As a workaround retry
540*4882a593Smuzhiyun 	 * the poll with preemption disabled to maximize the number of
541*4882a593Smuzhiyun 	 * requests. Increase the timeout from @timeout_base_ms to 50ms to
542*4882a593Smuzhiyun 	 * account for interrupts that could reduce the number of these
543*4882a593Smuzhiyun 	 * requests, and for any quirks of the PCODE firmware that delays
544*4882a593Smuzhiyun 	 * the request completion.
545*4882a593Smuzhiyun 	 */
546*4882a593Smuzhiyun 	drm_dbg_kms(&i915->drm,
547*4882a593Smuzhiyun 		    "PCODE timeout, retrying with preemption disabled\n");
548*4882a593Smuzhiyun 	drm_WARN_ON_ONCE(&i915->drm, timeout_base_ms > 3);
549*4882a593Smuzhiyun 	preempt_disable();
550*4882a593Smuzhiyun 	ret = wait_for_atomic(COND, 50);
551*4882a593Smuzhiyun 	preempt_enable();
552*4882a593Smuzhiyun 
553*4882a593Smuzhiyun out:
554*4882a593Smuzhiyun 	mutex_unlock(&i915->sb_lock);
555*4882a593Smuzhiyun 	return ret ? ret : status;
556*4882a593Smuzhiyun #undef COND
557*4882a593Smuzhiyun }
558