xref: /OK3568_Linux_fs/external/rkwifibt/drivers/infineon/siutils.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * Misc utility routines for accessing chip-specific features
3*4882a593Smuzhiyun  * of the SiliconBackplane-based Broadcom chips.
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Portions of this code are copyright (c) 2021 Cypress Semiconductor Corporation
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  * Copyright (C) 1999-2017, Broadcom Corporation
8*4882a593Smuzhiyun  *
9*4882a593Smuzhiyun  *      Unless you and Broadcom execute a separate written software license
10*4882a593Smuzhiyun  * agreement governing use of this software, this software is licensed to you
11*4882a593Smuzhiyun  * under the terms of the GNU General Public License version 2 (the "GPL"),
12*4882a593Smuzhiyun  * available at http://www.broadcom.com/licenses/GPLv2.php, with the
13*4882a593Smuzhiyun  * following added to such license:
14*4882a593Smuzhiyun  *
15*4882a593Smuzhiyun  *      As a special exception, the copyright holders of this software give you
16*4882a593Smuzhiyun  * permission to link this software with independent modules, and to copy and
17*4882a593Smuzhiyun  * distribute the resulting executable under terms of your choice, provided that
18*4882a593Smuzhiyun  * you also meet, for each linked independent module, the terms and conditions of
19*4882a593Smuzhiyun  * the license of that module.  An independent module is a module which is not
20*4882a593Smuzhiyun  * derived from this software.  The special exception does not apply to any
21*4882a593Smuzhiyun  * modifications of the software.
22*4882a593Smuzhiyun  *
23*4882a593Smuzhiyun  *      Notwithstanding the above, under no circumstances may you combine this
24*4882a593Smuzhiyun  * software in any way with any other Broadcom software provided under a license
25*4882a593Smuzhiyun  * other than the GPL, without Broadcom's express prior written consent.
26*4882a593Smuzhiyun  *
27*4882a593Smuzhiyun  *
28*4882a593Smuzhiyun  * <<Broadcom-WL-IPTag/Open:>>
29*4882a593Smuzhiyun  *
30*4882a593Smuzhiyun  * $Id: siutils.c 701025 2017-05-23 10:23:52Z $
31*4882a593Smuzhiyun  */
32*4882a593Smuzhiyun 
33*4882a593Smuzhiyun #include <bcm_cfg.h>
34*4882a593Smuzhiyun #include <typedefs.h>
35*4882a593Smuzhiyun #include <bcmdefs.h>
36*4882a593Smuzhiyun #include <osl.h>
37*4882a593Smuzhiyun #include <bcmutils.h>
38*4882a593Smuzhiyun #include <siutils.h>
39*4882a593Smuzhiyun #include <bcmdevs.h>
40*4882a593Smuzhiyun #include <hndsoc.h>
41*4882a593Smuzhiyun #include <sbchipc.h>
42*4882a593Smuzhiyun #include <sbgci.h>
43*4882a593Smuzhiyun #ifndef BCMSDIO
44*4882a593Smuzhiyun #include <pcie_core.h>
45*4882a593Smuzhiyun #endif // endif
46*4882a593Smuzhiyun #ifdef BCMPCIEDEV
47*4882a593Smuzhiyun /
48*4882a593Smuzhiyun #endif /* BCMPCIEDEV */
49*4882a593Smuzhiyun #include <pcicfg.h>
50*4882a593Smuzhiyun #include <sbpcmcia.h>
51*4882a593Smuzhiyun #include <sbsysmem.h>
52*4882a593Smuzhiyun #include <sbsocram.h>
53*4882a593Smuzhiyun #ifdef BCMSDIO
54*4882a593Smuzhiyun #include <bcmsdh.h>
55*4882a593Smuzhiyun #include <sdio.h>
56*4882a593Smuzhiyun #include <sbsdio.h>
57*4882a593Smuzhiyun #include <sbhnddma.h>
58*4882a593Smuzhiyun #include <sbsdpcmdev.h>
59*4882a593Smuzhiyun #include <bcmsdpcm.h>
60*4882a593Smuzhiyun #endif /* BCMSDIO */
61*4882a593Smuzhiyun #include <hndpmu.h>
62*4882a593Smuzhiyun #ifdef BCMSPI
63*4882a593Smuzhiyun #include <spid.h>
64*4882a593Smuzhiyun #endif /* BCMSPI */
65*4882a593Smuzhiyun 
66*4882a593Smuzhiyun #ifdef BCM_SDRBL
67*4882a593Smuzhiyun #include <hndcpu.h>
68*4882a593Smuzhiyun #endif /* BCM_SDRBL */
69*4882a593Smuzhiyun #ifdef HNDGCI
70*4882a593Smuzhiyun #include <hndgci.h>
71*4882a593Smuzhiyun #endif /* HNDGCI */
72*4882a593Smuzhiyun #ifdef WLGCIMBHLR
73*4882a593Smuzhiyun #include <hnd_gci.h>
74*4882a593Smuzhiyun #endif /* WLGCIMBHLR */
75*4882a593Smuzhiyun #ifdef BCMULP
76*4882a593Smuzhiyun #include <ulp.h>
77*4882a593Smuzhiyun #endif /* BCMULP */
78*4882a593Smuzhiyun #include <hndlhl.h>
79*4882a593Smuzhiyun 
80*4882a593Smuzhiyun #include <lpflags.h>
81*4882a593Smuzhiyun 
82*4882a593Smuzhiyun #include "siutils_priv.h"
83*4882a593Smuzhiyun #ifdef SECI_UART
84*4882a593Smuzhiyun /* Defines the set of GPIOs to be used for SECI UART if not specified in NVRAM */
85*4882a593Smuzhiyun /* For further details on each ppin functionality please refer to PINMUX table in
86*4882a593Smuzhiyun  * Top level architecture of BCMXXXX Chip
87*4882a593Smuzhiyun  */
88*4882a593Smuzhiyun #define DEFAULT_SECI_UART_PINMUX	0x08090a0b
89*4882a593Smuzhiyun #define DEFAULT_SECI_UART_PINMUX_43430	0x0102
90*4882a593Smuzhiyun static bool force_seci_clk = 0;
91*4882a593Smuzhiyun #endif /* SECI_UART */
92*4882a593Smuzhiyun 
93*4882a593Smuzhiyun #define XTAL_FREQ_26000KHZ		26000
94*4882a593Smuzhiyun 
95*4882a593Smuzhiyun /**
96*4882a593Smuzhiyun  * A set of PMU registers is clocked in the ILP domain, which has an implication on register write
97*4882a593Smuzhiyun  * behavior: if such a register is written, it takes multiple ILP clocks for the PMU block to absorb
98*4882a593Smuzhiyun  * the write. During that time the 'SlowWritePending' bit in the PMUStatus register is set.
99*4882a593Smuzhiyun  */
100*4882a593Smuzhiyun #define PMUREGS_ILP_SENSITIVE(regoff) \
101*4882a593Smuzhiyun 	((regoff) == OFFSETOF(pmuregs_t, pmutimer) || \
102*4882a593Smuzhiyun 	 (regoff) == OFFSETOF(pmuregs_t, pmuwatchdog) || \
103*4882a593Smuzhiyun 	 (regoff) == OFFSETOF(pmuregs_t, res_req_timer))
104*4882a593Smuzhiyun 
105*4882a593Smuzhiyun #define CHIPCREGS_ILP_SENSITIVE(regoff) \
106*4882a593Smuzhiyun 	((regoff) == OFFSETOF(chipcregs_t, pmutimer) || \
107*4882a593Smuzhiyun 	 (regoff) == OFFSETOF(chipcregs_t, pmuwatchdog) || \
108*4882a593Smuzhiyun 	 (regoff) == OFFSETOF(chipcregs_t, res_req_timer))
109*4882a593Smuzhiyun 
110*4882a593Smuzhiyun #define GCI_FEM_CTRL_WAR 0x11111111
111*4882a593Smuzhiyun 
112*4882a593Smuzhiyun #ifndef AXI_TO_VAL
113*4882a593Smuzhiyun #define AXI_TO_VAL 19
114*4882a593Smuzhiyun #endif	/* AXI_TO_VAL */
115*4882a593Smuzhiyun 
116*4882a593Smuzhiyun #ifndef AXI_TO_VAL_4347
117*4882a593Smuzhiyun /*
118*4882a593Smuzhiyun  * Increase BP timeout for fast clock and short PCIe timeouts
119*4882a593Smuzhiyun  * New timeout: 2 ** 25 cycles
120*4882a593Smuzhiyun  */
121*4882a593Smuzhiyun #define AXI_TO_VAL_4347	25
122*4882a593Smuzhiyun #endif /* AXI_TO_VAL_4347 */
123*4882a593Smuzhiyun 
124*4882a593Smuzhiyun /* local prototypes */
125*4882a593Smuzhiyun static si_info_t *si_doattach(si_info_t *sii, uint devid, osl_t *osh, volatile void *regs,
126*4882a593Smuzhiyun                               uint bustype, void *sdh, char **vars, uint *varsz);
127*4882a593Smuzhiyun static bool si_buscore_prep(si_info_t *sii, uint bustype, uint devid, void *sdh);
128*4882a593Smuzhiyun static bool si_buscore_setup(si_info_t *sii, chipcregs_t *cc, uint bustype, uint32 savewin,
129*4882a593Smuzhiyun 	uint *origidx, volatile void *regs);
130*4882a593Smuzhiyun 
131*4882a593Smuzhiyun static bool si_pmu_is_ilp_sensitive(uint32 idx, uint regoff);
132*4882a593Smuzhiyun 
133*4882a593Smuzhiyun /* global variable to indicate reservation/release of gpio's */
134*4882a593Smuzhiyun static uint32 si_gpioreservation = 0;
135*4882a593Smuzhiyun 
136*4882a593Smuzhiyun /* global flag to prevent shared resources from being initialized multiple times in si_attach() */
137*4882a593Smuzhiyun static bool si_onetimeinit = FALSE;
138*4882a593Smuzhiyun 
139*4882a593Smuzhiyun #ifdef SR_DEBUG
140*4882a593Smuzhiyun static const uint32 si_power_island_test_array[] = {
141*4882a593Smuzhiyun 	0x0000, 0x0001, 0x0010, 0x0011,
142*4882a593Smuzhiyun 	0x0100, 0x0101, 0x0110, 0x0111,
143*4882a593Smuzhiyun 	0x1000, 0x1001, 0x1010, 0x1011,
144*4882a593Smuzhiyun 	0x1100, 0x1101, 0x1110, 0x1111
145*4882a593Smuzhiyun };
146*4882a593Smuzhiyun #endif /* SR_DEBUG */
147*4882a593Smuzhiyun 
148*4882a593Smuzhiyun int do_4360_pcie2_war = 0;
149*4882a593Smuzhiyun 
150*4882a593Smuzhiyun #ifdef BCMULP
151*4882a593Smuzhiyun /* Variable to store boot_type: warm_boot/cold_boot/etc. */
152*4882a593Smuzhiyun static int boot_type = 0;
153*4882a593Smuzhiyun #endif // endif
154*4882a593Smuzhiyun 
155*4882a593Smuzhiyun /* global kernel resource */
156*4882a593Smuzhiyun static si_info_t ksii;
157*4882a593Smuzhiyun static si_cores_info_t ksii_cores_info;
158*4882a593Smuzhiyun 
159*4882a593Smuzhiyun /**
160*4882a593Smuzhiyun  * Allocate an si handle. This function may be called multiple times.
161*4882a593Smuzhiyun  *
162*4882a593Smuzhiyun  * devid - pci device id (used to determine chip#)
163*4882a593Smuzhiyun  * osh - opaque OS handle
164*4882a593Smuzhiyun  * regs - virtual address of initial core registers
165*4882a593Smuzhiyun  * bustype - pci/pcmcia/sb/sdio/etc
166*4882a593Smuzhiyun  * vars - pointer to a to-be created pointer area for "environment" variables. Some callers of this
167*4882a593Smuzhiyun  *        function set 'vars' to NULL, making dereferencing of this parameter undesired.
168*4882a593Smuzhiyun  * varsz - pointer to int to return the size of the vars
169*4882a593Smuzhiyun  */
170*4882a593Smuzhiyun si_t *
si_attach(uint devid,osl_t * osh,volatile void * regs,uint bustype,void * sdh,char ** vars,uint * varsz)171*4882a593Smuzhiyun si_attach(uint devid, osl_t *osh, volatile void *regs,
172*4882a593Smuzhiyun                        uint bustype, void *sdh, char **vars, uint *varsz)
173*4882a593Smuzhiyun {
174*4882a593Smuzhiyun 	si_info_t *sii;
175*4882a593Smuzhiyun 	si_cores_info_t *cores_info;
176*4882a593Smuzhiyun 	/* alloc si_info_t */
177*4882a593Smuzhiyun 	/* freed after ucode download for firmware builds */
178*4882a593Smuzhiyun 	if ((sii = MALLOCZ_NOPERSIST(osh, sizeof(si_info_t))) == NULL) {
179*4882a593Smuzhiyun 		SI_ERROR(("si_attach: malloc failed! malloced %d bytes\n", MALLOCED(osh)));
180*4882a593Smuzhiyun 		return (NULL);
181*4882a593Smuzhiyun 	}
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun 	/* alloc si_cores_info_t */
184*4882a593Smuzhiyun 	if ((cores_info = (si_cores_info_t *)MALLOCZ(osh,
185*4882a593Smuzhiyun 		sizeof(si_cores_info_t))) == NULL) {
186*4882a593Smuzhiyun 		SI_ERROR(("si_attach: malloc failed! malloced %d bytes\n", MALLOCED(osh)));
187*4882a593Smuzhiyun 		MFREE(osh, sii, sizeof(si_info_t));
188*4882a593Smuzhiyun 		return (NULL);
189*4882a593Smuzhiyun 	}
190*4882a593Smuzhiyun 	sii->cores_info = cores_info;
191*4882a593Smuzhiyun 
192*4882a593Smuzhiyun 	if (si_doattach(sii, devid, osh, regs, bustype, sdh, vars, varsz) == NULL) {
193*4882a593Smuzhiyun 		MFREE(osh, sii, sizeof(si_info_t));
194*4882a593Smuzhiyun 		MFREE(osh, cores_info, sizeof(si_cores_info_t));
195*4882a593Smuzhiyun 		return (NULL);
196*4882a593Smuzhiyun 	}
197*4882a593Smuzhiyun 	sii->vars = vars ? *vars : NULL;
198*4882a593Smuzhiyun 	sii->varsz = varsz ? *varsz : 0;
199*4882a593Smuzhiyun 
200*4882a593Smuzhiyun 	return (si_t *)sii;
201*4882a593Smuzhiyun }
202*4882a593Smuzhiyun 
203*4882a593Smuzhiyun static uint32	wd_msticks;		/**< watchdog timer ticks normalized to ms */
204*4882a593Smuzhiyun 
205*4882a593Smuzhiyun /** Returns the backplane address of the chipcommon core for a particular chip */
206*4882a593Smuzhiyun uint32
si_enum_base(uint devid)207*4882a593Smuzhiyun si_enum_base(uint devid)
208*4882a593Smuzhiyun {
209*4882a593Smuzhiyun 	// NIC/DHD build
210*4882a593Smuzhiyun 	switch (devid) {
211*4882a593Smuzhiyun 		case BCM7271_CHIP_ID:
212*4882a593Smuzhiyun 		case BCM7271_D11AC_ID:
213*4882a593Smuzhiyun 		case BCM7271_D11AC2G_ID:
214*4882a593Smuzhiyun 		case BCM7271_D11AC5G_ID:
215*4882a593Smuzhiyun 			return 0xF1800000;
216*4882a593Smuzhiyun 	}
217*4882a593Smuzhiyun 
218*4882a593Smuzhiyun 	return SI_ENUM_BASE_DEFAULT;
219*4882a593Smuzhiyun }
220*4882a593Smuzhiyun 
221*4882a593Smuzhiyun /** Returns the backplane address of the PCIE core for a particular chip */
222*4882a593Smuzhiyun uint32
si_pcie_enum_base(uint devid)223*4882a593Smuzhiyun si_pcie_enum_base(uint devid)
224*4882a593Smuzhiyun {
225*4882a593Smuzhiyun 	switch (devid) {
226*4882a593Smuzhiyun 		case CYW55560_WLAN_ID:
227*4882a593Smuzhiyun 			return SI_ENUM_PCIE2_BASE;
228*4882a593Smuzhiyun 	}
229*4882a593Smuzhiyun 
230*4882a593Smuzhiyun 	/* Default - In future chips if devid is not matched */
231*4882a593Smuzhiyun 	return SI_ENUM_PCIE2_BASE;
232*4882a593Smuzhiyun }
233*4882a593Smuzhiyun 
234*4882a593Smuzhiyun /** generic kernel variant of si_attach(). Is not called for Linux WLAN NIC builds. */
235*4882a593Smuzhiyun si_t *
si_kattach(osl_t * osh)236*4882a593Smuzhiyun si_kattach(osl_t *osh)
237*4882a593Smuzhiyun {
238*4882a593Smuzhiyun 	static bool ksii_attached = FALSE;
239*4882a593Smuzhiyun 	si_cores_info_t *cores_info;
240*4882a593Smuzhiyun 
241*4882a593Smuzhiyun 	if (!ksii_attached) {
242*4882a593Smuzhiyun 		void *regs = NULL;
243*4882a593Smuzhiyun 		const uint device_id = BCM4710_DEVICE_ID; // pick an arbitrary default device_id
244*4882a593Smuzhiyun 
245*4882a593Smuzhiyun 		regs = REG_MAP(si_enum_base(device_id), SI_CORE_SIZE); // map physical to virtual
246*4882a593Smuzhiyun 		cores_info = (si_cores_info_t *)&ksii_cores_info;
247*4882a593Smuzhiyun 		ksii.cores_info = cores_info;
248*4882a593Smuzhiyun 
249*4882a593Smuzhiyun 		ASSERT(osh);
250*4882a593Smuzhiyun 		if (si_doattach(&ksii, device_id, osh, regs,
251*4882a593Smuzhiyun 		                SI_BUS, NULL,
252*4882a593Smuzhiyun 		                osh != SI_OSH ? &(ksii.vars) : NULL,
253*4882a593Smuzhiyun 		                osh != SI_OSH ? &(ksii.varsz) : NULL) == NULL) {
254*4882a593Smuzhiyun 			SI_ERROR(("si_kattach: si_doattach failed\n"));
255*4882a593Smuzhiyun 			REG_UNMAP(regs);
256*4882a593Smuzhiyun 			return NULL;
257*4882a593Smuzhiyun 		}
258*4882a593Smuzhiyun 		REG_UNMAP(regs);
259*4882a593Smuzhiyun 
260*4882a593Smuzhiyun 		/* save ticks normalized to ms for si_watchdog_ms() */
261*4882a593Smuzhiyun 		if (PMUCTL_ENAB(&ksii.pub)) {
262*4882a593Smuzhiyun 			/* based on 32KHz ILP clock */
263*4882a593Smuzhiyun 			wd_msticks = 32;
264*4882a593Smuzhiyun 		} else {
265*4882a593Smuzhiyun 			wd_msticks = ALP_CLOCK / 1000;
266*4882a593Smuzhiyun 		}
267*4882a593Smuzhiyun 
268*4882a593Smuzhiyun 		ksii_attached = TRUE;
269*4882a593Smuzhiyun 		SI_MSG(("si_kattach done. ccrev = %d, wd_msticks = %d\n",
270*4882a593Smuzhiyun 		        CCREV(ksii.pub.ccrev), wd_msticks));
271*4882a593Smuzhiyun 	}
272*4882a593Smuzhiyun 
273*4882a593Smuzhiyun 	return &ksii.pub;
274*4882a593Smuzhiyun }
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun static bool
si_buscore_prep(si_info_t * sii,uint bustype,uint devid,void * sdh)277*4882a593Smuzhiyun si_buscore_prep(si_info_t *sii, uint bustype, uint devid, void *sdh)
278*4882a593Smuzhiyun {
279*4882a593Smuzhiyun 	BCM_REFERENCE(sdh);
280*4882a593Smuzhiyun 	BCM_REFERENCE(devid);
281*4882a593Smuzhiyun 	/* need to set memseg flag for CF card first before any sb registers access */
282*4882a593Smuzhiyun 	if (BUSTYPE(bustype) == PCMCIA_BUS)
283*4882a593Smuzhiyun 		sii->memseg = TRUE;
284*4882a593Smuzhiyun 
285*4882a593Smuzhiyun #if defined(BCMSDIO) && !defined(BCMSDIOLITE)
286*4882a593Smuzhiyun 	if (BUSTYPE(bustype) == SDIO_BUS) {
287*4882a593Smuzhiyun 		int err;
288*4882a593Smuzhiyun 		uint8 clkset;
289*4882a593Smuzhiyun 
290*4882a593Smuzhiyun 		/* Try forcing SDIO core to do ALPAvail request only */
291*4882a593Smuzhiyun 		clkset = SBSDIO_FORCE_HW_CLKREQ_OFF | SBSDIO_ALP_AVAIL_REQ;
292*4882a593Smuzhiyun 		bcmsdh_cfg_write(sdh, SDIO_FUNC_1, SBSDIO_FUNC1_CHIPCLKCSR, clkset, &err);
293*4882a593Smuzhiyun 		if (!err) {
294*4882a593Smuzhiyun 			uint8 clkval;
295*4882a593Smuzhiyun 
296*4882a593Smuzhiyun 			/* If register supported, wait for ALPAvail and then force ALP */
297*4882a593Smuzhiyun 			clkval = bcmsdh_cfg_read(sdh, SDIO_FUNC_1, SBSDIO_FUNC1_CHIPCLKCSR, NULL);
298*4882a593Smuzhiyun 			if ((clkval & ~SBSDIO_AVBITS) == clkset) {
299*4882a593Smuzhiyun 				SPINWAIT(((clkval = bcmsdh_cfg_read(sdh, SDIO_FUNC_1,
300*4882a593Smuzhiyun 					SBSDIO_FUNC1_CHIPCLKCSR, NULL)), !SBSDIO_ALPAV(clkval)),
301*4882a593Smuzhiyun 					PMU_MAX_TRANSITION_DLY);
302*4882a593Smuzhiyun 				if (!SBSDIO_ALPAV(clkval)) {
303*4882a593Smuzhiyun 					SI_ERROR(("timeout on ALPAV wait, clkval 0x%02x\n",
304*4882a593Smuzhiyun 						clkval));
305*4882a593Smuzhiyun 					return FALSE;
306*4882a593Smuzhiyun 				}
307*4882a593Smuzhiyun 				clkset = SBSDIO_FORCE_HW_CLKREQ_OFF | SBSDIO_FORCE_ALP;
308*4882a593Smuzhiyun 				bcmsdh_cfg_write(sdh, SDIO_FUNC_1, SBSDIO_FUNC1_CHIPCLKCSR,
309*4882a593Smuzhiyun 					clkset, &err);
310*4882a593Smuzhiyun 				OSL_DELAY(65);
311*4882a593Smuzhiyun 			}
312*4882a593Smuzhiyun 		}
313*4882a593Smuzhiyun 
314*4882a593Smuzhiyun 		/* Also, disable the extra SDIO pull-ups */
315*4882a593Smuzhiyun 		bcmsdh_cfg_write(sdh, SDIO_FUNC_1, SBSDIO_FUNC1_SDIOPULLUP, 0, NULL);
316*4882a593Smuzhiyun 	}
317*4882a593Smuzhiyun 
318*4882a593Smuzhiyun #ifdef BCMSPI
319*4882a593Smuzhiyun 	/* Avoid backplane accesses before wake-wlan (i.e. htavail) for spi.
320*4882a593Smuzhiyun 	 * F1 read accesses may return correct data but with data-not-available dstatus bit set.
321*4882a593Smuzhiyun 	 */
322*4882a593Smuzhiyun 	if (BUSTYPE(bustype) == SPI_BUS) {
323*4882a593Smuzhiyun 
324*4882a593Smuzhiyun 		int err;
325*4882a593Smuzhiyun 		uint32 regdata;
326*4882a593Smuzhiyun 		/* wake up wlan function :WAKE_UP goes as HT_AVAIL request in hardware */
327*4882a593Smuzhiyun 		regdata = bcmsdh_cfg_read_word(sdh, SDIO_FUNC_0, SPID_CONFIG, NULL);
328*4882a593Smuzhiyun 		SI_MSG(("F0 REG0 rd = 0x%x\n", regdata));
329*4882a593Smuzhiyun 		regdata |= WAKE_UP;
330*4882a593Smuzhiyun 
331*4882a593Smuzhiyun 		bcmsdh_cfg_write_word(sdh, SDIO_FUNC_0, SPID_CONFIG, regdata, &err);
332*4882a593Smuzhiyun 
333*4882a593Smuzhiyun 		OSL_DELAY(100000);
334*4882a593Smuzhiyun 	}
335*4882a593Smuzhiyun #endif /* BCMSPI */
336*4882a593Smuzhiyun #endif /* BCMSDIO && BCMDONGLEHOST && !BCMSDIOLITE */
337*4882a593Smuzhiyun 
338*4882a593Smuzhiyun 	return TRUE;
339*4882a593Smuzhiyun }
340*4882a593Smuzhiyun 
341*4882a593Smuzhiyun uint32
si_get_pmu_reg_addr(si_t * sih,uint32 offset)342*4882a593Smuzhiyun si_get_pmu_reg_addr(si_t *sih, uint32 offset)
343*4882a593Smuzhiyun {
344*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
345*4882a593Smuzhiyun 	uint32 pmuaddr = INVALID_ADDR;
346*4882a593Smuzhiyun 	uint origidx = 0;
347*4882a593Smuzhiyun 
348*4882a593Smuzhiyun 	SI_MSG(("%s: pmu access, offset: %x\n", __FUNCTION__, offset));
349*4882a593Smuzhiyun 	if (!(sii->pub.cccaps & CC_CAP_PMU)) {
350*4882a593Smuzhiyun 		goto done;
351*4882a593Smuzhiyun 	}
352*4882a593Smuzhiyun 	if (AOB_ENAB(&sii->pub)) {
353*4882a593Smuzhiyun 		uint pmucoreidx;
354*4882a593Smuzhiyun 		pmuregs_t *pmu;
355*4882a593Smuzhiyun 		SI_MSG(("%s: AOBENAB: %x\n", __FUNCTION__, offset));
356*4882a593Smuzhiyun 		origidx = sii->curidx;
357*4882a593Smuzhiyun 		pmucoreidx = si_findcoreidx(&sii->pub, PMU_CORE_ID, 0);
358*4882a593Smuzhiyun 		pmu = si_setcoreidx(&sii->pub, pmucoreidx);
359*4882a593Smuzhiyun 		pmuaddr = (uint32)(uintptr)((volatile uint8*)pmu + offset);
360*4882a593Smuzhiyun 		si_setcoreidx(sih, origidx);
361*4882a593Smuzhiyun 	} else
362*4882a593Smuzhiyun 		pmuaddr = SI_ENUM_BASE(sih) + offset;
363*4882a593Smuzhiyun 
364*4882a593Smuzhiyun done:
365*4882a593Smuzhiyun 	printf("%s: addrRET: %x\n", __FUNCTION__, pmuaddr);
366*4882a593Smuzhiyun 	return pmuaddr;
367*4882a593Smuzhiyun }
368*4882a593Smuzhiyun 
369*4882a593Smuzhiyun static bool
si_buscore_setup(si_info_t * sii,chipcregs_t * cc,uint bustype,uint32 savewin,uint * origidx,volatile void * regs)370*4882a593Smuzhiyun si_buscore_setup(si_info_t *sii, chipcregs_t *cc, uint bustype, uint32 savewin,
371*4882a593Smuzhiyun 	uint *origidx, volatile void *regs)
372*4882a593Smuzhiyun {
373*4882a593Smuzhiyun 	si_cores_info_t *cores_info = (si_cores_info_t *)sii->cores_info;
374*4882a593Smuzhiyun 	bool pci, pcie, pcie_gen2 = FALSE;
375*4882a593Smuzhiyun 	uint i;
376*4882a593Smuzhiyun 	uint pciidx, pcieidx, pcirev, pcierev;
377*4882a593Smuzhiyun 	struct si_pub *sih = &sii->pub;
378*4882a593Smuzhiyun 
379*4882a593Smuzhiyun #if defined(BCM_BACKPLANE_TIMEOUT) || defined(AXI_TIMEOUTS)
380*4882a593Smuzhiyun 	/* first, enable backplane timeouts */
381*4882a593Smuzhiyun 	si_slave_wrapper_add(&sii->pub);
382*4882a593Smuzhiyun #endif // endif
383*4882a593Smuzhiyun 	sii->curidx = 0;
384*4882a593Smuzhiyun 
385*4882a593Smuzhiyun 	cc = si_setcoreidx(&sii->pub, SI_CC_IDX);
386*4882a593Smuzhiyun 	ASSERT((uintptr)cc);
387*4882a593Smuzhiyun 
388*4882a593Smuzhiyun 	/* get chipcommon rev */
389*4882a593Smuzhiyun 	sii->pub.ccrev = (int)si_corerev(&sii->pub);
390*4882a593Smuzhiyun 
391*4882a593Smuzhiyun 	/* get chipcommon chipstatus */
392*4882a593Smuzhiyun 	if (CCREV(sii->pub.ccrev) >= 11) {
393*4882a593Smuzhiyun 		/* TODO : We need a better approach to avoid this access in secure mode chips */
394*4882a593Smuzhiyun 		if (sii->pub.chip != CYW55500_CHIP_ID &&
395*4882a593Smuzhiyun 		    sii->pub.chip != CYW55560_CHIP_ID) {
396*4882a593Smuzhiyun 			sii->pub.chipst = R_REG(sii->osh, &cc->chipstatus);
397*4882a593Smuzhiyun 		}
398*4882a593Smuzhiyun 	}
399*4882a593Smuzhiyun 
400*4882a593Smuzhiyun 	if (!sih->chipidpresent) {
401*4882a593Smuzhiyun 		/* get chipcommon capabilites */
402*4882a593Smuzhiyun 		sii->pub.cccaps = R_REG(sii->osh, &cc->capabilities);
403*4882a593Smuzhiyun 		/* get chipcommon extended capabilities */
404*4882a593Smuzhiyun 		if (CCREV(sii->pub.ccrev) >= 35)
405*4882a593Smuzhiyun 			sii->pub.cccaps_ext = R_REG(sii->osh, &cc->capabilities_ext);
406*4882a593Smuzhiyun 
407*4882a593Smuzhiyun 		/* get pmu rev and caps */
408*4882a593Smuzhiyun 		if (sii->pub.cccaps & CC_CAP_PMU) {
409*4882a593Smuzhiyun 			if (AOB_ENAB(&sii->pub)) {
410*4882a593Smuzhiyun 				uint pmucoreidx;
411*4882a593Smuzhiyun 				pmuregs_t *pmu;
412*4882a593Smuzhiyun 				struct si_pub *sih = &sii->pub;
413*4882a593Smuzhiyun 
414*4882a593Smuzhiyun 				pmucoreidx = si_findcoreidx(&sii->pub, PMU_CORE_ID, 0);
415*4882a593Smuzhiyun 				if (!GOODIDX(pmucoreidx)) {
416*4882a593Smuzhiyun 					SI_ERROR(("si_buscore_setup: si_findcoreidx failed\n"));
417*4882a593Smuzhiyun 					return FALSE;
418*4882a593Smuzhiyun 				}
419*4882a593Smuzhiyun 
420*4882a593Smuzhiyun 				pmu = si_setcoreidx(&sii->pub, pmucoreidx);
421*4882a593Smuzhiyun 				sii->pub.pmucaps = R_REG(sii->osh, &pmu->pmucapabilities);
422*4882a593Smuzhiyun 				si_setcoreidx(&sii->pub, SI_CC_IDX);
423*4882a593Smuzhiyun 
424*4882a593Smuzhiyun 				sii->pub.gcirev = si_corereg(sih, GCI_CORE_IDX(sih),
425*4882a593Smuzhiyun 						GCI_OFFSETOF(sih, gci_corecaps0), 0, 0) &
426*4882a593Smuzhiyun 						GCI_CAP0_REV_MASK;
427*4882a593Smuzhiyun 			} else
428*4882a593Smuzhiyun 				sii->pub.pmucaps = R_REG(sii->osh, &cc->pmucapabilities);
429*4882a593Smuzhiyun 
430*4882a593Smuzhiyun 			sii->pub.pmurev = sii->pub.pmucaps & PCAP_REV_MASK;
431*4882a593Smuzhiyun 		}
432*4882a593Smuzhiyun 	}
433*4882a593Smuzhiyun 
434*4882a593Smuzhiyun 	SI_MSG(("Chipc: rev %d, caps 0x%x, chipst 0x%x pmurev %d, pmucaps 0x%x\n",
435*4882a593Smuzhiyun 		CCREV(sii->pub.ccrev), sii->pub.cccaps, sii->pub.chipst, sii->pub.pmurev,
436*4882a593Smuzhiyun 		sii->pub.pmucaps));
437*4882a593Smuzhiyun 
438*4882a593Smuzhiyun 	/* figure out bus/orignal core idx */
439*4882a593Smuzhiyun 	sii->pub.buscoretype = NODEV_CORE_ID;
440*4882a593Smuzhiyun 	sii->pub.buscorerev = (uint)NOREV;
441*4882a593Smuzhiyun 	sii->pub.buscoreidx = BADIDX;
442*4882a593Smuzhiyun 
443*4882a593Smuzhiyun 	pci = pcie = FALSE;
444*4882a593Smuzhiyun 	pcirev = pcierev = (uint)NOREV;
445*4882a593Smuzhiyun 	pciidx = pcieidx = BADIDX;
446*4882a593Smuzhiyun 
447*4882a593Smuzhiyun 	for (i = 0; i < sii->numcores; i++) {
448*4882a593Smuzhiyun 		uint cid, crev;
449*4882a593Smuzhiyun 
450*4882a593Smuzhiyun 		si_setcoreidx(&sii->pub, i);
451*4882a593Smuzhiyun 		cid = si_coreid(&sii->pub);
452*4882a593Smuzhiyun 		crev = si_corerev(&sii->pub);
453*4882a593Smuzhiyun 
454*4882a593Smuzhiyun 		/* Display cores found */
455*4882a593Smuzhiyun 		SI_VMSG(("CORE[%d]: id 0x%x rev %d base 0x%x size:%x regs 0x%p\n",
456*4882a593Smuzhiyun 			i, cid, crev, sii->coresba[i], sii->coresba_size[i],
457*4882a593Smuzhiyun 			OSL_OBFUSCATE_BUF(sii->regs[i])));
458*4882a593Smuzhiyun 
459*4882a593Smuzhiyun 		if (BUSTYPE(bustype) == SI_BUS) {
460*4882a593Smuzhiyun 			/* now look at the chipstatus register to figure the pacakge */
461*4882a593Smuzhiyun 			/* for SDIO but downloaded on PCIE dev */
462*4882a593Smuzhiyun #ifdef BCMPCIEDEV_ENABLED
463*4882a593Smuzhiyun 			if (cid == PCIE2_CORE_ID) {
464*4882a593Smuzhiyun 					pcieidx = i;
465*4882a593Smuzhiyun 					pcierev = crev;
466*4882a593Smuzhiyun 					pcie = TRUE;
467*4882a593Smuzhiyun 					pcie_gen2 = TRUE;
468*4882a593Smuzhiyun 			}
469*4882a593Smuzhiyun #endif // endif
470*4882a593Smuzhiyun 
471*4882a593Smuzhiyun 		} else if (BUSTYPE(bustype) == PCI_BUS) {
472*4882a593Smuzhiyun 			if (cid == PCI_CORE_ID) {
473*4882a593Smuzhiyun 				pciidx = i;
474*4882a593Smuzhiyun 				pcirev = crev;
475*4882a593Smuzhiyun 				pci = TRUE;
476*4882a593Smuzhiyun 			} else if ((cid == PCIE_CORE_ID) || (cid == PCIE2_CORE_ID)) {
477*4882a593Smuzhiyun 				pcieidx = i;
478*4882a593Smuzhiyun 				pcierev = crev;
479*4882a593Smuzhiyun 				pcie = TRUE;
480*4882a593Smuzhiyun 				if (cid == PCIE2_CORE_ID)
481*4882a593Smuzhiyun 					pcie_gen2 = TRUE;
482*4882a593Smuzhiyun 			}
483*4882a593Smuzhiyun 		} else if ((BUSTYPE(bustype) == PCMCIA_BUS) &&
484*4882a593Smuzhiyun 		           (cid == PCMCIA_CORE_ID)) {
485*4882a593Smuzhiyun 			sii->pub.buscorerev = crev;
486*4882a593Smuzhiyun 			sii->pub.buscoretype = cid;
487*4882a593Smuzhiyun 			sii->pub.buscoreidx = i;
488*4882a593Smuzhiyun 		}
489*4882a593Smuzhiyun #ifdef BCMSDIO
490*4882a593Smuzhiyun 		else if (((BUSTYPE(bustype) == SDIO_BUS) ||
491*4882a593Smuzhiyun 		          (BUSTYPE(bustype) == SPI_BUS)) &&
492*4882a593Smuzhiyun 		         ((cid == PCMCIA_CORE_ID) ||
493*4882a593Smuzhiyun 		          (cid == SDIOD_CORE_ID))) {
494*4882a593Smuzhiyun 			sii->pub.buscorerev = crev;
495*4882a593Smuzhiyun 			sii->pub.buscoretype = cid;
496*4882a593Smuzhiyun 			sii->pub.buscoreidx = i;
497*4882a593Smuzhiyun 		}
498*4882a593Smuzhiyun #endif /* BCMSDIO */
499*4882a593Smuzhiyun 
500*4882a593Smuzhiyun 		/* find the core idx before entering this func. */
501*4882a593Smuzhiyun 		if ((savewin && (savewin == cores_info->coresba[i])) ||
502*4882a593Smuzhiyun 		    (regs == cores_info->regs[i]))
503*4882a593Smuzhiyun 			*origidx = i;
504*4882a593Smuzhiyun 	}
505*4882a593Smuzhiyun 
506*4882a593Smuzhiyun #if defined(PCIE_FULL_DONGLE)
507*4882a593Smuzhiyun 	if (pcie) {
508*4882a593Smuzhiyun 		if (pcie_gen2)
509*4882a593Smuzhiyun 			sii->pub.buscoretype = PCIE2_CORE_ID;
510*4882a593Smuzhiyun 		else
511*4882a593Smuzhiyun 			sii->pub.buscoretype = PCIE_CORE_ID;
512*4882a593Smuzhiyun 		sii->pub.buscorerev = pcierev;
513*4882a593Smuzhiyun 		sii->pub.buscoreidx = pcieidx;
514*4882a593Smuzhiyun 	}
515*4882a593Smuzhiyun 	BCM_REFERENCE(pci);
516*4882a593Smuzhiyun 	BCM_REFERENCE(pcirev);
517*4882a593Smuzhiyun 	BCM_REFERENCE(pciidx);
518*4882a593Smuzhiyun #else
519*4882a593Smuzhiyun 	if (pci) {
520*4882a593Smuzhiyun 		sii->pub.buscoretype = PCI_CORE_ID;
521*4882a593Smuzhiyun 		sii->pub.buscorerev = pcirev;
522*4882a593Smuzhiyun 		sii->pub.buscoreidx = pciidx;
523*4882a593Smuzhiyun 	} else if (pcie) {
524*4882a593Smuzhiyun 		if (pcie_gen2)
525*4882a593Smuzhiyun 			sii->pub.buscoretype = PCIE2_CORE_ID;
526*4882a593Smuzhiyun 		else
527*4882a593Smuzhiyun 			sii->pub.buscoretype = PCIE_CORE_ID;
528*4882a593Smuzhiyun 		sii->pub.buscorerev = pcierev;
529*4882a593Smuzhiyun 		sii->pub.buscoreidx = pcieidx;
530*4882a593Smuzhiyun 	}
531*4882a593Smuzhiyun #endif /* defined(PCIE_FULL_DONGLE) */
532*4882a593Smuzhiyun 
533*4882a593Smuzhiyun 	SI_VMSG(("Buscore id/type/rev %d/0x%x/%d\n", sii->pub.buscoreidx, sii->pub.buscoretype,
534*4882a593Smuzhiyun 	         sii->pub.buscorerev));
535*4882a593Smuzhiyun 
536*4882a593Smuzhiyun #if defined(BCMSDIO)
537*4882a593Smuzhiyun 	/* Make sure any on-chip ARM is off (in case strapping is wrong), or downloaded code was
538*4882a593Smuzhiyun 	 * already running.
539*4882a593Smuzhiyun 	 */
540*4882a593Smuzhiyun 	if ((BUSTYPE(bustype) == SDIO_BUS) || (BUSTYPE(bustype) == SPI_BUS)) {
541*4882a593Smuzhiyun 		if (si_setcore(&sii->pub, ARM7S_CORE_ID, 0) ||
542*4882a593Smuzhiyun 		    si_setcore(&sii->pub, ARMCM3_CORE_ID, 0))
543*4882a593Smuzhiyun 			si_core_disable(&sii->pub, 0);
544*4882a593Smuzhiyun 	}
545*4882a593Smuzhiyun #endif /* BCMSDIO && BCMDONGLEHOST */
546*4882a593Smuzhiyun 
547*4882a593Smuzhiyun 	/* return to the original core */
548*4882a593Smuzhiyun 	si_setcoreidx(&sii->pub, *origidx);
549*4882a593Smuzhiyun 
550*4882a593Smuzhiyun 	return TRUE;
551*4882a593Smuzhiyun }
552*4882a593Smuzhiyun 
553*4882a593Smuzhiyun uint16
si_chipid(si_t * sih)554*4882a593Smuzhiyun si_chipid(si_t *sih)
555*4882a593Smuzhiyun {
556*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
557*4882a593Smuzhiyun 
558*4882a593Smuzhiyun 	return (sii->chipnew) ? sii->chipnew : sih->chip;
559*4882a593Smuzhiyun }
560*4882a593Smuzhiyun 
561*4882a593Smuzhiyun /* CHIP_ID's being mapped here should not be used anywhere else in the code */
562*4882a593Smuzhiyun static void
si_chipid_fixup(si_t * sih)563*4882a593Smuzhiyun si_chipid_fixup(si_t *sih)
564*4882a593Smuzhiyun {
565*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
566*4882a593Smuzhiyun 
567*4882a593Smuzhiyun 	ASSERT(sii->chipnew == 0);
568*4882a593Smuzhiyun 	switch (sih->chip) {
569*4882a593Smuzhiyun 		case BCM43567_CHIP_ID:
570*4882a593Smuzhiyun 			sii->chipnew = sih->chip; /* save it */
571*4882a593Smuzhiyun 			sii->pub.chip = BCM43570_CHIP_ID; /* chip class */
572*4882a593Smuzhiyun 		break;
573*4882a593Smuzhiyun 		case BCM43562_CHIP_ID:
574*4882a593Smuzhiyun 		case BCM4358_CHIP_ID:
575*4882a593Smuzhiyun 		case BCM43566_CHIP_ID:
576*4882a593Smuzhiyun 			sii->chipnew = sih->chip; /* save it */
577*4882a593Smuzhiyun 			sii->pub.chip = BCM43569_CHIP_ID; /* chip class */
578*4882a593Smuzhiyun 		break;
579*4882a593Smuzhiyun 		case BCM4356_CHIP_ID:
580*4882a593Smuzhiyun 		case BCM4371_CHIP_ID:
581*4882a593Smuzhiyun 			sii->chipnew = sih->chip; /* save it */
582*4882a593Smuzhiyun 			sii->pub.chip = BCM4354_CHIP_ID; /* chip class */
583*4882a593Smuzhiyun 		break;
584*4882a593Smuzhiyun 		case BCM4357_CHIP_ID:
585*4882a593Smuzhiyun 		case BCM4361_CHIP_ID:
586*4882a593Smuzhiyun 			sii->chipnew = sih->chip; /* save it */
587*4882a593Smuzhiyun 			sii->pub.chip = BCM4347_CHIP_ID; /* chip class */
588*4882a593Smuzhiyun 		break;
589*4882a593Smuzhiyun #ifdef CHIPS_CUSTOMER_HW6
590*4882a593Smuzhiyun 		case BCM4377_CHIP_ID:
591*4882a593Smuzhiyun 			sii->chipnew = sih->chip; /* save it */
592*4882a593Smuzhiyun 			sii->pub.chip = BCM4369_CHIP_ID; /* chip class */
593*4882a593Smuzhiyun 		break;
594*4882a593Smuzhiyun #endif /* CHIPS_CUSTOMER_HW6 */
595*4882a593Smuzhiyun 		default:
596*4882a593Smuzhiyun 		break;
597*4882a593Smuzhiyun 	}
598*4882a593Smuzhiyun }
599*4882a593Smuzhiyun 
600*4882a593Smuzhiyun #ifdef BCMULP
601*4882a593Smuzhiyun static void
si_check_boot_type(si_t * sih,osl_t * osh)602*4882a593Smuzhiyun si_check_boot_type(si_t *sih, osl_t *osh)
603*4882a593Smuzhiyun {
604*4882a593Smuzhiyun 	if (sih->pmurev >= 30) {
605*4882a593Smuzhiyun 		boot_type = PMU_REG_NEW(sih, swscratch, 0, 0);
606*4882a593Smuzhiyun 	} else {
607*4882a593Smuzhiyun 		boot_type = CHIPC_REG(sih, flashdata, 0, 0);
608*4882a593Smuzhiyun 	}
609*4882a593Smuzhiyun 
610*4882a593Smuzhiyun 	SI_ERROR(("%s: boot_type: 0x%08x\n", __func__, boot_type));
611*4882a593Smuzhiyun }
612*4882a593Smuzhiyun #endif /* BCMULP */
613*4882a593Smuzhiyun 
614*4882a593Smuzhiyun #ifdef BCM_BACKPLANE_TIMEOUT
615*4882a593Smuzhiyun uint32
si_clear_backplane_to_fast(void * sih,void * addr)616*4882a593Smuzhiyun si_clear_backplane_to_fast(void *sih, void *addr)
617*4882a593Smuzhiyun {
618*4882a593Smuzhiyun 	si_t *_sih = DISCARD_QUAL(sih, si_t);
619*4882a593Smuzhiyun 
620*4882a593Smuzhiyun 	if (CHIPTYPE(_sih->socitype) == SOCI_AI) {
621*4882a593Smuzhiyun 		return ai_clear_backplane_to_fast(_sih, addr);
622*4882a593Smuzhiyun 	}
623*4882a593Smuzhiyun 
624*4882a593Smuzhiyun 	return 0;
625*4882a593Smuzhiyun }
626*4882a593Smuzhiyun 
627*4882a593Smuzhiyun const si_axi_error_info_t *
si_get_axi_errlog_info(si_t * sih)628*4882a593Smuzhiyun si_get_axi_errlog_info(si_t *sih)
629*4882a593Smuzhiyun {
630*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_AI) {
631*4882a593Smuzhiyun 		return (const si_axi_error_info_t *)sih->err_info;
632*4882a593Smuzhiyun 	}
633*4882a593Smuzhiyun 
634*4882a593Smuzhiyun 	return NULL;
635*4882a593Smuzhiyun }
636*4882a593Smuzhiyun 
637*4882a593Smuzhiyun void
si_reset_axi_errlog_info(si_t * sih)638*4882a593Smuzhiyun si_reset_axi_errlog_info(si_t *sih)
639*4882a593Smuzhiyun {
640*4882a593Smuzhiyun 	if (sih->err_info) {
641*4882a593Smuzhiyun 		sih->err_info->count = 0;
642*4882a593Smuzhiyun 	}
643*4882a593Smuzhiyun }
644*4882a593Smuzhiyun #endif /* BCM_BACKPLANE_TIMEOUT */
645*4882a593Smuzhiyun 
646*4882a593Smuzhiyun #ifdef BCMSDIO
647*4882a593Smuzhiyun void *
si_get_sdio_addrbase(void * sdh)648*4882a593Smuzhiyun si_get_sdio_addrbase(void *sdh)
649*4882a593Smuzhiyun {
650*4882a593Smuzhiyun 	uint8 devctl;
651*4882a593Smuzhiyun 	int err = 0;
652*4882a593Smuzhiyun 	uint32 addr = 0;
653*4882a593Smuzhiyun 
654*4882a593Smuzhiyun 	devctl = bcmsdh_cfg_read(sdh, SDIO_FUNC_1, SBSDIO_DEVICE_CTL, &err);
655*4882a593Smuzhiyun 	if (err)
656*4882a593Smuzhiyun 		return NULL;
657*4882a593Smuzhiyun 
658*4882a593Smuzhiyun 	bcmsdh_cfg_write(sdh, SDIO_FUNC_1,
659*4882a593Smuzhiyun 			SBSDIO_DEVICE_CTL, devctl | SBSDIO_DEVCTL_ADDR_RESET, &err);
660*4882a593Smuzhiyun 	if (err)
661*4882a593Smuzhiyun 		goto exit;
662*4882a593Smuzhiyun 
663*4882a593Smuzhiyun 	addr |= (bcmsdh_cfg_read(sdh, SDIO_FUNC_1, SBSDIO_FUNC1_SBADDRLOW, NULL) << 8) |
664*4882a593Smuzhiyun 		(bcmsdh_cfg_read(sdh, SDIO_FUNC_1, SBSDIO_FUNC1_SBADDRMID, NULL) << 16) |
665*4882a593Smuzhiyun 		(bcmsdh_cfg_read(sdh, SDIO_FUNC_1, SBSDIO_FUNC1_SBADDRHIGH, NULL) << 24);
666*4882a593Smuzhiyun 
667*4882a593Smuzhiyun 	SI_MSG(("%s: sdiod core address is 0x%x\n", __FUNCTION__, addr));
668*4882a593Smuzhiyun exit:
669*4882a593Smuzhiyun 	if (err) {
670*4882a593Smuzhiyun 		SI_ERROR(("%s: Get SDIO core base address failed, err=%d", __FUNCTION__, err));
671*4882a593Smuzhiyun 		addr = 0;
672*4882a593Smuzhiyun 	}
673*4882a593Smuzhiyun 	bcmsdh_cfg_write(sdh, SDIO_FUNC_1, SBSDIO_DEVICE_CTL, devctl, &err);
674*4882a593Smuzhiyun 
675*4882a593Smuzhiyun 	return (void *)((uintptr)addr);
676*4882a593Smuzhiyun }
677*4882a593Smuzhiyun #endif /* BCMSDIO */
678*4882a593Smuzhiyun 
679*4882a593Smuzhiyun /**
680*4882a593Smuzhiyun  * Allocate an si handle. This function may be called multiple times. This function is called by
681*4882a593Smuzhiyun  * both si_attach() and si_kattach().
682*4882a593Smuzhiyun  *
683*4882a593Smuzhiyun  * vars - pointer to a to-be created pointer area for "environment" variables. Some callers of this
684*4882a593Smuzhiyun  *        function set 'vars' to NULL.
685*4882a593Smuzhiyun  */
686*4882a593Smuzhiyun static si_info_t *
si_doattach(si_info_t * sii,uint devid,osl_t * osh,volatile void * regs,uint bustype,void * sdh,char ** vars,uint * varsz)687*4882a593Smuzhiyun si_doattach(si_info_t *sii, uint devid, osl_t *osh, volatile void *regs,
688*4882a593Smuzhiyun                        uint bustype, void *sdh, char **vars, uint *varsz)
689*4882a593Smuzhiyun {
690*4882a593Smuzhiyun 	struct si_pub *sih = &sii->pub;
691*4882a593Smuzhiyun 	uint32 w = 0;
692*4882a593Smuzhiyun 	uint32 savewin;
693*4882a593Smuzhiyun 	chipcregs_t *cc;
694*4882a593Smuzhiyun 	char *pvars = NULL;
695*4882a593Smuzhiyun 	uint origidx;
696*4882a593Smuzhiyun #ifdef NVSRCX
697*4882a593Smuzhiyun 	char *sromvars;
698*4882a593Smuzhiyun #endif // endif
699*4882a593Smuzhiyun 	uint32 erombase;
700*4882a593Smuzhiyun #ifdef BCMSDIO
701*4882a593Smuzhiyun 	uint8 cardcap;
702*4882a593Smuzhiyun 	sdpcmd_regs_t *sdioc;
703*4882a593Smuzhiyun #endif // endif
704*4882a593Smuzhiyun 
705*4882a593Smuzhiyun 	ASSERT(GOODREGS(regs));
706*4882a593Smuzhiyun 
707*4882a593Smuzhiyun 	savewin = 0;
708*4882a593Smuzhiyun 
709*4882a593Smuzhiyun 	sih->buscoreidx = BADIDX;
710*4882a593Smuzhiyun 	sii->device_removed = FALSE;
711*4882a593Smuzhiyun 
712*4882a593Smuzhiyun 	sii->curmap = regs;
713*4882a593Smuzhiyun 	sii->sdh = sdh;
714*4882a593Smuzhiyun 	sii->osh = osh;
715*4882a593Smuzhiyun 	sii->second_bar0win = ~0x0;
716*4882a593Smuzhiyun 	sih->enum_base = si_enum_base(devid);
717*4882a593Smuzhiyun 
718*4882a593Smuzhiyun #if defined(BCM_BACKPLANE_TIMEOUT)
719*4882a593Smuzhiyun 	sih->err_info = MALLOCZ(osh, sizeof(si_axi_error_info_t));
720*4882a593Smuzhiyun 	if (sih->err_info == NULL) {
721*4882a593Smuzhiyun 		SI_ERROR(("%s: %zu bytes MALLOC FAILED",
722*4882a593Smuzhiyun 			__FUNCTION__, sizeof(si_axi_error_info_t)));
723*4882a593Smuzhiyun 	}
724*4882a593Smuzhiyun #endif /* BCM_BACKPLANE_TIMEOUT */
725*4882a593Smuzhiyun 
726*4882a593Smuzhiyun #if defined(BCM_BACKPLANE_TIMEOUT)
727*4882a593Smuzhiyun 	osl_set_bpt_cb(osh, (void *)si_clear_backplane_to_fast, (void *)sih);
728*4882a593Smuzhiyun #endif // endif
729*4882a593Smuzhiyun 
730*4882a593Smuzhiyun 	/* check to see if we are a si core mimic'ing a pci core */
731*4882a593Smuzhiyun 	if ((bustype == PCI_BUS) &&
732*4882a593Smuzhiyun 	    (OSL_PCI_READ_CONFIG(sii->osh, PCI_SPROM_CONTROL, sizeof(uint32)) == 0xffffffff)) {
733*4882a593Smuzhiyun 		SI_ERROR(("%s: incoming bus is PCI but it's a lie, switching to SI "
734*4882a593Smuzhiyun 		          "devid:0x%x\n", __FUNCTION__, devid));
735*4882a593Smuzhiyun 		bustype = SI_BUS;
736*4882a593Smuzhiyun 	}
737*4882a593Smuzhiyun 
738*4882a593Smuzhiyun 	/* find Chipcommon address */
739*4882a593Smuzhiyun 	if (bustype == PCI_BUS) {
740*4882a593Smuzhiyun 		savewin = OSL_PCI_READ_CONFIG(sii->osh, PCI_BAR0_WIN, sizeof(uint32));
741*4882a593Smuzhiyun 		if (!GOODCOREADDR(savewin, SI_ENUM_BASE(sih)))
742*4882a593Smuzhiyun 			savewin = SI_ENUM_BASE(sih);
743*4882a593Smuzhiyun 		OSL_PCI_WRITE_CONFIG(sii->osh, PCI_BAR0_WIN, 4, SI_ENUM_BASE(sih));
744*4882a593Smuzhiyun 		if (!regs)
745*4882a593Smuzhiyun 			return NULL;
746*4882a593Smuzhiyun 		cc = (chipcregs_t *)regs;
747*4882a593Smuzhiyun 		erombase = R_REG(osh, &cc->eromptr);
748*4882a593Smuzhiyun #ifdef BCMSDIO
749*4882a593Smuzhiyun 	} else if ((bustype == SDIO_BUS) || (bustype == SPI_BUS)) {
750*4882a593Smuzhiyun 		cc = (chipcregs_t *)sii->curmap;
751*4882a593Smuzhiyun 		cardcap = bcmsdh_cfg_read(sdh, SDIO_FUNC_0, SDIOD_CCCR_BRCM_CARDCAP, NULL);
752*4882a593Smuzhiyun 		if (cardcap & SDIOD_CCCR_BRCM_CARDCAP_CHIPID_PRESENT) {
753*4882a593Smuzhiyun 			sih->chipidpresent = TRUE;
754*4882a593Smuzhiyun 			sdioc = si_get_sdio_addrbase(sdh);
755*4882a593Smuzhiyun 			w = R_REG(osh, &sdioc->chipid);
756*4882a593Smuzhiyun 			erombase = R_REG(osh, &sdioc->eromptr);
757*4882a593Smuzhiyun 		} else {
758*4882a593Smuzhiyun 			erombase = R_REG(osh, &cc->eromptr);
759*4882a593Smuzhiyun 		}
760*4882a593Smuzhiyun 		if (cardcap & SDIOD_CCCR_BRCM_CARDCAP_SECURE_MODE) {
761*4882a593Smuzhiyun 			sih->secureboot = TRUE;
762*4882a593Smuzhiyun 		}
763*4882a593Smuzhiyun #endif // endif
764*4882a593Smuzhiyun 	} else {
765*4882a593Smuzhiyun 		cc = (chipcregs_t *)REG_MAP(SI_ENUM_BASE(sih), SI_CORE_SIZE);
766*4882a593Smuzhiyun 		erombase = R_REG(osh, &cc->eromptr);
767*4882a593Smuzhiyun 	}
768*4882a593Smuzhiyun 
769*4882a593Smuzhiyun 	sih->bustype = bustype;
770*4882a593Smuzhiyun #ifdef BCMBUSTYPE
771*4882a593Smuzhiyun 	if (bustype != BUSTYPE(bustype)) {
772*4882a593Smuzhiyun 		SI_ERROR(("si_doattach: bus type %d does not match configured bus type %d\n",
773*4882a593Smuzhiyun 			bustype, BUSTYPE(bustype)));
774*4882a593Smuzhiyun 		return NULL;
775*4882a593Smuzhiyun 	}
776*4882a593Smuzhiyun #endif // endif
777*4882a593Smuzhiyun 
778*4882a593Smuzhiyun 	/* bus/core/clk setup for register access */
779*4882a593Smuzhiyun 	if (!si_buscore_prep(sii, bustype, devid, sdh)) {
780*4882a593Smuzhiyun 		SI_ERROR(("si_doattach: si_core_clk_prep failed %d\n", bustype));
781*4882a593Smuzhiyun 		return NULL;
782*4882a593Smuzhiyun 	}
783*4882a593Smuzhiyun 
784*4882a593Smuzhiyun 	/* ChipID recognition.
785*4882a593Smuzhiyun 	*   We assume we can read chipid at offset 0 from the regs arg.
786*4882a593Smuzhiyun 	*   If we add other chiptypes (or if we need to support old sdio hosts w/o chipcommon),
787*4882a593Smuzhiyun 	*   some way of recognizing them needs to be added here.
788*4882a593Smuzhiyun 	*/
789*4882a593Smuzhiyun 	if (!cc) {
790*4882a593Smuzhiyun 		SI_ERROR(("%s: chipcommon register space is null \n", __FUNCTION__));
791*4882a593Smuzhiyun 		return NULL;
792*4882a593Smuzhiyun 	}
793*4882a593Smuzhiyun 	if (!w)
794*4882a593Smuzhiyun 		w = R_REG(osh, &cc->chipid);
795*4882a593Smuzhiyun 	if ((w & 0xfffff) == 148277) w -= 65532;
796*4882a593Smuzhiyun 	sih->socitype = (w & CID_TYPE_MASK) >> CID_TYPE_SHIFT;
797*4882a593Smuzhiyun 	/* Might as wll fill in chip id rev & pkg */
798*4882a593Smuzhiyun 	sih->chip = w & CID_ID_MASK;
799*4882a593Smuzhiyun 	sih->chiprev = (w & CID_REV_MASK) >> CID_REV_SHIFT;
800*4882a593Smuzhiyun 	sih->chippkg = (w & CID_PKG_MASK) >> CID_PKG_SHIFT;
801*4882a593Smuzhiyun 
802*4882a593Smuzhiyun 	si_chipid_fixup(sih);
803*4882a593Smuzhiyun 
804*4882a593Smuzhiyun 	if (CHIPID(sih->chip) == BCM43465_CHIP_ID) {
805*4882a593Smuzhiyun 		sih->chip = BCM4366_CHIP_ID;
806*4882a593Smuzhiyun 	} else if (CHIPID(sih->chip) == BCM43525_CHIP_ID) {
807*4882a593Smuzhiyun 		sih->chip = BCM4365_CHIP_ID;
808*4882a593Smuzhiyun 	}
809*4882a593Smuzhiyun 
810*4882a593Smuzhiyun 	sih->issim = IS_SIM(sih->chippkg);
811*4882a593Smuzhiyun 
812*4882a593Smuzhiyun #ifdef CHIPS_CUSTOMER_HW6
813*4882a593Smuzhiyun 	if (MULTIBP_CAP(sih))
814*4882a593Smuzhiyun 	{
815*4882a593Smuzhiyun 		sih->_multibp_enable = TRUE;
816*4882a593Smuzhiyun 	}
817*4882a593Smuzhiyun #endif // endif
818*4882a593Smuzhiyun 
819*4882a593Smuzhiyun 	/* scan for cores */
820*4882a593Smuzhiyun 	if (CHIPTYPE(sii->pub.socitype) == SOCI_SB) {
821*4882a593Smuzhiyun 		SI_MSG(("Found chip type SB (0x%08x)\n", w));
822*4882a593Smuzhiyun 		sb_scan(&sii->pub, regs, devid);
823*4882a593Smuzhiyun 	} else if ((CHIPTYPE(sii->pub.socitype) == SOCI_AI) ||
824*4882a593Smuzhiyun 		(CHIPTYPE(sii->pub.socitype) == SOCI_NAI) ||
825*4882a593Smuzhiyun 		(CHIPTYPE(sii->pub.socitype) == SOCI_DVTBUS)) {
826*4882a593Smuzhiyun 
827*4882a593Smuzhiyun 		if (CHIPTYPE(sii->pub.socitype) == SOCI_AI)
828*4882a593Smuzhiyun 			SI_MSG(("Found chip type AI (0x%08x)\n", w));
829*4882a593Smuzhiyun 		else if (CHIPTYPE(sii->pub.socitype) == SOCI_NAI)
830*4882a593Smuzhiyun 			SI_MSG(("Found chip type NAI (0x%08x)\n", w));
831*4882a593Smuzhiyun 		else
832*4882a593Smuzhiyun 			SI_MSG(("Found chip type DVT (0x%08x)\n", w));
833*4882a593Smuzhiyun 		/* pass chipc address instead of original core base */
834*4882a593Smuzhiyun 
835*4882a593Smuzhiyun 		if (sii->osh) {
836*4882a593Smuzhiyun 			sii->axi_wrapper = (axi_wrapper_t *)MALLOCZ(sii->osh,
837*4882a593Smuzhiyun 				(sizeof(axi_wrapper_t) * SI_MAX_AXI_WRAPPERS));
838*4882a593Smuzhiyun 
839*4882a593Smuzhiyun 			if (sii->axi_wrapper == NULL) {
840*4882a593Smuzhiyun 				SI_ERROR(("%s: %zu  bytes MALLOC Failed", __FUNCTION__,
841*4882a593Smuzhiyun 					(sizeof(axi_wrapper_t) * SI_MAX_AXI_WRAPPERS)));
842*4882a593Smuzhiyun 			}
843*4882a593Smuzhiyun 		} else {
844*4882a593Smuzhiyun 			sii->axi_wrapper = NULL;
845*4882a593Smuzhiyun 		}
846*4882a593Smuzhiyun 
847*4882a593Smuzhiyun 		ai_scan(&sii->pub, (void *)(uintptr)cc, erombase,  devid);
848*4882a593Smuzhiyun 	} else if (CHIPTYPE(sii->pub.socitype) == SOCI_UBUS) {
849*4882a593Smuzhiyun 		SI_MSG(("Found chip type UBUS (0x%08x), chip id = 0x%4x\n", w, sih->chip));
850*4882a593Smuzhiyun 		/* pass chipc address instead of original core base */
851*4882a593Smuzhiyun 		ub_scan(&sii->pub, (void *)(uintptr)cc, devid);
852*4882a593Smuzhiyun 	} else {
853*4882a593Smuzhiyun 		SI_ERROR(("Found chip of unknown type (0x%08x)\n", w));
854*4882a593Smuzhiyun 		return NULL;
855*4882a593Smuzhiyun 	}
856*4882a593Smuzhiyun 	/* no cores found, bail out */
857*4882a593Smuzhiyun 	if (sii->numcores == 0) {
858*4882a593Smuzhiyun 		SI_ERROR(("si_doattach: could not find any cores\n"));
859*4882a593Smuzhiyun 		return NULL;
860*4882a593Smuzhiyun 	}
861*4882a593Smuzhiyun 	/* bus/core/clk setup */
862*4882a593Smuzhiyun 	origidx = SI_CC_IDX;
863*4882a593Smuzhiyun 	if (!si_buscore_setup(sii, cc, bustype, savewin, &origidx, regs)) {
864*4882a593Smuzhiyun 		SI_ERROR(("si_doattach: si_buscore_setup failed\n"));
865*4882a593Smuzhiyun 		goto exit;
866*4882a593Smuzhiyun 	}
867*4882a593Smuzhiyun #ifdef BCMULP
868*4882a593Smuzhiyun 	if (BCMULP_ENAB()) {
869*4882a593Smuzhiyun 		si_check_boot_type(sih, osh);
870*4882a593Smuzhiyun 		if (ulp_module_init(osh, sih) != BCME_OK) {
871*4882a593Smuzhiyun 			ULP_ERR(("%s: err in ulp_module_init\n", __FUNCTION__));
872*4882a593Smuzhiyun 			goto exit;
873*4882a593Smuzhiyun 		}
874*4882a593Smuzhiyun 	}
875*4882a593Smuzhiyun #endif /* BCMULP */
876*4882a593Smuzhiyun 
877*4882a593Smuzhiyun #if !defined(_CFEZ_) || defined(CFG_WL)
878*4882a593Smuzhiyun 	/* assume current core is CC */
879*4882a593Smuzhiyun 	if ((CCREV(sii->pub.ccrev) == 0x25) && ((CHIPID(sih->chip) == BCM43236_CHIP_ID ||
880*4882a593Smuzhiyun 	                                  CHIPID(sih->chip) == BCM43235_CHIP_ID ||
881*4882a593Smuzhiyun 	                                  CHIPID(sih->chip) == BCM43234_CHIP_ID ||
882*4882a593Smuzhiyun 	                                  CHIPID(sih->chip) == BCM43238_CHIP_ID) &&
883*4882a593Smuzhiyun 	                                 (CHIPREV(sii->pub.chiprev) <= 2))) {
884*4882a593Smuzhiyun 
885*4882a593Smuzhiyun 		if ((cc->chipstatus & CST43236_BP_CLK) != 0) {
886*4882a593Smuzhiyun 			uint clkdiv;
887*4882a593Smuzhiyun 			clkdiv = R_REG(osh, &cc->clkdiv);
888*4882a593Smuzhiyun 			/* otp_clk_div is even number, 120/14 < 9mhz */
889*4882a593Smuzhiyun 			clkdiv = (clkdiv & ~CLKD_OTP) | (14 << CLKD_OTP_SHIFT);
890*4882a593Smuzhiyun 			W_REG(osh, &cc->clkdiv, clkdiv);
891*4882a593Smuzhiyun 			SI_ERROR(("%s: set clkdiv to %x\n", __FUNCTION__, clkdiv));
892*4882a593Smuzhiyun 		}
893*4882a593Smuzhiyun 		OSL_DELAY(10);
894*4882a593Smuzhiyun 	}
895*4882a593Smuzhiyun 
896*4882a593Smuzhiyun 	/* Set the clkdiv2 divisor bits (2:0) to 0x4 if srom is present */
897*4882a593Smuzhiyun 	if (bustype == SI_BUS) {
898*4882a593Smuzhiyun 		uint32 clkdiv2, sromprsnt, capabilities, srom_supported;
899*4882a593Smuzhiyun 		capabilities =	R_REG(osh, &cc->capabilities);
900*4882a593Smuzhiyun 		srom_supported = capabilities & SROM_SUPPORTED;
901*4882a593Smuzhiyun 		if (srom_supported)
902*4882a593Smuzhiyun 		{
903*4882a593Smuzhiyun 			sromprsnt = R_REG(osh, &cc->sromcontrol);
904*4882a593Smuzhiyun 			sromprsnt = sromprsnt & SROM_PRSNT_MASK;
905*4882a593Smuzhiyun 			if (sromprsnt) {
906*4882a593Smuzhiyun 				/* SROM clock come from backplane clock/div2. Must <= 1Mhz */
907*4882a593Smuzhiyun 				clkdiv2 = (R_REG(osh, &cc->clkdiv2) & ~CLKD2_SROM);
908*4882a593Smuzhiyun 					clkdiv2 |= CLKD2_SROMDIV_192;
909*4882a593Smuzhiyun 				W_REG(osh, &cc->clkdiv2, clkdiv2);
910*4882a593Smuzhiyun 			}
911*4882a593Smuzhiyun 		}
912*4882a593Smuzhiyun 	}
913*4882a593Smuzhiyun 
914*4882a593Smuzhiyun 	if (bustype == PCI_BUS) {
915*4882a593Smuzhiyun 
916*4882a593Smuzhiyun #ifdef BCMQT
917*4882a593Smuzhiyun 		/* Set OTPClkDiv to smaller value otherwise OTP always reads 0xFFFF.
918*4882a593Smuzhiyun 		 * For real-chip we shouldn't set OTPClkDiv to 2 because 20/2 = 10 > 9Mhz
919*4882a593Smuzhiyun 		 */
920*4882a593Smuzhiyun 		{
921*4882a593Smuzhiyun 			uint otpclkdiv = 0;
922*4882a593Smuzhiyun 
923*4882a593Smuzhiyun 			if ((CHIPID(sih->chip) == BCM43131_CHIP_ID) ||
924*4882a593Smuzhiyun 				(CHIPID(sih->chip) == BCM43217_CHIP_ID)) {
925*4882a593Smuzhiyun 				otpclkdiv = 4;
926*4882a593Smuzhiyun 			}
927*4882a593Smuzhiyun 
928*4882a593Smuzhiyun 			if (otpclkdiv != 0) {
929*4882a593Smuzhiyun 				uint clkdiv, savecore;
930*4882a593Smuzhiyun 				savecore = si_coreidx(sih);
931*4882a593Smuzhiyun 				si_setcore(sih, CC_CORE_ID, 0);
932*4882a593Smuzhiyun 
933*4882a593Smuzhiyun 				clkdiv = R_REG(osh, &cc->clkdiv);
934*4882a593Smuzhiyun 				clkdiv = (clkdiv & ~CLKD_OTP) | (otpclkdiv << CLKD_OTP_SHIFT);
935*4882a593Smuzhiyun 				W_REG(osh, &cc->clkdiv, clkdiv);
936*4882a593Smuzhiyun 
937*4882a593Smuzhiyun 				SI_ERROR(("%s: set clkdiv to 0x%x for QT\n", __FUNCTION__, clkdiv));
938*4882a593Smuzhiyun 				si_setcoreidx(sih, savecore);
939*4882a593Smuzhiyun 			}
940*4882a593Smuzhiyun 		}
941*4882a593Smuzhiyun #endif /* BCMQT */
942*4882a593Smuzhiyun 	}
943*4882a593Smuzhiyun #endif // endif
944*4882a593Smuzhiyun #ifdef BCM_SDRBL
945*4882a593Smuzhiyun 	/* 4360 rom bootloader in PCIE case, if the SDR is enabled, But preotection is
946*4882a593Smuzhiyun 	 * not turned on, then we want to hold arm in reset.
947*4882a593Smuzhiyun 	 * Bottomline: In sdrenable case, we allow arm to boot only when protection is
948*4882a593Smuzhiyun 	 * turned on.
949*4882a593Smuzhiyun 	 */
950*4882a593Smuzhiyun 	if (CHIP_HOSTIF_PCIE(&(sii->pub))) {
951*4882a593Smuzhiyun 		uint32 sflags = si_arm_sflags(&(sii->pub));
952*4882a593Smuzhiyun 
953*4882a593Smuzhiyun 		/* If SDR is enabled but protection is not turned on
954*4882a593Smuzhiyun 		* then we want to force arm to WFI.
955*4882a593Smuzhiyun 		*/
956*4882a593Smuzhiyun 		if ((sflags & (SISF_SDRENABLE | SISF_TCMPROT)) == SISF_SDRENABLE) {
957*4882a593Smuzhiyun 			disable_arm_irq();
958*4882a593Smuzhiyun 			while (1) {
959*4882a593Smuzhiyun 				hnd_cpu_wait(sih);
960*4882a593Smuzhiyun 			}
961*4882a593Smuzhiyun 		}
962*4882a593Smuzhiyun 	}
963*4882a593Smuzhiyun #endif /* BCM_SDRBL */
964*4882a593Smuzhiyun 
965*4882a593Smuzhiyun 	pvars = NULL;
966*4882a593Smuzhiyun 	BCM_REFERENCE(pvars);
967*4882a593Smuzhiyun 
968*4882a593Smuzhiyun 	{
969*4882a593Smuzhiyun 		sii->lhl_ps_mode = LHL_PS_MODE_0;
970*4882a593Smuzhiyun 	}
971*4882a593Smuzhiyun 
972*4882a593Smuzhiyun 	if (!si_onetimeinit) {
973*4882a593Smuzhiyun 
974*4882a593Smuzhiyun 		if (CCREV(sii->pub.ccrev) >= 20) {
975*4882a593Smuzhiyun 			uint32 gpiopullup = 0, gpiopulldown = 0;
976*4882a593Smuzhiyun 			cc = (chipcregs_t *)si_setcore(sih, CC_CORE_ID, 0);
977*4882a593Smuzhiyun 			ASSERT(cc != NULL);
978*4882a593Smuzhiyun 			BCM_REFERENCE(gpiopullup);
979*4882a593Smuzhiyun 			BCM_REFERENCE(gpiopulldown);
980*4882a593Smuzhiyun 			si_setcoreidx(sih, origidx);
981*4882a593Smuzhiyun 		}
982*4882a593Smuzhiyun 
983*4882a593Smuzhiyun 	}
984*4882a593Smuzhiyun 
985*4882a593Smuzhiyun 	/* clear any previous epidiag-induced target abort */
986*4882a593Smuzhiyun 	ASSERT(!si_taclear(sih, FALSE));
987*4882a593Smuzhiyun 
988*4882a593Smuzhiyun #if defined(BCMPMU_STATS) && !defined(BCMPMU_STATS_DISABLED)
989*4882a593Smuzhiyun 	si_pmustatstimer_init(sih);
990*4882a593Smuzhiyun #endif /* BCMPMU_STATS */
991*4882a593Smuzhiyun 
992*4882a593Smuzhiyun #ifdef BOOTLOADER_CONSOLE_OUTPUT
993*4882a593Smuzhiyun 	/* Enable console prints */
994*4882a593Smuzhiyun 	si_muxenab(sii, 3);
995*4882a593Smuzhiyun #endif // endif
996*4882a593Smuzhiyun 
997*4882a593Smuzhiyun 	return (sii);
998*4882a593Smuzhiyun 
999*4882a593Smuzhiyun exit:
1000*4882a593Smuzhiyun 
1001*4882a593Smuzhiyun 	return NULL;
1002*4882a593Smuzhiyun }
1003*4882a593Smuzhiyun 
1004*4882a593Smuzhiyun /** may be called with core in reset */
1005*4882a593Smuzhiyun void
si_detach(si_t * sih)1006*4882a593Smuzhiyun si_detach(si_t *sih)
1007*4882a593Smuzhiyun {
1008*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
1009*4882a593Smuzhiyun 	si_cores_info_t *cores_info = (si_cores_info_t *)sii->cores_info;
1010*4882a593Smuzhiyun 	uint idx;
1011*4882a593Smuzhiyun 
1012*4882a593Smuzhiyun 	if (BUSTYPE(sih->bustype) == SI_BUS)
1013*4882a593Smuzhiyun 		for (idx = 0; idx < SI_MAXCORES; idx++)
1014*4882a593Smuzhiyun 			if (cores_info->regs[idx]) {
1015*4882a593Smuzhiyun 				REG_UNMAP(cores_info->regs[idx]);
1016*4882a593Smuzhiyun 				cores_info->regs[idx] = NULL;
1017*4882a593Smuzhiyun 			}
1018*4882a593Smuzhiyun 
1019*4882a593Smuzhiyun #if !defined(BCMBUSTYPE) || (BCMBUSTYPE == SI_BUS)
1020*4882a593Smuzhiyun 	if (cores_info != &ksii_cores_info)
1021*4882a593Smuzhiyun #endif	/* !BCMBUSTYPE || (BCMBUSTYPE == SI_BUS) */
1022*4882a593Smuzhiyun 		MFREE(sii->osh, cores_info, sizeof(si_cores_info_t));
1023*4882a593Smuzhiyun 
1024*4882a593Smuzhiyun #if defined(BCM_BACKPLANE_TIMEOUT)
1025*4882a593Smuzhiyun 	if (sih->err_info) {
1026*4882a593Smuzhiyun 		MFREE(sii->osh, sih->err_info, sizeof(si_axi_error_info_t));
1027*4882a593Smuzhiyun 		sii->pub.err_info = NULL;
1028*4882a593Smuzhiyun 	}
1029*4882a593Smuzhiyun #endif /* BCM_BACKPLANE_TIMEOUT */
1030*4882a593Smuzhiyun 
1031*4882a593Smuzhiyun 	if (sii->axi_wrapper) {
1032*4882a593Smuzhiyun 		MFREE(sii->osh, sii->axi_wrapper,
1033*4882a593Smuzhiyun 			(sizeof(axi_wrapper_t) * SI_MAX_AXI_WRAPPERS));
1034*4882a593Smuzhiyun 		sii->axi_wrapper = NULL;
1035*4882a593Smuzhiyun 	}
1036*4882a593Smuzhiyun 
1037*4882a593Smuzhiyun #if !defined(BCMBUSTYPE) || (BCMBUSTYPE == SI_BUS)
1038*4882a593Smuzhiyun 	if (sii != &ksii)
1039*4882a593Smuzhiyun #endif	/* !BCMBUSTYPE || (BCMBUSTYPE == SI_BUS) */
1040*4882a593Smuzhiyun 		MFREE(sii->osh, sii, sizeof(si_info_t));
1041*4882a593Smuzhiyun }
1042*4882a593Smuzhiyun 
1043*4882a593Smuzhiyun void *
si_osh(si_t * sih)1044*4882a593Smuzhiyun si_osh(si_t *sih)
1045*4882a593Smuzhiyun {
1046*4882a593Smuzhiyun 	si_info_t *sii;
1047*4882a593Smuzhiyun 
1048*4882a593Smuzhiyun 	sii = SI_INFO(sih);
1049*4882a593Smuzhiyun 	return sii->osh;
1050*4882a593Smuzhiyun }
1051*4882a593Smuzhiyun 
1052*4882a593Smuzhiyun void
si_setosh(si_t * sih,osl_t * osh)1053*4882a593Smuzhiyun si_setosh(si_t *sih, osl_t *osh)
1054*4882a593Smuzhiyun {
1055*4882a593Smuzhiyun 	si_info_t *sii;
1056*4882a593Smuzhiyun 
1057*4882a593Smuzhiyun 	sii = SI_INFO(sih);
1058*4882a593Smuzhiyun 	if (sii->osh != NULL) {
1059*4882a593Smuzhiyun 		SI_ERROR(("osh is already set....\n"));
1060*4882a593Smuzhiyun 		ASSERT(!sii->osh);
1061*4882a593Smuzhiyun 	}
1062*4882a593Smuzhiyun 	sii->osh = osh;
1063*4882a593Smuzhiyun }
1064*4882a593Smuzhiyun 
1065*4882a593Smuzhiyun /** register driver interrupt disabling and restoring callback functions */
1066*4882a593Smuzhiyun void
si_register_intr_callback(si_t * sih,void * intrsoff_fn,void * intrsrestore_fn,void * intrsenabled_fn,void * intr_arg)1067*4882a593Smuzhiyun si_register_intr_callback(si_t *sih, void *intrsoff_fn, void *intrsrestore_fn,
1068*4882a593Smuzhiyun                           void *intrsenabled_fn, void *intr_arg)
1069*4882a593Smuzhiyun {
1070*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
1071*4882a593Smuzhiyun 	si_cores_info_t *cores_info = (si_cores_info_t *)sii->cores_info;
1072*4882a593Smuzhiyun 	sii->intr_arg = intr_arg;
1073*4882a593Smuzhiyun 	sii->intrsoff_fn = (si_intrsoff_t)intrsoff_fn;
1074*4882a593Smuzhiyun 	sii->intrsrestore_fn = (si_intrsrestore_t)intrsrestore_fn;
1075*4882a593Smuzhiyun 	sii->intrsenabled_fn = (si_intrsenabled_t)intrsenabled_fn;
1076*4882a593Smuzhiyun 	/* save current core id.  when this function called, the current core
1077*4882a593Smuzhiyun 	 * must be the core which provides driver functions(il, et, wl, etc.)
1078*4882a593Smuzhiyun 	 */
1079*4882a593Smuzhiyun 	sii->dev_coreid = cores_info->coreid[sii->curidx];
1080*4882a593Smuzhiyun }
1081*4882a593Smuzhiyun 
1082*4882a593Smuzhiyun void
si_deregister_intr_callback(si_t * sih)1083*4882a593Smuzhiyun si_deregister_intr_callback(si_t *sih)
1084*4882a593Smuzhiyun {
1085*4882a593Smuzhiyun 	si_info_t *sii;
1086*4882a593Smuzhiyun 
1087*4882a593Smuzhiyun 	sii = SI_INFO(sih);
1088*4882a593Smuzhiyun 	sii->intrsoff_fn = NULL;
1089*4882a593Smuzhiyun 	sii->intrsrestore_fn = NULL;
1090*4882a593Smuzhiyun 	sii->intrsenabled_fn = NULL;
1091*4882a593Smuzhiyun }
1092*4882a593Smuzhiyun 
1093*4882a593Smuzhiyun uint
si_intflag(si_t * sih)1094*4882a593Smuzhiyun si_intflag(si_t *sih)
1095*4882a593Smuzhiyun {
1096*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
1097*4882a593Smuzhiyun 
1098*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1099*4882a593Smuzhiyun 		return sb_intflag(sih);
1100*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1101*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1102*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1103*4882a593Smuzhiyun 		return R_REG(sii->osh, ((uint32 *)(uintptr)
1104*4882a593Smuzhiyun 			    (sii->oob_router + OOB_STATUSA)));
1105*4882a593Smuzhiyun 	else {
1106*4882a593Smuzhiyun 		ASSERT(0);
1107*4882a593Smuzhiyun 		return 0;
1108*4882a593Smuzhiyun 	}
1109*4882a593Smuzhiyun }
1110*4882a593Smuzhiyun 
1111*4882a593Smuzhiyun uint
si_flag(si_t * sih)1112*4882a593Smuzhiyun si_flag(si_t *sih)
1113*4882a593Smuzhiyun {
1114*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1115*4882a593Smuzhiyun 		return sb_flag(sih);
1116*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1117*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1118*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1119*4882a593Smuzhiyun 		return ai_flag(sih);
1120*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1121*4882a593Smuzhiyun 		return ub_flag(sih);
1122*4882a593Smuzhiyun 	else {
1123*4882a593Smuzhiyun 		ASSERT(0);
1124*4882a593Smuzhiyun 		return 0;
1125*4882a593Smuzhiyun 	}
1126*4882a593Smuzhiyun }
1127*4882a593Smuzhiyun 
1128*4882a593Smuzhiyun uint
si_flag_alt(si_t * sih)1129*4882a593Smuzhiyun si_flag_alt(si_t *sih)
1130*4882a593Smuzhiyun {
1131*4882a593Smuzhiyun 	if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1132*4882a593Smuzhiyun 	(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1133*4882a593Smuzhiyun 	(CHIPTYPE(sih->socitype) == SOCI_NAI))
1134*4882a593Smuzhiyun 		return ai_flag_alt(sih);
1135*4882a593Smuzhiyun 	else {
1136*4882a593Smuzhiyun 		ASSERT(0);
1137*4882a593Smuzhiyun 		return 0;
1138*4882a593Smuzhiyun 	}
1139*4882a593Smuzhiyun }
1140*4882a593Smuzhiyun 
1141*4882a593Smuzhiyun void
si_setint(si_t * sih,int siflag)1142*4882a593Smuzhiyun si_setint(si_t *sih, int siflag)
1143*4882a593Smuzhiyun {
1144*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1145*4882a593Smuzhiyun 		sb_setint(sih, siflag);
1146*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1147*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1148*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1149*4882a593Smuzhiyun 		ai_setint(sih, siflag);
1150*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1151*4882a593Smuzhiyun 		ub_setint(sih, siflag);
1152*4882a593Smuzhiyun 	else
1153*4882a593Smuzhiyun 		ASSERT(0);
1154*4882a593Smuzhiyun }
1155*4882a593Smuzhiyun 
1156*4882a593Smuzhiyun uint32
si_oobr_baseaddr(si_t * sih,bool second)1157*4882a593Smuzhiyun si_oobr_baseaddr(si_t *sih, bool second)
1158*4882a593Smuzhiyun {
1159*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
1160*4882a593Smuzhiyun 
1161*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1162*4882a593Smuzhiyun 		return 0;
1163*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1164*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1165*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1166*4882a593Smuzhiyun 		return (second ? sii->oob_router1 : sii->oob_router);
1167*4882a593Smuzhiyun 	else {
1168*4882a593Smuzhiyun 		ASSERT(0);
1169*4882a593Smuzhiyun 		return 0;
1170*4882a593Smuzhiyun 	}
1171*4882a593Smuzhiyun }
1172*4882a593Smuzhiyun 
1173*4882a593Smuzhiyun uint
si_coreid(si_t * sih)1174*4882a593Smuzhiyun si_coreid(si_t *sih)
1175*4882a593Smuzhiyun {
1176*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
1177*4882a593Smuzhiyun 	si_cores_info_t *cores_info = (si_cores_info_t *)sii->cores_info;
1178*4882a593Smuzhiyun 
1179*4882a593Smuzhiyun 	return cores_info->coreid[sii->curidx];
1180*4882a593Smuzhiyun }
1181*4882a593Smuzhiyun 
1182*4882a593Smuzhiyun uint
si_coreidx(si_t * sih)1183*4882a593Smuzhiyun si_coreidx(si_t *sih)
1184*4882a593Smuzhiyun {
1185*4882a593Smuzhiyun 	si_info_t *sii;
1186*4882a593Smuzhiyun 
1187*4882a593Smuzhiyun 	sii = SI_INFO(sih);
1188*4882a593Smuzhiyun 	return sii->curidx;
1189*4882a593Smuzhiyun }
1190*4882a593Smuzhiyun 
1191*4882a593Smuzhiyun volatile void *
si_d11_switch_addrbase(si_t * sih,uint coreunit)1192*4882a593Smuzhiyun si_d11_switch_addrbase(si_t *sih, uint coreunit)
1193*4882a593Smuzhiyun {
1194*4882a593Smuzhiyun 	return si_setcore(sih,  D11_CORE_ID, coreunit);
1195*4882a593Smuzhiyun }
1196*4882a593Smuzhiyun 
1197*4882a593Smuzhiyun /** return the core-type instantiation # of the current core */
1198*4882a593Smuzhiyun uint
si_coreunit(si_t * sih)1199*4882a593Smuzhiyun si_coreunit(si_t *sih)
1200*4882a593Smuzhiyun {
1201*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
1202*4882a593Smuzhiyun 	si_cores_info_t *cores_info = (si_cores_info_t *)sii->cores_info;
1203*4882a593Smuzhiyun 	uint idx;
1204*4882a593Smuzhiyun 	uint coreid;
1205*4882a593Smuzhiyun 	uint coreunit;
1206*4882a593Smuzhiyun 	uint i;
1207*4882a593Smuzhiyun 
1208*4882a593Smuzhiyun 	coreunit = 0;
1209*4882a593Smuzhiyun 
1210*4882a593Smuzhiyun 	idx = sii->curidx;
1211*4882a593Smuzhiyun 
1212*4882a593Smuzhiyun 	ASSERT(GOODREGS(sii->curmap));
1213*4882a593Smuzhiyun 	coreid = si_coreid(sih);
1214*4882a593Smuzhiyun 
1215*4882a593Smuzhiyun 	/* count the cores of our type */
1216*4882a593Smuzhiyun 	for (i = 0; i < idx; i++)
1217*4882a593Smuzhiyun 		if (cores_info->coreid[i] == coreid)
1218*4882a593Smuzhiyun 			coreunit++;
1219*4882a593Smuzhiyun 
1220*4882a593Smuzhiyun 	return (coreunit);
1221*4882a593Smuzhiyun }
1222*4882a593Smuzhiyun 
1223*4882a593Smuzhiyun uint
si_corevendor(si_t * sih)1224*4882a593Smuzhiyun si_corevendor(si_t *sih)
1225*4882a593Smuzhiyun {
1226*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1227*4882a593Smuzhiyun 		return sb_corevendor(sih);
1228*4882a593Smuzhiyun 		else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1229*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1230*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1231*4882a593Smuzhiyun 		return ai_corevendor(sih);
1232*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1233*4882a593Smuzhiyun 		return ub_corevendor(sih);
1234*4882a593Smuzhiyun 	else {
1235*4882a593Smuzhiyun 		ASSERT(0);
1236*4882a593Smuzhiyun 		return 0;
1237*4882a593Smuzhiyun 	}
1238*4882a593Smuzhiyun }
1239*4882a593Smuzhiyun 
1240*4882a593Smuzhiyun bool
si_backplane64(si_t * sih)1241*4882a593Smuzhiyun si_backplane64(si_t *sih)
1242*4882a593Smuzhiyun {
1243*4882a593Smuzhiyun 	return ((sih->cccaps & CC_CAP_BKPLN64) != 0);
1244*4882a593Smuzhiyun }
1245*4882a593Smuzhiyun 
1246*4882a593Smuzhiyun uint
si_corerev(si_t * sih)1247*4882a593Smuzhiyun si_corerev(si_t *sih)
1248*4882a593Smuzhiyun {
1249*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1250*4882a593Smuzhiyun 		return sb_corerev(sih);
1251*4882a593Smuzhiyun 		else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1252*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1253*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1254*4882a593Smuzhiyun 		return ai_corerev(sih);
1255*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1256*4882a593Smuzhiyun 		return ub_corerev(sih);
1257*4882a593Smuzhiyun 	else {
1258*4882a593Smuzhiyun 		ASSERT(0);
1259*4882a593Smuzhiyun 		return 0;
1260*4882a593Smuzhiyun 	}
1261*4882a593Smuzhiyun }
1262*4882a593Smuzhiyun 
1263*4882a593Smuzhiyun uint
si_corerev_minor(si_t * sih)1264*4882a593Smuzhiyun si_corerev_minor(si_t *sih)
1265*4882a593Smuzhiyun {
1266*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_AI) {
1267*4882a593Smuzhiyun 		return ai_corerev_minor(sih);
1268*4882a593Smuzhiyun 	} else {
1269*4882a593Smuzhiyun 		return 0;
1270*4882a593Smuzhiyun 	}
1271*4882a593Smuzhiyun }
1272*4882a593Smuzhiyun 
1273*4882a593Smuzhiyun /* return index of coreid or BADIDX if not found */
1274*4882a593Smuzhiyun uint
si_findcoreidx(si_t * sih,uint coreid,uint coreunit)1275*4882a593Smuzhiyun si_findcoreidx(si_t *sih, uint coreid, uint coreunit)
1276*4882a593Smuzhiyun {
1277*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
1278*4882a593Smuzhiyun 	si_cores_info_t *cores_info = (si_cores_info_t *)sii->cores_info;
1279*4882a593Smuzhiyun 	uint found;
1280*4882a593Smuzhiyun 	uint i;
1281*4882a593Smuzhiyun 
1282*4882a593Smuzhiyun 	found = 0;
1283*4882a593Smuzhiyun 
1284*4882a593Smuzhiyun 	for (i = 0; i < sii->numcores; i++)
1285*4882a593Smuzhiyun 		if (cores_info->coreid[i] == coreid) {
1286*4882a593Smuzhiyun 			if (found == coreunit)
1287*4882a593Smuzhiyun 				return (i);
1288*4882a593Smuzhiyun 			found++;
1289*4882a593Smuzhiyun 		}
1290*4882a593Smuzhiyun 
1291*4882a593Smuzhiyun 	return (BADIDX);
1292*4882a593Smuzhiyun }
1293*4882a593Smuzhiyun 
1294*4882a593Smuzhiyun /** return total coreunit of coreid or zero if not found */
1295*4882a593Smuzhiyun uint
si_numcoreunits(si_t * sih,uint coreid)1296*4882a593Smuzhiyun si_numcoreunits(si_t *sih, uint coreid)
1297*4882a593Smuzhiyun {
1298*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
1299*4882a593Smuzhiyun 	si_cores_info_t *cores_info = (si_cores_info_t *)sii->cores_info;
1300*4882a593Smuzhiyun 	uint found = 0;
1301*4882a593Smuzhiyun 	uint i;
1302*4882a593Smuzhiyun 
1303*4882a593Smuzhiyun 	for (i = 0; i < sii->numcores; i++) {
1304*4882a593Smuzhiyun 		if (cores_info->coreid[i] == coreid) {
1305*4882a593Smuzhiyun 			found++;
1306*4882a593Smuzhiyun 		}
1307*4882a593Smuzhiyun 	}
1308*4882a593Smuzhiyun 
1309*4882a593Smuzhiyun 	return found;
1310*4882a593Smuzhiyun }
1311*4882a593Smuzhiyun 
1312*4882a593Smuzhiyun /** return total D11 coreunits */
1313*4882a593Smuzhiyun uint
BCMRAMFN(si_numd11coreunits)1314*4882a593Smuzhiyun BCMRAMFN(si_numd11coreunits)(si_t *sih)
1315*4882a593Smuzhiyun {
1316*4882a593Smuzhiyun 	uint found = 0;
1317*4882a593Smuzhiyun 
1318*4882a593Smuzhiyun 	found = si_numcoreunits(sih, D11_CORE_ID);
1319*4882a593Smuzhiyun 
1320*4882a593Smuzhiyun #if defined(WLRSDB) && defined(WLRSDB_DISABLED)
1321*4882a593Smuzhiyun 	/* If RSDB functionality is compiled out,
1322*4882a593Smuzhiyun 	 * then ignore any D11 cores beyond the first
1323*4882a593Smuzhiyun 	 * Used in norsdb dongle build variants for rsdb chip.
1324*4882a593Smuzhiyun 	 */
1325*4882a593Smuzhiyun 	found = 1;
1326*4882a593Smuzhiyun #endif /* defined(WLRSDB) && !defined(WLRSDB_DISABLED) */
1327*4882a593Smuzhiyun 
1328*4882a593Smuzhiyun 	return found;
1329*4882a593Smuzhiyun }
1330*4882a593Smuzhiyun 
1331*4882a593Smuzhiyun /** return list of found cores */
1332*4882a593Smuzhiyun uint
si_corelist(si_t * sih,uint coreid[])1333*4882a593Smuzhiyun si_corelist(si_t *sih, uint coreid[])
1334*4882a593Smuzhiyun {
1335*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
1336*4882a593Smuzhiyun 	si_cores_info_t *cores_info = (si_cores_info_t *)sii->cores_info;
1337*4882a593Smuzhiyun 
1338*4882a593Smuzhiyun 	bcopy((uchar*)cores_info->coreid, (uchar*)coreid, (sii->numcores * sizeof(uint)));
1339*4882a593Smuzhiyun 	return (sii->numcores);
1340*4882a593Smuzhiyun }
1341*4882a593Smuzhiyun 
1342*4882a593Smuzhiyun /** return current wrapper mapping */
1343*4882a593Smuzhiyun void *
si_wrapperregs(si_t * sih)1344*4882a593Smuzhiyun si_wrapperregs(si_t *sih)
1345*4882a593Smuzhiyun {
1346*4882a593Smuzhiyun 	si_info_t *sii;
1347*4882a593Smuzhiyun 
1348*4882a593Smuzhiyun 	sii = SI_INFO(sih);
1349*4882a593Smuzhiyun 	ASSERT(GOODREGS(sii->curwrap));
1350*4882a593Smuzhiyun 
1351*4882a593Smuzhiyun 	return (sii->curwrap);
1352*4882a593Smuzhiyun }
1353*4882a593Smuzhiyun 
1354*4882a593Smuzhiyun /** return current register mapping */
1355*4882a593Smuzhiyun volatile void *
si_coreregs(si_t * sih)1356*4882a593Smuzhiyun si_coreregs(si_t *sih)
1357*4882a593Smuzhiyun {
1358*4882a593Smuzhiyun 	si_info_t *sii;
1359*4882a593Smuzhiyun 
1360*4882a593Smuzhiyun 	sii = SI_INFO(sih);
1361*4882a593Smuzhiyun 	ASSERT(GOODREGS(sii->curmap));
1362*4882a593Smuzhiyun 
1363*4882a593Smuzhiyun 	return (sii->curmap);
1364*4882a593Smuzhiyun }
1365*4882a593Smuzhiyun 
1366*4882a593Smuzhiyun /**
1367*4882a593Smuzhiyun  * This function changes logical "focus" to the indicated core;
1368*4882a593Smuzhiyun  * must be called with interrupts off.
1369*4882a593Smuzhiyun  * Moreover, callers should keep interrupts off during switching out of and back to d11 core
1370*4882a593Smuzhiyun  */
1371*4882a593Smuzhiyun volatile void *
si_setcore(si_t * sih,uint coreid,uint coreunit)1372*4882a593Smuzhiyun si_setcore(si_t *sih, uint coreid, uint coreunit)
1373*4882a593Smuzhiyun {
1374*4882a593Smuzhiyun 	uint idx;
1375*4882a593Smuzhiyun 
1376*4882a593Smuzhiyun 	idx = si_findcoreidx(sih, coreid, coreunit);
1377*4882a593Smuzhiyun 	if (!GOODIDX(idx))
1378*4882a593Smuzhiyun 		return (NULL);
1379*4882a593Smuzhiyun 
1380*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1381*4882a593Smuzhiyun 		return sb_setcoreidx(sih, idx);
1382*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1383*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1384*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1385*4882a593Smuzhiyun 		return ai_setcoreidx(sih, idx);
1386*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1387*4882a593Smuzhiyun 		return ub_setcoreidx(sih, idx);
1388*4882a593Smuzhiyun 	else {
1389*4882a593Smuzhiyun 		ASSERT(0);
1390*4882a593Smuzhiyun 		return NULL;
1391*4882a593Smuzhiyun 	}
1392*4882a593Smuzhiyun }
1393*4882a593Smuzhiyun 
1394*4882a593Smuzhiyun volatile void *
si_setcoreidx(si_t * sih,uint coreidx)1395*4882a593Smuzhiyun si_setcoreidx(si_t *sih, uint coreidx)
1396*4882a593Smuzhiyun {
1397*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1398*4882a593Smuzhiyun 		return sb_setcoreidx(sih, coreidx);
1399*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1400*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1401*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1402*4882a593Smuzhiyun 		return ai_setcoreidx(sih, coreidx);
1403*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1404*4882a593Smuzhiyun 		return ub_setcoreidx(sih, coreidx);
1405*4882a593Smuzhiyun 	else {
1406*4882a593Smuzhiyun 		ASSERT(0);
1407*4882a593Smuzhiyun 		return NULL;
1408*4882a593Smuzhiyun 	}
1409*4882a593Smuzhiyun }
1410*4882a593Smuzhiyun 
1411*4882a593Smuzhiyun /** Turn off interrupt as required by sb_setcore, before switch core */
1412*4882a593Smuzhiyun volatile void *
si_switch_core(si_t * sih,uint coreid,uint * origidx,uint * intr_val)1413*4882a593Smuzhiyun si_switch_core(si_t *sih, uint coreid, uint *origidx, uint *intr_val)
1414*4882a593Smuzhiyun {
1415*4882a593Smuzhiyun 	volatile void *cc;
1416*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
1417*4882a593Smuzhiyun 
1418*4882a593Smuzhiyun 	if (SI_FAST(sii)) {
1419*4882a593Smuzhiyun 		/* Overloading the origidx variable to remember the coreid,
1420*4882a593Smuzhiyun 		 * this works because the core ids cannot be confused with
1421*4882a593Smuzhiyun 		 * core indices.
1422*4882a593Smuzhiyun 		 */
1423*4882a593Smuzhiyun 		*origidx = coreid;
1424*4882a593Smuzhiyun 		if (coreid == CC_CORE_ID)
1425*4882a593Smuzhiyun 			return (volatile void *)CCREGS_FAST(sii);
1426*4882a593Smuzhiyun 		else if (coreid == BUSCORETYPE(sih->buscoretype))
1427*4882a593Smuzhiyun 			return (volatile void *)PCIEREGS(sii);
1428*4882a593Smuzhiyun 	}
1429*4882a593Smuzhiyun 	INTR_OFF(sii, *intr_val);
1430*4882a593Smuzhiyun 	*origidx = sii->curidx;
1431*4882a593Smuzhiyun 	cc = si_setcore(sih, coreid, 0);
1432*4882a593Smuzhiyun 	ASSERT(cc != NULL);
1433*4882a593Smuzhiyun 
1434*4882a593Smuzhiyun 	return cc;
1435*4882a593Smuzhiyun }
1436*4882a593Smuzhiyun 
1437*4882a593Smuzhiyun /* restore coreidx and restore interrupt */
1438*4882a593Smuzhiyun void
si_restore_core(si_t * sih,uint coreid,uint intr_val)1439*4882a593Smuzhiyun si_restore_core(si_t *sih, uint coreid, uint intr_val)
1440*4882a593Smuzhiyun {
1441*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
1442*4882a593Smuzhiyun 
1443*4882a593Smuzhiyun 	if (SI_FAST(sii) && ((coreid == CC_CORE_ID) || (coreid == BUSCORETYPE(sih->buscoretype))))
1444*4882a593Smuzhiyun 		return;
1445*4882a593Smuzhiyun 
1446*4882a593Smuzhiyun 	si_setcoreidx(sih, coreid);
1447*4882a593Smuzhiyun 	INTR_RESTORE(sii, intr_val);
1448*4882a593Smuzhiyun }
1449*4882a593Smuzhiyun 
1450*4882a593Smuzhiyun int
si_numaddrspaces(si_t * sih)1451*4882a593Smuzhiyun si_numaddrspaces(si_t *sih)
1452*4882a593Smuzhiyun {
1453*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1454*4882a593Smuzhiyun 		return sb_numaddrspaces(sih);
1455*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1456*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1457*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1458*4882a593Smuzhiyun 		return ai_numaddrspaces(sih);
1459*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1460*4882a593Smuzhiyun 		return ub_numaddrspaces(sih);
1461*4882a593Smuzhiyun 	else {
1462*4882a593Smuzhiyun 		ASSERT(0);
1463*4882a593Smuzhiyun 		return 0;
1464*4882a593Smuzhiyun 	}
1465*4882a593Smuzhiyun }
1466*4882a593Smuzhiyun 
1467*4882a593Smuzhiyun /* Return the address of the nth address space in the current core
1468*4882a593Smuzhiyun  * Arguments:
1469*4882a593Smuzhiyun  * sih : Pointer to struct si_t
1470*4882a593Smuzhiyun  * spidx : slave port index
1471*4882a593Smuzhiyun  * baidx : base address index
1472*4882a593Smuzhiyun  */
1473*4882a593Smuzhiyun 
1474*4882a593Smuzhiyun uint32
si_addrspace(si_t * sih,uint spidx,uint baidx)1475*4882a593Smuzhiyun si_addrspace(si_t *sih, uint spidx, uint baidx)
1476*4882a593Smuzhiyun {
1477*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1478*4882a593Smuzhiyun 		return sb_addrspace(sih, baidx);
1479*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1480*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1481*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1482*4882a593Smuzhiyun 		return ai_addrspace(sih, spidx, baidx);
1483*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1484*4882a593Smuzhiyun 		return ub_addrspace(sih, baidx);
1485*4882a593Smuzhiyun 	else {
1486*4882a593Smuzhiyun 		ASSERT(0);
1487*4882a593Smuzhiyun 		return 0;
1488*4882a593Smuzhiyun 	}
1489*4882a593Smuzhiyun }
1490*4882a593Smuzhiyun 
1491*4882a593Smuzhiyun /* Return the size of the nth address space in the current core
1492*4882a593Smuzhiyun  * Arguments:
1493*4882a593Smuzhiyun  * sih : Pointer to struct si_t
1494*4882a593Smuzhiyun  * spidx : slave port index
1495*4882a593Smuzhiyun  * baidx : base address index
1496*4882a593Smuzhiyun  */
1497*4882a593Smuzhiyun uint32
si_addrspacesize(si_t * sih,uint spidx,uint baidx)1498*4882a593Smuzhiyun si_addrspacesize(si_t *sih, uint spidx, uint baidx)
1499*4882a593Smuzhiyun {
1500*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1501*4882a593Smuzhiyun 		return sb_addrspacesize(sih, baidx);
1502*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1503*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1504*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1505*4882a593Smuzhiyun 		return ai_addrspacesize(sih, spidx, baidx);
1506*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1507*4882a593Smuzhiyun 		return ub_addrspacesize(sih, baidx);
1508*4882a593Smuzhiyun 	else {
1509*4882a593Smuzhiyun 		ASSERT(0);
1510*4882a593Smuzhiyun 		return 0;
1511*4882a593Smuzhiyun 	}
1512*4882a593Smuzhiyun }
1513*4882a593Smuzhiyun 
1514*4882a593Smuzhiyun void
si_coreaddrspaceX(si_t * sih,uint asidx,uint32 * addr,uint32 * size)1515*4882a593Smuzhiyun si_coreaddrspaceX(si_t *sih, uint asidx, uint32 *addr, uint32 *size)
1516*4882a593Smuzhiyun {
1517*4882a593Smuzhiyun 	/* Only supported for SOCI_AI */
1518*4882a593Smuzhiyun 	if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1519*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1520*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1521*4882a593Smuzhiyun 		ai_coreaddrspaceX(sih, asidx, addr, size);
1522*4882a593Smuzhiyun 	else
1523*4882a593Smuzhiyun 		*size = 0;
1524*4882a593Smuzhiyun }
1525*4882a593Smuzhiyun 
1526*4882a593Smuzhiyun uint32
si_core_cflags(si_t * sih,uint32 mask,uint32 val)1527*4882a593Smuzhiyun si_core_cflags(si_t *sih, uint32 mask, uint32 val)
1528*4882a593Smuzhiyun {
1529*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1530*4882a593Smuzhiyun 		return sb_core_cflags(sih, mask, val);
1531*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1532*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1533*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1534*4882a593Smuzhiyun 		return ai_core_cflags(sih, mask, val);
1535*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1536*4882a593Smuzhiyun 		return ub_core_cflags(sih, mask, val);
1537*4882a593Smuzhiyun 	else {
1538*4882a593Smuzhiyun 		ASSERT(0);
1539*4882a593Smuzhiyun 		return 0;
1540*4882a593Smuzhiyun 	}
1541*4882a593Smuzhiyun }
1542*4882a593Smuzhiyun 
1543*4882a593Smuzhiyun void
si_core_cflags_wo(si_t * sih,uint32 mask,uint32 val)1544*4882a593Smuzhiyun si_core_cflags_wo(si_t *sih, uint32 mask, uint32 val)
1545*4882a593Smuzhiyun {
1546*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1547*4882a593Smuzhiyun 		sb_core_cflags_wo(sih, mask, val);
1548*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1549*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1550*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1551*4882a593Smuzhiyun 		ai_core_cflags_wo(sih, mask, val);
1552*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1553*4882a593Smuzhiyun 		ub_core_cflags_wo(sih, mask, val);
1554*4882a593Smuzhiyun 	else
1555*4882a593Smuzhiyun 		ASSERT(0);
1556*4882a593Smuzhiyun }
1557*4882a593Smuzhiyun 
1558*4882a593Smuzhiyun uint32
si_core_sflags(si_t * sih,uint32 mask,uint32 val)1559*4882a593Smuzhiyun si_core_sflags(si_t *sih, uint32 mask, uint32 val)
1560*4882a593Smuzhiyun {
1561*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1562*4882a593Smuzhiyun 		return sb_core_sflags(sih, mask, val);
1563*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1564*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1565*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1566*4882a593Smuzhiyun 		return ai_core_sflags(sih, mask, val);
1567*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1568*4882a593Smuzhiyun 		return ub_core_sflags(sih, mask, val);
1569*4882a593Smuzhiyun 	else {
1570*4882a593Smuzhiyun 		ASSERT(0);
1571*4882a593Smuzhiyun 		return 0;
1572*4882a593Smuzhiyun 	}
1573*4882a593Smuzhiyun }
1574*4882a593Smuzhiyun 
1575*4882a593Smuzhiyun void
si_commit(si_t * sih)1576*4882a593Smuzhiyun si_commit(si_t *sih)
1577*4882a593Smuzhiyun {
1578*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1579*4882a593Smuzhiyun 		sb_commit(sih);
1580*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1581*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1582*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1583*4882a593Smuzhiyun 		;
1584*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1585*4882a593Smuzhiyun 		;
1586*4882a593Smuzhiyun 	else {
1587*4882a593Smuzhiyun 		ASSERT(0);
1588*4882a593Smuzhiyun 	}
1589*4882a593Smuzhiyun }
1590*4882a593Smuzhiyun 
1591*4882a593Smuzhiyun bool
si_iscoreup(si_t * sih)1592*4882a593Smuzhiyun si_iscoreup(si_t *sih)
1593*4882a593Smuzhiyun {
1594*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1595*4882a593Smuzhiyun 		return sb_iscoreup(sih);
1596*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1597*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1598*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1599*4882a593Smuzhiyun 		return ai_iscoreup(sih);
1600*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1601*4882a593Smuzhiyun 		return ub_iscoreup(sih);
1602*4882a593Smuzhiyun 	else {
1603*4882a593Smuzhiyun 		ASSERT(0);
1604*4882a593Smuzhiyun 		return FALSE;
1605*4882a593Smuzhiyun 	}
1606*4882a593Smuzhiyun }
1607*4882a593Smuzhiyun 
1608*4882a593Smuzhiyun uint
si_wrapperreg(si_t * sih,uint32 offset,uint32 mask,uint32 val)1609*4882a593Smuzhiyun si_wrapperreg(si_t *sih, uint32 offset, uint32 mask, uint32 val)
1610*4882a593Smuzhiyun {
1611*4882a593Smuzhiyun 	/* only for AI back plane chips */
1612*4882a593Smuzhiyun 	if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1613*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1614*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1615*4882a593Smuzhiyun 		return (ai_wrap_reg(sih, offset, mask, val));
1616*4882a593Smuzhiyun 	return 0;
1617*4882a593Smuzhiyun }
1618*4882a593Smuzhiyun /* si_backplane_access is used to read full backplane address from host for PCIE FD
1619*4882a593Smuzhiyun  * it uses secondary bar-0 window which lies at an offset of 16K from primary bar-0
1620*4882a593Smuzhiyun  * Provides support for read/write of 1/2/4 bytes of backplane address
1621*4882a593Smuzhiyun  * Can be used to read/write
1622*4882a593Smuzhiyun  *	1. core regs
1623*4882a593Smuzhiyun  *	2. Wrapper regs
1624*4882a593Smuzhiyun  *	3. memory
1625*4882a593Smuzhiyun  *	4. BT area
1626*4882a593Smuzhiyun  * For accessing any 32 bit backplane address, [31 : 12] of backplane should be given in "region"
1627*4882a593Smuzhiyun  * [11 : 0] should be the "regoff"
1628*4882a593Smuzhiyun  * for reading  4 bytes from reg 0x200 of d11 core use it like below
1629*4882a593Smuzhiyun  * : si_backplane_access(sih, 0x18001000, 0x200, 4, 0, TRUE)
1630*4882a593Smuzhiyun  */
si_backplane_addr_sane(uint addr,uint size)1631*4882a593Smuzhiyun static int si_backplane_addr_sane(uint addr, uint size)
1632*4882a593Smuzhiyun {
1633*4882a593Smuzhiyun 	int bcmerror = BCME_OK;
1634*4882a593Smuzhiyun 
1635*4882a593Smuzhiyun 	/* For 2 byte access, address has to be 2 byte aligned */
1636*4882a593Smuzhiyun 	if (size == 2) {
1637*4882a593Smuzhiyun 		if (addr & 0x1) {
1638*4882a593Smuzhiyun 			bcmerror = BCME_ERROR;
1639*4882a593Smuzhiyun 		}
1640*4882a593Smuzhiyun 	}
1641*4882a593Smuzhiyun 	/* For 4 byte access, address has to be 4 byte aligned */
1642*4882a593Smuzhiyun 	if (size == 4) {
1643*4882a593Smuzhiyun 		if (addr & 0x3) {
1644*4882a593Smuzhiyun 			bcmerror = BCME_ERROR;
1645*4882a593Smuzhiyun 		}
1646*4882a593Smuzhiyun 	}
1647*4882a593Smuzhiyun 	return bcmerror;
1648*4882a593Smuzhiyun }
1649*4882a593Smuzhiyun 
1650*4882a593Smuzhiyun void
si_invalidate_second_bar0win(si_t * sih)1651*4882a593Smuzhiyun si_invalidate_second_bar0win(si_t *sih)
1652*4882a593Smuzhiyun {
1653*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
1654*4882a593Smuzhiyun 	sii->second_bar0win = ~0x0;
1655*4882a593Smuzhiyun }
1656*4882a593Smuzhiyun 
1657*4882a593Smuzhiyun int
si_backplane_access(si_t * sih,uint addr,uint size,uint * val,bool read)1658*4882a593Smuzhiyun si_backplane_access(si_t *sih, uint addr, uint size, uint *val, bool read)
1659*4882a593Smuzhiyun {
1660*4882a593Smuzhiyun 	volatile uint32 *r = NULL;
1661*4882a593Smuzhiyun 	uint32 region = 0;
1662*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
1663*4882a593Smuzhiyun 
1664*4882a593Smuzhiyun 	/* Valid only for pcie bus */
1665*4882a593Smuzhiyun 	if (BUSTYPE(sih->bustype) != PCI_BUS) {
1666*4882a593Smuzhiyun 		SI_ERROR(("Valid only for pcie bus \n"));
1667*4882a593Smuzhiyun 		return BCME_ERROR;
1668*4882a593Smuzhiyun 	}
1669*4882a593Smuzhiyun 
1670*4882a593Smuzhiyun 	/* Split adrr into region and address offset */
1671*4882a593Smuzhiyun 	region = (addr & (0xFFFFF << 12));
1672*4882a593Smuzhiyun 	addr = addr & 0xFFF;
1673*4882a593Smuzhiyun 
1674*4882a593Smuzhiyun 	/* check for address and size sanity */
1675*4882a593Smuzhiyun 	if (si_backplane_addr_sane(addr, size) != BCME_OK)
1676*4882a593Smuzhiyun 		return BCME_ERROR;
1677*4882a593Smuzhiyun 
1678*4882a593Smuzhiyun 	/* Update window if required */
1679*4882a593Smuzhiyun 	if (sii->second_bar0win != region) {
1680*4882a593Smuzhiyun 		OSL_PCI_WRITE_CONFIG(sii->osh, PCIE2_BAR0_CORE2_WIN, 4, region);
1681*4882a593Smuzhiyun 		sii->second_bar0win = region;
1682*4882a593Smuzhiyun 	}
1683*4882a593Smuzhiyun 
1684*4882a593Smuzhiyun 	/* Estimate effective address
1685*4882a593Smuzhiyun 	 * sii->curmap   : bar-0 virtual address
1686*4882a593Smuzhiyun 	 * PCI_SECOND_BAR0_OFFSET  : secondar bar-0 offset
1687*4882a593Smuzhiyun 	 * regoff : actual reg offset
1688*4882a593Smuzhiyun 	 */
1689*4882a593Smuzhiyun 	r = (volatile uint32 *)((volatile char *)sii->curmap + PCI_SECOND_BAR0_OFFSET + addr);
1690*4882a593Smuzhiyun 
1691*4882a593Smuzhiyun 	SI_VMSG(("si curmap %p  region %x regaddr %x effective addr %p READ %d\n",
1692*4882a593Smuzhiyun 		(volatile char*)sii->curmap, region, addr, r, read));
1693*4882a593Smuzhiyun 
1694*4882a593Smuzhiyun 	switch (size) {
1695*4882a593Smuzhiyun 		case sizeof(uint8) :
1696*4882a593Smuzhiyun 			if (read)
1697*4882a593Smuzhiyun 				*val = R_REG(sii->osh, (volatile uint8*)r);
1698*4882a593Smuzhiyun 			else
1699*4882a593Smuzhiyun 				W_REG(sii->osh, (volatile uint8*)r, *val);
1700*4882a593Smuzhiyun 			break;
1701*4882a593Smuzhiyun 		case sizeof(uint16) :
1702*4882a593Smuzhiyun 			if (read)
1703*4882a593Smuzhiyun 				*val = R_REG(sii->osh, (volatile uint16*)r);
1704*4882a593Smuzhiyun 			else
1705*4882a593Smuzhiyun 				W_REG(sii->osh, (volatile uint16*)r, *val);
1706*4882a593Smuzhiyun 			break;
1707*4882a593Smuzhiyun 		case sizeof(uint32) :
1708*4882a593Smuzhiyun 			if (read)
1709*4882a593Smuzhiyun 				*val = R_REG(sii->osh, (volatile uint32*)r);
1710*4882a593Smuzhiyun 			else
1711*4882a593Smuzhiyun 				W_REG(sii->osh, (volatile uint32*)r, *val);
1712*4882a593Smuzhiyun 			break;
1713*4882a593Smuzhiyun 		default :
1714*4882a593Smuzhiyun 			SI_ERROR(("Invalid  size %d \n", size));
1715*4882a593Smuzhiyun 			return (BCME_ERROR);
1716*4882a593Smuzhiyun 			break;
1717*4882a593Smuzhiyun 	}
1718*4882a593Smuzhiyun 
1719*4882a593Smuzhiyun 	return (BCME_OK);
1720*4882a593Smuzhiyun }
1721*4882a593Smuzhiyun uint
si_corereg(si_t * sih,uint coreidx,uint regoff,uint mask,uint val)1722*4882a593Smuzhiyun si_corereg(si_t *sih, uint coreidx, uint regoff, uint mask, uint val)
1723*4882a593Smuzhiyun {
1724*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1725*4882a593Smuzhiyun 		return sb_corereg(sih, coreidx, regoff, mask, val);
1726*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1727*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1728*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1729*4882a593Smuzhiyun 		return ai_corereg(sih, coreidx, regoff, mask, val);
1730*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1731*4882a593Smuzhiyun 		return ub_corereg(sih, coreidx, regoff, mask, val);
1732*4882a593Smuzhiyun 	else {
1733*4882a593Smuzhiyun 		ASSERT(0);
1734*4882a593Smuzhiyun 		return 0;
1735*4882a593Smuzhiyun 	}
1736*4882a593Smuzhiyun }
1737*4882a593Smuzhiyun 
1738*4882a593Smuzhiyun uint
si_corereg_writeonly(si_t * sih,uint coreidx,uint regoff,uint mask,uint val)1739*4882a593Smuzhiyun si_corereg_writeonly(si_t *sih, uint coreidx, uint regoff, uint mask, uint val)
1740*4882a593Smuzhiyun {
1741*4882a593Smuzhiyun 	return ai_corereg_writeonly(sih, coreidx, regoff, mask, val);
1742*4882a593Smuzhiyun }
1743*4882a593Smuzhiyun 
1744*4882a593Smuzhiyun /** ILP sensitive register access needs special treatment to avoid backplane stalls */
si_pmu_is_ilp_sensitive(uint32 idx,uint regoff)1745*4882a593Smuzhiyun bool si_pmu_is_ilp_sensitive(uint32 idx, uint regoff)
1746*4882a593Smuzhiyun {
1747*4882a593Smuzhiyun 	if (idx == SI_CC_IDX) {
1748*4882a593Smuzhiyun 		if (CHIPCREGS_ILP_SENSITIVE(regoff))
1749*4882a593Smuzhiyun 			return TRUE;
1750*4882a593Smuzhiyun 	} else if (PMUREGS_ILP_SENSITIVE(regoff)) {
1751*4882a593Smuzhiyun 		return TRUE;
1752*4882a593Smuzhiyun 	}
1753*4882a593Smuzhiyun 
1754*4882a593Smuzhiyun 	return FALSE;
1755*4882a593Smuzhiyun }
1756*4882a593Smuzhiyun 
1757*4882a593Smuzhiyun /** 'idx' should refer either to the chipcommon core or the PMU core */
1758*4882a593Smuzhiyun uint
si_pmu_corereg(si_t * sih,uint32 idx,uint regoff,uint mask,uint val)1759*4882a593Smuzhiyun si_pmu_corereg(si_t *sih, uint32 idx, uint regoff, uint mask, uint val)
1760*4882a593Smuzhiyun {
1761*4882a593Smuzhiyun 	int pmustatus_offset;
1762*4882a593Smuzhiyun 
1763*4882a593Smuzhiyun 	/* prevent backplane stall on double write to 'ILP domain' registers in the PMU */
1764*4882a593Smuzhiyun 	if (mask != 0 && PMUREV(sih->pmurev) >= 22 &&
1765*4882a593Smuzhiyun 	    si_pmu_is_ilp_sensitive(idx, regoff)) {
1766*4882a593Smuzhiyun 		pmustatus_offset = AOB_ENAB(sih) ? OFFSETOF(pmuregs_t, pmustatus) :
1767*4882a593Smuzhiyun 			OFFSETOF(chipcregs_t, pmustatus);
1768*4882a593Smuzhiyun 
1769*4882a593Smuzhiyun 		while (si_corereg(sih, idx, pmustatus_offset, 0, 0) & PST_SLOW_WR_PENDING)
1770*4882a593Smuzhiyun 			{};
1771*4882a593Smuzhiyun 	}
1772*4882a593Smuzhiyun 
1773*4882a593Smuzhiyun 	return si_corereg(sih, idx, regoff, mask, val);
1774*4882a593Smuzhiyun }
1775*4882a593Smuzhiyun 
1776*4882a593Smuzhiyun /*
1777*4882a593Smuzhiyun  * If there is no need for fiddling with interrupts or core switches (typically silicon
1778*4882a593Smuzhiyun  * back plane registers, pci registers and chipcommon registers), this function
1779*4882a593Smuzhiyun  * returns the register offset on this core to a mapped address. This address can
1780*4882a593Smuzhiyun  * be used for W_REG/R_REG directly.
1781*4882a593Smuzhiyun  *
1782*4882a593Smuzhiyun  * For accessing registers that would need a core switch, this function will return
1783*4882a593Smuzhiyun  * NULL.
1784*4882a593Smuzhiyun  */
1785*4882a593Smuzhiyun volatile uint32 *
si_corereg_addr(si_t * sih,uint coreidx,uint regoff)1786*4882a593Smuzhiyun si_corereg_addr(si_t *sih, uint coreidx, uint regoff)
1787*4882a593Smuzhiyun {
1788*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1789*4882a593Smuzhiyun 		return sb_corereg_addr(sih, coreidx, regoff);
1790*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1791*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1792*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1793*4882a593Smuzhiyun 		return ai_corereg_addr(sih, coreidx, regoff);
1794*4882a593Smuzhiyun 	else {
1795*4882a593Smuzhiyun 		return 0;
1796*4882a593Smuzhiyun 	}
1797*4882a593Smuzhiyun }
1798*4882a593Smuzhiyun 
1799*4882a593Smuzhiyun void
si_core_disable(si_t * sih,uint32 bits)1800*4882a593Smuzhiyun si_core_disable(si_t *sih, uint32 bits)
1801*4882a593Smuzhiyun {
1802*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1803*4882a593Smuzhiyun 		sb_core_disable(sih, bits);
1804*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1805*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1806*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1807*4882a593Smuzhiyun 		ai_core_disable(sih, bits);
1808*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1809*4882a593Smuzhiyun 		ub_core_disable(sih, bits);
1810*4882a593Smuzhiyun }
1811*4882a593Smuzhiyun 
1812*4882a593Smuzhiyun void
si_core_reset(si_t * sih,uint32 bits,uint32 resetbits)1813*4882a593Smuzhiyun si_core_reset(si_t *sih, uint32 bits, uint32 resetbits)
1814*4882a593Smuzhiyun {
1815*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) == SOCI_SB)
1816*4882a593Smuzhiyun 		sb_core_reset(sih, bits, resetbits);
1817*4882a593Smuzhiyun 	else if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1818*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1819*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI))
1820*4882a593Smuzhiyun 		ai_core_reset(sih, bits, resetbits);
1821*4882a593Smuzhiyun 	else if (CHIPTYPE(sih->socitype) == SOCI_UBUS)
1822*4882a593Smuzhiyun 		ub_core_reset(sih, bits, resetbits);
1823*4882a593Smuzhiyun }
1824*4882a593Smuzhiyun 
1825*4882a593Smuzhiyun /** Run bist on current core. Caller needs to take care of core-specific bist hazards */
1826*4882a593Smuzhiyun int
si_corebist(si_t * sih)1827*4882a593Smuzhiyun si_corebist(si_t *sih)
1828*4882a593Smuzhiyun {
1829*4882a593Smuzhiyun 	uint32 cflags;
1830*4882a593Smuzhiyun 	int result = 0;
1831*4882a593Smuzhiyun 
1832*4882a593Smuzhiyun 	/* Read core control flags */
1833*4882a593Smuzhiyun 	cflags = si_core_cflags(sih, 0, 0);
1834*4882a593Smuzhiyun 
1835*4882a593Smuzhiyun 	/* Set bist & fgc */
1836*4882a593Smuzhiyun 	si_core_cflags(sih, ~0, (SICF_BIST_EN | SICF_FGC));
1837*4882a593Smuzhiyun 
1838*4882a593Smuzhiyun 	/* Wait for bist done */
1839*4882a593Smuzhiyun 	SPINWAIT(((si_core_sflags(sih, 0, 0) & SISF_BIST_DONE) == 0), 100000);
1840*4882a593Smuzhiyun 
1841*4882a593Smuzhiyun 	if (si_core_sflags(sih, 0, 0) & SISF_BIST_ERROR)
1842*4882a593Smuzhiyun 		result = BCME_ERROR;
1843*4882a593Smuzhiyun 
1844*4882a593Smuzhiyun 	/* Reset core control flags */
1845*4882a593Smuzhiyun 	si_core_cflags(sih, 0xffff, cflags);
1846*4882a593Smuzhiyun 
1847*4882a593Smuzhiyun 	return result;
1848*4882a593Smuzhiyun }
1849*4882a593Smuzhiyun 
1850*4882a593Smuzhiyun uint
si_num_slaveports(si_t * sih,uint coreid)1851*4882a593Smuzhiyun si_num_slaveports(si_t *sih, uint coreid)
1852*4882a593Smuzhiyun {
1853*4882a593Smuzhiyun 	uint idx = si_findcoreidx(sih, coreid, 0);
1854*4882a593Smuzhiyun 	uint num = 0;
1855*4882a593Smuzhiyun 
1856*4882a593Smuzhiyun 	if (idx != BADIDX) {
1857*4882a593Smuzhiyun 		if (CHIPTYPE(sih->socitype) == SOCI_AI) {
1858*4882a593Smuzhiyun 			num = ai_num_slaveports(sih, idx);
1859*4882a593Smuzhiyun 		}
1860*4882a593Smuzhiyun 	}
1861*4882a593Smuzhiyun 	return num;
1862*4882a593Smuzhiyun }
1863*4882a593Smuzhiyun 
1864*4882a593Smuzhiyun uint32
si_get_slaveport_addr(si_t * sih,uint spidx,uint baidx,uint core_id,uint coreunit)1865*4882a593Smuzhiyun si_get_slaveport_addr(si_t *sih, uint spidx, uint baidx, uint core_id, uint coreunit)
1866*4882a593Smuzhiyun {
1867*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
1868*4882a593Smuzhiyun 	uint origidx = sii->curidx;
1869*4882a593Smuzhiyun 	uint32 addr = 0x0;
1870*4882a593Smuzhiyun 
1871*4882a593Smuzhiyun 	if (!((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1872*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1873*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI)))
1874*4882a593Smuzhiyun 		goto done;
1875*4882a593Smuzhiyun 
1876*4882a593Smuzhiyun 	si_setcore(sih, core_id, coreunit);
1877*4882a593Smuzhiyun 
1878*4882a593Smuzhiyun 	addr = ai_addrspace(sih, spidx, baidx);
1879*4882a593Smuzhiyun 
1880*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
1881*4882a593Smuzhiyun 
1882*4882a593Smuzhiyun done:
1883*4882a593Smuzhiyun 	return addr;
1884*4882a593Smuzhiyun }
1885*4882a593Smuzhiyun 
1886*4882a593Smuzhiyun uint32
si_get_d11_slaveport_addr(si_t * sih,uint spidx,uint baidx,uint coreunit)1887*4882a593Smuzhiyun si_get_d11_slaveport_addr(si_t *sih, uint spidx, uint baidx, uint coreunit)
1888*4882a593Smuzhiyun {
1889*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
1890*4882a593Smuzhiyun 	uint origidx = sii->curidx;
1891*4882a593Smuzhiyun 	uint32 addr = 0x0;
1892*4882a593Smuzhiyun 
1893*4882a593Smuzhiyun 	if (!((CHIPTYPE(sih->socitype) == SOCI_AI) ||
1894*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS) ||
1895*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_NAI)))
1896*4882a593Smuzhiyun 		goto done;
1897*4882a593Smuzhiyun 
1898*4882a593Smuzhiyun 	si_setcore(sih, D11_CORE_ID, coreunit);
1899*4882a593Smuzhiyun 
1900*4882a593Smuzhiyun 	addr = ai_addrspace(sih, spidx, baidx);
1901*4882a593Smuzhiyun 
1902*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
1903*4882a593Smuzhiyun 
1904*4882a593Smuzhiyun done:
1905*4882a593Smuzhiyun 	return addr;
1906*4882a593Smuzhiyun }
1907*4882a593Smuzhiyun 
1908*4882a593Smuzhiyun static uint32
factor6(uint32 x)1909*4882a593Smuzhiyun factor6(uint32 x)
1910*4882a593Smuzhiyun {
1911*4882a593Smuzhiyun 	switch (x) {
1912*4882a593Smuzhiyun 	case CC_F6_2:	return 2;
1913*4882a593Smuzhiyun 	case CC_F6_3:	return 3;
1914*4882a593Smuzhiyun 	case CC_F6_4:	return 4;
1915*4882a593Smuzhiyun 	case CC_F6_5:	return 5;
1916*4882a593Smuzhiyun 	case CC_F6_6:	return 6;
1917*4882a593Smuzhiyun 	case CC_F6_7:	return 7;
1918*4882a593Smuzhiyun 	default:	return 0;
1919*4882a593Smuzhiyun 	}
1920*4882a593Smuzhiyun }
1921*4882a593Smuzhiyun 
1922*4882a593Smuzhiyun /*
1923*4882a593Smuzhiyun  * Divide the clock by the divisor with protection for
1924*4882a593Smuzhiyun  * a zero divisor.
1925*4882a593Smuzhiyun  */
1926*4882a593Smuzhiyun static uint32
divide_clock(uint32 clock,uint32 div)1927*4882a593Smuzhiyun divide_clock(uint32 clock, uint32 div)
1928*4882a593Smuzhiyun {
1929*4882a593Smuzhiyun 	return div ? clock / div : 0;
1930*4882a593Smuzhiyun }
1931*4882a593Smuzhiyun 
1932*4882a593Smuzhiyun /** calculate the speed the SI would run at given a set of clockcontrol values */
1933*4882a593Smuzhiyun uint32
si_clock_rate(uint32 pll_type,uint32 n,uint32 m)1934*4882a593Smuzhiyun si_clock_rate(uint32 pll_type, uint32 n, uint32 m)
1935*4882a593Smuzhiyun {
1936*4882a593Smuzhiyun 	uint32 n1, n2, clock, m1, m2, m3, mc;
1937*4882a593Smuzhiyun 
1938*4882a593Smuzhiyun 	n1 = n & CN_N1_MASK;
1939*4882a593Smuzhiyun 	n2 = (n & CN_N2_MASK) >> CN_N2_SHIFT;
1940*4882a593Smuzhiyun 
1941*4882a593Smuzhiyun 	if (pll_type == PLL_TYPE6) {
1942*4882a593Smuzhiyun 		if (m & CC_T6_MMASK)
1943*4882a593Smuzhiyun 			return CC_T6_M1;
1944*4882a593Smuzhiyun 		else
1945*4882a593Smuzhiyun 			return CC_T6_M0;
1946*4882a593Smuzhiyun 	} else if ((pll_type == PLL_TYPE1) ||
1947*4882a593Smuzhiyun 	           (pll_type == PLL_TYPE3) ||
1948*4882a593Smuzhiyun 	           (pll_type == PLL_TYPE4) ||
1949*4882a593Smuzhiyun 	           (pll_type == PLL_TYPE7)) {
1950*4882a593Smuzhiyun 		n1 = factor6(n1);
1951*4882a593Smuzhiyun 		n2 += CC_F5_BIAS;
1952*4882a593Smuzhiyun 	} else if (pll_type == PLL_TYPE2) {
1953*4882a593Smuzhiyun 		n1 += CC_T2_BIAS;
1954*4882a593Smuzhiyun 		n2 += CC_T2_BIAS;
1955*4882a593Smuzhiyun 		ASSERT((n1 >= 2) && (n1 <= 7));
1956*4882a593Smuzhiyun 		ASSERT((n2 >= 5) && (n2 <= 23));
1957*4882a593Smuzhiyun 	} else if (pll_type == PLL_TYPE5) {
1958*4882a593Smuzhiyun 		return (100000000);
1959*4882a593Smuzhiyun 	} else
1960*4882a593Smuzhiyun 		ASSERT(0);
1961*4882a593Smuzhiyun 	/* PLL types 3 and 7 use BASE2 (25Mhz) */
1962*4882a593Smuzhiyun 	if ((pll_type == PLL_TYPE3) ||
1963*4882a593Smuzhiyun 	    (pll_type == PLL_TYPE7)) {
1964*4882a593Smuzhiyun 		clock = CC_CLOCK_BASE2 * n1 * n2;
1965*4882a593Smuzhiyun 	} else
1966*4882a593Smuzhiyun 		clock = CC_CLOCK_BASE1 * n1 * n2;
1967*4882a593Smuzhiyun 
1968*4882a593Smuzhiyun 	if (clock == 0)
1969*4882a593Smuzhiyun 		return 0;
1970*4882a593Smuzhiyun 
1971*4882a593Smuzhiyun 	m1 = m & CC_M1_MASK;
1972*4882a593Smuzhiyun 	m2 = (m & CC_M2_MASK) >> CC_M2_SHIFT;
1973*4882a593Smuzhiyun 	m3 = (m & CC_M3_MASK) >> CC_M3_SHIFT;
1974*4882a593Smuzhiyun 	mc = (m & CC_MC_MASK) >> CC_MC_SHIFT;
1975*4882a593Smuzhiyun 
1976*4882a593Smuzhiyun 	if ((pll_type == PLL_TYPE1) ||
1977*4882a593Smuzhiyun 	    (pll_type == PLL_TYPE3) ||
1978*4882a593Smuzhiyun 	    (pll_type == PLL_TYPE4) ||
1979*4882a593Smuzhiyun 	    (pll_type == PLL_TYPE7)) {
1980*4882a593Smuzhiyun 		m1 = factor6(m1);
1981*4882a593Smuzhiyun 		if ((pll_type == PLL_TYPE1) || (pll_type == PLL_TYPE3))
1982*4882a593Smuzhiyun 			m2 += CC_F5_BIAS;
1983*4882a593Smuzhiyun 		else
1984*4882a593Smuzhiyun 			m2 = factor6(m2);
1985*4882a593Smuzhiyun 		m3 = factor6(m3);
1986*4882a593Smuzhiyun 
1987*4882a593Smuzhiyun 		switch (mc) {
1988*4882a593Smuzhiyun 		case CC_MC_BYPASS:	return (clock);
1989*4882a593Smuzhiyun 		case CC_MC_M1:		return divide_clock(clock, m1);
1990*4882a593Smuzhiyun 		case CC_MC_M1M2:	return divide_clock(clock, m1 * m2);
1991*4882a593Smuzhiyun 		case CC_MC_M1M2M3:	return divide_clock(clock, m1 * m2 * m3);
1992*4882a593Smuzhiyun 		case CC_MC_M1M3:	return divide_clock(clock, m1 * m3);
1993*4882a593Smuzhiyun 		default:		return (0);
1994*4882a593Smuzhiyun 		}
1995*4882a593Smuzhiyun 	} else {
1996*4882a593Smuzhiyun 		ASSERT(pll_type == PLL_TYPE2);
1997*4882a593Smuzhiyun 
1998*4882a593Smuzhiyun 		m1 += CC_T2_BIAS;
1999*4882a593Smuzhiyun 		m2 += CC_T2M2_BIAS;
2000*4882a593Smuzhiyun 		m3 += CC_T2_BIAS;
2001*4882a593Smuzhiyun 		ASSERT((m1 >= 2) && (m1 <= 7));
2002*4882a593Smuzhiyun 		ASSERT((m2 >= 3) && (m2 <= 10));
2003*4882a593Smuzhiyun 		ASSERT((m3 >= 2) && (m3 <= 7));
2004*4882a593Smuzhiyun 
2005*4882a593Smuzhiyun 		if ((mc & CC_T2MC_M1BYP) == 0)
2006*4882a593Smuzhiyun 			clock /= m1;
2007*4882a593Smuzhiyun 		if ((mc & CC_T2MC_M2BYP) == 0)
2008*4882a593Smuzhiyun 			clock /= m2;
2009*4882a593Smuzhiyun 		if ((mc & CC_T2MC_M3BYP) == 0)
2010*4882a593Smuzhiyun 			clock /= m3;
2011*4882a593Smuzhiyun 
2012*4882a593Smuzhiyun 		return (clock);
2013*4882a593Smuzhiyun 	}
2014*4882a593Smuzhiyun }
2015*4882a593Smuzhiyun 
2016*4882a593Smuzhiyun /**
2017*4882a593Smuzhiyun  * Some chips could have multiple host interfaces, however only one will be active.
2018*4882a593Smuzhiyun  * For a given chip. Depending pkgopt and cc_chipst return the active host interface.
2019*4882a593Smuzhiyun  */
2020*4882a593Smuzhiyun uint
si_chip_hostif(si_t * sih)2021*4882a593Smuzhiyun si_chip_hostif(si_t *sih)
2022*4882a593Smuzhiyun {
2023*4882a593Smuzhiyun 	uint hosti = 0;
2024*4882a593Smuzhiyun 
2025*4882a593Smuzhiyun 	switch (CHIPID(sih->chip)) {
2026*4882a593Smuzhiyun 	case BCM43018_CHIP_ID:
2027*4882a593Smuzhiyun 	case BCM43430_CHIP_ID:
2028*4882a593Smuzhiyun 		hosti = CHIP_HOSTIF_SDIOMODE;
2029*4882a593Smuzhiyun 		break;
2030*4882a593Smuzhiyun 	case BCM43012_CHIP_ID:
2031*4882a593Smuzhiyun 		hosti = CHIP_HOSTIF_SDIOMODE;
2032*4882a593Smuzhiyun 		break;
2033*4882a593Smuzhiyun 	CASE_BCM43602_CHIP:
2034*4882a593Smuzhiyun 		hosti = CHIP_HOSTIF_PCIEMODE;
2035*4882a593Smuzhiyun 		break;
2036*4882a593Smuzhiyun 
2037*4882a593Smuzhiyun 	case BCM4360_CHIP_ID:
2038*4882a593Smuzhiyun 		/* chippkg bit-0 == 0 is PCIE only pkgs
2039*4882a593Smuzhiyun 		 * chippkg bit-0 == 1 has both PCIE and USB cores enabled
2040*4882a593Smuzhiyun 		 */
2041*4882a593Smuzhiyun 		if ((sih->chippkg & 0x1) && (sih->chipst & CST4360_MODE_USB))
2042*4882a593Smuzhiyun 			hosti = CHIP_HOSTIF_USBMODE;
2043*4882a593Smuzhiyun 		else
2044*4882a593Smuzhiyun 			hosti = CHIP_HOSTIF_PCIEMODE;
2045*4882a593Smuzhiyun 
2046*4882a593Smuzhiyun 		break;
2047*4882a593Smuzhiyun 
2048*4882a593Smuzhiyun 	case BCM4335_CHIP_ID:
2049*4882a593Smuzhiyun 		/* TBD: like in 4360, do we need to check pkg? */
2050*4882a593Smuzhiyun 		if (CST4335_CHIPMODE_USB20D(sih->chipst))
2051*4882a593Smuzhiyun 			hosti = CHIP_HOSTIF_USBMODE;
2052*4882a593Smuzhiyun 		else if (CST4335_CHIPMODE_SDIOD(sih->chipst))
2053*4882a593Smuzhiyun 			hosti = CHIP_HOSTIF_SDIOMODE;
2054*4882a593Smuzhiyun 		else
2055*4882a593Smuzhiyun 			hosti = CHIP_HOSTIF_PCIEMODE;
2056*4882a593Smuzhiyun 		break;
2057*4882a593Smuzhiyun 
2058*4882a593Smuzhiyun 	CASE_BCM4345_CHIP:
2059*4882a593Smuzhiyun 		if (CST4345_CHIPMODE_USB20D(sih->chipst) || CST4345_CHIPMODE_HSIC(sih->chipst))
2060*4882a593Smuzhiyun 			hosti = CHIP_HOSTIF_USBMODE;
2061*4882a593Smuzhiyun 		else if (CST4345_CHIPMODE_SDIOD(sih->chipst))
2062*4882a593Smuzhiyun 			hosti = CHIP_HOSTIF_SDIOMODE;
2063*4882a593Smuzhiyun 		else if (CST4345_CHIPMODE_PCIE(sih->chipst))
2064*4882a593Smuzhiyun 			hosti = CHIP_HOSTIF_PCIEMODE;
2065*4882a593Smuzhiyun 		break;
2066*4882a593Smuzhiyun 
2067*4882a593Smuzhiyun 	case BCM4349_CHIP_GRPID:
2068*4882a593Smuzhiyun 	case BCM53573_CHIP_GRPID:
2069*4882a593Smuzhiyun 		if (CST4349_CHIPMODE_SDIOD(sih->chipst))
2070*4882a593Smuzhiyun 			hosti = CHIP_HOSTIF_SDIOMODE;
2071*4882a593Smuzhiyun 		else if (CST4349_CHIPMODE_PCIE(sih->chipst))
2072*4882a593Smuzhiyun 			hosti = CHIP_HOSTIF_PCIEMODE;
2073*4882a593Smuzhiyun 		break;
2074*4882a593Smuzhiyun 	case BCM4364_CHIP_ID:
2075*4882a593Smuzhiyun 		 if (CST4364_CHIPMODE_SDIOD(sih->chipst))
2076*4882a593Smuzhiyun 			 hosti = CHIP_HOSTIF_SDIOMODE;
2077*4882a593Smuzhiyun 		 else if (CST4364_CHIPMODE_PCIE(sih->chipst))
2078*4882a593Smuzhiyun 			 hosti = CHIP_HOSTIF_PCIEMODE;
2079*4882a593Smuzhiyun 		 break;
2080*4882a593Smuzhiyun 	case BCM4373_CHIP_ID:
2081*4882a593Smuzhiyun 		 if (CST4373_CHIPMODE_USB20D(sih->chipst))
2082*4882a593Smuzhiyun 			 hosti = CHIP_HOSTIF_USBMODE;
2083*4882a593Smuzhiyun 		 else if (CST4373_CHIPMODE_SDIOD(sih->chipst))
2084*4882a593Smuzhiyun 			 hosti = CHIP_HOSTIF_SDIOMODE;
2085*4882a593Smuzhiyun 		 else if (CST4373_CHIPMODE_PCIE(sih->chipst))
2086*4882a593Smuzhiyun 			 hosti = CHIP_HOSTIF_PCIEMODE;
2087*4882a593Smuzhiyun 		 break;
2088*4882a593Smuzhiyun 
2089*4882a593Smuzhiyun 	case BCM4347_CHIP_GRPID:
2090*4882a593Smuzhiyun 		 if (CST4347_CHIPMODE_SDIOD(sih->chipst))
2091*4882a593Smuzhiyun 			 hosti = CHIP_HOSTIF_SDIOMODE;
2092*4882a593Smuzhiyun 		 else if (CST4347_CHIPMODE_PCIE(sih->chipst))
2093*4882a593Smuzhiyun 			 hosti = CHIP_HOSTIF_PCIEMODE;
2094*4882a593Smuzhiyun 		 break;
2095*4882a593Smuzhiyun 	case BCM4369_CHIP_GRPID:
2096*4882a593Smuzhiyun 		 if (CST4369_CHIPMODE_SDIOD(sih->chipst))
2097*4882a593Smuzhiyun 			 hosti = CHIP_HOSTIF_SDIOMODE;
2098*4882a593Smuzhiyun 		 else if (CST4369_CHIPMODE_PCIE(sih->chipst))
2099*4882a593Smuzhiyun 			 hosti = CHIP_HOSTIF_PCIEMODE;
2100*4882a593Smuzhiyun 		 break;
2101*4882a593Smuzhiyun #ifdef CHIPS_CUSTOMER_HW6
2102*4882a593Smuzhiyun 	case BCM4368_CHIP_GRPID:
2103*4882a593Smuzhiyun 		 hosti = CHIP_HOSTIF_PCIEMODE;
2104*4882a593Smuzhiyun 		 break;
2105*4882a593Smuzhiyun #endif /* CHIPS_CUSTOMER_HW6 */
2106*4882a593Smuzhiyun 
2107*4882a593Smuzhiyun 	case BCM4350_CHIP_ID:
2108*4882a593Smuzhiyun 	case BCM4354_CHIP_ID:
2109*4882a593Smuzhiyun 	case BCM43556_CHIP_ID:
2110*4882a593Smuzhiyun 	case BCM43558_CHIP_ID:
2111*4882a593Smuzhiyun 	case BCM43566_CHIP_ID:
2112*4882a593Smuzhiyun 	case BCM43568_CHIP_ID:
2113*4882a593Smuzhiyun 	case BCM43569_CHIP_ID:
2114*4882a593Smuzhiyun 	case BCM43570_CHIP_ID:
2115*4882a593Smuzhiyun 	case BCM4358_CHIP_ID:
2116*4882a593Smuzhiyun 		if (CST4350_CHIPMODE_USB20D(sih->chipst) ||
2117*4882a593Smuzhiyun 		    CST4350_CHIPMODE_HSIC20D(sih->chipst) ||
2118*4882a593Smuzhiyun 		    CST4350_CHIPMODE_USB30D(sih->chipst) ||
2119*4882a593Smuzhiyun 		    CST4350_CHIPMODE_USB30D_WL(sih->chipst) ||
2120*4882a593Smuzhiyun 		    CST4350_CHIPMODE_HSIC30D(sih->chipst))
2121*4882a593Smuzhiyun 			hosti = CHIP_HOSTIF_USBMODE;
2122*4882a593Smuzhiyun 		else if (CST4350_CHIPMODE_SDIOD(sih->chipst))
2123*4882a593Smuzhiyun 			hosti = CHIP_HOSTIF_SDIOMODE;
2124*4882a593Smuzhiyun 		else if (CST4350_CHIPMODE_PCIE(sih->chipst))
2125*4882a593Smuzhiyun 			hosti = CHIP_HOSTIF_PCIEMODE;
2126*4882a593Smuzhiyun 		break;
2127*4882a593Smuzhiyun 
2128*4882a593Smuzhiyun 	default:
2129*4882a593Smuzhiyun 		break;
2130*4882a593Smuzhiyun 	}
2131*4882a593Smuzhiyun 
2132*4882a593Smuzhiyun 	return hosti;
2133*4882a593Smuzhiyun }
2134*4882a593Smuzhiyun 
2135*4882a593Smuzhiyun /** set chip watchdog reset timer to fire in 'ticks' */
2136*4882a593Smuzhiyun void
si_watchdog(si_t * sih,uint ticks)2137*4882a593Smuzhiyun si_watchdog(si_t *sih, uint ticks)
2138*4882a593Smuzhiyun {
2139*4882a593Smuzhiyun 	uint nb, maxt;
2140*4882a593Smuzhiyun 	uint pmu_wdt = 1;
2141*4882a593Smuzhiyun 
2142*4882a593Smuzhiyun 	if (PMUCTL_ENAB(sih) && pmu_wdt) {
2143*4882a593Smuzhiyun 		nb = (CCREV(sih->ccrev) < 26) ? 16 : ((CCREV(sih->ccrev) >= 37) ? 32 : 24);
2144*4882a593Smuzhiyun 		/* The mips compiler uses the sllv instruction,
2145*4882a593Smuzhiyun 		 * so we specially handle the 32-bit case.
2146*4882a593Smuzhiyun 		 */
2147*4882a593Smuzhiyun 		if (nb == 32)
2148*4882a593Smuzhiyun 			maxt = 0xffffffff;
2149*4882a593Smuzhiyun 		else
2150*4882a593Smuzhiyun 			maxt = ((1 << nb) - 1);
2151*4882a593Smuzhiyun 
2152*4882a593Smuzhiyun 		if (ticks == 1)
2153*4882a593Smuzhiyun 			ticks = 2;
2154*4882a593Smuzhiyun 		else if (ticks > maxt)
2155*4882a593Smuzhiyun 			ticks = maxt;
2156*4882a593Smuzhiyun 		if (CHIPID(sih->chip) == BCM43012_CHIP_ID) {
2157*4882a593Smuzhiyun 			PMU_REG_NEW(sih, min_res_mask, ~0, DEFAULT_43012_MIN_RES_MASK);
2158*4882a593Smuzhiyun 			PMU_REG_NEW(sih, watchdog_res_mask, ~0, DEFAULT_43012_MIN_RES_MASK);
2159*4882a593Smuzhiyun 			PMU_REG_NEW(sih, pmustatus, PST_WDRESET, PST_WDRESET);
2160*4882a593Smuzhiyun 			PMU_REG_NEW(sih, pmucontrol_ext, PCTL_EXT_FASTLPO_SWENAB, 0);
2161*4882a593Smuzhiyun 			SPINWAIT((PMU_REG(sih, pmustatus, 0, 0) & PST_ILPFASTLPO),
2162*4882a593Smuzhiyun 				PMU_MAX_TRANSITION_DLY);
2163*4882a593Smuzhiyun 		}
2164*4882a593Smuzhiyun 		if (sih->chip == CYW55500_CHIP_ID ||
2165*4882a593Smuzhiyun 		    sih->chip == CYW55560_CHIP_ID) {
2166*4882a593Smuzhiyun 			si_corereg(sih, si_findcoreidx(sih, PMU_CORE_ID, 0),
2167*4882a593Smuzhiyun 				OFFSETOF(pmuregs_t, pmuwatchdog), ~0, ticks);
2168*4882a593Smuzhiyun 		} else {
2169*4882a593Smuzhiyun 			pmu_corereg(sih, SI_CC_IDX, pmuwatchdog, ~0, ticks);
2170*4882a593Smuzhiyun 		}
2171*4882a593Smuzhiyun 	} else {
2172*4882a593Smuzhiyun 		maxt = (1 << 28) - 1;
2173*4882a593Smuzhiyun 		if (ticks > maxt)
2174*4882a593Smuzhiyun 			ticks = maxt;
2175*4882a593Smuzhiyun 
2176*4882a593Smuzhiyun 		si_corereg(sih, SI_CC_IDX, OFFSETOF(chipcregs_t, watchdog), ~0, ticks);
2177*4882a593Smuzhiyun 	}
2178*4882a593Smuzhiyun }
2179*4882a593Smuzhiyun 
2180*4882a593Smuzhiyun /** trigger watchdog reset after ms milliseconds */
2181*4882a593Smuzhiyun void
si_watchdog_ms(si_t * sih,uint32 ms)2182*4882a593Smuzhiyun si_watchdog_ms(si_t *sih, uint32 ms)
2183*4882a593Smuzhiyun {
2184*4882a593Smuzhiyun 	si_watchdog(sih, wd_msticks * ms);
2185*4882a593Smuzhiyun }
2186*4882a593Smuzhiyun 
si_watchdog_msticks(void)2187*4882a593Smuzhiyun uint32 si_watchdog_msticks(void)
2188*4882a593Smuzhiyun {
2189*4882a593Smuzhiyun 	return wd_msticks;
2190*4882a593Smuzhiyun }
2191*4882a593Smuzhiyun 
2192*4882a593Smuzhiyun bool
si_taclear(si_t * sih,bool details)2193*4882a593Smuzhiyun si_taclear(si_t *sih, bool details)
2194*4882a593Smuzhiyun {
2195*4882a593Smuzhiyun 	return FALSE;
2196*4882a593Smuzhiyun }
2197*4882a593Smuzhiyun 
2198*4882a593Smuzhiyun /** return the slow clock source - LPO, XTAL, or PCI */
2199*4882a593Smuzhiyun static uint
si_slowclk_src(si_info_t * sii)2200*4882a593Smuzhiyun si_slowclk_src(si_info_t *sii)
2201*4882a593Smuzhiyun {
2202*4882a593Smuzhiyun 	chipcregs_t *cc;
2203*4882a593Smuzhiyun 
2204*4882a593Smuzhiyun 	ASSERT(SI_FAST(sii) || si_coreid(&sii->pub) == CC_CORE_ID);
2205*4882a593Smuzhiyun 
2206*4882a593Smuzhiyun 	if (CCREV(sii->pub.ccrev) < 6) {
2207*4882a593Smuzhiyun 		if ((BUSTYPE(sii->pub.bustype) == PCI_BUS) &&
2208*4882a593Smuzhiyun 		    (OSL_PCI_READ_CONFIG(sii->osh, PCI_GPIO_OUT, sizeof(uint32)) &
2209*4882a593Smuzhiyun 		     PCI_CFG_GPIO_SCS))
2210*4882a593Smuzhiyun 			return (SCC_SS_PCI);
2211*4882a593Smuzhiyun 		else
2212*4882a593Smuzhiyun 			return (SCC_SS_XTAL);
2213*4882a593Smuzhiyun 	} else if (CCREV(sii->pub.ccrev) < 10) {
2214*4882a593Smuzhiyun 		cc = (chipcregs_t *)si_setcoreidx(&sii->pub, sii->curidx);
2215*4882a593Smuzhiyun 		ASSERT(cc);
2216*4882a593Smuzhiyun 		return (R_REG(sii->osh, &cc->slow_clk_ctl) & SCC_SS_MASK);
2217*4882a593Smuzhiyun 	} else	/* Insta-clock */
2218*4882a593Smuzhiyun 		return (SCC_SS_XTAL);
2219*4882a593Smuzhiyun }
2220*4882a593Smuzhiyun 
2221*4882a593Smuzhiyun /** return the ILP (slowclock) min or max frequency */
2222*4882a593Smuzhiyun static uint
si_slowclk_freq(si_info_t * sii,bool max_freq,chipcregs_t * cc)2223*4882a593Smuzhiyun si_slowclk_freq(si_info_t *sii, bool max_freq, chipcregs_t *cc)
2224*4882a593Smuzhiyun {
2225*4882a593Smuzhiyun 	uint32 slowclk;
2226*4882a593Smuzhiyun 	uint div;
2227*4882a593Smuzhiyun 
2228*4882a593Smuzhiyun 	ASSERT(SI_FAST(sii) || si_coreid(&sii->pub) == CC_CORE_ID);
2229*4882a593Smuzhiyun 
2230*4882a593Smuzhiyun 	/* shouldn't be here unless we've established the chip has dynamic clk control */
2231*4882a593Smuzhiyun 	ASSERT(R_REG(sii->osh, &cc->capabilities) & CC_CAP_PWR_CTL);
2232*4882a593Smuzhiyun 
2233*4882a593Smuzhiyun 	slowclk = si_slowclk_src(sii);
2234*4882a593Smuzhiyun 	if (CCREV(sii->pub.ccrev) < 6) {
2235*4882a593Smuzhiyun 		if (slowclk == SCC_SS_PCI)
2236*4882a593Smuzhiyun 			return (max_freq ? (PCIMAXFREQ / 64) : (PCIMINFREQ / 64));
2237*4882a593Smuzhiyun 		else
2238*4882a593Smuzhiyun 			return (max_freq ? (XTALMAXFREQ / 32) : (XTALMINFREQ / 32));
2239*4882a593Smuzhiyun 	} else if (CCREV(sii->pub.ccrev) < 10) {
2240*4882a593Smuzhiyun 		div = 4 *
2241*4882a593Smuzhiyun 		        (((R_REG(sii->osh, &cc->slow_clk_ctl) & SCC_CD_MASK) >> SCC_CD_SHIFT) + 1);
2242*4882a593Smuzhiyun 		if (slowclk == SCC_SS_LPO)
2243*4882a593Smuzhiyun 			return (max_freq ? LPOMAXFREQ : LPOMINFREQ);
2244*4882a593Smuzhiyun 		else if (slowclk == SCC_SS_XTAL)
2245*4882a593Smuzhiyun 			return (max_freq ? (XTALMAXFREQ / div) : (XTALMINFREQ / div));
2246*4882a593Smuzhiyun 		else if (slowclk == SCC_SS_PCI)
2247*4882a593Smuzhiyun 			return (max_freq ? (PCIMAXFREQ / div) : (PCIMINFREQ / div));
2248*4882a593Smuzhiyun 		else
2249*4882a593Smuzhiyun 			ASSERT(0);
2250*4882a593Smuzhiyun 	} else {
2251*4882a593Smuzhiyun 		/* Chipc rev 10 is InstaClock */
2252*4882a593Smuzhiyun 		div = R_REG(sii->osh, &cc->system_clk_ctl) >> SYCC_CD_SHIFT;
2253*4882a593Smuzhiyun 		div = 4 * (div + 1);
2254*4882a593Smuzhiyun 		return (max_freq ? XTALMAXFREQ : (XTALMINFREQ / div));
2255*4882a593Smuzhiyun 	}
2256*4882a593Smuzhiyun 	return (0);
2257*4882a593Smuzhiyun }
2258*4882a593Smuzhiyun 
2259*4882a593Smuzhiyun static void
si_clkctl_setdelay(si_info_t * sii,void * chipcregs)2260*4882a593Smuzhiyun si_clkctl_setdelay(si_info_t *sii, void *chipcregs)
2261*4882a593Smuzhiyun {
2262*4882a593Smuzhiyun 	chipcregs_t *cc = (chipcregs_t *)chipcregs;
2263*4882a593Smuzhiyun 	uint slowmaxfreq, pll_delay, slowclk;
2264*4882a593Smuzhiyun 	uint pll_on_delay, fref_sel_delay;
2265*4882a593Smuzhiyun 
2266*4882a593Smuzhiyun 	pll_delay = PLL_DELAY;
2267*4882a593Smuzhiyun 
2268*4882a593Smuzhiyun 	/* If the slow clock is not sourced by the xtal then add the xtal_on_delay
2269*4882a593Smuzhiyun 	 * since the xtal will also be powered down by dynamic clk control logic.
2270*4882a593Smuzhiyun 	 */
2271*4882a593Smuzhiyun 
2272*4882a593Smuzhiyun 	slowclk = si_slowclk_src(sii);
2273*4882a593Smuzhiyun 	if (slowclk != SCC_SS_XTAL)
2274*4882a593Smuzhiyun 		pll_delay += XTAL_ON_DELAY;
2275*4882a593Smuzhiyun 
2276*4882a593Smuzhiyun 	/* Starting with 4318 it is ILP that is used for the delays */
2277*4882a593Smuzhiyun 	slowmaxfreq = si_slowclk_freq(sii, (CCREV(sii->pub.ccrev) >= 10) ? FALSE : TRUE, cc);
2278*4882a593Smuzhiyun 
2279*4882a593Smuzhiyun 	pll_on_delay = ((slowmaxfreq * pll_delay) + 999999) / 1000000;
2280*4882a593Smuzhiyun 	fref_sel_delay = ((slowmaxfreq * FREF_DELAY) + 999999) / 1000000;
2281*4882a593Smuzhiyun 
2282*4882a593Smuzhiyun 	W_REG(sii->osh, &cc->pll_on_delay, pll_on_delay);
2283*4882a593Smuzhiyun 	W_REG(sii->osh, &cc->fref_sel_delay, fref_sel_delay);
2284*4882a593Smuzhiyun }
2285*4882a593Smuzhiyun 
2286*4882a593Smuzhiyun /** initialize power control delay registers */
2287*4882a593Smuzhiyun void
si_clkctl_init(si_t * sih)2288*4882a593Smuzhiyun si_clkctl_init(si_t *sih)
2289*4882a593Smuzhiyun {
2290*4882a593Smuzhiyun 	si_info_t *sii;
2291*4882a593Smuzhiyun 	uint origidx = 0;
2292*4882a593Smuzhiyun 	chipcregs_t *cc;
2293*4882a593Smuzhiyun 	bool fast;
2294*4882a593Smuzhiyun 
2295*4882a593Smuzhiyun 	if (!CCCTL_ENAB(sih))
2296*4882a593Smuzhiyun 		return;
2297*4882a593Smuzhiyun 
2298*4882a593Smuzhiyun 	sii = SI_INFO(sih);
2299*4882a593Smuzhiyun 	fast = SI_FAST(sii);
2300*4882a593Smuzhiyun 	if (!fast) {
2301*4882a593Smuzhiyun 		origidx = sii->curidx;
2302*4882a593Smuzhiyun 		if ((cc = (chipcregs_t *)si_setcore(sih, CC_CORE_ID, 0)) == NULL)
2303*4882a593Smuzhiyun 			return;
2304*4882a593Smuzhiyun 	} else if ((cc = (chipcregs_t *)CCREGS_FAST(sii)) == NULL)
2305*4882a593Smuzhiyun 		return;
2306*4882a593Smuzhiyun 	ASSERT(cc != NULL);
2307*4882a593Smuzhiyun 
2308*4882a593Smuzhiyun 	/* set all Instaclk chip ILP to 1 MHz */
2309*4882a593Smuzhiyun 	if (CCREV(sih->ccrev) >= 10)
2310*4882a593Smuzhiyun 		SET_REG(sii->osh, &cc->system_clk_ctl, SYCC_CD_MASK,
2311*4882a593Smuzhiyun 		        (ILP_DIV_1MHZ << SYCC_CD_SHIFT));
2312*4882a593Smuzhiyun 
2313*4882a593Smuzhiyun 	si_clkctl_setdelay(sii, (void *)(uintptr)cc);
2314*4882a593Smuzhiyun 
2315*4882a593Smuzhiyun 	OSL_DELAY(20000);
2316*4882a593Smuzhiyun 
2317*4882a593Smuzhiyun 	if (!fast)
2318*4882a593Smuzhiyun 		si_setcoreidx(sih, origidx);
2319*4882a593Smuzhiyun }
2320*4882a593Smuzhiyun 
2321*4882a593Smuzhiyun /** change logical "focus" to the gpio core for optimized access */
2322*4882a593Smuzhiyun volatile void *
si_gpiosetcore(si_t * sih)2323*4882a593Smuzhiyun si_gpiosetcore(si_t *sih)
2324*4882a593Smuzhiyun {
2325*4882a593Smuzhiyun 	return (si_setcoreidx(sih, SI_CC_IDX));
2326*4882a593Smuzhiyun }
2327*4882a593Smuzhiyun 
2328*4882a593Smuzhiyun /**
2329*4882a593Smuzhiyun  * mask & set gpiocontrol bits.
2330*4882a593Smuzhiyun  * If a gpiocontrol bit is set to 0, chipcommon controls the corresponding GPIO pin.
2331*4882a593Smuzhiyun  * If a gpiocontrol bit is set to 1, the GPIO pin is no longer a GPIO and becomes dedicated
2332*4882a593Smuzhiyun  *   to some chip-specific purpose.
2333*4882a593Smuzhiyun  */
2334*4882a593Smuzhiyun uint32
si_gpiocontrol(si_t * sih,uint32 mask,uint32 val,uint8 priority)2335*4882a593Smuzhiyun si_gpiocontrol(si_t *sih, uint32 mask, uint32 val, uint8 priority)
2336*4882a593Smuzhiyun {
2337*4882a593Smuzhiyun 	uint regoff;
2338*4882a593Smuzhiyun 
2339*4882a593Smuzhiyun 	regoff = 0;
2340*4882a593Smuzhiyun 
2341*4882a593Smuzhiyun 	/* gpios could be shared on router platforms
2342*4882a593Smuzhiyun 	 * ignore reservation if it's high priority (e.g., test apps)
2343*4882a593Smuzhiyun 	 */
2344*4882a593Smuzhiyun 	if ((priority != GPIO_HI_PRIORITY) &&
2345*4882a593Smuzhiyun 	    (BUSTYPE(sih->bustype) == SI_BUS) && (val || mask)) {
2346*4882a593Smuzhiyun 		mask = priority ? (si_gpioreservation & mask) :
2347*4882a593Smuzhiyun 			((si_gpioreservation | mask) & ~(si_gpioreservation));
2348*4882a593Smuzhiyun 		val &= mask;
2349*4882a593Smuzhiyun 	}
2350*4882a593Smuzhiyun 
2351*4882a593Smuzhiyun 	regoff = OFFSETOF(chipcregs_t, gpiocontrol);
2352*4882a593Smuzhiyun 	return (si_corereg(sih, SI_CC_IDX, regoff, mask, val));
2353*4882a593Smuzhiyun }
2354*4882a593Smuzhiyun 
2355*4882a593Smuzhiyun /** mask&set gpio output enable bits */
2356*4882a593Smuzhiyun uint32
si_gpioouten(si_t * sih,uint32 mask,uint32 val,uint8 priority)2357*4882a593Smuzhiyun si_gpioouten(si_t *sih, uint32 mask, uint32 val, uint8 priority)
2358*4882a593Smuzhiyun {
2359*4882a593Smuzhiyun 	uint regoff;
2360*4882a593Smuzhiyun 
2361*4882a593Smuzhiyun 	regoff = 0;
2362*4882a593Smuzhiyun 
2363*4882a593Smuzhiyun 	/* gpios could be shared on router platforms
2364*4882a593Smuzhiyun 	 * ignore reservation if it's high priority (e.g., test apps)
2365*4882a593Smuzhiyun 	 */
2366*4882a593Smuzhiyun 	if ((priority != GPIO_HI_PRIORITY) &&
2367*4882a593Smuzhiyun 	    (BUSTYPE(sih->bustype) == SI_BUS) && (val || mask)) {
2368*4882a593Smuzhiyun 		mask = priority ? (si_gpioreservation & mask) :
2369*4882a593Smuzhiyun 			((si_gpioreservation | mask) & ~(si_gpioreservation));
2370*4882a593Smuzhiyun 		val &= mask;
2371*4882a593Smuzhiyun 	}
2372*4882a593Smuzhiyun 
2373*4882a593Smuzhiyun 	regoff = OFFSETOF(chipcregs_t, gpioouten);
2374*4882a593Smuzhiyun 	return (si_corereg(sih, SI_CC_IDX, regoff, mask, val));
2375*4882a593Smuzhiyun }
2376*4882a593Smuzhiyun 
2377*4882a593Smuzhiyun /** mask&set gpio output bits */
2378*4882a593Smuzhiyun uint32
si_gpioout(si_t * sih,uint32 mask,uint32 val,uint8 priority)2379*4882a593Smuzhiyun si_gpioout(si_t *sih, uint32 mask, uint32 val, uint8 priority)
2380*4882a593Smuzhiyun {
2381*4882a593Smuzhiyun 	uint regoff;
2382*4882a593Smuzhiyun 
2383*4882a593Smuzhiyun 	regoff = 0;
2384*4882a593Smuzhiyun 
2385*4882a593Smuzhiyun 	/* gpios could be shared on router platforms
2386*4882a593Smuzhiyun 	 * ignore reservation if it's high priority (e.g., test apps)
2387*4882a593Smuzhiyun 	 */
2388*4882a593Smuzhiyun 	if ((priority != GPIO_HI_PRIORITY) &&
2389*4882a593Smuzhiyun 	    (BUSTYPE(sih->bustype) == SI_BUS) && (val || mask)) {
2390*4882a593Smuzhiyun 		mask = priority ? (si_gpioreservation & mask) :
2391*4882a593Smuzhiyun 			((si_gpioreservation | mask) & ~(si_gpioreservation));
2392*4882a593Smuzhiyun 		val &= mask;
2393*4882a593Smuzhiyun 	}
2394*4882a593Smuzhiyun 
2395*4882a593Smuzhiyun 	regoff = OFFSETOF(chipcregs_t, gpioout);
2396*4882a593Smuzhiyun 	return (si_corereg(sih, SI_CC_IDX, regoff, mask, val));
2397*4882a593Smuzhiyun }
2398*4882a593Smuzhiyun 
2399*4882a593Smuzhiyun /** reserve one gpio */
2400*4882a593Smuzhiyun uint32
si_gpioreserve(si_t * sih,uint32 gpio_bitmask,uint8 priority)2401*4882a593Smuzhiyun si_gpioreserve(si_t *sih, uint32 gpio_bitmask, uint8 priority)
2402*4882a593Smuzhiyun {
2403*4882a593Smuzhiyun 	/* only cores on SI_BUS share GPIO's and only applcation users need to
2404*4882a593Smuzhiyun 	 * reserve/release GPIO
2405*4882a593Smuzhiyun 	 */
2406*4882a593Smuzhiyun 	if ((BUSTYPE(sih->bustype) != SI_BUS) || (!priority)) {
2407*4882a593Smuzhiyun 		ASSERT((BUSTYPE(sih->bustype) == SI_BUS) && (priority));
2408*4882a593Smuzhiyun 		return 0xffffffff;
2409*4882a593Smuzhiyun 	}
2410*4882a593Smuzhiyun 	/* make sure only one bit is set */
2411*4882a593Smuzhiyun 	if ((!gpio_bitmask) || ((gpio_bitmask) & (gpio_bitmask - 1))) {
2412*4882a593Smuzhiyun 		ASSERT((gpio_bitmask) && !((gpio_bitmask) & (gpio_bitmask - 1)));
2413*4882a593Smuzhiyun 		return 0xffffffff;
2414*4882a593Smuzhiyun 	}
2415*4882a593Smuzhiyun 
2416*4882a593Smuzhiyun 	/* already reserved */
2417*4882a593Smuzhiyun 	if (si_gpioreservation & gpio_bitmask)
2418*4882a593Smuzhiyun 		return 0xffffffff;
2419*4882a593Smuzhiyun 	/* set reservation */
2420*4882a593Smuzhiyun 	si_gpioreservation |= gpio_bitmask;
2421*4882a593Smuzhiyun 
2422*4882a593Smuzhiyun 	return si_gpioreservation;
2423*4882a593Smuzhiyun }
2424*4882a593Smuzhiyun 
2425*4882a593Smuzhiyun /**
2426*4882a593Smuzhiyun  * release one gpio.
2427*4882a593Smuzhiyun  *
2428*4882a593Smuzhiyun  * releasing the gpio doesn't change the current value on the GPIO last write value
2429*4882a593Smuzhiyun  * persists till someone overwrites it.
2430*4882a593Smuzhiyun  */
2431*4882a593Smuzhiyun uint32
si_gpiorelease(si_t * sih,uint32 gpio_bitmask,uint8 priority)2432*4882a593Smuzhiyun si_gpiorelease(si_t *sih, uint32 gpio_bitmask, uint8 priority)
2433*4882a593Smuzhiyun {
2434*4882a593Smuzhiyun 	/* only cores on SI_BUS share GPIO's and only applcation users need to
2435*4882a593Smuzhiyun 	 * reserve/release GPIO
2436*4882a593Smuzhiyun 	 */
2437*4882a593Smuzhiyun 	if ((BUSTYPE(sih->bustype) != SI_BUS) || (!priority)) {
2438*4882a593Smuzhiyun 		ASSERT((BUSTYPE(sih->bustype) == SI_BUS) && (priority));
2439*4882a593Smuzhiyun 		return 0xffffffff;
2440*4882a593Smuzhiyun 	}
2441*4882a593Smuzhiyun 	/* make sure only one bit is set */
2442*4882a593Smuzhiyun 	if ((!gpio_bitmask) || ((gpio_bitmask) & (gpio_bitmask - 1))) {
2443*4882a593Smuzhiyun 		ASSERT((gpio_bitmask) && !((gpio_bitmask) & (gpio_bitmask - 1)));
2444*4882a593Smuzhiyun 		return 0xffffffff;
2445*4882a593Smuzhiyun 	}
2446*4882a593Smuzhiyun 
2447*4882a593Smuzhiyun 	/* already released */
2448*4882a593Smuzhiyun 	if (!(si_gpioreservation & gpio_bitmask))
2449*4882a593Smuzhiyun 		return 0xffffffff;
2450*4882a593Smuzhiyun 
2451*4882a593Smuzhiyun 	/* clear reservation */
2452*4882a593Smuzhiyun 	si_gpioreservation &= ~gpio_bitmask;
2453*4882a593Smuzhiyun 
2454*4882a593Smuzhiyun 	return si_gpioreservation;
2455*4882a593Smuzhiyun }
2456*4882a593Smuzhiyun 
2457*4882a593Smuzhiyun /* return the current gpioin register value */
2458*4882a593Smuzhiyun uint32
si_gpioin(si_t * sih)2459*4882a593Smuzhiyun si_gpioin(si_t *sih)
2460*4882a593Smuzhiyun {
2461*4882a593Smuzhiyun 	uint regoff;
2462*4882a593Smuzhiyun 
2463*4882a593Smuzhiyun 	regoff = OFFSETOF(chipcregs_t, gpioin);
2464*4882a593Smuzhiyun 	return (si_corereg(sih, SI_CC_IDX, regoff, 0, 0));
2465*4882a593Smuzhiyun }
2466*4882a593Smuzhiyun 
2467*4882a593Smuzhiyun /* mask&set gpio interrupt polarity bits */
2468*4882a593Smuzhiyun uint32
si_gpiointpolarity(si_t * sih,uint32 mask,uint32 val,uint8 priority)2469*4882a593Smuzhiyun si_gpiointpolarity(si_t *sih, uint32 mask, uint32 val, uint8 priority)
2470*4882a593Smuzhiyun {
2471*4882a593Smuzhiyun 	uint regoff;
2472*4882a593Smuzhiyun 
2473*4882a593Smuzhiyun 	/* gpios could be shared on router platforms */
2474*4882a593Smuzhiyun 	if ((BUSTYPE(sih->bustype) == SI_BUS) && (val || mask)) {
2475*4882a593Smuzhiyun 		mask = priority ? (si_gpioreservation & mask) :
2476*4882a593Smuzhiyun 			((si_gpioreservation | mask) & ~(si_gpioreservation));
2477*4882a593Smuzhiyun 		val &= mask;
2478*4882a593Smuzhiyun 	}
2479*4882a593Smuzhiyun 
2480*4882a593Smuzhiyun 	regoff = OFFSETOF(chipcregs_t, gpiointpolarity);
2481*4882a593Smuzhiyun 	return (si_corereg(sih, SI_CC_IDX, regoff, mask, val));
2482*4882a593Smuzhiyun }
2483*4882a593Smuzhiyun 
2484*4882a593Smuzhiyun /* mask&set gpio interrupt mask bits */
2485*4882a593Smuzhiyun uint32
si_gpiointmask(si_t * sih,uint32 mask,uint32 val,uint8 priority)2486*4882a593Smuzhiyun si_gpiointmask(si_t *sih, uint32 mask, uint32 val, uint8 priority)
2487*4882a593Smuzhiyun {
2488*4882a593Smuzhiyun 	uint regoff;
2489*4882a593Smuzhiyun 
2490*4882a593Smuzhiyun 	/* gpios could be shared on router platforms */
2491*4882a593Smuzhiyun 	if ((BUSTYPE(sih->bustype) == SI_BUS) && (val || mask)) {
2492*4882a593Smuzhiyun 		mask = priority ? (si_gpioreservation & mask) :
2493*4882a593Smuzhiyun 			((si_gpioreservation | mask) & ~(si_gpioreservation));
2494*4882a593Smuzhiyun 		val &= mask;
2495*4882a593Smuzhiyun 	}
2496*4882a593Smuzhiyun 
2497*4882a593Smuzhiyun 	regoff = OFFSETOF(chipcregs_t, gpiointmask);
2498*4882a593Smuzhiyun 	return (si_corereg(sih, SI_CC_IDX, regoff, mask, val));
2499*4882a593Smuzhiyun }
2500*4882a593Smuzhiyun 
2501*4882a593Smuzhiyun uint32
si_gpioeventintmask(si_t * sih,uint32 mask,uint32 val,uint8 priority)2502*4882a593Smuzhiyun si_gpioeventintmask(si_t *sih, uint32 mask, uint32 val, uint8 priority)
2503*4882a593Smuzhiyun {
2504*4882a593Smuzhiyun 	uint regoff;
2505*4882a593Smuzhiyun 	/* gpios could be shared on router platforms */
2506*4882a593Smuzhiyun 	if ((BUSTYPE(sih->bustype) == SI_BUS) && (val || mask)) {
2507*4882a593Smuzhiyun 		mask = priority ? (si_gpioreservation & mask) :
2508*4882a593Smuzhiyun 			((si_gpioreservation | mask) & ~(si_gpioreservation));
2509*4882a593Smuzhiyun 		val &= mask;
2510*4882a593Smuzhiyun 	}
2511*4882a593Smuzhiyun 	regoff = OFFSETOF(chipcregs_t, gpioeventintmask);
2512*4882a593Smuzhiyun 	return (si_corereg(sih, SI_CC_IDX, regoff, mask, val));
2513*4882a593Smuzhiyun }
2514*4882a593Smuzhiyun 
2515*4882a593Smuzhiyun /* assign the gpio to an led */
2516*4882a593Smuzhiyun uint32
si_gpioled(si_t * sih,uint32 mask,uint32 val)2517*4882a593Smuzhiyun si_gpioled(si_t *sih, uint32 mask, uint32 val)
2518*4882a593Smuzhiyun {
2519*4882a593Smuzhiyun 	if (CCREV(sih->ccrev) < 16)
2520*4882a593Smuzhiyun 		return 0xffffffff;
2521*4882a593Smuzhiyun 
2522*4882a593Smuzhiyun 	/* gpio led powersave reg */
2523*4882a593Smuzhiyun 	return (si_corereg(sih, SI_CC_IDX, OFFSETOF(chipcregs_t, gpiotimeroutmask), mask, val));
2524*4882a593Smuzhiyun }
2525*4882a593Smuzhiyun 
2526*4882a593Smuzhiyun /* mask&set gpio timer val */
2527*4882a593Smuzhiyun uint32
si_gpiotimerval(si_t * sih,uint32 mask,uint32 gpiotimerval)2528*4882a593Smuzhiyun si_gpiotimerval(si_t *sih, uint32 mask, uint32 gpiotimerval)
2529*4882a593Smuzhiyun {
2530*4882a593Smuzhiyun 	if (CCREV(sih->ccrev) < 16)
2531*4882a593Smuzhiyun 		return 0xffffffff;
2532*4882a593Smuzhiyun 
2533*4882a593Smuzhiyun 	return (si_corereg(sih, SI_CC_IDX,
2534*4882a593Smuzhiyun 		OFFSETOF(chipcregs_t, gpiotimerval), mask, gpiotimerval));
2535*4882a593Smuzhiyun }
2536*4882a593Smuzhiyun 
2537*4882a593Smuzhiyun uint32
si_gpiopull(si_t * sih,bool updown,uint32 mask,uint32 val)2538*4882a593Smuzhiyun si_gpiopull(si_t *sih, bool updown, uint32 mask, uint32 val)
2539*4882a593Smuzhiyun {
2540*4882a593Smuzhiyun 	uint offs;
2541*4882a593Smuzhiyun 
2542*4882a593Smuzhiyun 	if (CCREV(sih->ccrev) < 20)
2543*4882a593Smuzhiyun 		return 0xffffffff;
2544*4882a593Smuzhiyun 
2545*4882a593Smuzhiyun 	offs = (updown ? OFFSETOF(chipcregs_t, gpiopulldown) : OFFSETOF(chipcregs_t, gpiopullup));
2546*4882a593Smuzhiyun 	return (si_corereg(sih, SI_CC_IDX, offs, mask, val));
2547*4882a593Smuzhiyun }
2548*4882a593Smuzhiyun 
2549*4882a593Smuzhiyun uint32
si_gpioevent(si_t * sih,uint regtype,uint32 mask,uint32 val)2550*4882a593Smuzhiyun si_gpioevent(si_t *sih, uint regtype, uint32 mask, uint32 val)
2551*4882a593Smuzhiyun {
2552*4882a593Smuzhiyun 	uint offs;
2553*4882a593Smuzhiyun 
2554*4882a593Smuzhiyun 	if (CCREV(sih->ccrev) < 11)
2555*4882a593Smuzhiyun 		return 0xffffffff;
2556*4882a593Smuzhiyun 
2557*4882a593Smuzhiyun 	if (regtype == GPIO_REGEVT)
2558*4882a593Smuzhiyun 		offs = OFFSETOF(chipcregs_t, gpioevent);
2559*4882a593Smuzhiyun 	else if (regtype == GPIO_REGEVT_INTMSK)
2560*4882a593Smuzhiyun 		offs = OFFSETOF(chipcregs_t, gpioeventintmask);
2561*4882a593Smuzhiyun 	else if (regtype == GPIO_REGEVT_INTPOL)
2562*4882a593Smuzhiyun 		offs = OFFSETOF(chipcregs_t, gpioeventintpolarity);
2563*4882a593Smuzhiyun 	else
2564*4882a593Smuzhiyun 		return 0xffffffff;
2565*4882a593Smuzhiyun 
2566*4882a593Smuzhiyun 	return (si_corereg(sih, SI_CC_IDX, offs, mask, val));
2567*4882a593Smuzhiyun }
2568*4882a593Smuzhiyun 
2569*4882a593Smuzhiyun uint32
si_gpio_int_enable(si_t * sih,bool enable)2570*4882a593Smuzhiyun si_gpio_int_enable(si_t *sih, bool enable)
2571*4882a593Smuzhiyun {
2572*4882a593Smuzhiyun 	uint offs;
2573*4882a593Smuzhiyun 
2574*4882a593Smuzhiyun 	if (CCREV(sih->ccrev) < 11)
2575*4882a593Smuzhiyun 		return 0xffffffff;
2576*4882a593Smuzhiyun 
2577*4882a593Smuzhiyun 	offs = OFFSETOF(chipcregs_t, intmask);
2578*4882a593Smuzhiyun 	return (si_corereg(sih, SI_CC_IDX, offs, CI_GPIO, (enable ? CI_GPIO : 0)));
2579*4882a593Smuzhiyun }
2580*4882a593Smuzhiyun 
2581*4882a593Smuzhiyun /** Return the size of the specified SYSMEM bank */
2582*4882a593Smuzhiyun static uint
sysmem_banksize(si_info_t * sii,sysmemregs_t * regs,uint8 idx)2583*4882a593Smuzhiyun sysmem_banksize(si_info_t *sii, sysmemregs_t *regs, uint8 idx)
2584*4882a593Smuzhiyun {
2585*4882a593Smuzhiyun 	uint banksize, bankinfo;
2586*4882a593Smuzhiyun 	uint bankidx = idx;
2587*4882a593Smuzhiyun 
2588*4882a593Smuzhiyun 	W_REG(sii->osh, &regs->bankidx, bankidx);
2589*4882a593Smuzhiyun 	bankinfo = R_REG(sii->osh, &regs->bankinfo);
2590*4882a593Smuzhiyun 	banksize = SYSMEM_BANKINFO_SZBASE * ((bankinfo & SYSMEM_BANKINFO_SZMASK) + 1);
2591*4882a593Smuzhiyun 	return banksize;
2592*4882a593Smuzhiyun }
2593*4882a593Smuzhiyun 
2594*4882a593Smuzhiyun /** Return the RAM size of the SYSMEM core */
2595*4882a593Smuzhiyun uint32
si_sysmem_size(si_t * sih)2596*4882a593Smuzhiyun si_sysmem_size(si_t *sih)
2597*4882a593Smuzhiyun {
2598*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
2599*4882a593Smuzhiyun 	uint origidx;
2600*4882a593Smuzhiyun 	uint intr_val = 0;
2601*4882a593Smuzhiyun 
2602*4882a593Smuzhiyun 	sysmemregs_t *regs;
2603*4882a593Smuzhiyun 	bool wasup;
2604*4882a593Smuzhiyun 	uint32 coreinfo;
2605*4882a593Smuzhiyun 	uint memsize = 0;
2606*4882a593Smuzhiyun 	uint8 i;
2607*4882a593Smuzhiyun 	uint nb, nrb;
2608*4882a593Smuzhiyun 
2609*4882a593Smuzhiyun 	/* Block ints and save current core */
2610*4882a593Smuzhiyun 	INTR_OFF(sii, intr_val);
2611*4882a593Smuzhiyun 	origidx = si_coreidx(sih);
2612*4882a593Smuzhiyun 
2613*4882a593Smuzhiyun 	/* Switch to SYSMEM core */
2614*4882a593Smuzhiyun 	if (!(regs = si_setcore(sih, SYSMEM_CORE_ID, 0)))
2615*4882a593Smuzhiyun 		goto done;
2616*4882a593Smuzhiyun 
2617*4882a593Smuzhiyun 	/* Get info for determining size */
2618*4882a593Smuzhiyun 	if (!(wasup = si_iscoreup(sih)))
2619*4882a593Smuzhiyun 		si_core_reset(sih, 0, 0);
2620*4882a593Smuzhiyun 	coreinfo = R_REG(sii->osh, &regs->coreinfo);
2621*4882a593Smuzhiyun 
2622*4882a593Smuzhiyun 	/* Number of ROM banks, SW need to skip the ROM banks. */
2623*4882a593Smuzhiyun 	nrb = (coreinfo & SYSMEM_SRCI_ROMNB_MASK) >> SYSMEM_SRCI_ROMNB_SHIFT;
2624*4882a593Smuzhiyun 
2625*4882a593Smuzhiyun 	nb = (coreinfo & SYSMEM_SRCI_SRNB_MASK) >> SYSMEM_SRCI_SRNB_SHIFT;
2626*4882a593Smuzhiyun 	for (i = 0; i < nb; i++)
2627*4882a593Smuzhiyun 		memsize += sysmem_banksize(sii, regs, i + nrb);
2628*4882a593Smuzhiyun 
2629*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
2630*4882a593Smuzhiyun 
2631*4882a593Smuzhiyun done:
2632*4882a593Smuzhiyun 	INTR_RESTORE(sii, intr_val);
2633*4882a593Smuzhiyun 
2634*4882a593Smuzhiyun 	return memsize;
2635*4882a593Smuzhiyun }
2636*4882a593Smuzhiyun 
2637*4882a593Smuzhiyun /** Return the size of the specified SOCRAM bank */
2638*4882a593Smuzhiyun static uint
socram_banksize(si_info_t * sii,sbsocramregs_t * regs,uint8 idx,uint8 mem_type)2639*4882a593Smuzhiyun socram_banksize(si_info_t *sii, sbsocramregs_t *regs, uint8 idx, uint8 mem_type)
2640*4882a593Smuzhiyun {
2641*4882a593Smuzhiyun 	uint banksize, bankinfo;
2642*4882a593Smuzhiyun 	uint bankidx = idx | (mem_type << SOCRAM_BANKIDX_MEMTYPE_SHIFT);
2643*4882a593Smuzhiyun 
2644*4882a593Smuzhiyun 	ASSERT(mem_type <= SOCRAM_MEMTYPE_DEVRAM);
2645*4882a593Smuzhiyun 
2646*4882a593Smuzhiyun 	W_REG(sii->osh, &regs->bankidx, bankidx);
2647*4882a593Smuzhiyun 	bankinfo = R_REG(sii->osh, &regs->bankinfo);
2648*4882a593Smuzhiyun 	banksize = SOCRAM_BANKINFO_SZBASE * ((bankinfo & SOCRAM_BANKINFO_SZMASK) + 1);
2649*4882a593Smuzhiyun 	return banksize;
2650*4882a593Smuzhiyun }
2651*4882a593Smuzhiyun 
si_socram_set_bankpda(si_t * sih,uint32 bankidx,uint32 bankpda)2652*4882a593Smuzhiyun void si_socram_set_bankpda(si_t *sih, uint32 bankidx, uint32 bankpda)
2653*4882a593Smuzhiyun {
2654*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
2655*4882a593Smuzhiyun 	uint origidx;
2656*4882a593Smuzhiyun 	uint intr_val = 0;
2657*4882a593Smuzhiyun 	sbsocramregs_t *regs;
2658*4882a593Smuzhiyun 	bool wasup;
2659*4882a593Smuzhiyun 	uint corerev;
2660*4882a593Smuzhiyun 
2661*4882a593Smuzhiyun 	/* Block ints and save current core */
2662*4882a593Smuzhiyun 	INTR_OFF(sii, intr_val);
2663*4882a593Smuzhiyun 	origidx = si_coreidx(sih);
2664*4882a593Smuzhiyun 
2665*4882a593Smuzhiyun 	/* Switch to SOCRAM core */
2666*4882a593Smuzhiyun 	if (!(regs = si_setcore(sih, SOCRAM_CORE_ID, 0)))
2667*4882a593Smuzhiyun 		goto done;
2668*4882a593Smuzhiyun 
2669*4882a593Smuzhiyun 	if (!(wasup = si_iscoreup(sih)))
2670*4882a593Smuzhiyun 		si_core_reset(sih, 0, 0);
2671*4882a593Smuzhiyun 
2672*4882a593Smuzhiyun 	corerev = si_corerev(sih);
2673*4882a593Smuzhiyun 	if (corerev >= 16) {
2674*4882a593Smuzhiyun 		W_REG(sii->osh, &regs->bankidx, bankidx);
2675*4882a593Smuzhiyun 		W_REG(sii->osh, &regs->bankpda, bankpda);
2676*4882a593Smuzhiyun 	}
2677*4882a593Smuzhiyun 
2678*4882a593Smuzhiyun 	/* Return to previous state and core */
2679*4882a593Smuzhiyun 	if (!wasup)
2680*4882a593Smuzhiyun 		si_core_disable(sih, 0);
2681*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
2682*4882a593Smuzhiyun 
2683*4882a593Smuzhiyun done:
2684*4882a593Smuzhiyun 	INTR_RESTORE(sii, intr_val);
2685*4882a593Smuzhiyun }
2686*4882a593Smuzhiyun 
2687*4882a593Smuzhiyun void
si_socdevram(si_t * sih,bool set,uint8 * enable,uint8 * protect,uint8 * remap)2688*4882a593Smuzhiyun si_socdevram(si_t *sih, bool set, uint8 *enable, uint8 *protect, uint8 *remap)
2689*4882a593Smuzhiyun {
2690*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
2691*4882a593Smuzhiyun 	uint origidx;
2692*4882a593Smuzhiyun 	uint intr_val = 0;
2693*4882a593Smuzhiyun 	sbsocramregs_t *regs;
2694*4882a593Smuzhiyun 	bool wasup;
2695*4882a593Smuzhiyun 	uint corerev;
2696*4882a593Smuzhiyun 
2697*4882a593Smuzhiyun 	/* Block ints and save current core */
2698*4882a593Smuzhiyun 	INTR_OFF(sii, intr_val);
2699*4882a593Smuzhiyun 	origidx = si_coreidx(sih);
2700*4882a593Smuzhiyun 
2701*4882a593Smuzhiyun 	if (!set)
2702*4882a593Smuzhiyun 		*enable = *protect = *remap = 0;
2703*4882a593Smuzhiyun 
2704*4882a593Smuzhiyun 	/* Switch to SOCRAM core */
2705*4882a593Smuzhiyun 	if (!(regs = si_setcore(sih, SOCRAM_CORE_ID, 0)))
2706*4882a593Smuzhiyun 		goto done;
2707*4882a593Smuzhiyun 
2708*4882a593Smuzhiyun 	/* Get info for determining size */
2709*4882a593Smuzhiyun 	if (!(wasup = si_iscoreup(sih)))
2710*4882a593Smuzhiyun 		si_core_reset(sih, 0, 0);
2711*4882a593Smuzhiyun 
2712*4882a593Smuzhiyun 	corerev = si_corerev(sih);
2713*4882a593Smuzhiyun 	if (corerev >= 10) {
2714*4882a593Smuzhiyun 		uint32 extcinfo;
2715*4882a593Smuzhiyun 		uint8 nb;
2716*4882a593Smuzhiyun 		uint8 i;
2717*4882a593Smuzhiyun 		uint32 bankidx, bankinfo;
2718*4882a593Smuzhiyun 
2719*4882a593Smuzhiyun 		extcinfo = R_REG(sii->osh, &regs->extracoreinfo);
2720*4882a593Smuzhiyun 		nb = ((extcinfo & SOCRAM_DEVRAMBANK_MASK) >> SOCRAM_DEVRAMBANK_SHIFT);
2721*4882a593Smuzhiyun 		for (i = 0; i < nb; i++) {
2722*4882a593Smuzhiyun 			bankidx = i | (SOCRAM_MEMTYPE_DEVRAM << SOCRAM_BANKIDX_MEMTYPE_SHIFT);
2723*4882a593Smuzhiyun 			W_REG(sii->osh, &regs->bankidx, bankidx);
2724*4882a593Smuzhiyun 			bankinfo = R_REG(sii->osh, &regs->bankinfo);
2725*4882a593Smuzhiyun 			if (set) {
2726*4882a593Smuzhiyun 				bankinfo &= ~SOCRAM_BANKINFO_DEVRAMSEL_MASK;
2727*4882a593Smuzhiyun 				bankinfo &= ~SOCRAM_BANKINFO_DEVRAMPRO_MASK;
2728*4882a593Smuzhiyun 				bankinfo &= ~SOCRAM_BANKINFO_DEVRAMREMAP_MASK;
2729*4882a593Smuzhiyun 				if (*enable) {
2730*4882a593Smuzhiyun 					bankinfo |= (1 << SOCRAM_BANKINFO_DEVRAMSEL_SHIFT);
2731*4882a593Smuzhiyun 					if (*protect)
2732*4882a593Smuzhiyun 						bankinfo |= (1 << SOCRAM_BANKINFO_DEVRAMPRO_SHIFT);
2733*4882a593Smuzhiyun 					if ((corerev >= 16) && *remap)
2734*4882a593Smuzhiyun 						bankinfo |=
2735*4882a593Smuzhiyun 							(1 << SOCRAM_BANKINFO_DEVRAMREMAP_SHIFT);
2736*4882a593Smuzhiyun 				}
2737*4882a593Smuzhiyun 				W_REG(sii->osh, &regs->bankinfo, bankinfo);
2738*4882a593Smuzhiyun 			} else if (i == 0) {
2739*4882a593Smuzhiyun 				if (bankinfo & SOCRAM_BANKINFO_DEVRAMSEL_MASK) {
2740*4882a593Smuzhiyun 					*enable = 1;
2741*4882a593Smuzhiyun 					if (bankinfo & SOCRAM_BANKINFO_DEVRAMPRO_MASK)
2742*4882a593Smuzhiyun 						*protect = 1;
2743*4882a593Smuzhiyun 					if (bankinfo & SOCRAM_BANKINFO_DEVRAMREMAP_MASK)
2744*4882a593Smuzhiyun 						*remap = 1;
2745*4882a593Smuzhiyun 				}
2746*4882a593Smuzhiyun 			}
2747*4882a593Smuzhiyun 		}
2748*4882a593Smuzhiyun 	}
2749*4882a593Smuzhiyun 
2750*4882a593Smuzhiyun 	/* Return to previous state and core */
2751*4882a593Smuzhiyun 	if (!wasup)
2752*4882a593Smuzhiyun 		si_core_disable(sih, 0);
2753*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
2754*4882a593Smuzhiyun 
2755*4882a593Smuzhiyun done:
2756*4882a593Smuzhiyun 	INTR_RESTORE(sii, intr_val);
2757*4882a593Smuzhiyun }
2758*4882a593Smuzhiyun 
2759*4882a593Smuzhiyun bool
si_socdevram_remap_isenb(si_t * sih)2760*4882a593Smuzhiyun si_socdevram_remap_isenb(si_t *sih)
2761*4882a593Smuzhiyun {
2762*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
2763*4882a593Smuzhiyun 	uint origidx;
2764*4882a593Smuzhiyun 	uint intr_val = 0;
2765*4882a593Smuzhiyun 	sbsocramregs_t *regs;
2766*4882a593Smuzhiyun 	bool wasup, remap = FALSE;
2767*4882a593Smuzhiyun 	uint corerev;
2768*4882a593Smuzhiyun 	uint32 extcinfo;
2769*4882a593Smuzhiyun 	uint8 nb;
2770*4882a593Smuzhiyun 	uint8 i;
2771*4882a593Smuzhiyun 	uint32 bankidx, bankinfo;
2772*4882a593Smuzhiyun 
2773*4882a593Smuzhiyun 	/* Block ints and save current core */
2774*4882a593Smuzhiyun 	INTR_OFF(sii, intr_val);
2775*4882a593Smuzhiyun 	origidx = si_coreidx(sih);
2776*4882a593Smuzhiyun 
2777*4882a593Smuzhiyun 	/* Switch to SOCRAM core */
2778*4882a593Smuzhiyun 	if (!(regs = si_setcore(sih, SOCRAM_CORE_ID, 0)))
2779*4882a593Smuzhiyun 		goto done;
2780*4882a593Smuzhiyun 
2781*4882a593Smuzhiyun 	/* Get info for determining size */
2782*4882a593Smuzhiyun 	if (!(wasup = si_iscoreup(sih)))
2783*4882a593Smuzhiyun 		si_core_reset(sih, 0, 0);
2784*4882a593Smuzhiyun 
2785*4882a593Smuzhiyun 	corerev = si_corerev(sih);
2786*4882a593Smuzhiyun 	if (corerev >= 16) {
2787*4882a593Smuzhiyun 		extcinfo = R_REG(sii->osh, &regs->extracoreinfo);
2788*4882a593Smuzhiyun 		nb = ((extcinfo & SOCRAM_DEVRAMBANK_MASK) >> SOCRAM_DEVRAMBANK_SHIFT);
2789*4882a593Smuzhiyun 		for (i = 0; i < nb; i++) {
2790*4882a593Smuzhiyun 			bankidx = i | (SOCRAM_MEMTYPE_DEVRAM << SOCRAM_BANKIDX_MEMTYPE_SHIFT);
2791*4882a593Smuzhiyun 			W_REG(sii->osh, &regs->bankidx, bankidx);
2792*4882a593Smuzhiyun 			bankinfo = R_REG(sii->osh, &regs->bankinfo);
2793*4882a593Smuzhiyun 			if (bankinfo & SOCRAM_BANKINFO_DEVRAMREMAP_MASK) {
2794*4882a593Smuzhiyun 				remap = TRUE;
2795*4882a593Smuzhiyun 				break;
2796*4882a593Smuzhiyun 			}
2797*4882a593Smuzhiyun 		}
2798*4882a593Smuzhiyun 	}
2799*4882a593Smuzhiyun 
2800*4882a593Smuzhiyun 	/* Return to previous state and core */
2801*4882a593Smuzhiyun 	if (!wasup)
2802*4882a593Smuzhiyun 		si_core_disable(sih, 0);
2803*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
2804*4882a593Smuzhiyun 
2805*4882a593Smuzhiyun done:
2806*4882a593Smuzhiyun 	INTR_RESTORE(sii, intr_val);
2807*4882a593Smuzhiyun 	return remap;
2808*4882a593Smuzhiyun }
2809*4882a593Smuzhiyun 
2810*4882a593Smuzhiyun bool
si_socdevram_pkg(si_t * sih)2811*4882a593Smuzhiyun si_socdevram_pkg(si_t *sih)
2812*4882a593Smuzhiyun {
2813*4882a593Smuzhiyun 	if (si_socdevram_size(sih) > 0)
2814*4882a593Smuzhiyun 		return TRUE;
2815*4882a593Smuzhiyun 	else
2816*4882a593Smuzhiyun 		return FALSE;
2817*4882a593Smuzhiyun }
2818*4882a593Smuzhiyun 
2819*4882a593Smuzhiyun uint32
si_socdevram_size(si_t * sih)2820*4882a593Smuzhiyun si_socdevram_size(si_t *sih)
2821*4882a593Smuzhiyun {
2822*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
2823*4882a593Smuzhiyun 	uint origidx;
2824*4882a593Smuzhiyun 	uint intr_val = 0;
2825*4882a593Smuzhiyun 	uint32 memsize = 0;
2826*4882a593Smuzhiyun 	sbsocramregs_t *regs;
2827*4882a593Smuzhiyun 	bool wasup;
2828*4882a593Smuzhiyun 	uint corerev;
2829*4882a593Smuzhiyun 
2830*4882a593Smuzhiyun 	/* Block ints and save current core */
2831*4882a593Smuzhiyun 	INTR_OFF(sii, intr_val);
2832*4882a593Smuzhiyun 	origidx = si_coreidx(sih);
2833*4882a593Smuzhiyun 
2834*4882a593Smuzhiyun 	/* Switch to SOCRAM core */
2835*4882a593Smuzhiyun 	if (!(regs = si_setcore(sih, SOCRAM_CORE_ID, 0)))
2836*4882a593Smuzhiyun 		goto done;
2837*4882a593Smuzhiyun 
2838*4882a593Smuzhiyun 	/* Get info for determining size */
2839*4882a593Smuzhiyun 	if (!(wasup = si_iscoreup(sih)))
2840*4882a593Smuzhiyun 		si_core_reset(sih, 0, 0);
2841*4882a593Smuzhiyun 
2842*4882a593Smuzhiyun 	corerev = si_corerev(sih);
2843*4882a593Smuzhiyun 	if (corerev >= 10) {
2844*4882a593Smuzhiyun 		uint32 extcinfo;
2845*4882a593Smuzhiyun 		uint8 nb;
2846*4882a593Smuzhiyun 		uint8 i;
2847*4882a593Smuzhiyun 
2848*4882a593Smuzhiyun 		extcinfo = R_REG(sii->osh, &regs->extracoreinfo);
2849*4882a593Smuzhiyun 		nb = (((extcinfo & SOCRAM_DEVRAMBANK_MASK) >> SOCRAM_DEVRAMBANK_SHIFT));
2850*4882a593Smuzhiyun 		for (i = 0; i < nb; i++)
2851*4882a593Smuzhiyun 			memsize += socram_banksize(sii, regs, i, SOCRAM_MEMTYPE_DEVRAM);
2852*4882a593Smuzhiyun 	}
2853*4882a593Smuzhiyun 
2854*4882a593Smuzhiyun 	/* Return to previous state and core */
2855*4882a593Smuzhiyun 	if (!wasup)
2856*4882a593Smuzhiyun 		si_core_disable(sih, 0);
2857*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
2858*4882a593Smuzhiyun 
2859*4882a593Smuzhiyun done:
2860*4882a593Smuzhiyun 	INTR_RESTORE(sii, intr_val);
2861*4882a593Smuzhiyun 
2862*4882a593Smuzhiyun 	return memsize;
2863*4882a593Smuzhiyun }
2864*4882a593Smuzhiyun 
2865*4882a593Smuzhiyun uint32
si_socdevram_remap_size(si_t * sih)2866*4882a593Smuzhiyun si_socdevram_remap_size(si_t *sih)
2867*4882a593Smuzhiyun {
2868*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
2869*4882a593Smuzhiyun 	uint origidx;
2870*4882a593Smuzhiyun 	uint intr_val = 0;
2871*4882a593Smuzhiyun 	uint32 memsize = 0, banksz;
2872*4882a593Smuzhiyun 	sbsocramregs_t *regs;
2873*4882a593Smuzhiyun 	bool wasup;
2874*4882a593Smuzhiyun 	uint corerev;
2875*4882a593Smuzhiyun 	uint32 extcinfo;
2876*4882a593Smuzhiyun 	uint8 nb;
2877*4882a593Smuzhiyun 	uint8 i;
2878*4882a593Smuzhiyun 	uint32 bankidx, bankinfo;
2879*4882a593Smuzhiyun 
2880*4882a593Smuzhiyun 	/* Block ints and save current core */
2881*4882a593Smuzhiyun 	INTR_OFF(sii, intr_val);
2882*4882a593Smuzhiyun 	origidx = si_coreidx(sih);
2883*4882a593Smuzhiyun 
2884*4882a593Smuzhiyun 	/* Switch to SOCRAM core */
2885*4882a593Smuzhiyun 	if (!(regs = si_setcore(sih, SOCRAM_CORE_ID, 0)))
2886*4882a593Smuzhiyun 		goto done;
2887*4882a593Smuzhiyun 
2888*4882a593Smuzhiyun 	/* Get info for determining size */
2889*4882a593Smuzhiyun 	if (!(wasup = si_iscoreup(sih)))
2890*4882a593Smuzhiyun 		si_core_reset(sih, 0, 0);
2891*4882a593Smuzhiyun 
2892*4882a593Smuzhiyun 	corerev = si_corerev(sih);
2893*4882a593Smuzhiyun 	if (corerev >= 16) {
2894*4882a593Smuzhiyun 		extcinfo = R_REG(sii->osh, &regs->extracoreinfo);
2895*4882a593Smuzhiyun 		nb = (((extcinfo & SOCRAM_DEVRAMBANK_MASK) >> SOCRAM_DEVRAMBANK_SHIFT));
2896*4882a593Smuzhiyun 
2897*4882a593Smuzhiyun 		/*
2898*4882a593Smuzhiyun 		 * FIX: A0 Issue: Max addressable is 512KB, instead 640KB
2899*4882a593Smuzhiyun 		 * Only four banks are accessible to ARM
2900*4882a593Smuzhiyun 		 */
2901*4882a593Smuzhiyun 		if ((corerev == 16) && (nb == 5))
2902*4882a593Smuzhiyun 			nb = 4;
2903*4882a593Smuzhiyun 
2904*4882a593Smuzhiyun 		for (i = 0; i < nb; i++) {
2905*4882a593Smuzhiyun 			bankidx = i | (SOCRAM_MEMTYPE_DEVRAM << SOCRAM_BANKIDX_MEMTYPE_SHIFT);
2906*4882a593Smuzhiyun 			W_REG(sii->osh, &regs->bankidx, bankidx);
2907*4882a593Smuzhiyun 			bankinfo = R_REG(sii->osh, &regs->bankinfo);
2908*4882a593Smuzhiyun 			if (bankinfo & SOCRAM_BANKINFO_DEVRAMREMAP_MASK) {
2909*4882a593Smuzhiyun 				banksz = socram_banksize(sii, regs, i, SOCRAM_MEMTYPE_DEVRAM);
2910*4882a593Smuzhiyun 				memsize += banksz;
2911*4882a593Smuzhiyun 			} else {
2912*4882a593Smuzhiyun 				/* Account only consecutive banks for now */
2913*4882a593Smuzhiyun 				break;
2914*4882a593Smuzhiyun 			}
2915*4882a593Smuzhiyun 		}
2916*4882a593Smuzhiyun 	}
2917*4882a593Smuzhiyun 
2918*4882a593Smuzhiyun 	/* Return to previous state and core */
2919*4882a593Smuzhiyun 	if (!wasup)
2920*4882a593Smuzhiyun 		si_core_disable(sih, 0);
2921*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
2922*4882a593Smuzhiyun 
2923*4882a593Smuzhiyun done:
2924*4882a593Smuzhiyun 	INTR_RESTORE(sii, intr_val);
2925*4882a593Smuzhiyun 
2926*4882a593Smuzhiyun 	return memsize;
2927*4882a593Smuzhiyun }
2928*4882a593Smuzhiyun 
2929*4882a593Smuzhiyun /** Return the RAM size of the SOCRAM core */
2930*4882a593Smuzhiyun uint32
si_socram_size(si_t * sih)2931*4882a593Smuzhiyun si_socram_size(si_t *sih)
2932*4882a593Smuzhiyun {
2933*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
2934*4882a593Smuzhiyun 	uint origidx;
2935*4882a593Smuzhiyun 	uint intr_val = 0;
2936*4882a593Smuzhiyun 
2937*4882a593Smuzhiyun 	sbsocramregs_t *regs;
2938*4882a593Smuzhiyun 	bool wasup;
2939*4882a593Smuzhiyun 	uint corerev;
2940*4882a593Smuzhiyun 	uint32 coreinfo;
2941*4882a593Smuzhiyun 	uint memsize = 0;
2942*4882a593Smuzhiyun 
2943*4882a593Smuzhiyun 	/* Block ints and save current core */
2944*4882a593Smuzhiyun 	INTR_OFF(sii, intr_val);
2945*4882a593Smuzhiyun 	origidx = si_coreidx(sih);
2946*4882a593Smuzhiyun 
2947*4882a593Smuzhiyun 	/* Switch to SOCRAM core */
2948*4882a593Smuzhiyun 	if (!(regs = si_setcore(sih, SOCRAM_CORE_ID, 0)))
2949*4882a593Smuzhiyun 		goto done;
2950*4882a593Smuzhiyun 
2951*4882a593Smuzhiyun 	/* Get info for determining size */
2952*4882a593Smuzhiyun 	if (!(wasup = si_iscoreup(sih)))
2953*4882a593Smuzhiyun 		si_core_reset(sih, 0, 0);
2954*4882a593Smuzhiyun 	corerev = si_corerev(sih);
2955*4882a593Smuzhiyun 	coreinfo = R_REG(sii->osh, &regs->coreinfo);
2956*4882a593Smuzhiyun 
2957*4882a593Smuzhiyun 	/* Calculate size from coreinfo based on rev */
2958*4882a593Smuzhiyun 	if (corerev == 0)
2959*4882a593Smuzhiyun 		memsize = 1 << (16 + (coreinfo & SRCI_MS0_MASK));
2960*4882a593Smuzhiyun 	else if (corerev < 3) {
2961*4882a593Smuzhiyun 		memsize = 1 << (SR_BSZ_BASE + (coreinfo & SRCI_SRBSZ_MASK));
2962*4882a593Smuzhiyun 		memsize *= (coreinfo & SRCI_SRNB_MASK) >> SRCI_SRNB_SHIFT;
2963*4882a593Smuzhiyun 	} else if ((corerev <= 7) || (corerev == 12)) {
2964*4882a593Smuzhiyun 		uint nb = (coreinfo & SRCI_SRNB_MASK) >> SRCI_SRNB_SHIFT;
2965*4882a593Smuzhiyun 		uint bsz = (coreinfo & SRCI_SRBSZ_MASK);
2966*4882a593Smuzhiyun 		uint lss = (coreinfo & SRCI_LSS_MASK) >> SRCI_LSS_SHIFT;
2967*4882a593Smuzhiyun 		if (lss != 0)
2968*4882a593Smuzhiyun 			nb --;
2969*4882a593Smuzhiyun 		memsize = nb * (1 << (bsz + SR_BSZ_BASE));
2970*4882a593Smuzhiyun 		if (lss != 0)
2971*4882a593Smuzhiyun 			memsize += (1 << ((lss - 1) + SR_BSZ_BASE));
2972*4882a593Smuzhiyun 	} else {
2973*4882a593Smuzhiyun 		uint8 i;
2974*4882a593Smuzhiyun 		uint nb;
2975*4882a593Smuzhiyun 		/* length of SRAM Banks increased for corerev greater than 23 */
2976*4882a593Smuzhiyun 		if (corerev >= 23) {
2977*4882a593Smuzhiyun 			nb = (coreinfo & (SRCI_SRNB_MASK | SRCI_SRNB_MASK_EXT)) >> SRCI_SRNB_SHIFT;
2978*4882a593Smuzhiyun 		} else {
2979*4882a593Smuzhiyun 			nb = (coreinfo & SRCI_SRNB_MASK) >> SRCI_SRNB_SHIFT;
2980*4882a593Smuzhiyun 		}
2981*4882a593Smuzhiyun 		for (i = 0; i < nb; i++)
2982*4882a593Smuzhiyun 			memsize += socram_banksize(sii, regs, i, SOCRAM_MEMTYPE_RAM);
2983*4882a593Smuzhiyun 	}
2984*4882a593Smuzhiyun 
2985*4882a593Smuzhiyun 	/* Return to previous state and core */
2986*4882a593Smuzhiyun 	if (!wasup)
2987*4882a593Smuzhiyun 		si_core_disable(sih, 0);
2988*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
2989*4882a593Smuzhiyun 
2990*4882a593Smuzhiyun done:
2991*4882a593Smuzhiyun 	INTR_RESTORE(sii, intr_val);
2992*4882a593Smuzhiyun 
2993*4882a593Smuzhiyun 	return memsize;
2994*4882a593Smuzhiyun }
2995*4882a593Smuzhiyun 
2996*4882a593Smuzhiyun /** Return the TCM-RAM size of the ARMCR4 core. */
2997*4882a593Smuzhiyun uint32
si_tcm_size(si_t * sih)2998*4882a593Smuzhiyun si_tcm_size(si_t *sih)
2999*4882a593Smuzhiyun {
3000*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
3001*4882a593Smuzhiyun 	uint origidx;
3002*4882a593Smuzhiyun 	uint intr_val = 0;
3003*4882a593Smuzhiyun 	volatile uint8 *regs;
3004*4882a593Smuzhiyun 	bool wasup = FALSE;
3005*4882a593Smuzhiyun 	uint32 corecap;
3006*4882a593Smuzhiyun 	uint memsize = 0;
3007*4882a593Smuzhiyun 	uint banku_size = 0;
3008*4882a593Smuzhiyun 	uint32 nab = 0;
3009*4882a593Smuzhiyun 	uint32 nbb = 0;
3010*4882a593Smuzhiyun 	uint32 totb = 0;
3011*4882a593Smuzhiyun 	uint32 bxinfo = 0;
3012*4882a593Smuzhiyun 	uint32 idx = 0;
3013*4882a593Smuzhiyun 	volatile uint32 *arm_cap_reg;
3014*4882a593Smuzhiyun 	volatile uint32 *arm_bidx;
3015*4882a593Smuzhiyun 	volatile uint32 *arm_binfo;
3016*4882a593Smuzhiyun 
3017*4882a593Smuzhiyun 	/* Block ints and save current core */
3018*4882a593Smuzhiyun 	INTR_OFF(sii, intr_val);
3019*4882a593Smuzhiyun 	origidx = si_coreidx(sih);
3020*4882a593Smuzhiyun 
3021*4882a593Smuzhiyun 	/* Switch to CR4 core */
3022*4882a593Smuzhiyun 	if (!(regs = si_setcore(sih, ARMCR4_CORE_ID, 0)))
3023*4882a593Smuzhiyun 		goto done;
3024*4882a593Smuzhiyun 
3025*4882a593Smuzhiyun 	/* Get info for determining size. If in reset, come out of reset,
3026*4882a593Smuzhiyun 	 * but remain in halt
3027*4882a593Smuzhiyun 	 */
3028*4882a593Smuzhiyun 	if (!sih->secureboot) {
3029*4882a593Smuzhiyun 		 if (!(wasup = si_iscoreup(sih)))
3030*4882a593Smuzhiyun 			 si_core_reset(sih, SICF_CPUHALT, SICF_CPUHALT);
3031*4882a593Smuzhiyun 	}
3032*4882a593Smuzhiyun 
3033*4882a593Smuzhiyun 	arm_cap_reg = (volatile uint32 *)(regs + SI_CR4_CAP);
3034*4882a593Smuzhiyun 	corecap = R_REG(sii->osh, arm_cap_reg);
3035*4882a593Smuzhiyun 
3036*4882a593Smuzhiyun 	nab = (corecap & ARMCR4_TCBANB_MASK) >> ARMCR4_TCBANB_SHIFT;
3037*4882a593Smuzhiyun 	nbb = (corecap & ARMCR4_TCBBNB_MASK) >> ARMCR4_TCBBNB_SHIFT;
3038*4882a593Smuzhiyun 	totb = nab + nbb;
3039*4882a593Smuzhiyun 
3040*4882a593Smuzhiyun 	arm_bidx = (volatile uint32 *)(regs + SI_CR4_BANKIDX);
3041*4882a593Smuzhiyun 	arm_binfo = (volatile uint32 *)(regs + SI_CR4_BANKINFO);
3042*4882a593Smuzhiyun 	for (idx = 0; idx < totb; idx++) {
3043*4882a593Smuzhiyun 		W_REG(sii->osh, arm_bidx, idx);
3044*4882a593Smuzhiyun 
3045*4882a593Smuzhiyun 		bxinfo = R_REG(sii->osh, arm_binfo);
3046*4882a593Smuzhiyun 		if (bxinfo & ARMCR4_BUNITSZ_MASK) {
3047*4882a593Smuzhiyun 			banku_size = ARMCR4_BSZ_1K;
3048*4882a593Smuzhiyun 		} else {
3049*4882a593Smuzhiyun 			banku_size = ARMCR4_BSZ_8K;
3050*4882a593Smuzhiyun 		}
3051*4882a593Smuzhiyun 		memsize += ((bxinfo & ARMCR4_BSZ_MASK) + 1) * banku_size;
3052*4882a593Smuzhiyun 	}
3053*4882a593Smuzhiyun 
3054*4882a593Smuzhiyun 	/* Return to previous state and core */
3055*4882a593Smuzhiyun 	if (!sih->secureboot) {
3056*4882a593Smuzhiyun 		if (!wasup)
3057*4882a593Smuzhiyun 			si_core_disable(sih, 0);
3058*4882a593Smuzhiyun 	}
3059*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
3060*4882a593Smuzhiyun 
3061*4882a593Smuzhiyun done:
3062*4882a593Smuzhiyun 	INTR_RESTORE(sii, intr_val);
3063*4882a593Smuzhiyun 
3064*4882a593Smuzhiyun 	return memsize;
3065*4882a593Smuzhiyun }
3066*4882a593Smuzhiyun 
3067*4882a593Smuzhiyun bool
si_has_flops(si_t * sih)3068*4882a593Smuzhiyun si_has_flops(si_t *sih)
3069*4882a593Smuzhiyun {
3070*4882a593Smuzhiyun 	uint origidx, cr4_rev;
3071*4882a593Smuzhiyun 
3072*4882a593Smuzhiyun 	/* Find out CR4 core revision */
3073*4882a593Smuzhiyun 	origidx = si_coreidx(sih);
3074*4882a593Smuzhiyun 	if (si_setcore(sih, ARMCR4_CORE_ID, 0)) {
3075*4882a593Smuzhiyun 		cr4_rev = si_corerev(sih);
3076*4882a593Smuzhiyun 		si_setcoreidx(sih, origidx);
3077*4882a593Smuzhiyun 
3078*4882a593Smuzhiyun 		if (cr4_rev == 1 || cr4_rev >= 3)
3079*4882a593Smuzhiyun 			return TRUE;
3080*4882a593Smuzhiyun 	}
3081*4882a593Smuzhiyun 	return FALSE;
3082*4882a593Smuzhiyun }
3083*4882a593Smuzhiyun 
3084*4882a593Smuzhiyun uint32
si_socram_srmem_size(si_t * sih)3085*4882a593Smuzhiyun si_socram_srmem_size(si_t *sih)
3086*4882a593Smuzhiyun {
3087*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
3088*4882a593Smuzhiyun 	uint origidx;
3089*4882a593Smuzhiyun 	uint intr_val = 0;
3090*4882a593Smuzhiyun 
3091*4882a593Smuzhiyun 	sbsocramregs_t *regs;
3092*4882a593Smuzhiyun 	bool wasup;
3093*4882a593Smuzhiyun 	uint corerev;
3094*4882a593Smuzhiyun 	uint32 coreinfo;
3095*4882a593Smuzhiyun 	uint memsize = 0;
3096*4882a593Smuzhiyun 
3097*4882a593Smuzhiyun 	if (CHIPID(sih->chip) == BCM43430_CHIP_ID ||
3098*4882a593Smuzhiyun 		CHIPID(sih->chip) == BCM43018_CHIP_ID) {
3099*4882a593Smuzhiyun 		return (64 * 1024);
3100*4882a593Smuzhiyun 	}
3101*4882a593Smuzhiyun 
3102*4882a593Smuzhiyun 	/* Block ints and save current core */
3103*4882a593Smuzhiyun 	INTR_OFF(sii, intr_val);
3104*4882a593Smuzhiyun 	origidx = si_coreidx(sih);
3105*4882a593Smuzhiyun 
3106*4882a593Smuzhiyun 	/* Switch to SOCRAM core */
3107*4882a593Smuzhiyun 	if (!(regs = si_setcore(sih, SOCRAM_CORE_ID, 0)))
3108*4882a593Smuzhiyun 		goto done;
3109*4882a593Smuzhiyun 
3110*4882a593Smuzhiyun 	/* Get info for determining size */
3111*4882a593Smuzhiyun 	if (!(wasup = si_iscoreup(sih)))
3112*4882a593Smuzhiyun 		si_core_reset(sih, 0, 0);
3113*4882a593Smuzhiyun 	corerev = si_corerev(sih);
3114*4882a593Smuzhiyun 	coreinfo = R_REG(sii->osh, &regs->coreinfo);
3115*4882a593Smuzhiyun 
3116*4882a593Smuzhiyun 	/* Calculate size from coreinfo based on rev */
3117*4882a593Smuzhiyun 	if (corerev >= 16) {
3118*4882a593Smuzhiyun 		uint8 i;
3119*4882a593Smuzhiyun 		uint nb = (coreinfo & SRCI_SRNB_MASK) >> SRCI_SRNB_SHIFT;
3120*4882a593Smuzhiyun 		for (i = 0; i < nb; i++) {
3121*4882a593Smuzhiyun 			W_REG(sii->osh, &regs->bankidx, i);
3122*4882a593Smuzhiyun 			if (R_REG(sii->osh, &regs->bankinfo) & SOCRAM_BANKINFO_RETNTRAM_MASK)
3123*4882a593Smuzhiyun 				memsize += socram_banksize(sii, regs, i, SOCRAM_MEMTYPE_RAM);
3124*4882a593Smuzhiyun 		}
3125*4882a593Smuzhiyun 	}
3126*4882a593Smuzhiyun 
3127*4882a593Smuzhiyun 	/* Return to previous state and core */
3128*4882a593Smuzhiyun 	if (!wasup)
3129*4882a593Smuzhiyun 		si_core_disable(sih, 0);
3130*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
3131*4882a593Smuzhiyun 
3132*4882a593Smuzhiyun done:
3133*4882a593Smuzhiyun 	INTR_RESTORE(sii, intr_val);
3134*4882a593Smuzhiyun 
3135*4882a593Smuzhiyun 	return memsize;
3136*4882a593Smuzhiyun }
3137*4882a593Smuzhiyun 
3138*4882a593Smuzhiyun #if !defined(_CFEZ_) || defined(CFG_WL)
3139*4882a593Smuzhiyun void
si_btcgpiowar(si_t * sih)3140*4882a593Smuzhiyun si_btcgpiowar(si_t *sih)
3141*4882a593Smuzhiyun {
3142*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
3143*4882a593Smuzhiyun 	uint origidx;
3144*4882a593Smuzhiyun 	uint intr_val = 0;
3145*4882a593Smuzhiyun 	chipcregs_t *cc;
3146*4882a593Smuzhiyun 
3147*4882a593Smuzhiyun 	/* Make sure that there is ChipCommon core present &&
3148*4882a593Smuzhiyun 	 * UART_TX is strapped to 1
3149*4882a593Smuzhiyun 	 */
3150*4882a593Smuzhiyun 	if (!(sih->cccaps & CC_CAP_UARTGPIO))
3151*4882a593Smuzhiyun 		return;
3152*4882a593Smuzhiyun 
3153*4882a593Smuzhiyun 	/* si_corereg cannot be used as we have to guarantee 8-bit read/writes */
3154*4882a593Smuzhiyun 	INTR_OFF(sii, intr_val);
3155*4882a593Smuzhiyun 
3156*4882a593Smuzhiyun 	origidx = si_coreidx(sih);
3157*4882a593Smuzhiyun 
3158*4882a593Smuzhiyun 	cc = (chipcregs_t *)si_setcore(sih, CC_CORE_ID, 0);
3159*4882a593Smuzhiyun 	ASSERT(cc != NULL);
3160*4882a593Smuzhiyun 
3161*4882a593Smuzhiyun 	W_REG(sii->osh, &cc->uart0mcr, R_REG(sii->osh, &cc->uart0mcr) | 0x04);
3162*4882a593Smuzhiyun 
3163*4882a593Smuzhiyun 	/* restore the original index */
3164*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
3165*4882a593Smuzhiyun 
3166*4882a593Smuzhiyun 	INTR_RESTORE(sii, intr_val);
3167*4882a593Smuzhiyun }
3168*4882a593Smuzhiyun 
3169*4882a593Smuzhiyun void
si_chipcontrl_restore(si_t * sih,uint32 val)3170*4882a593Smuzhiyun si_chipcontrl_restore(si_t *sih, uint32 val)
3171*4882a593Smuzhiyun {
3172*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
3173*4882a593Smuzhiyun 	chipcregs_t *cc;
3174*4882a593Smuzhiyun 	uint origidx = si_coreidx(sih);
3175*4882a593Smuzhiyun 
3176*4882a593Smuzhiyun 	if ((cc = (chipcregs_t *)si_setcore(sih, CC_CORE_ID, 0)) == NULL) {
3177*4882a593Smuzhiyun 		SI_ERROR(("%s: Failed to find CORE ID!\n", __FUNCTION__));
3178*4882a593Smuzhiyun 		return;
3179*4882a593Smuzhiyun 	}
3180*4882a593Smuzhiyun 	W_REG(sii->osh, &cc->chipcontrol, val);
3181*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
3182*4882a593Smuzhiyun }
3183*4882a593Smuzhiyun 
3184*4882a593Smuzhiyun uint32
si_chipcontrl_read(si_t * sih)3185*4882a593Smuzhiyun si_chipcontrl_read(si_t *sih)
3186*4882a593Smuzhiyun {
3187*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
3188*4882a593Smuzhiyun 	chipcregs_t *cc;
3189*4882a593Smuzhiyun 	uint origidx = si_coreidx(sih);
3190*4882a593Smuzhiyun 	uint32 val;
3191*4882a593Smuzhiyun 
3192*4882a593Smuzhiyun 	if ((cc = (chipcregs_t *)si_setcore(sih, CC_CORE_ID, 0)) == NULL) {
3193*4882a593Smuzhiyun 		SI_ERROR(("%s: Failed to find CORE ID!\n", __FUNCTION__));
3194*4882a593Smuzhiyun 		return -1;
3195*4882a593Smuzhiyun 	}
3196*4882a593Smuzhiyun 	val = R_REG(sii->osh, &cc->chipcontrol);
3197*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
3198*4882a593Smuzhiyun 	return val;
3199*4882a593Smuzhiyun }
3200*4882a593Smuzhiyun 
3201*4882a593Smuzhiyun /** switch muxed pins, on: SROM, off: FEMCTRL. Called for a family of ac chips, not just 4360. */
3202*4882a593Smuzhiyun void
si_chipcontrl_srom4360(si_t * sih,bool on)3203*4882a593Smuzhiyun si_chipcontrl_srom4360(si_t *sih, bool on)
3204*4882a593Smuzhiyun {
3205*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
3206*4882a593Smuzhiyun 	chipcregs_t *cc;
3207*4882a593Smuzhiyun 	uint origidx = si_coreidx(sih);
3208*4882a593Smuzhiyun 	uint32 val;
3209*4882a593Smuzhiyun 
3210*4882a593Smuzhiyun 	if ((cc = (chipcregs_t *)si_setcore(sih, CC_CORE_ID, 0)) == NULL) {
3211*4882a593Smuzhiyun 		SI_ERROR(("%s: Failed to find CORE ID!\n", __FUNCTION__));
3212*4882a593Smuzhiyun 		return;
3213*4882a593Smuzhiyun 	}
3214*4882a593Smuzhiyun 	val = R_REG(sii->osh, &cc->chipcontrol);
3215*4882a593Smuzhiyun 
3216*4882a593Smuzhiyun 	if (on) {
3217*4882a593Smuzhiyun 		val &= ~(CCTRL4360_SECI_MODE |
3218*4882a593Smuzhiyun 			CCTRL4360_BTSWCTRL_MODE |
3219*4882a593Smuzhiyun 			CCTRL4360_EXTRA_FEMCTRL_MODE |
3220*4882a593Smuzhiyun 			CCTRL4360_BT_LGCY_MODE |
3221*4882a593Smuzhiyun 			CCTRL4360_CORE2FEMCTRL4_ON);
3222*4882a593Smuzhiyun 
3223*4882a593Smuzhiyun 		W_REG(sii->osh, &cc->chipcontrol, val);
3224*4882a593Smuzhiyun 	} else {
3225*4882a593Smuzhiyun 	}
3226*4882a593Smuzhiyun 
3227*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
3228*4882a593Smuzhiyun }
3229*4882a593Smuzhiyun 
3230*4882a593Smuzhiyun /**
3231*4882a593Smuzhiyun  * The SROM clock is derived from the backplane clock. 4365 (200Mhz) and 43684 (240Mhz) have a fast
3232*4882a593Smuzhiyun  * backplane clock that requires a higher-than-POR-default clock divisor ratio for the SROM clock.
3233*4882a593Smuzhiyun  */
3234*4882a593Smuzhiyun void
si_srom_clk_set(si_t * sih)3235*4882a593Smuzhiyun si_srom_clk_set(si_t *sih)
3236*4882a593Smuzhiyun {
3237*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
3238*4882a593Smuzhiyun 	chipcregs_t *cc;
3239*4882a593Smuzhiyun 	uint origidx = si_coreidx(sih);
3240*4882a593Smuzhiyun 	uint32 val;
3241*4882a593Smuzhiyun 	uint32 divisor = 1;
3242*4882a593Smuzhiyun 
3243*4882a593Smuzhiyun 	if ((cc = (chipcregs_t *)si_setcore(sih, CC_CORE_ID, 0)) == NULL) {
3244*4882a593Smuzhiyun 		SI_ERROR(("%s: Failed to find CORE ID!\n", __FUNCTION__));
3245*4882a593Smuzhiyun 		return;
3246*4882a593Smuzhiyun 	}
3247*4882a593Smuzhiyun 
3248*4882a593Smuzhiyun 	val = R_REG(sii->osh, &cc->clkdiv2);
3249*4882a593Smuzhiyun 	if (BCM4365_CHIP(sih->chip)) {
3250*4882a593Smuzhiyun 		divisor = CLKD2_SROMDIV_192; /* divide 200 by 192 -> SPROM clock ~ 1.04Mhz */
3251*4882a593Smuzhiyun 	} else {
3252*4882a593Smuzhiyun 		ASSERT(0);
3253*4882a593Smuzhiyun 	}
3254*4882a593Smuzhiyun 
3255*4882a593Smuzhiyun 	W_REG(sii->osh, &cc->clkdiv2, ((val & ~CLKD2_SROM) | divisor));
3256*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
3257*4882a593Smuzhiyun }
3258*4882a593Smuzhiyun #endif // endif
3259*4882a593Smuzhiyun 
3260*4882a593Smuzhiyun void
si_pmu_avb_clk_set(si_t * sih,osl_t * osh,bool set_flag)3261*4882a593Smuzhiyun si_pmu_avb_clk_set(si_t *sih, osl_t *osh, bool set_flag)
3262*4882a593Smuzhiyun {
3263*4882a593Smuzhiyun }
3264*4882a593Smuzhiyun 
3265*4882a593Smuzhiyun void
si_btc_enable_chipcontrol(si_t * sih)3266*4882a593Smuzhiyun si_btc_enable_chipcontrol(si_t *sih)
3267*4882a593Smuzhiyun {
3268*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
3269*4882a593Smuzhiyun 	chipcregs_t *cc;
3270*4882a593Smuzhiyun 	uint origidx = si_coreidx(sih);
3271*4882a593Smuzhiyun 
3272*4882a593Smuzhiyun 	if ((cc = (chipcregs_t *)si_setcore(sih, CC_CORE_ID, 0)) == NULL) {
3273*4882a593Smuzhiyun 		SI_ERROR(("%s: Failed to find CORE ID!\n", __FUNCTION__));
3274*4882a593Smuzhiyun 		return;
3275*4882a593Smuzhiyun 	}
3276*4882a593Smuzhiyun 
3277*4882a593Smuzhiyun 	/* BT fix */
3278*4882a593Smuzhiyun 	W_REG(sii->osh, &cc->chipcontrol,
3279*4882a593Smuzhiyun 		R_REG(sii->osh, &cc->chipcontrol) | CC_BTCOEX_EN_MASK);
3280*4882a593Smuzhiyun 
3281*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
3282*4882a593Smuzhiyun }
3283*4882a593Smuzhiyun 
3284*4882a593Smuzhiyun /** cache device removed state */
si_set_device_removed(si_t * sih,bool status)3285*4882a593Smuzhiyun void si_set_device_removed(si_t *sih, bool status)
3286*4882a593Smuzhiyun {
3287*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
3288*4882a593Smuzhiyun 
3289*4882a593Smuzhiyun 	sii->device_removed = status;
3290*4882a593Smuzhiyun }
3291*4882a593Smuzhiyun 
3292*4882a593Smuzhiyun /** check if the device is removed */
3293*4882a593Smuzhiyun bool
si_deviceremoved(si_t * sih)3294*4882a593Smuzhiyun si_deviceremoved(si_t *sih)
3295*4882a593Smuzhiyun {
3296*4882a593Smuzhiyun 	uint32 w;
3297*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
3298*4882a593Smuzhiyun 
3299*4882a593Smuzhiyun 	if (sii->device_removed) {
3300*4882a593Smuzhiyun 		return TRUE;
3301*4882a593Smuzhiyun 	}
3302*4882a593Smuzhiyun 
3303*4882a593Smuzhiyun 	switch (BUSTYPE(sih->bustype)) {
3304*4882a593Smuzhiyun 	case PCI_BUS:
3305*4882a593Smuzhiyun 		ASSERT(SI_INFO(sih)->osh != NULL);
3306*4882a593Smuzhiyun 		w = OSL_PCI_READ_CONFIG(SI_INFO(sih)->osh, PCI_CFG_VID, sizeof(uint32));
3307*4882a593Smuzhiyun 		if ((w & 0xFFFF) != VENDOR_BROADCOM)
3308*4882a593Smuzhiyun 			return TRUE;
3309*4882a593Smuzhiyun 		break;
3310*4882a593Smuzhiyun 	}
3311*4882a593Smuzhiyun 	return FALSE;
3312*4882a593Smuzhiyun }
3313*4882a593Smuzhiyun 
3314*4882a593Smuzhiyun bool
si_is_warmboot(void)3315*4882a593Smuzhiyun si_is_warmboot(void)
3316*4882a593Smuzhiyun {
3317*4882a593Smuzhiyun 
3318*4882a593Smuzhiyun #ifdef BCMULP
3319*4882a593Smuzhiyun 	return (boot_type == WARM_BOOT);
3320*4882a593Smuzhiyun #else
3321*4882a593Smuzhiyun 	return FALSE;
3322*4882a593Smuzhiyun #endif // endif
3323*4882a593Smuzhiyun }
3324*4882a593Smuzhiyun 
3325*4882a593Smuzhiyun bool
si_is_sprom_available(si_t * sih)3326*4882a593Smuzhiyun si_is_sprom_available(si_t *sih)
3327*4882a593Smuzhiyun {
3328*4882a593Smuzhiyun 	if (CCREV(sih->ccrev) >= 31) {
3329*4882a593Smuzhiyun 		si_info_t *sii;
3330*4882a593Smuzhiyun 		uint origidx;
3331*4882a593Smuzhiyun 		chipcregs_t *cc;
3332*4882a593Smuzhiyun 		uint32 sromctrl;
3333*4882a593Smuzhiyun 
3334*4882a593Smuzhiyun 		if ((sih->cccaps & CC_CAP_SROM) == 0)
3335*4882a593Smuzhiyun 			return FALSE;
3336*4882a593Smuzhiyun 
3337*4882a593Smuzhiyun 		sii = SI_INFO(sih);
3338*4882a593Smuzhiyun 		origidx = sii->curidx;
3339*4882a593Smuzhiyun 		cc = si_setcoreidx(sih, SI_CC_IDX);
3340*4882a593Smuzhiyun 		ASSERT(cc);
3341*4882a593Smuzhiyun 		sromctrl = R_REG(sii->osh, &cc->sromcontrol);
3342*4882a593Smuzhiyun 		si_setcoreidx(sih, origidx);
3343*4882a593Smuzhiyun 		return (sromctrl & SRC_PRESENT);
3344*4882a593Smuzhiyun 	}
3345*4882a593Smuzhiyun 
3346*4882a593Smuzhiyun 	switch (CHIPID(sih->chip)) {
3347*4882a593Smuzhiyun 	case BCM43018_CHIP_ID:
3348*4882a593Smuzhiyun 	case BCM43430_CHIP_ID:
3349*4882a593Smuzhiyun 		return FALSE;
3350*4882a593Smuzhiyun 	case BCM4335_CHIP_ID:
3351*4882a593Smuzhiyun 	CASE_BCM4345_CHIP:
3352*4882a593Smuzhiyun 		return ((sih->chipst & CST4335_SPROM_MASK) &&
3353*4882a593Smuzhiyun 			!(sih->chipst & CST4335_SFLASH_MASK));
3354*4882a593Smuzhiyun 	case BCM4349_CHIP_GRPID:
3355*4882a593Smuzhiyun 		return (sih->chipst & CST4349_SPROM_PRESENT) != 0;
3356*4882a593Smuzhiyun 	case BCM53573_CHIP_GRPID:
3357*4882a593Smuzhiyun 		return FALSE; /* SPROM PRESENT is not defined for 53573 as of now */
3358*4882a593Smuzhiyun 	case BCM4364_CHIP_ID:
3359*4882a593Smuzhiyun 		return (sih->chipst & CST4364_SPROM_PRESENT) != 0;
3360*4882a593Smuzhiyun 	case BCM4369_CHIP_GRPID:
3361*4882a593Smuzhiyun 		if (CHIPREV(sih->chiprev) == 0) {
3362*4882a593Smuzhiyun 			/* WAR for 4369a0: HW4369-1729. no sprom, default to otp always. */
3363*4882a593Smuzhiyun 			return 0;
3364*4882a593Smuzhiyun 		} else {
3365*4882a593Smuzhiyun 			return (sih->chipst & CST4369_SPROM_PRESENT) != 0;
3366*4882a593Smuzhiyun 		}
3367*4882a593Smuzhiyun #ifdef CHIPS_CUSTOMER_HW6
3368*4882a593Smuzhiyun 	case BCM4368_CHIP_ID:
3369*4882a593Smuzhiyun 		return FALSE;
3370*4882a593Smuzhiyun #endif /* CHIPS_CUSTOMER_HW6 */
3371*4882a593Smuzhiyun 	case BCM4347_CHIP_GRPID:
3372*4882a593Smuzhiyun 		return (sih->chipst & CST4347_SPROM_PRESENT) != 0;
3373*4882a593Smuzhiyun 		break;
3374*4882a593Smuzhiyun 	case BCM4350_CHIP_ID:
3375*4882a593Smuzhiyun 	case BCM4354_CHIP_ID:
3376*4882a593Smuzhiyun 	case BCM43556_CHIP_ID:
3377*4882a593Smuzhiyun 	case BCM43558_CHIP_ID:
3378*4882a593Smuzhiyun 	case BCM43566_CHIP_ID:
3379*4882a593Smuzhiyun 	case BCM43568_CHIP_ID:
3380*4882a593Smuzhiyun 	case BCM43569_CHIP_ID:
3381*4882a593Smuzhiyun 	case BCM43570_CHIP_ID:
3382*4882a593Smuzhiyun 	case BCM4358_CHIP_ID:
3383*4882a593Smuzhiyun 		return (sih->chipst & CST4350_SPROM_PRESENT) != 0;
3384*4882a593Smuzhiyun 	CASE_BCM43602_CHIP:
3385*4882a593Smuzhiyun 		return (sih->chipst & CST43602_SPROM_PRESENT) != 0;
3386*4882a593Smuzhiyun 	case BCM43131_CHIP_ID:
3387*4882a593Smuzhiyun 	case BCM43217_CHIP_ID:
3388*4882a593Smuzhiyun 	case BCM43428_CHIP_ID:
3389*4882a593Smuzhiyun 		return (sih->chipst & CST43228_OTP_PRESENT) != CST43228_OTP_PRESENT;
3390*4882a593Smuzhiyun 	case BCM4373_CHIP_ID:
3391*4882a593Smuzhiyun 	case BCM43012_CHIP_ID:
3392*4882a593Smuzhiyun 		return FALSE;
3393*4882a593Smuzhiyun 	default:
3394*4882a593Smuzhiyun 		return TRUE;
3395*4882a593Smuzhiyun 	}
3396*4882a593Smuzhiyun }
3397*4882a593Smuzhiyun 
si_get_sromctl(si_t * sih)3398*4882a593Smuzhiyun uint32 si_get_sromctl(si_t *sih)
3399*4882a593Smuzhiyun {
3400*4882a593Smuzhiyun 	chipcregs_t *cc;
3401*4882a593Smuzhiyun 	uint origidx = si_coreidx(sih);
3402*4882a593Smuzhiyun 	uint32 sromctl;
3403*4882a593Smuzhiyun 	osl_t *osh = si_osh(sih);
3404*4882a593Smuzhiyun 
3405*4882a593Smuzhiyun 	cc = si_setcoreidx(sih, SI_CC_IDX);
3406*4882a593Smuzhiyun 	ASSERT((uintptr)cc);
3407*4882a593Smuzhiyun 
3408*4882a593Smuzhiyun 	sromctl = R_REG(osh, &cc->sromcontrol);
3409*4882a593Smuzhiyun 
3410*4882a593Smuzhiyun 	/* return to the original core */
3411*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
3412*4882a593Smuzhiyun 	return sromctl;
3413*4882a593Smuzhiyun }
3414*4882a593Smuzhiyun 
si_set_sromctl(si_t * sih,uint32 value)3415*4882a593Smuzhiyun int si_set_sromctl(si_t *sih, uint32 value)
3416*4882a593Smuzhiyun {
3417*4882a593Smuzhiyun 	chipcregs_t *cc;
3418*4882a593Smuzhiyun 	uint origidx = si_coreidx(sih);
3419*4882a593Smuzhiyun 	osl_t *osh = si_osh(sih);
3420*4882a593Smuzhiyun 	int ret = BCME_OK;
3421*4882a593Smuzhiyun 
3422*4882a593Smuzhiyun 	cc = si_setcoreidx(sih, SI_CC_IDX);
3423*4882a593Smuzhiyun 	ASSERT((uintptr)cc);
3424*4882a593Smuzhiyun 
3425*4882a593Smuzhiyun 	/* get chipcommon rev */
3426*4882a593Smuzhiyun 	if (si_corerev(sih) >= 32) {
3427*4882a593Smuzhiyun 		/* SpromCtrl is only accessible if CoreCapabilities.SpromSupported and
3428*4882a593Smuzhiyun 		 * SpromPresent is 1.
3429*4882a593Smuzhiyun 		 */
3430*4882a593Smuzhiyun 		if ((R_REG(osh, &cc->capabilities) & CC_CAP_SROM) != 0 &&
3431*4882a593Smuzhiyun 		     (R_REG(osh, &cc->sromcontrol) & SRC_PRESENT)) {
3432*4882a593Smuzhiyun 			W_REG(osh, &cc->sromcontrol, value);
3433*4882a593Smuzhiyun 		} else {
3434*4882a593Smuzhiyun 			ret = BCME_NODEVICE;
3435*4882a593Smuzhiyun 		}
3436*4882a593Smuzhiyun 	} else {
3437*4882a593Smuzhiyun 		ret = BCME_UNSUPPORTED;
3438*4882a593Smuzhiyun 	}
3439*4882a593Smuzhiyun 
3440*4882a593Smuzhiyun 	/* return to the original core */
3441*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
3442*4882a593Smuzhiyun 
3443*4882a593Smuzhiyun 	return ret;
3444*4882a593Smuzhiyun }
3445*4882a593Smuzhiyun 
3446*4882a593Smuzhiyun uint
si_core_wrapperreg(si_t * sih,uint32 coreidx,uint32 offset,uint32 mask,uint32 val)3447*4882a593Smuzhiyun si_core_wrapperreg(si_t *sih, uint32 coreidx, uint32 offset, uint32 mask, uint32 val)
3448*4882a593Smuzhiyun {
3449*4882a593Smuzhiyun 	uint origidx, intr_val = 0;
3450*4882a593Smuzhiyun 	uint ret_val;
3451*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
3452*4882a593Smuzhiyun 
3453*4882a593Smuzhiyun 	origidx = si_coreidx(sih);
3454*4882a593Smuzhiyun 
3455*4882a593Smuzhiyun 	INTR_OFF(sii, intr_val);
3456*4882a593Smuzhiyun 	si_setcoreidx(sih, coreidx);
3457*4882a593Smuzhiyun 
3458*4882a593Smuzhiyun 	ret_val = si_wrapperreg(sih, offset, mask, val);
3459*4882a593Smuzhiyun 
3460*4882a593Smuzhiyun 	/* return to the original core */
3461*4882a593Smuzhiyun 	si_setcoreidx(sih, origidx);
3462*4882a593Smuzhiyun 	INTR_RESTORE(sii, intr_val);
3463*4882a593Smuzhiyun 	return ret_val;
3464*4882a593Smuzhiyun }
3465*4882a593Smuzhiyun 
3466*4882a593Smuzhiyun /* cleanup the timer from the host when ARM is been halted
3467*4882a593Smuzhiyun  * without a chance for ARM cleanup its resources
3468*4882a593Smuzhiyun  * If left not cleanup, Intr from a software timer can still
3469*4882a593Smuzhiyun  * request HT clk when ARM is halted.
3470*4882a593Smuzhiyun  */
3471*4882a593Smuzhiyun uint32
si_pmu_res_req_timer_clr(si_t * sih)3472*4882a593Smuzhiyun si_pmu_res_req_timer_clr(si_t *sih)
3473*4882a593Smuzhiyun {
3474*4882a593Smuzhiyun 	uint32 mask;
3475*4882a593Smuzhiyun 
3476*4882a593Smuzhiyun 	mask = PRRT_REQ_ACTIVE | PRRT_INTEN | PRRT_HT_REQ;
3477*4882a593Smuzhiyun 	mask <<= 14;
3478*4882a593Smuzhiyun 	/* clear mask bits */
3479*4882a593Smuzhiyun 	pmu_corereg(sih, SI_CC_IDX, res_req_timer, mask, 0);
3480*4882a593Smuzhiyun 	/* readback to ensure write completes */
3481*4882a593Smuzhiyun 	return pmu_corereg(sih, SI_CC_IDX, res_req_timer, 0, 0);
3482*4882a593Smuzhiyun }
3483*4882a593Smuzhiyun 
3484*4882a593Smuzhiyun /** turn on/off rfldo */
3485*4882a593Smuzhiyun void
si_pmu_rfldo(si_t * sih,bool on)3486*4882a593Smuzhiyun si_pmu_rfldo(si_t *sih, bool on)
3487*4882a593Smuzhiyun {
3488*4882a593Smuzhiyun }
3489*4882a593Smuzhiyun 
3490*4882a593Smuzhiyun /* Caller of this function should make sure is on PCIE core
3491*4882a593Smuzhiyun  * Used in pciedev.c.
3492*4882a593Smuzhiyun  */
3493*4882a593Smuzhiyun void
si_pcie_disable_oobselltr(si_t * sih)3494*4882a593Smuzhiyun si_pcie_disable_oobselltr(si_t *sih)
3495*4882a593Smuzhiyun {
3496*4882a593Smuzhiyun 	ASSERT(si_coreid(sih) == PCIE2_CORE_ID);
3497*4882a593Smuzhiyun 	 if (PCIECOREREV(sih->buscorerev) >= 23)
3498*4882a593Smuzhiyun 		si_wrapperreg(sih, AI_OOBSELIND74, ~0, 0);
3499*4882a593Smuzhiyun 	 else
3500*4882a593Smuzhiyun 		si_wrapperreg(sih, AI_OOBSELIND30, ~0, 0);
3501*4882a593Smuzhiyun }
3502*4882a593Smuzhiyun 
3503*4882a593Smuzhiyun void
si_pcie_ltr_war(si_t * sih)3504*4882a593Smuzhiyun si_pcie_ltr_war(si_t *sih)
3505*4882a593Smuzhiyun {
3506*4882a593Smuzhiyun }
3507*4882a593Smuzhiyun 
3508*4882a593Smuzhiyun void
si_pcie_hw_LTR_war(si_t * sih)3509*4882a593Smuzhiyun si_pcie_hw_LTR_war(si_t *sih)
3510*4882a593Smuzhiyun {
3511*4882a593Smuzhiyun }
3512*4882a593Smuzhiyun 
3513*4882a593Smuzhiyun void
si_pciedev_reg_pm_clk_period(si_t * sih)3514*4882a593Smuzhiyun si_pciedev_reg_pm_clk_period(si_t *sih)
3515*4882a593Smuzhiyun {
3516*4882a593Smuzhiyun }
3517*4882a593Smuzhiyun 
3518*4882a593Smuzhiyun void
si_pciedev_crwlpciegen2(si_t * sih)3519*4882a593Smuzhiyun si_pciedev_crwlpciegen2(si_t *sih)
3520*4882a593Smuzhiyun {
3521*4882a593Smuzhiyun }
3522*4882a593Smuzhiyun 
3523*4882a593Smuzhiyun void
si_pcie_prep_D3(si_t * sih,bool enter_D3)3524*4882a593Smuzhiyun si_pcie_prep_D3(si_t *sih, bool enter_D3)
3525*4882a593Smuzhiyun {
3526*4882a593Smuzhiyun }
3527*4882a593Smuzhiyun 
3528*4882a593Smuzhiyun #if defined(AXI_TIMEOUTS) || defined(BCM_BACKPLANE_TIMEOUT)
3529*4882a593Smuzhiyun uint32
si_clear_backplane_to_per_core(si_t * sih,uint coreid,uint coreunit,void * wrap)3530*4882a593Smuzhiyun si_clear_backplane_to_per_core(si_t *sih, uint coreid, uint coreunit, void * wrap)
3531*4882a593Smuzhiyun {
3532*4882a593Smuzhiyun 	if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
3533*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS)) {
3534*4882a593Smuzhiyun 		return ai_clear_backplane_to_per_core(sih, coreid, coreunit, wrap);
3535*4882a593Smuzhiyun 	}
3536*4882a593Smuzhiyun 
3537*4882a593Smuzhiyun 	return AXI_WRAP_STS_NONE;
3538*4882a593Smuzhiyun }
3539*4882a593Smuzhiyun #endif /* AXI_TIMEOUTS || BCM_BACKPLANE_TIMEOUT */
3540*4882a593Smuzhiyun 
3541*4882a593Smuzhiyun uint32
si_clear_backplane_to(si_t * sih)3542*4882a593Smuzhiyun si_clear_backplane_to(si_t *sih)
3543*4882a593Smuzhiyun {
3544*4882a593Smuzhiyun 	if ((CHIPTYPE(sih->socitype) == SOCI_AI) ||
3545*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) == SOCI_DVTBUS)) {
3546*4882a593Smuzhiyun 		return ai_clear_backplane_to(sih);
3547*4882a593Smuzhiyun 	}
3548*4882a593Smuzhiyun 
3549*4882a593Smuzhiyun 	return 0;
3550*4882a593Smuzhiyun }
3551*4882a593Smuzhiyun 
3552*4882a593Smuzhiyun void
si_update_backplane_timeouts(si_t * sih,bool enable,uint32 timeout_exp,uint32 cid)3553*4882a593Smuzhiyun si_update_backplane_timeouts(si_t *sih, bool enable, uint32 timeout_exp, uint32 cid)
3554*4882a593Smuzhiyun {
3555*4882a593Smuzhiyun #if defined(AXI_TIMEOUTS) || defined(BCM_BACKPLANE_TIMEOUT)
3556*4882a593Smuzhiyun 	/* Enable only for AXI */
3557*4882a593Smuzhiyun 	if (CHIPTYPE(sih->socitype) != SOCI_AI) {
3558*4882a593Smuzhiyun 		return;
3559*4882a593Smuzhiyun 	}
3560*4882a593Smuzhiyun 
3561*4882a593Smuzhiyun 	ai_update_backplane_timeouts(sih, enable, timeout_exp, cid);
3562*4882a593Smuzhiyun #endif /* AXI_TIMEOUTS  || BCM_BACKPLANE_TIMEOUT */
3563*4882a593Smuzhiyun }
3564*4882a593Smuzhiyun 
3565*4882a593Smuzhiyun /*
3566*4882a593Smuzhiyun  * This routine adds the AXI timeouts for
3567*4882a593Smuzhiyun  * chipcommon, pcie and ARM slave wrappers
3568*4882a593Smuzhiyun  */
3569*4882a593Smuzhiyun void
si_slave_wrapper_add(si_t * sih)3570*4882a593Smuzhiyun si_slave_wrapper_add(si_t *sih)
3571*4882a593Smuzhiyun {
3572*4882a593Smuzhiyun #if defined(AXI_TIMEOUTS) || defined(BCM_BACKPLANE_TIMEOUT)
3573*4882a593Smuzhiyun 	uint32 axi_to = 0;
3574*4882a593Smuzhiyun 
3575*4882a593Smuzhiyun 	/* Enable only for AXI */
3576*4882a593Smuzhiyun 	if ((CHIPTYPE(sih->socitype) != SOCI_AI) &&
3577*4882a593Smuzhiyun 		(CHIPTYPE(sih->socitype) != SOCI_DVTBUS)) {
3578*4882a593Smuzhiyun 		return;
3579*4882a593Smuzhiyun 	}
3580*4882a593Smuzhiyun 
3581*4882a593Smuzhiyun 	if (CHIPID(sih->chip) == BCM4345_CHIP_ID && CHIPREV(sih->chiprev) >= 6) {
3582*4882a593Smuzhiyun 		si_info_t *sii = SI_INFO(sih);
3583*4882a593Smuzhiyun 
3584*4882a593Smuzhiyun 		int wrapper_idx = (int)sii->axi_num_wrappers - 1;
3585*4882a593Smuzhiyun 
3586*4882a593Smuzhiyun 		ASSERT(wrapper_idx >= 0);		/* axi_wrapper[] not initialised */
3587*4882a593Smuzhiyun 		do {
3588*4882a593Smuzhiyun 			if (sii->axi_wrapper[wrapper_idx].wrapper_type == AI_SLAVE_WRAPPER &&
3589*4882a593Smuzhiyun 				sii->axi_wrapper[wrapper_idx].cid == 0xfff) {
3590*4882a593Smuzhiyun 				sii->axi_wrapper[wrapper_idx].wrapper_addr = 0x1810b000;
3591*4882a593Smuzhiyun 				break;
3592*4882a593Smuzhiyun 			}
3593*4882a593Smuzhiyun 		} while (wrapper_idx-- > 0);
3594*4882a593Smuzhiyun 		ASSERT(wrapper_idx >= 0);	/* all addresses valid for the chiprev under test */
3595*4882a593Smuzhiyun 	}
3596*4882a593Smuzhiyun 
3597*4882a593Smuzhiyun 	if (BCM4347_CHIP(sih->chip)) {
3598*4882a593Smuzhiyun 		axi_to = AXI_TO_VAL_4347;
3599*4882a593Smuzhiyun 	}
3600*4882a593Smuzhiyun 	else {
3601*4882a593Smuzhiyun 		axi_to = AXI_TO_VAL;
3602*4882a593Smuzhiyun 	}
3603*4882a593Smuzhiyun 
3604*4882a593Smuzhiyun 	/* All required slave wrappers are added in ai_scan */
3605*4882a593Smuzhiyun 	ai_update_backplane_timeouts(sih, TRUE, axi_to, 0);
3606*4882a593Smuzhiyun 
3607*4882a593Smuzhiyun #ifdef DISABLE_PCIE2_AXI_TIMEOUT
3608*4882a593Smuzhiyun 	ai_update_backplane_timeouts(sih, FALSE, 0, PCIE_CORE_ID);
3609*4882a593Smuzhiyun 	ai_update_backplane_timeouts(sih, FALSE, 0, PCIE2_CORE_ID);
3610*4882a593Smuzhiyun #endif // endif
3611*4882a593Smuzhiyun 
3612*4882a593Smuzhiyun #endif /* AXI_TIMEOUTS  || BCM_BACKPLANE_TIMEOUT */
3613*4882a593Smuzhiyun 
3614*4882a593Smuzhiyun }
3615*4882a593Smuzhiyun 
3616*4882a593Smuzhiyun void
si_pll_sr_reinit(si_t * sih)3617*4882a593Smuzhiyun si_pll_sr_reinit(si_t *sih)
3618*4882a593Smuzhiyun {
3619*4882a593Smuzhiyun }
3620*4882a593Smuzhiyun 
3621*4882a593Smuzhiyun /* Programming d11 core oob  settings for 4364
3622*4882a593Smuzhiyun  * WARs for HW4364-237 and HW4364-166
3623*4882a593Smuzhiyun */
3624*4882a593Smuzhiyun void
si_config_4364_d11_oob(si_t * sih,uint coreid)3625*4882a593Smuzhiyun si_config_4364_d11_oob(si_t *sih, uint coreid)
3626*4882a593Smuzhiyun {
3627*4882a593Smuzhiyun 	uint save_idx;
3628*4882a593Smuzhiyun 
3629*4882a593Smuzhiyun 	save_idx = si_coreidx(sih);
3630*4882a593Smuzhiyun 	si_setcore(sih, coreid, 0);
3631*4882a593Smuzhiyun 	si_wrapperreg(sih, AI_OOBSELINC30, ~0, 0x81828180);
3632*4882a593Smuzhiyun 	si_wrapperreg(sih, AI_OOBSELINC74, ~0, 0x87868183);
3633*4882a593Smuzhiyun 	si_wrapperreg(sih, AI_OOBSELOUTB74, ~0, 0x84858484);
3634*4882a593Smuzhiyun 	si_setcore(sih, coreid, 1);
3635*4882a593Smuzhiyun 	si_wrapperreg(sih, AI_OOBSELINC30, ~0, 0x81828180);
3636*4882a593Smuzhiyun 	si_wrapperreg(sih, AI_OOBSELINC74, ~0, 0x87868184);
3637*4882a593Smuzhiyun 	si_wrapperreg(sih, AI_OOBSELOUTB74, ~0, 0x84868484);
3638*4882a593Smuzhiyun 	si_setcoreidx(sih, save_idx);
3639*4882a593Smuzhiyun }
3640*4882a593Smuzhiyun 
3641*4882a593Smuzhiyun void
si_pll_closeloop(si_t * sih)3642*4882a593Smuzhiyun si_pll_closeloop(si_t *sih)
3643*4882a593Smuzhiyun {
3644*4882a593Smuzhiyun #if defined(SAVERESTORE)
3645*4882a593Smuzhiyun 	uint32 data;
3646*4882a593Smuzhiyun 
3647*4882a593Smuzhiyun 	/* disable PLL open loop operation */
3648*4882a593Smuzhiyun 	switch (CHIPID(sih->chip)) {
3649*4882a593Smuzhiyun #ifdef SAVERESTORE
3650*4882a593Smuzhiyun 		case BCM43018_CHIP_ID:
3651*4882a593Smuzhiyun 		case BCM43430_CHIP_ID:
3652*4882a593Smuzhiyun 			if (SR_ENAB() && sr_isenab(sih)) {
3653*4882a593Smuzhiyun 				/* read back the pll openloop state */
3654*4882a593Smuzhiyun 				data = si_pmu_pllcontrol(sih, PMU1_PLL0_PLLCTL8, 0, 0);
3655*4882a593Smuzhiyun 				/* current mode is openloop (possible POR) */
3656*4882a593Smuzhiyun 				if ((data & PMU1_PLLCTL8_OPENLOOP_MASK) != 0) {
3657*4882a593Smuzhiyun 					si_pmu_pllcontrol(sih, PMU1_PLL0_PLLCTL8,
3658*4882a593Smuzhiyun 						PMU1_PLLCTL8_OPENLOOP_MASK, 0);
3659*4882a593Smuzhiyun 					si_pmu_pllupd(sih);
3660*4882a593Smuzhiyun 				}
3661*4882a593Smuzhiyun 			}
3662*4882a593Smuzhiyun 			break;
3663*4882a593Smuzhiyun #endif /* SAVERESTORE */
3664*4882a593Smuzhiyun 		case BCM4347_CHIP_GRPID:
3665*4882a593Smuzhiyun 		case BCM4369_CHIP_GRPID:
3666*4882a593Smuzhiyun 			si_pmu_chipcontrol(sih, PMU_CHIPCTL1,
3667*4882a593Smuzhiyun 				PMU_CC1_ENABLE_CLOSED_LOOP_MASK, PMU_CC1_ENABLE_CLOSED_LOOP);
3668*4882a593Smuzhiyun 			break;
3669*4882a593Smuzhiyun 		default:
3670*4882a593Smuzhiyun 			/* any unsupported chip bail */
3671*4882a593Smuzhiyun 			return;
3672*4882a593Smuzhiyun 	}
3673*4882a593Smuzhiyun #endif // endif
3674*4882a593Smuzhiyun }
3675*4882a593Smuzhiyun 
3676*4882a593Smuzhiyun #if defined(BCMSRPWR) && !defined(BCMSRPWR_DISABLED)
3677*4882a593Smuzhiyun bool _bcmsrpwr = TRUE;
3678*4882a593Smuzhiyun #else
3679*4882a593Smuzhiyun bool _bcmsrpwr = FALSE;
3680*4882a593Smuzhiyun #endif // endif
3681*4882a593Smuzhiyun 
3682*4882a593Smuzhiyun #define PWRREQ_OFFSET(sih)	OFFSETOF(chipcregs_t, powerctl)
3683*4882a593Smuzhiyun 
3684*4882a593Smuzhiyun static void
si_corereg_pciefast_write(si_t * sih,uint regoff,uint val)3685*4882a593Smuzhiyun si_corereg_pciefast_write(si_t *sih, uint regoff, uint val)
3686*4882a593Smuzhiyun {
3687*4882a593Smuzhiyun 	volatile uint32 *r = NULL;
3688*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
3689*4882a593Smuzhiyun 
3690*4882a593Smuzhiyun 	ASSERT((BUSTYPE(sih->bustype) == PCI_BUS));
3691*4882a593Smuzhiyun 
3692*4882a593Smuzhiyun 	r = (volatile uint32 *)((volatile char *)sii->curmap +
3693*4882a593Smuzhiyun 		PCI_16KB0_PCIREGS_OFFSET + regoff);
3694*4882a593Smuzhiyun 
3695*4882a593Smuzhiyun 	W_REG(sii->osh, r, val);
3696*4882a593Smuzhiyun }
3697*4882a593Smuzhiyun 
3698*4882a593Smuzhiyun static uint
si_corereg_pciefast_read(si_t * sih,uint regoff)3699*4882a593Smuzhiyun si_corereg_pciefast_read(si_t *sih, uint regoff)
3700*4882a593Smuzhiyun {
3701*4882a593Smuzhiyun 	volatile uint32 *r = NULL;
3702*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
3703*4882a593Smuzhiyun 
3704*4882a593Smuzhiyun 	ASSERT((BUSTYPE(sih->bustype) == PCI_BUS));
3705*4882a593Smuzhiyun 
3706*4882a593Smuzhiyun 	r = (volatile uint32 *)((volatile char *)sii->curmap +
3707*4882a593Smuzhiyun 		PCI_16KB0_PCIREGS_OFFSET + regoff);
3708*4882a593Smuzhiyun 
3709*4882a593Smuzhiyun 	return R_REG(sii->osh, r);
3710*4882a593Smuzhiyun }
3711*4882a593Smuzhiyun 
3712*4882a593Smuzhiyun uint32
si_srpwr_request(si_t * sih,uint32 mask,uint32 val)3713*4882a593Smuzhiyun si_srpwr_request(si_t *sih, uint32 mask, uint32 val)
3714*4882a593Smuzhiyun {
3715*4882a593Smuzhiyun 	uint32 r, offset = (BUSTYPE(sih->bustype) == SI_BUS) ?
3716*4882a593Smuzhiyun 		OFFSETOF(chipcregs_t, powerctl) : PWRREQ_OFFSET(sih);
3717*4882a593Smuzhiyun 	uint32 mask2 = mask;
3718*4882a593Smuzhiyun 	uint32 val2 = val;
3719*4882a593Smuzhiyun 	volatile uint32 *fast_srpwr_addr = (volatile uint32 *)((uintptr)SI_ENUM_BASE(sih)
3720*4882a593Smuzhiyun 					 + (uintptr)offset);
3721*4882a593Smuzhiyun 
3722*4882a593Smuzhiyun 	if (mask || val) {
3723*4882a593Smuzhiyun 		mask <<= SRPWR_REQON_SHIFT;
3724*4882a593Smuzhiyun 		val  <<= SRPWR_REQON_SHIFT;
3725*4882a593Smuzhiyun 
3726*4882a593Smuzhiyun 		/* Return if requested power request is already set */
3727*4882a593Smuzhiyun 		if (BUSTYPE(sih->bustype) == SI_BUS) {
3728*4882a593Smuzhiyun 			r = R_REG(OSH_NULL, fast_srpwr_addr);
3729*4882a593Smuzhiyun 		} else {
3730*4882a593Smuzhiyun 			r = si_corereg_pciefast_read(sih, offset);
3731*4882a593Smuzhiyun 		}
3732*4882a593Smuzhiyun 
3733*4882a593Smuzhiyun 		if ((r & mask) == val) {
3734*4882a593Smuzhiyun 			return r;
3735*4882a593Smuzhiyun 		}
3736*4882a593Smuzhiyun 
3737*4882a593Smuzhiyun 		r = (r & ~mask) | val;
3738*4882a593Smuzhiyun 
3739*4882a593Smuzhiyun 		if (BUSTYPE(sih->bustype) == SI_BUS) {
3740*4882a593Smuzhiyun 			W_REG(OSH_NULL, fast_srpwr_addr, r);
3741*4882a593Smuzhiyun 			r = R_REG(OSH_NULL, fast_srpwr_addr);
3742*4882a593Smuzhiyun 		} else {
3743*4882a593Smuzhiyun 			si_corereg_pciefast_write(sih, offset, r);
3744*4882a593Smuzhiyun 			r = si_corereg_pciefast_read(sih, offset);
3745*4882a593Smuzhiyun 		}
3746*4882a593Smuzhiyun 
3747*4882a593Smuzhiyun 		if (val2) {
3748*4882a593Smuzhiyun 			if ((r & (mask2 << SRPWR_STATUS_SHIFT)) ==
3749*4882a593Smuzhiyun 			(val2 << SRPWR_STATUS_SHIFT)) {
3750*4882a593Smuzhiyun 				return r;
3751*4882a593Smuzhiyun 			}
3752*4882a593Smuzhiyun 			si_srpwr_stat_spinwait(sih, mask2, val2);
3753*4882a593Smuzhiyun 		}
3754*4882a593Smuzhiyun 	} else {
3755*4882a593Smuzhiyun 		if (BUSTYPE(sih->bustype) == SI_BUS) {
3756*4882a593Smuzhiyun 			r = R_REG(OSH_NULL, fast_srpwr_addr);
3757*4882a593Smuzhiyun 		} else {
3758*4882a593Smuzhiyun 			r = si_corereg_pciefast_read(sih, offset);
3759*4882a593Smuzhiyun 		}
3760*4882a593Smuzhiyun 	}
3761*4882a593Smuzhiyun 
3762*4882a593Smuzhiyun 	return r;
3763*4882a593Smuzhiyun }
3764*4882a593Smuzhiyun 
3765*4882a593Smuzhiyun uint32
si_srpwr_stat_spinwait(si_t * sih,uint32 mask,uint32 val)3766*4882a593Smuzhiyun si_srpwr_stat_spinwait(si_t *sih, uint32 mask, uint32 val)
3767*4882a593Smuzhiyun {
3768*4882a593Smuzhiyun 	uint32 r, offset = (BUSTYPE(sih->bustype) == SI_BUS) ?
3769*4882a593Smuzhiyun 		OFFSETOF(chipcregs_t, powerctl) : PWRREQ_OFFSET(sih);
3770*4882a593Smuzhiyun 	volatile uint32 *fast_srpwr_addr = (volatile uint32 *)((uintptr)SI_ENUM_BASE(sih)
3771*4882a593Smuzhiyun 					 + (uintptr)offset);
3772*4882a593Smuzhiyun 
3773*4882a593Smuzhiyun 	ASSERT(mask);
3774*4882a593Smuzhiyun 	ASSERT(val);
3775*4882a593Smuzhiyun 
3776*4882a593Smuzhiyun 	/* spinwait on pwrstatus */
3777*4882a593Smuzhiyun 	mask <<= SRPWR_STATUS_SHIFT;
3778*4882a593Smuzhiyun 	val <<= SRPWR_STATUS_SHIFT;
3779*4882a593Smuzhiyun 
3780*4882a593Smuzhiyun 	if (BUSTYPE(sih->bustype) == SI_BUS) {
3781*4882a593Smuzhiyun 		SPINWAIT(((R_REG(OSH_NULL, fast_srpwr_addr) & mask) != val),
3782*4882a593Smuzhiyun 			PMU_MAX_TRANSITION_DLY);
3783*4882a593Smuzhiyun 		r = R_REG(OSH_NULL, fast_srpwr_addr) & mask;
3784*4882a593Smuzhiyun 		ASSERT(r == val);
3785*4882a593Smuzhiyun 	} else {
3786*4882a593Smuzhiyun 		SPINWAIT(((si_corereg_pciefast_read(sih, offset) & mask) != val),
3787*4882a593Smuzhiyun 			PMU_MAX_TRANSITION_DLY);
3788*4882a593Smuzhiyun 		r = si_corereg_pciefast_read(sih, offset) & mask;
3789*4882a593Smuzhiyun 		ASSERT(r == val);
3790*4882a593Smuzhiyun 	}
3791*4882a593Smuzhiyun 
3792*4882a593Smuzhiyun 	r = (r >> SRPWR_STATUS_SHIFT) & SRPWR_DMN_ALL_MASK(sih);
3793*4882a593Smuzhiyun 
3794*4882a593Smuzhiyun 	return r;
3795*4882a593Smuzhiyun }
3796*4882a593Smuzhiyun 
3797*4882a593Smuzhiyun uint32
si_srpwr_stat(si_t * sih)3798*4882a593Smuzhiyun si_srpwr_stat(si_t *sih)
3799*4882a593Smuzhiyun {
3800*4882a593Smuzhiyun 	uint32 r, offset = (BUSTYPE(sih->bustype) == SI_BUS) ?
3801*4882a593Smuzhiyun 		OFFSETOF(chipcregs_t, powerctl) : PWRREQ_OFFSET(sih);
3802*4882a593Smuzhiyun 	uint cidx = (BUSTYPE(sih->bustype) == SI_BUS) ? SI_CC_IDX : sih->buscoreidx;
3803*4882a593Smuzhiyun 
3804*4882a593Smuzhiyun 	if (BUSTYPE(sih->bustype) == SI_BUS) {
3805*4882a593Smuzhiyun 		r = si_corereg(sih, cidx, offset, 0, 0);
3806*4882a593Smuzhiyun 	} else {
3807*4882a593Smuzhiyun 		r = si_corereg_pciefast_read(sih, offset);
3808*4882a593Smuzhiyun 	}
3809*4882a593Smuzhiyun 
3810*4882a593Smuzhiyun 	r = (r >> SRPWR_STATUS_SHIFT) & SRPWR_DMN_ALL_MASK(sih);
3811*4882a593Smuzhiyun 
3812*4882a593Smuzhiyun 	return r;
3813*4882a593Smuzhiyun }
3814*4882a593Smuzhiyun 
3815*4882a593Smuzhiyun uint32
si_srpwr_domain(si_t * sih)3816*4882a593Smuzhiyun si_srpwr_domain(si_t *sih)
3817*4882a593Smuzhiyun {
3818*4882a593Smuzhiyun 	uint32 r, offset = (BUSTYPE(sih->bustype) == SI_BUS) ?
3819*4882a593Smuzhiyun 		OFFSETOF(chipcregs_t, powerctl) : PWRREQ_OFFSET(sih);
3820*4882a593Smuzhiyun 	uint cidx = (BUSTYPE(sih->bustype) == SI_BUS) ? SI_CC_IDX : sih->buscoreidx;
3821*4882a593Smuzhiyun 
3822*4882a593Smuzhiyun 	if (BUSTYPE(sih->bustype) == SI_BUS) {
3823*4882a593Smuzhiyun 		r = si_corereg(sih, cidx, offset, 0, 0);
3824*4882a593Smuzhiyun 	} else {
3825*4882a593Smuzhiyun 		r = si_corereg_pciefast_read(sih, offset);
3826*4882a593Smuzhiyun 	}
3827*4882a593Smuzhiyun 
3828*4882a593Smuzhiyun 	r = (r >> SRPWR_DMN_ID_SHIFT) & SRPWR_DMN_ID_MASK;
3829*4882a593Smuzhiyun 
3830*4882a593Smuzhiyun 	return r;
3831*4882a593Smuzhiyun }
3832*4882a593Smuzhiyun 
3833*4882a593Smuzhiyun uint32
si_srpwr_domain_all_mask(si_t * sih)3834*4882a593Smuzhiyun si_srpwr_domain_all_mask(si_t *sih)
3835*4882a593Smuzhiyun {
3836*4882a593Smuzhiyun 	uint32 mask = SRPWR_DMN0_PCIE_MASK |
3837*4882a593Smuzhiyun 	              SRPWR_DMN1_ARMBPSD_MASK |
3838*4882a593Smuzhiyun 	              SRPWR_DMN2_MACAUX_MASK |
3839*4882a593Smuzhiyun 	              SRPWR_DMN3_MACMAIN_MASK;
3840*4882a593Smuzhiyun 
3841*4882a593Smuzhiyun 	if (si_scan_core_present(sih)) {
3842*4882a593Smuzhiyun 		mask |= SRPWR_DMN4_MACSCAN_MASK;
3843*4882a593Smuzhiyun 	}
3844*4882a593Smuzhiyun 
3845*4882a593Smuzhiyun 	return mask;
3846*4882a593Smuzhiyun }
3847*4882a593Smuzhiyun 
3848*4882a593Smuzhiyun /* Utility API to read/write the raw registers with absolute address.
3849*4882a593Smuzhiyun  * This function can be invoked from either FW or host driver.
3850*4882a593Smuzhiyun  */
3851*4882a593Smuzhiyun uint32
si_raw_reg(si_t * sih,uint32 reg,uint32 val,uint32 wrire_req)3852*4882a593Smuzhiyun si_raw_reg(si_t *sih, uint32 reg, uint32 val, uint32 wrire_req)
3853*4882a593Smuzhiyun {
3854*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
3855*4882a593Smuzhiyun 	uint32 address_space = reg & ~0xFFF;
3856*4882a593Smuzhiyun 	volatile uint32 * addr = (void*)(uintptr)(reg);
3857*4882a593Smuzhiyun 	uint32 prev_value = 0;
3858*4882a593Smuzhiyun 	uint32 cfg_reg = 0;
3859*4882a593Smuzhiyun 
3860*4882a593Smuzhiyun 	if (sii == NULL) {
3861*4882a593Smuzhiyun 		return 0;
3862*4882a593Smuzhiyun 	}
3863*4882a593Smuzhiyun 
3864*4882a593Smuzhiyun 	/* No need to translate the absolute address on SI bus */
3865*4882a593Smuzhiyun 	if (BUSTYPE(sih->bustype) == SI_BUS) {
3866*4882a593Smuzhiyun 		goto skip_cfg;
3867*4882a593Smuzhiyun 	}
3868*4882a593Smuzhiyun 
3869*4882a593Smuzhiyun 	/* This API supports only the PCI host interface */
3870*4882a593Smuzhiyun 	if (BUSTYPE(sih->bustype) != PCI_BUS) {
3871*4882a593Smuzhiyun 		return ID32_INVALID;
3872*4882a593Smuzhiyun 	}
3873*4882a593Smuzhiyun 
3874*4882a593Smuzhiyun 	if (PCIE_GEN2(sii)) {
3875*4882a593Smuzhiyun 		/* Use BAR0 Secondary window is PCIe Gen2.
3876*4882a593Smuzhiyun 		 * Set the secondary BAR0 Window to current register of interest
3877*4882a593Smuzhiyun 		 */
3878*4882a593Smuzhiyun 		addr = (volatile uint32*)(((volatile uint8*)sii->curmap) +
3879*4882a593Smuzhiyun 			PCI_SEC_BAR0_WIN_OFFSET + (reg & 0xfff));
3880*4882a593Smuzhiyun 		cfg_reg = PCIE2_BAR0_CORE2_WIN;
3881*4882a593Smuzhiyun 
3882*4882a593Smuzhiyun 	} else {
3883*4882a593Smuzhiyun 		/* PCIe Gen1 do not have secondary BAR0 window.
3884*4882a593Smuzhiyun 		 * reuse the BAR0 WIN2
3885*4882a593Smuzhiyun 		 */
3886*4882a593Smuzhiyun 		addr = (volatile uint32*)(((volatile uint8*)sii->curmap) +
3887*4882a593Smuzhiyun 			PCI_BAR0_WIN2_OFFSET + (reg & 0xfff));
3888*4882a593Smuzhiyun 		cfg_reg = PCI_BAR0_WIN2;
3889*4882a593Smuzhiyun 	}
3890*4882a593Smuzhiyun 
3891*4882a593Smuzhiyun 	prev_value = OSL_PCI_READ_CONFIG(sii->osh, cfg_reg, 4);
3892*4882a593Smuzhiyun 
3893*4882a593Smuzhiyun 	if (prev_value != address_space) {
3894*4882a593Smuzhiyun 		OSL_PCI_WRITE_CONFIG(sii->osh, cfg_reg,
3895*4882a593Smuzhiyun 			sizeof(uint32), address_space);
3896*4882a593Smuzhiyun 	} else {
3897*4882a593Smuzhiyun 		prev_value = 0;
3898*4882a593Smuzhiyun 	}
3899*4882a593Smuzhiyun 
3900*4882a593Smuzhiyun skip_cfg:
3901*4882a593Smuzhiyun 	if (wrire_req) {
3902*4882a593Smuzhiyun 		W_REG(sii->osh, addr, val);
3903*4882a593Smuzhiyun 	} else {
3904*4882a593Smuzhiyun 		val = R_REG(sii->osh, addr);
3905*4882a593Smuzhiyun 	}
3906*4882a593Smuzhiyun 
3907*4882a593Smuzhiyun 	if (prev_value) {
3908*4882a593Smuzhiyun 		/* Restore BAR0 WIN2 for PCIE GEN1 devices */
3909*4882a593Smuzhiyun 		OSL_PCI_WRITE_CONFIG(sii->osh,
3910*4882a593Smuzhiyun 			cfg_reg, sizeof(uint32), prev_value);
3911*4882a593Smuzhiyun 	}
3912*4882a593Smuzhiyun 
3913*4882a593Smuzhiyun 	return val;
3914*4882a593Smuzhiyun }
3915*4882a593Smuzhiyun 
3916*4882a593Smuzhiyun uint8
si_lhl_ps_mode(si_t * sih)3917*4882a593Smuzhiyun si_lhl_ps_mode(si_t *sih)
3918*4882a593Smuzhiyun {
3919*4882a593Smuzhiyun 	si_info_t *sii = SI_INFO(sih);
3920*4882a593Smuzhiyun 	return sii->lhl_ps_mode;
3921*4882a593Smuzhiyun }
3922*4882a593Smuzhiyun 
3923*4882a593Smuzhiyun bool
BCMRAMFN(si_scan_core_present)3924*4882a593Smuzhiyun BCMRAMFN(si_scan_core_present)(si_t *sih)
3925*4882a593Smuzhiyun {
3926*4882a593Smuzhiyun 	return ((si_numcoreunits(sih, D11_CORE_ID) >= 2) &&
3927*4882a593Smuzhiyun 		(si_numcoreunits(sih, SR_CORE_ID) > 4));
3928*4882a593Smuzhiyun }
3929