224 lines
		
	
	
	
		
			6.3 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			224 lines
		
	
	
	
		
			6.3 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
|   | /*
 | ||
|  |  * This file is subject to the terms and conditions of the GNU General Public | ||
|  |  * License.  See the file "COPYING" in the main directory of this archive | ||
|  |  * for more details. | ||
|  |  * | ||
|  |  * Copyright (C) 2012 Jonas Gorski <jonas.gorski@gmail.com> | ||
|  |  */ | ||
|  | 
 | ||
|  | #include <linux/module.h>
 | ||
|  | #include <linux/mutex.h>
 | ||
|  | #include <linux/err.h>
 | ||
|  | #include <linux/clk.h>
 | ||
|  | #include <linux/delay.h>
 | ||
|  | #include <bcm63xx_cpu.h>
 | ||
|  | #include <bcm63xx_io.h>
 | ||
|  | #include <bcm63xx_regs.h>
 | ||
|  | #include <bcm63xx_reset.h>
 | ||
|  | 
 | ||
|  | #define __GEN_RESET_BITS_TABLE(__cpu)					\
 | ||
|  | 	[BCM63XX_RESET_SPI]		= BCM## __cpu ##_RESET_SPI,	\ | ||
|  | 	[BCM63XX_RESET_ENET]		= BCM## __cpu ##_RESET_ENET,	\ | ||
|  | 	[BCM63XX_RESET_USBH]		= BCM## __cpu ##_RESET_USBH,	\ | ||
|  | 	[BCM63XX_RESET_USBD]		= BCM## __cpu ##_RESET_USBD,	\ | ||
|  | 	[BCM63XX_RESET_DSL]		= BCM## __cpu ##_RESET_DSL,	\ | ||
|  | 	[BCM63XX_RESET_SAR]		= BCM## __cpu ##_RESET_SAR,	\ | ||
|  | 	[BCM63XX_RESET_EPHY]		= BCM## __cpu ##_RESET_EPHY,	\ | ||
|  | 	[BCM63XX_RESET_ENETSW]		= BCM## __cpu ##_RESET_ENETSW,	\ | ||
|  | 	[BCM63XX_RESET_PCM]		= BCM## __cpu ##_RESET_PCM,	\ | ||
|  | 	[BCM63XX_RESET_MPI]		= BCM## __cpu ##_RESET_MPI,	\ | ||
|  | 	[BCM63XX_RESET_PCIE]		= BCM## __cpu ##_RESET_PCIE,	\ | ||
|  | 	[BCM63XX_RESET_PCIE_EXT]	= BCM## __cpu ##_RESET_PCIE_EXT, | ||
|  | 
 | ||
|  | #define BCM6328_RESET_SPI	SOFTRESET_6328_SPI_MASK
 | ||
|  | #define BCM6328_RESET_ENET	0
 | ||
|  | #define BCM6328_RESET_USBH	SOFTRESET_6328_USBH_MASK
 | ||
|  | #define BCM6328_RESET_USBD	SOFTRESET_6328_USBS_MASK
 | ||
|  | #define BCM6328_RESET_DSL	0
 | ||
|  | #define BCM6328_RESET_SAR	SOFTRESET_6328_SAR_MASK
 | ||
|  | #define BCM6328_RESET_EPHY	SOFTRESET_6328_EPHY_MASK
 | ||
|  | #define BCM6328_RESET_ENETSW	SOFTRESET_6328_ENETSW_MASK
 | ||
|  | #define BCM6328_RESET_PCM	SOFTRESET_6328_PCM_MASK
 | ||
|  | #define BCM6328_RESET_MPI	0
 | ||
|  | #define BCM6328_RESET_PCIE	\
 | ||
|  | 				(SOFTRESET_6328_PCIE_MASK |		\ | ||
|  | 				 SOFTRESET_6328_PCIE_CORE_MASK |	\ | ||
|  | 				 SOFTRESET_6328_PCIE_HARD_MASK) | ||
|  | #define BCM6328_RESET_PCIE_EXT	SOFTRESET_6328_PCIE_EXT_MASK
 | ||
|  | 
 | ||
|  | #define BCM6338_RESET_SPI	SOFTRESET_6338_SPI_MASK
 | ||
|  | #define BCM6338_RESET_ENET	SOFTRESET_6338_ENET_MASK
 | ||
|  | #define BCM6338_RESET_USBH	SOFTRESET_6338_USBH_MASK
 | ||
|  | #define BCM6338_RESET_USBD	SOFTRESET_6338_USBS_MASK
 | ||
|  | #define BCM6338_RESET_DSL	SOFTRESET_6338_ADSL_MASK
 | ||
|  | #define BCM6338_RESET_SAR	SOFTRESET_6338_SAR_MASK
 | ||
|  | #define BCM6338_RESET_EPHY	0
 | ||
|  | #define BCM6338_RESET_ENETSW	0
 | ||
|  | #define BCM6338_RESET_PCM	0
 | ||
|  | #define BCM6338_RESET_MPI	0
 | ||
