1/*
2 * Broadcom specific AMBA
3 * PCI Core
4 *
5 * Copyright 2005, 2011, Broadcom Corporation
6 * Copyright 2006, 2007, Michael Buesch <m@bues.ch>
7 * Copyright 2011, 2012, Hauke Mehrtens <hauke@hauke-m.de>
8 *
9 * Licensed under the GNU/GPL. See COPYING for details.
10 */
11
12#include "bcma_private.h"
13#include <linux/export.h>
14#include <linux/bcma/bcma.h>
15
16/**************************************************
17 * R/W ops.
18 **************************************************/
19
20u32 bcma_pcie_read(struct bcma_drv_pci *pc, u32 address)
21{
22	pcicore_write32(pc, BCMA_CORE_PCI_PCIEIND_ADDR, address);
23	pcicore_read32(pc, BCMA_CORE_PCI_PCIEIND_ADDR);
24	return pcicore_read32(pc, BCMA_CORE_PCI_PCIEIND_DATA);
25}
26
27static void bcma_pcie_write(struct bcma_drv_pci *pc, u32 address, u32 data)
28{
29	pcicore_write32(pc, BCMA_CORE_PCI_PCIEIND_ADDR, address);
30	pcicore_read32(pc, BCMA_CORE_PCI_PCIEIND_ADDR);
31	pcicore_write32(pc, BCMA_CORE_PCI_PCIEIND_DATA, data);
32}
33
34static void bcma_pcie_mdio_set_phy(struct bcma_drv_pci *pc, u16 phy)
35{
36	u32 v;
37	int i;
38
39	v = BCMA_CORE_PCI_MDIODATA_START;
40	v |= BCMA_CORE_PCI_MDIODATA_WRITE;
41	v |= (BCMA_CORE_PCI_MDIODATA_DEV_ADDR <<
42	      BCMA_CORE_PCI_MDIODATA_DEVADDR_SHF);
43	v |= (BCMA_CORE_PCI_MDIODATA_BLK_ADDR <<
44	      BCMA_CORE_PCI_MDIODATA_REGADDR_SHF);
45	v |= BCMA_CORE_PCI_MDIODATA_TA;
46	v |= (phy << 4);
47	pcicore_write32(pc, BCMA_CORE_PCI_MDIO_DATA, v);
48
49	udelay(10);
50	for (i = 0; i < 200; i++) {
51		v = pcicore_read32(pc, BCMA_CORE_PCI_MDIO_CONTROL);
52		if (v & BCMA_CORE_PCI_MDIOCTL_ACCESS_DONE)
53			break;
54		usleep_range(1000, 2000);
55	}
56}
57
58static u16 bcma_pcie_mdio_read(struct bcma_drv_pci *pc, u16 device, u8 address)
59{
60	int max_retries = 10;
61	u16 ret = 0;
62	u32 v;
63	int i;
64
65	/* enable mdio access to SERDES */
66	v = BCMA_CORE_PCI_MDIOCTL_PREAM_EN;
67	v |= BCMA_CORE_PCI_MDIOCTL_DIVISOR_VAL;
68	pcicore_write32(pc, BCMA_CORE_PCI_MDIO_CONTROL, v);
69
70	if (pc->core->id.rev >= 10) {
71		max_retries = 200;
72		bcma_pcie_mdio_set_phy(pc, device);
73		v = (BCMA_CORE_PCI_MDIODATA_DEV_ADDR <<
74		     BCMA_CORE_PCI_MDIODATA_DEVADDR_SHF);
75		v |= (address << BCMA_CORE_PCI_MDIODATA_REGADDR_SHF);
76	} else {
77		v = (device << BCMA_CORE_PCI_MDIODATA_DEVADDR_SHF_OLD);
78		v |= (address << BCMA_CORE_PCI_MDIODATA_REGADDR_SHF_OLD);
79	}
80
81	v = BCMA_CORE_PCI_MDIODATA_START;
82	v |= BCMA_CORE_PCI_MDIODATA_READ;
83	v |= BCMA_CORE_PCI_MDIODATA_TA;
84
85	pcicore_write32(pc, BCMA_CORE_PCI_MDIO_DATA, v);
86	/* Wait for the device to complete the transaction */
87	udelay(10);
88	for (i = 0; i < max_retries; i++) {
89		v = pcicore_read32(pc, BCMA_CORE_PCI_MDIO_CONTROL);
90		if (v & BCMA_CORE_PCI_MDIOCTL_ACCESS_DONE) {
91			udelay(10);
92			ret = pcicore_read32(pc, BCMA_CORE_PCI_MDIO_DATA);
93			break;
94		}
95		usleep_range(1000, 2000);
96	}
97	pcicore_write32(pc, BCMA_CORE_PCI_MDIO_CONTROL, 0);
98	return ret;
99}
100
101static void bcma_pcie_mdio_write(struct bcma_drv_pci *pc, u16 device,
102				u8 address, u16 data)
103{
104	int max_retries = 10;
105	u32 v;
106	int i;
107
108	/* enable mdio access to SERDES */
109	v = BCMA_CORE_PCI_MDIOCTL_PREAM_EN;
110	v |= BCMA_CORE_PCI_MDIOCTL_DIVISOR_VAL;
111	pcicore_write32(pc, BCMA_CORE_PCI_MDIO_CONTROL, v);
112
113	if (pc->core->id.rev >= 10) {
114		max_retries = 200;
115		bcma_pcie_mdio_set_phy(pc, device);
116		v = (BCMA_CORE_PCI_MDIODATA_DEV_ADDR <<
117		     BCMA_CORE_PCI_MDIODATA_DEVADDR_SHF);
118		v |= (address << BCMA_CORE_PCI_MDIODATA_REGADDR_SHF);
119	} else {
120		v = (device << BCMA_CORE_PCI_MDIODATA_DEVADDR_SHF_OLD);
121		v |= (address << BCMA_CORE_PCI_MDIODATA_REGADDR_SHF_OLD);
122	}
123
124	v = BCMA_CORE_PCI_MDIODATA_START;
125	v |= BCMA_CORE_PCI_MDIODATA_WRITE;
126	v |= BCMA_CORE_PCI_MDIODATA_TA;
127	v |= data;
128	pcicore_write32(pc, BCMA_CORE_PCI_MDIO_DATA, v);
129	/* Wait for the device to complete the transaction */
130	udelay(10);
131	for (i = 0; i < max_retries; i++) {
132		v = pcicore_read32(pc, BCMA_CORE_PCI_MDIO_CONTROL);
133		if (v & BCMA_CORE_PCI_MDIOCTL_ACCESS_DONE)
134			break;
135		usleep_range(1000, 2000);
136	}
137	pcicore_write32(pc, BCMA_CORE_PCI_MDIO_CONTROL, 0);
138}
139
140static u16 bcma_pcie_mdio_writeread(struct bcma_drv_pci *pc, u16 device,
141				    u8 address, u16 data)
142{
143	bcma_pcie_mdio_write(pc, device, address, data);
144	return bcma_pcie_mdio_read(pc, device, address);
145}
146
147/**************************************************
148 * Early init.
149 **************************************************/
150
151static void bcma_core_pci_fixcfg(struct bcma_drv_pci *pc)
152{
153	struct bcma_device *core = pc->core;
154	u16 val16, core_index;
155	uint regoff;
156
157	regoff = BCMA_CORE_PCI_SPROM(BCMA_CORE_PCI_SPROM_PI_OFFSET);
158	core_index = (u16)core->core_index;
159
160	val16 = pcicore_read16(pc, regoff);
161	if (((val16 & BCMA_CORE_PCI_SPROM_PI_MASK) >> BCMA_CORE_PCI_SPROM_PI_SHIFT)
162	     != core_index) {
163		val16 = (core_index << BCMA_CORE_PCI_SPROM_PI_SHIFT) |
164			(val16 & ~BCMA_CORE_PCI_SPROM_PI_MASK);
165		pcicore_write16(pc, regoff, val16);
166	}
167}
168
169/*
170 * Apply some early fixes required before accessing SPROM.
171 * See also si_pci_fixcfg.
172 */
173void bcma_core_pci_early_init(struct bcma_drv_pci *pc)
174{
175	if (pc->early_setup_done)
176		return;
177
178	pc->hostmode = bcma_core_pci_is_in_hostmode(pc);
179	if (pc->hostmode)
180		goto out;
181
182	bcma_core_pci_fixcfg(pc);
183
184out:
185	pc->early_setup_done = true;
186}
187
188/**************************************************
189 * Workarounds.
190 **************************************************/
191
192static u8 bcma_pcicore_polarity_workaround(struct bcma_drv_pci *pc)
193{
194	u32 tmp;
195
196	tmp = bcma_pcie_read(pc, BCMA_CORE_PCI_PLP_STATUSREG);
197	if (tmp & BCMA_CORE_PCI_PLP_POLARITYINV_STAT)
198		return BCMA_CORE_PCI_SERDES_RX_CTRL_FORCE |
199		       BCMA_CORE_PCI_SERDES_RX_CTRL_POLARITY;
200	else
201		return BCMA_CORE_PCI_SERDES_RX_CTRL_FORCE;
202}
203
204static void bcma_pcicore_serdes_workaround(struct bcma_drv_pci *pc)
205{
206	u16 tmp;
207
208	bcma_pcie_mdio_write(pc, BCMA_CORE_PCI_MDIODATA_DEV_RX,
209	                     BCMA_CORE_PCI_SERDES_RX_CTRL,
210			     bcma_pcicore_polarity_workaround(pc));
211	tmp = bcma_pcie_mdio_read(pc, BCMA_CORE_PCI_MDIODATA_DEV_PLL,
212	                          BCMA_CORE_PCI_SERDES_PLL_CTRL);
213	if (tmp & BCMA_CORE_PCI_PLL_CTRL_FREQDET_EN)
214		bcma_pcie_mdio_write(pc, BCMA_CORE_PCI_MDIODATA_DEV_PLL,
215		                     BCMA_CORE_PCI_SERDES_PLL_CTRL,
216		                     tmp & ~BCMA_CORE_PCI_PLL_CTRL_FREQDET_EN);
217}
218
219/* Fix MISC config to allow coming out of L2/L3-Ready state w/o PRST */
220/* Needs to happen when coming out of 'standby'/'hibernate' */
221static void bcma_core_pci_config_fixup(struct bcma_drv_pci *pc)
222{
223	u16 val16;
224	uint regoff;
225
226	regoff = BCMA_CORE_PCI_SPROM(BCMA_CORE_PCI_SPROM_MISC_CONFIG);
227
228	val16 = pcicore_read16(pc, regoff);
229
230	if (!(val16 & BCMA_CORE_PCI_SPROM_L23READY_EXIT_NOPERST)) {
231		val16 |= BCMA_CORE_PCI_SPROM_L23READY_EXIT_NOPERST;
232		pcicore_write16(pc, regoff, val16);
233	}
234}
235
236/**************************************************
237 * Init.
238 **************************************************/
239
240static void bcma_core_pci_clientmode_init(struct bcma_drv_pci *pc)
241{
242	bcma_pcicore_serdes_workaround(pc);
243	bcma_core_pci_config_fixup(pc);
244}
245
246void bcma_core_pci_init(struct bcma_drv_pci *pc)
247{
248	if (pc->setup_done)
249		return;
250
251	bcma_core_pci_early_init(pc);
252
253	if (pc->hostmode)
254		bcma_core_pci_hostmode_init(pc);
255	else
256		bcma_core_pci_clientmode_init(pc);
257}
258
259void bcma_core_pci_power_save(struct bcma_bus *bus, bool up)
260{
261	struct bcma_drv_pci *pc;
262	u16 data;
263
264	if (bus->hosttype != BCMA_HOSTTYPE_PCI)
265		return;
266
267	pc = &bus->drv_pci[0];
268
269	if (pc->core->id.rev >= 15 && pc->core->id.rev <= 20) {
270		data = up ? 0x74 : 0x7C;
271		bcma_pcie_mdio_writeread(pc, BCMA_CORE_PCI_MDIO_BLK1,
272					 BCMA_CORE_PCI_MDIO_BLK1_MGMT1, 0x7F64);
273		bcma_pcie_mdio_writeread(pc, BCMA_CORE_PCI_MDIO_BLK1,
274					 BCMA_CORE_PCI_MDIO_BLK1_MGMT3, data);
275	} else if (pc->core->id.rev >= 21 && pc->core->id.rev <= 22) {
276		data = up ? 0x75 : 0x7D;
277		bcma_pcie_mdio_writeread(pc, BCMA_CORE_PCI_MDIO_BLK1,
278					 BCMA_CORE_PCI_MDIO_BLK1_MGMT1, 0x7E65);
279		bcma_pcie_mdio_writeread(pc, BCMA_CORE_PCI_MDIO_BLK1,
280					 BCMA_CORE_PCI_MDIO_BLK1_MGMT3, data);
281	}
282}
283EXPORT_SYMBOL_GPL(bcma_core_pci_power_save);
284
285static void bcma_core_pci_extend_L1timer(struct bcma_drv_pci *pc, bool extend)
286{
287	u32 w;
288
289	w = bcma_pcie_read(pc, BCMA_CORE_PCI_DLLP_PMTHRESHREG);
290	if (extend)
291		w |= BCMA_CORE_PCI_ASPMTIMER_EXTEND;
292	else
293		w &= ~BCMA_CORE_PCI_ASPMTIMER_EXTEND;
294	bcma_pcie_write(pc, BCMA_CORE_PCI_DLLP_PMTHRESHREG, w);
295	bcma_pcie_read(pc, BCMA_CORE_PCI_DLLP_PMTHRESHREG);
296}
297
298void bcma_core_pci_up(struct bcma_drv_pci *pc)
299{
300	bcma_core_pci_extend_L1timer(pc, true);
301}
302
303void bcma_core_pci_down(struct bcma_drv_pci *pc)
304{
305	bcma_core_pci_extend_L1timer(pc, false);
306}
307