|  | #define BCM6338_RESET_PCIE	0
 | ||
|  | #define BCM6338_RESET_PCIE_EXT	0
 | ||
|  | 
 | ||
|  | #define BCM6348_RESET_SPI	SOFTRESET_6348_SPI_MASK
 | ||
|  | #define BCM6348_RESET_ENET	SOFTRESET_6348_ENET_MASK
 | ||
|  | #define BCM6348_RESET_USBH	SOFTRESET_6348_USBH_MASK
 | ||
|  | #define BCM6348_RESET_USBD	SOFTRESET_6348_USBS_MASK
 | ||
|  | #define BCM6348_RESET_DSL	SOFTRESET_6348_ADSL_MASK
 | ||
|  | #define BCM6348_RESET_SAR	SOFTRESET_6348_SAR_MASK
 | ||
|  | #define BCM6348_RESET_EPHY	0
 | ||
|  | #define BCM6348_RESET_ENETSW	0
 | ||
|  | #define BCM6348_RESET_PCM	0
 | ||
|  | #define BCM6348_RESET_MPI	0
 | ||
|  | #define BCM6348_RESET_PCIE	0
 | ||
|  | #define BCM6348_RESET_PCIE_EXT	0
 | ||
|  | 
 | ||
|  | #define BCM6358_RESET_SPI	SOFTRESET_6358_SPI_MASK
 | ||
|  | #define BCM6358_RESET_ENET	SOFTRESET_6358_ENET_MASK
 | ||
|  | #define BCM6358_RESET_USBH	SOFTRESET_6358_USBH_MASK
 | ||
|  | #define BCM6358_RESET_USBD	0
 | ||
|  | #define BCM6358_RESET_DSL	SOFTRESET_6358_ADSL_MASK
 | ||
|  | #define BCM6358_RESET_SAR	SOFTRESET_6358_SAR_MASK
 | ||
|  | #define BCM6358_RESET_EPHY	SOFTRESET_6358_EPHY_MASK
 | ||
|  | #define BCM6358_RESET_ENETSW	0
 | ||
|  | #define BCM6358_RESET_PCM	SOFTRESET_6358_PCM_MASK
 | ||
|  | #define BCM6358_RESET_MPI	SOFTRESET_6358_MPI_MASK
 | ||
|  | #define BCM6358_RESET_PCIE	0
 | ||
|  | #define BCM6358_RESET_PCIE_EXT	0
 | ||
|  | 
 | ||
|  | #define BCM6368_RESET_SPI	SOFTRESET_6368_SPI_MASK
 | ||
|  | #define BCM6368_RESET_ENET	0
 | ||
|  | #define BCM6368_RESET_USBH	SOFTRESET_6368_USBH_MASK
 | ||
|  | #define BCM6368_RESET_USBD	SOFTRESET_6368_USBS_MASK
 | ||
|  | #define BCM6368_RESET_DSL	0
 | ||
|  | #define BCM6368_RESET_SAR	SOFTRESET_6368_SAR_MASK
 | ||
|  | #define BCM6368_RESET_EPHY	SOFTRESET_6368_EPHY_MASK
 | ||
|  | #define BCM6368_RESET_ENETSW	0
 | ||
|  | #define BCM6368_RESET_PCM	SOFTRESET_6368_PCM_MASK
 | ||
|  | #define BCM6368_RESET_MPI	SOFTRESET_6368_MPI_MASK
 | ||
|  | #define BCM6368_RESET_PCIE	0
 | ||
|  | #define BCM6368_RESET_PCIE_EXT	0
 | ||
|  | 
 | ||
|  | #ifdef BCMCPU_RUNTIME_DETECT
 | ||
|  | 
 | ||
|  | /*
 | ||
|  |  * core reset bits | ||
|  |  */ | ||
|  | static const u32 bcm6328_reset_bits[] = { | ||
|  | 	__GEN_RESET_BITS_TABLE(6328) | ||
|  | }; | ||
|  | 
 | ||
|  | static const u32 bcm6338_reset_bits[] = { | ||
|  | 	__GEN_RESET_BITS_TABLE(6338) | ||
|  | }; | ||
|  | 
 | ||
|  | static const u32 bcm6348_reset_bits[] = { | ||
|  | 	__GEN_RESET_BITS_TABLE(6348) | ||
|  | }; | ||
|  | 
 | ||
|  | static const u32 bcm6358_reset_bits[] = { | ||
|  | 	__GEN_RESET_BITS_TABLE(6358) | ||
|  | }; | ||
|  | 
 | ||
|  | static const u32 bcm6368_reset_bits[] = { | ||
|  | 	__GEN_RESET_BITS_TABLE(6368) | ||
|  | }; | ||
|  | 
 | ||
|  | const u32 *bcm63xx_reset_bits; | ||
|  | static int reset_reg; | ||
|  | 
 | ||
|  | static int __init bcm63xx_reset_bits_init(void) | ||
|  | { | ||
|  | 	if (BCMCPU_IS_6328()) { | ||
|  | 		reset_reg = PERF_SOFTRESET_6328_REG; | ||
|  | 		bcm63xx_reset_bits = bcm6328_reset_bits; | ||
|  | 	} else if (BCMCPU_IS_6338()) { | ||
|  | 		reset_reg = PERF_SOFTRESET_REG; | ||
|  | 		bcm63xx_reset_bits = bcm6338_reset_bits; | ||
|  | 	} else if (BCMCPU_IS_6348()) { | ||
|  | 		reset_reg = PERF_SOFTRESET_REG; | ||
|  | 		bcm63xx_reset_bits = bcm6348_reset_bits; | ||
|  | 	} else if (BCMCPU_IS_6358()) { | ||
|  | 		reset_reg = PERF_SOFTRESET_6358_REG; | ||
|  | 		bcm63xx_reset_bits = bcm6358_reset_bits; | ||
|  | 	} else if (BCMCPU_IS_6368()) { | ||
|  | 		reset_reg = PERF_SOFTRESET_6368_REG; | ||
|  | 		bcm63xx_reset_bits = bcm6368_reset_bits; | ||
|  | 	} | ||
|  | 
 | ||
|  | 	return 0; | ||
|  | } | ||
|  | #else
 | ||
|  | 
 | ||
|  | #ifdef CONFIG_BCM63XX_CPU_6328
 | ||
|  | static const u32 bcm63xx_reset_bits[] = { | ||
|  | 	__GEN_RESET_BITS_TABLE(6328) | ||
|  | }; | ||
|  | #define reset_reg PERF_SOFTRESET_6328_REG
 | ||
|  | #endif
 | ||
|  | 
 | ||
|  | #ifdef CONFIG_BCM63XX_CPU_6338
 | ||
|  | static const u32 bcm63xx_reset_bits[] = { | ||
|  | 	__GEN_RESET_BITS_TABLE(6338) | ||
|  | }; | ||
|  | #define reset_reg PERF_SOFTRESET_REG
 | ||
|  | #endif
 | ||
|  | 
 | ||
|  | #ifdef CONFIG_BCM63XX_CPU_6345
 | ||
|  | static const u32 bcm63xx_reset_bits[] = { }; | ||
|  | #define reset_reg 0
 | ||
|  | #endif
 | ||
|  | 
 | ||
|  | #ifdef CONFIG_BCM63XX_CPU_6348
 | ||
|  | static const u32 bcm63xx_reset_bits[] = { | ||
|  | 	__GEN_RESET_BITS_TABLE(6348) | ||
|  | }; | ||
|  | #define reset_reg PERF_SOFTRESET_REG
 | ||
|  | #endif
 | ||
|  | 
 | ||
|  | #ifdef CONFIG_BCM63XX_CPU_6358
 | ||
|  | static const u32 bcm63xx_reset_bits[] = { | ||
|  | 	__GEN_RESET_BITS_TABLE(6358) | ||
|  | }; | ||
|  | #define reset_reg PERF_SOFTRESET_6358_REG
 | ||
|  | #endif
 | ||
|  | 
 | ||
|  | #ifdef CONFIG_BCM63XX_CPU_6368
 | ||
|  | static const u32 bcm63xx_reset_bits[] = { | ||
|  | 	__GEN_RESET_BITS_TABLE(6368) | ||
|  | }; | ||
|  | #define reset_reg PERF_SOFTRESET_6368_REG
 | ||
|  | #endif
 | ||
|  | 
 | ||
|  | static int __init bcm63xx_reset_bits_init(void) { return 0; } | ||
|  | #endif
 | ||
|  | 
 | ||
|  | static DEFINE_SPINLOCK(reset_mutex); | ||
|  | 
 | ||
|  | static void __bcm63xx_core_set_reset(u32 mask, int enable) | ||
|  | { | ||
|  | 	unsigned long flags; | ||
|  | 	u32 val; | ||
|  | 
 | ||
|  | 	if (!mask) | ||
|  | 		return; | ||
|  | 
 | ||
|  | 	spin_lock_irqsave(&reset_mutex, flags); | ||
|  | 	val = bcm_perf_readl(reset_reg); | ||
|  | 
 | ||
|  | 	if (enable) | ||
|  | 		val &= ~mask; | ||
|  | 	else | ||
|  | 		val |= mask; | ||
|  | 
 | ||
|  | 	bcm_perf_writel(val, reset_reg); | ||
|  | 	spin_unlock_irqrestore(&reset_mutex, flags); | ||
|  | } | ||
|  | 
 | ||
|  | void bcm63xx_core_set_reset(enum bcm63xx_core_reset core, int reset) | ||
|  | { | ||
|  | 	__bcm63xx_core_set_reset(bcm63xx_reset_bits[core], reset); | ||
|  | } | ||
|  | EXPORT_SYMBOL(bcm63xx_core_set_reset); | ||
|  | 
 | ||
|  | postcore_initcall(bcm63xx_reset_bits_init); |