brcm47xx: add support for kernel 3.3
SVN-Revision: 31573
This commit is contained in:
		
							
								
								
									
										150
									
								
								target/linux/brcm47xx/config-3.3
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										150
									
								
								target/linux/brcm47xx/config-3.3
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,150 @@ | |||||||
|  | CONFIG_ARCH_BINFMT_ELF_RANDOMIZE_PIE=y | ||||||
|  | CONFIG_ARCH_DISCARD_MEMBLOCK=y | ||||||
|  | # CONFIG_ARCH_DMA_ADDR_T_64BIT is not set | ||||||
|  | # CONFIG_ARCH_HAS_ILOG2_U32 is not set | ||||||
|  | # CONFIG_ARCH_HAS_ILOG2_U64 is not set | ||||||
|  | CONFIG_ARCH_HIBERNATION_POSSIBLE=y | ||||||
|  | # CONFIG_ARCH_PHYS_ADDR_T_64BIT is not set | ||||||
|  | # CONFIG_ARCH_SUPPORTS_MSI is not set | ||||||
|  | CONFIG_ARCH_SUSPEND_POSSIBLE=y | ||||||
|  | # CONFIG_ARPD is not set | ||||||
|  | CONFIG_B44=y | ||||||
|  | CONFIG_B44_PCI=y | ||||||
|  | CONFIG_B44_PCICORE_AUTOSELECT=y | ||||||
|  | CONFIG_B44_PCI_AUTOSELECT=y | ||||||
|  | CONFIG_BCM47XX=y | ||||||
|  | CONFIG_BCM47XX_BCMA=y | ||||||
|  | CONFIG_BCM47XX_SSB=y | ||||||
|  | CONFIG_BCM47XX_WDT=y | ||||||
|  | CONFIG_BCMA=y | ||||||
|  | CONFIG_BCMA_BLOCKIO=y | ||||||
|  | CONFIG_BCMA_DEBUG=y | ||||||
|  | CONFIG_BCMA_DRIVER_MIPS=y | ||||||
|  | CONFIG_BCMA_DRIVER_PCI_HOSTMODE=y | ||||||
|  | CONFIG_BCMA_HOST_PCI=y | ||||||
|  | CONFIG_BCMA_HOST_PCI_POSSIBLE=y | ||||||
|  | CONFIG_BCMA_HOST_SOC=y | ||||||
|  | CONFIG_BCMA_NFLASH=y | ||||||
|  | CONFIG_BCMA_POSSIBLE=y | ||||||
|  | CONFIG_BCMA_SFLASH=y | ||||||
|  | CONFIG_CC_OPTIMIZE_FOR_SIZE=y | ||||||
|  | CONFIG_CEVT_R4K=y | ||||||
|  | CONFIG_CEVT_R4K_LIB=y | ||||||
|  | CONFIG_CFE=y | ||||||
|  | CONFIG_CMDLINE="root=/dev/mtdblock2 rootfstype=squashfs,jffs2 noinitrd console=ttyS0,115200" | ||||||
|  | CONFIG_CMDLINE_BOOL=y | ||||||
|  | # CONFIG_CMDLINE_OVERRIDE is not set | ||||||
|  | CONFIG_CPU_HAS_PREFETCH=y | ||||||
|  | CONFIG_CPU_HAS_SYNC=y | ||||||
|  | CONFIG_CPU_LITTLE_ENDIAN=y | ||||||
|  | CONFIG_CPU_MIPS32=y | ||||||
|  | CONFIG_CPU_MIPS32_R1=y | ||||||
|  | # CONFIG_CPU_MIPS32_R2 is not set | ||||||
|  | CONFIG_CPU_MIPSR1=y | ||||||
|  | CONFIG_CPU_SUPPORTS_32BIT_KERNEL=y | ||||||
|  | CONFIG_CPU_SUPPORTS_HIGHMEM=y | ||||||
|  | CONFIG_CSRC_R4K=y | ||||||
|  | CONFIG_CSRC_R4K_LIB=y | ||||||
|  | CONFIG_DECOMPRESS_LZMA=y | ||||||
|  | CONFIG_DMA_NONCOHERENT=y | ||||||
|  | CONFIG_GENERIC_ATOMIC64=y | ||||||
|  | CONFIG_GENERIC_CLOCKEVENTS=y | ||||||
|  | CONFIG_GENERIC_CLOCKEVENTS_BUILD=y | ||||||
|  | CONFIG_GENERIC_CMOS_UPDATE=y | ||||||
|  | # CONFIG_GENERIC_CPU_DEVICES is not set | ||||||
|  | CONFIG_GENERIC_GPIO=y | ||||||
|  | CONFIG_GENERIC_IRQ_SHOW=y | ||||||
|  | CONFIG_GENERIC_PCI_IOMAP=y | ||||||
|  | CONFIG_HARDWARE_WATCHPOINTS=y | ||||||
|  | CONFIG_HAS_DMA=y | ||||||
|  | CONFIG_HAS_IOMEM=y | ||||||
|  | CONFIG_HAS_IOPORT=y | ||||||
|  | CONFIG_HAVE_ARCH_JUMP_LABEL=y | ||||||
|  | CONFIG_HAVE_ARCH_KGDB=y | ||||||
|  | CONFIG_HAVE_C_RECORDMCOUNT=y | ||||||
|  | CONFIG_HAVE_DMA_API_DEBUG=y | ||||||
|  | CONFIG_HAVE_DMA_ATTRS=y | ||||||
|  | CONFIG_HAVE_DYNAMIC_FTRACE=y | ||||||
|  | CONFIG_HAVE_FTRACE_MCOUNT_RECORD=y | ||||||
|  | CONFIG_HAVE_FUNCTION_GRAPH_TRACER=y | ||||||
|  | CONFIG_HAVE_FUNCTION_TRACER=y | ||||||
|  | CONFIG_HAVE_FUNCTION_TRACE_MCOUNT_TEST=y | ||||||
|  | CONFIG_HAVE_GENERIC_DMA_COHERENT=y | ||||||
|  | CONFIG_HAVE_GENERIC_HARDIRQS=y | ||||||
|  | CONFIG_HAVE_IDE=y | ||||||
|  | CONFIG_HAVE_IRQ_WORK=y | ||||||
|  | CONFIG_HAVE_MEMBLOCK=y | ||||||
|  | CONFIG_HAVE_MEMBLOCK_NODE_MAP=y | ||||||
|  | CONFIG_HAVE_OPROFILE=y | ||||||
|  | CONFIG_HAVE_PERF_EVENTS=y | ||||||
|  | CONFIG_HW_HAS_PCI=y | ||||||
|  | CONFIG_HW_RANDOM=y | ||||||
|  | CONFIG_HZ=250 | ||||||
|  | # CONFIG_HZ_100 is not set | ||||||
|  | CONFIG_HZ_250=y | ||||||
|  | CONFIG_IMAGE_CMDLINE_HACK=y | ||||||
|  | CONFIG_INITRAMFS_SOURCE="" | ||||||
|  | # CONFIG_IP_ROUTE_VERBOSE is not set | ||||||
|  | CONFIG_IRQ_CPU=y | ||||||
|  | CONFIG_IRQ_FORCED_THREADING=y | ||||||
|  | CONFIG_KALLSYMS=y | ||||||
|  | CONFIG_LEDS_GPIO=y | ||||||
|  | CONFIG_MDIO_BOARDINFO=y | ||||||
|  | # CONFIG_MINIX_FS_NATIVE_ENDIAN is not set | ||||||
|  | CONFIG_MIPS=y | ||||||
|  | CONFIG_MIPS_L1_CACHE_SHIFT=5 | ||||||
|  | # CONFIG_MIPS_MACHINE is not set | ||||||
|  | CONFIG_MIPS_MT_DISABLED=y | ||||||
|  | # CONFIG_MLX4_CORE is not set | ||||||
|  | CONFIG_MTD_BCM47XX_PARTS=y | ||||||
|  | CONFIG_MTD_BCM47XX_PFLASH=y | ||||||
|  | CONFIG_MTD_BCM47XX_SFLASH=y | ||||||
|  | CONFIG_MTD_NAND=y | ||||||
|  | CONFIG_MTD_NAND_BCM47XX=y | ||||||
|  | CONFIG_MTD_NAND_ECC=y | ||||||
|  | # CONFIG_MTD_SM_COMMON is not set | ||||||
|  | CONFIG_NEED_DMA_MAP_STATE=y | ||||||
|  | CONFIG_NEED_PER_CPU_KM=y | ||||||
|  | CONFIG_NO_GENERIC_PCI_IOPORT_MAP=y | ||||||
|  | CONFIG_PAGEFLAGS_EXTENDED=y | ||||||
|  | CONFIG_PCI=y | ||||||
|  | CONFIG_PCI_DISABLE_COMMON_QUIRKS=y | ||||||
|  | CONFIG_PCI_DOMAINS=y | ||||||
|  | CONFIG_PERF_USE_VMALLOC=y | ||||||
|  | CONFIG_PHYLIB=y | ||||||
|  | # CONFIG_PREEMPT_RCU is not set | ||||||
|  | # CONFIG_QUOTACTL is not set | ||||||
|  | # CONFIG_SCSI_DMA is not set | ||||||
|  | # CONFIG_SERIAL_8250_DETECT_IRQ is not set | ||||||
|  | CONFIG_SERIAL_8250_EXTENDED=y | ||||||
|  | # CONFIG_SERIAL_8250_MANY_PORTS is not set | ||||||
|  | # CONFIG_SERIAL_8250_RSA is not set | ||||||
|  | CONFIG_SERIAL_8250_SHARE_IRQ=y | ||||||
|  | CONFIG_SSB=y | ||||||
|  | CONFIG_SSB_B43_PCI_BRIDGE=y | ||||||
|  | CONFIG_SSB_BLOCKIO=y | ||||||
|  | CONFIG_SSB_DEBUG=y | ||||||
|  | CONFIG_SSB_DRIVER_EXTIF=y | ||||||
|  | CONFIG_SSB_DRIVER_GIGE=y | ||||||
|  | CONFIG_SSB_DRIVER_MIPS=y | ||||||
|  | CONFIG_SSB_DRIVER_PCICORE=y | ||||||
|  | CONFIG_SSB_DRIVER_PCICORE_POSSIBLE=y | ||||||
|  | CONFIG_SSB_EMBEDDED=y | ||||||
|  | CONFIG_SSB_PCICORE_HOSTMODE=y | ||||||
|  | CONFIG_SSB_PCIHOST=y | ||||||
|  | CONFIG_SSB_PCIHOST_POSSIBLE=y | ||||||
|  | CONFIG_SSB_SERIAL=y | ||||||
|  | CONFIG_SSB_SFLASH=y | ||||||
|  | CONFIG_SSB_SPROM=y | ||||||
|  | CONFIG_SYS_HAS_CPU_MIPS32_R1=y | ||||||
|  | CONFIG_SYS_HAS_CPU_MIPS32_R2=y | ||||||
|  | CONFIG_SYS_SUPPORTS_32BIT_KERNEL=y | ||||||
|  | CONFIG_SYS_SUPPORTS_ARBIT_HZ=y | ||||||
|  | CONFIG_SYS_SUPPORTS_LITTLE_ENDIAN=y | ||||||
|  | CONFIG_USB_ARCH_HAS_XHCI=y | ||||||
|  | # CONFIG_USB_HCD_BCMA is not set | ||||||
|  | # CONFIG_USB_HCD_SSB is not set | ||||||
|  | CONFIG_USB_SUPPORT=y | ||||||
|  | CONFIG_WATCHDOG_NOWAYOUT=y | ||||||
|  | CONFIG_XZ_DEC=y | ||||||
|  | CONFIG_ZONE_DMA_FLAG=0 | ||||||
| @@ -0,0 +1,129 @@ | |||||||
|  | --- a/arch/mips/bcm47xx/nvram.c | ||||||
|  | +++ b/arch/mips/bcm47xx/nvram.c | ||||||
|  | @@ -50,6 +50,9 @@ static void early_nvram_init(void) | ||||||
|  |  #ifdef CONFIG_BCM47XX_BCMA | ||||||
|  |  	case BCM47XX_BUS_TYPE_BCMA: | ||||||
|  |  		bcma_cc = &bcm47xx_bus.bcma.bus.drv_cc; | ||||||
|  | +		if (bcma_cc->flash_type != BCMA_PFLASH) | ||||||
|  | +			return; | ||||||
|  | + | ||||||
|  |  		base = bcma_cc->pflash.window; | ||||||
|  |  		lim = bcma_cc->pflash.window_size; | ||||||
|  |  		break; | ||||||
|  | --- a/drivers/bcma/driver_mips.c | ||||||
|  | +++ b/drivers/bcma/driver_mips.c | ||||||
|  | @@ -189,6 +189,7 @@ static void bcma_core_mips_flash_detect( | ||||||
|  |  		break; | ||||||
|  |  	case BCMA_CC_FLASHT_PARA: | ||||||
|  |  		pr_info("found parallel flash.\n"); | ||||||
|  | +		bus->drv_cc.flash_type = BCMA_PFLASH; | ||||||
|  |  		bus->drv_cc.pflash.window = 0x1c000000; | ||||||
|  |  		bus->drv_cc.pflash.window_size = 0x02000000; | ||||||
|  |   | ||||||
|  | --- a/include/linux/bcma/bcma_driver_chipcommon.h | ||||||
|  | +++ b/include/linux/bcma/bcma_driver_chipcommon.h | ||||||
|  | @@ -117,10 +117,68 @@ | ||||||
|  |  #define  BCMA_CC_JCTL_EXT_EN		2		/* Enable external targets */ | ||||||
|  |  #define  BCMA_CC_JCTL_EN		1		/* Enable Jtag master */ | ||||||
|  |  #define BCMA_CC_FLASHCTL		0x0040 | ||||||
|  | + | ||||||
|  | +/* Start/busy bit in flashcontrol */ | ||||||
|  | +#define  BCMA_CC_FLASHCTL_OPCODE	0x000000ff | ||||||
|  | +#define  BCMA_CC_FLASHCTL_ACTION	0x00000700 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_CS_ACTIVE	0x00001000	/* Chip Select Active, rev >= 20 */ | ||||||
|  |  #define  BCMA_CC_FLASHCTL_START		0x80000000 | ||||||
|  |  #define  BCMA_CC_FLASHCTL_BUSY		BCMA_CC_FLASHCTL_START | ||||||
|  | + | ||||||
|  | +/* flashcontrol action+opcodes for ST flashes */ | ||||||
|  | +#define  BCMA_CC_FLASHCTL_ST_WREN	0x0006		/* Write Enable */ | ||||||
|  | +#define  BCMA_CC_FLASHCTL_ST_WRDIS	0x0004		/* Write Disable */ | ||||||
|  | +#define  BCMA_CC_FLASHCTL_ST_RDSR	0x0105		/* Read Status Register */ | ||||||
|  | +#define  BCMA_CC_FLASHCTL_ST_WRSR	0x0101		/* Write Status Register */ | ||||||
|  | +#define  BCMA_CC_FLASHCTL_ST_READ	0x0303		/* Read Data Bytes */ | ||||||
|  | +#define  BCMA_CC_FLASHCTL_ST_PP		0x0302		/* Page Program */ | ||||||
|  | +#define  BCMA_CC_FLASHCTL_ST_SE		0x02d8		/* Sector Erase */ | ||||||
|  | +#define  BCMA_CC_FLASHCTL_ST_BE		0x00c7		/* Bulk Erase */ | ||||||
|  | +#define  BCMA_CC_FLASHCTL_ST_DP		0x00b9		/* Deep Power-down */ | ||||||
|  | +#define  BCMA_CC_FLASHCTL_ST_RES	0x03ab		/* Read Electronic Signature */ | ||||||
|  | +#define  BCMA_CC_FLASHCTL_ST_CSA	0x1000		/* Keep chip select asserted */ | ||||||
|  | +#define  BCMA_CC_FLASHCTL_ST_SSE	0x0220		/* Sub-sector Erase */ | ||||||
|  | + | ||||||
|  | + | ||||||
|  | +/* flashcontrol action+opcodes for Atmel flashes */ | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_READ			0x07e8 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_PAGE_READ			0x07d2 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BUF1_READ | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BUF2_READ | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_STATUS			0x01d7 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BUF1_WRITE			0x0384 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BUF2_WRITE			0x0387 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BUF1_ERASE_PROGRAM		0x0283 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BUF2_ERASE_PROGRAM		0x0286 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BUF1_PROGRAM		0x0288 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BUF2_PROGRAM		0x0289 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_PAGE_ERASE			0x0281 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BLOCK_ERASE		0x0250 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BUF1_WRITE_ERASE_PROGRAM	0x0382 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BUF2_WRITE_ERASE_PROGRAM	0x0385 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BUF1_LOAD			0x0253 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BUF2_LOAD			0x0255 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BUF1_COMPARE		0x0260 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BUF2_COMPARE		0x0261 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BUF1_REPROGRAM		0x0258 | ||||||
|  | +#define  BCMA_CC_FLASHCTL_AT_BUF2_REPROGRAM		0x0259 | ||||||
|  | + | ||||||
|  |  #define BCMA_CC_FLASHADDR		0x0044 | ||||||
|  |  #define BCMA_CC_FLASHDATA		0x0048 | ||||||
|  | + | ||||||
|  | +/* Status register bits for ST flashes */ | ||||||
|  | +#define  BCMA_CC_FLASHDATA_ST_WIP	0x01		/* Write In Progress */ | ||||||
|  | +#define  BCMA_CC_FLASHDATA_ST_WEL	0x02		/* Write Enable Latch */ | ||||||
|  | +#define  BCMA_CC_FLASHDATA_ST_BP_MASK	0x1c		/* Block Protect */ | ||||||
|  | +#define  BCMA_CC_FLASHDATA_ST_BP_SHIFT	2 | ||||||
|  | +#define  BCMA_CC_FLASHDATA_ST_SRWD	0x80		/* Status Register Write Disable */ | ||||||
|  | + | ||||||
|  | +/* Status register bits for Atmel flashes */ | ||||||
|  | +#define  BCMA_CC_FLASHDATA_AT_READY	0x80 | ||||||
|  | +#define  BCMA_CC_FLASHDATA_AT_MISMATCH	0x40 | ||||||
|  | +#define  BCMA_CC_FLASHDATA_AT_ID_MASK	0x38 | ||||||
|  | +#define  BCMA_CC_FLASHDATA_AT_ID_SHIFT	3 | ||||||
|  | + | ||||||
|  |  #define BCMA_CC_BCAST_ADDR		0x0050 | ||||||
|  |  #define BCMA_CC_BCAST_DATA		0x0054 | ||||||
|  |  #define BCMA_CC_GPIOPULLUP		0x0058		/* Rev >= 20 only */ | ||||||
|  | @@ -324,6 +382,12 @@ | ||||||
|  |  #define BCMA_CHIPCTL_4331_BT_SHD0_ON_GPIO4	BIT(16)	/* enable bt_shd0 at gpio4 */ | ||||||
|  |  #define BCMA_CHIPCTL_4331_BT_SHD1_ON_GPIO5	BIT(17)	/* enable bt_shd1 at gpio5 */ | ||||||
|  |   | ||||||
|  | +#define	BCMA_FLASH2			0x1c000000	/* Flash Region 2 (region 1 shadowed here) */ | ||||||
|  | +#define	BCMA_FLASH2_SZ			0x02000000	/* Size of Flash Region 2 */ | ||||||
|  | +#define	BCMA_FLASH1			0x1fc00000	/* MIPS Flash Region 1 */ | ||||||
|  | +#define	BCMA_FLASH1_SZ			0x00400000	/* MIPS Size of Flash Region 1 */ | ||||||
|  | + | ||||||
|  | + | ||||||
|  |  /* Data for the PMU, if available. | ||||||
|  |   * Check availability with ((struct bcma_chipcommon)->capabilities & BCMA_CC_CAP_PMU) | ||||||
|  |   */ | ||||||
|  | @@ -333,6 +397,10 @@ struct bcma_chipcommon_pmu { | ||||||
|  |  }; | ||||||
|  |   | ||||||
|  |  #ifdef CONFIG_BCMA_DRIVER_MIPS | ||||||
|  | +enum bcma_flash_type { | ||||||
|  | +	BCMA_PFLASH, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  |  struct bcma_pflash { | ||||||
|  |  	u8 buswidth; | ||||||
|  |  	u32 window; | ||||||
|  | @@ -358,7 +426,10 @@ struct bcma_drv_cc { | ||||||
|  |  	u16 fast_pwrup_delay; | ||||||
|  |  	struct bcma_chipcommon_pmu pmu; | ||||||
|  |  #ifdef CONFIG_BCMA_DRIVER_MIPS | ||||||
|  | -	struct bcma_pflash pflash; | ||||||
|  | +	enum bcma_flash_type flash_type; | ||||||
|  | +	union { | ||||||
|  | +		struct bcma_pflash pflash; | ||||||
|  | +	}; | ||||||
|  |   | ||||||
|  |  	int nr_serial_ports; | ||||||
|  |  	struct bcma_serial_port serial_ports[4]; | ||||||
| @@ -0,0 +1,505 @@ | |||||||
|  | --- a/drivers/bcma/Kconfig | ||||||
|  | +++ b/drivers/bcma/Kconfig | ||||||
|  | @@ -38,6 +38,11 @@ config BCMA_HOST_SOC | ||||||
|  |  	bool | ||||||
|  |  	depends on BCMA_DRIVER_MIPS | ||||||
|  |   | ||||||
|  | +config BCMA_SFLASH | ||||||
|  | +	bool | ||||||
|  | +	depends on BCMA_DRIVER_MIPS | ||||||
|  | +	default y | ||||||
|  | + | ||||||
|  |  config BCMA_DRIVER_MIPS | ||||||
|  |  	bool "BCMA Broadcom MIPS core driver" | ||||||
|  |  	depends on BCMA && MIPS | ||||||
|  | --- a/drivers/bcma/Makefile | ||||||
|  | +++ b/drivers/bcma/Makefile | ||||||
|  | @@ -1,5 +1,6 @@ | ||||||
|  |  bcma-y					+= main.o scan.o core.o sprom.o | ||||||
|  |  bcma-y					+= driver_chipcommon.o driver_chipcommon_pmu.o | ||||||
|  | +bcma-$(CONFIG_BCMA_SFLASH)		+= driver_chipcommon_sflash.o | ||||||
|  |  bcma-y					+= driver_pci.o | ||||||
|  |  bcma-$(CONFIG_BCMA_DRIVER_PCI_HOSTMODE)	+= driver_pci_host.o | ||||||
|  |  bcma-$(CONFIG_BCMA_DRIVER_MIPS)		+= driver_mips.o | ||||||
|  | --- a/drivers/bcma/bcma_private.h | ||||||
|  | +++ b/drivers/bcma/bcma_private.h | ||||||
|  | @@ -42,6 +42,11 @@ void bcma_chipco_serial_init(struct bcma | ||||||
|  |  u32 bcma_pmu_alp_clock(struct bcma_drv_cc *cc); | ||||||
|  |  u32 bcma_pmu_get_clockcpu(struct bcma_drv_cc *cc); | ||||||
|  |   | ||||||
|  | +#ifdef CONFIG_BCMA_SFLASH | ||||||
|  | +/* driver_chipcommon_sflash.c */ | ||||||
|  | +int bcma_sflash_init(struct bcma_drv_cc *cc); | ||||||
|  | +#endif /* CONFIG_BCMA_SFLASH */ | ||||||
|  | + | ||||||
|  |  #ifdef CONFIG_BCMA_HOST_PCI | ||||||
|  |  /* host_pci.c */ | ||||||
|  |  extern int __init bcma_host_pci_init(void); | ||||||
|  | --- /dev/null | ||||||
|  | +++ b/drivers/bcma/driver_chipcommon_sflash.c | ||||||
|  | @@ -0,0 +1,398 @@ | ||||||
|  | +/* | ||||||
|  | + * Broadcom SiliconBackplane chipcommon serial flash interface | ||||||
|  | + * | ||||||
|  | + * Copyright 2011, Jonas Gorski <jonas.gorski@gmail.com> | ||||||
|  | + * Copyright 2011, 2012, Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | + * Copyright 2010, Broadcom Corporation | ||||||
|  | + * | ||||||
|  | + * Licensed under the GNU/GPL. See COPYING for details. | ||||||
|  | + */ | ||||||
|  | + | ||||||
|  | +#include <linux/bcma/bcma.h> | ||||||
|  | +#include <linux/bcma/bcma_driver_chipcommon.h> | ||||||
|  | +#include <linux/delay.h> | ||||||
|  | + | ||||||
|  | +#include "bcma_private.h" | ||||||
|  | + | ||||||
|  | +#define NUM_RETRIES	3 | ||||||
|  | + | ||||||
|  | + | ||||||
|  | +/* Issue a serial flash command */ | ||||||
|  | +static inline void bcma_sflash_cmd(struct bcma_drv_cc *cc, u32 opcode) | ||||||
|  | +{ | ||||||
|  | +	bcma_cc_write32(cc, BCMA_CC_FLASHCTL, | ||||||
|  | +			BCMA_CC_FLASHCTL_START | opcode); | ||||||
|  | +	while (bcma_cc_read32(cc, BCMA_CC_FLASHCTL) & BCMA_CC_FLASHCTL_BUSY) | ||||||
|  | +		; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | + | ||||||
|  | +static inline void bcma_sflash_write_u8(struct bcma_drv_cc *cc, | ||||||
|  | +					u32 offset, u8 byte) | ||||||
|  | +{ | ||||||
|  | +	bcma_cc_write32(cc, BCMA_CC_FLASHADDR, offset); | ||||||
|  | +	bcma_cc_write32(cc, BCMA_CC_FLASHDATA, byte); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +/* Initialize serial flash access */ | ||||||
|  | +int bcma_sflash_init(struct bcma_drv_cc *cc) | ||||||
|  | +{ | ||||||
|  | +	u32 id, id2; | ||||||
|  | + | ||||||
|  | +	memset(&cc->sflash, 0, sizeof(struct bcma_sflash)); | ||||||
|  | + | ||||||
|  | +	switch (cc->capabilities & BCMA_CC_CAP_FLASHT) { | ||||||
|  | +	case BCMA_CC_FLASHT_STSER: | ||||||
|  | +		/* Probe for ST chips */ | ||||||
|  | +		bcma_sflash_cmd(cc, BCMA_CC_FLASHCTL_ST_DP); | ||||||
|  | +		bcma_cc_write32(cc, BCMA_CC_FLASHADDR, 0); | ||||||
|  | +		bcma_sflash_cmd(cc, BCMA_CC_FLASHCTL_ST_RES); | ||||||
|  | +		id = bcma_cc_read32(cc, BCMA_CC_FLASHDATA); | ||||||
|  | +		cc->sflash.blocksize = 64 * 1024; | ||||||
|  | +		switch (id) { | ||||||
|  | +		case 0x11: | ||||||
|  | +			/* ST M25P20 2 Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.numblocks = 4; | ||||||
|  | +			break; | ||||||
|  | +		case 0x12: | ||||||
|  | +			/* ST M25P40 4 Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.numblocks = 8; | ||||||
|  | +			break; | ||||||
|  | +		case 0x13: | ||||||
|  | +			/* ST M25P80 8 Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.numblocks = 16; | ||||||
|  | +			break; | ||||||
|  | +		case 0x14: | ||||||
|  | +			/* ST M25P16 16 Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.numblocks = 32; | ||||||
|  | +			break; | ||||||
|  | +		case 0x15: | ||||||
|  | +			/* ST M25P32 32 Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.numblocks = 64; | ||||||
|  | +			break; | ||||||
|  | +		case 0x16: | ||||||
|  | +			/* ST M25P64 64 Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.numblocks = 128; | ||||||
|  | +			break; | ||||||
|  | +		case 0x17: | ||||||
|  | +			/* ST M25FL128 128 Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.numblocks = 256; | ||||||
|  | +			break; | ||||||
|  | +		case 0xbf: | ||||||
|  | +			/* All of the following flashes are SST with | ||||||
|  | +			 * 4KB subsectors. Others should be added but | ||||||
|  | +			 * We'll have to revamp the way we identify them | ||||||
|  | +			 * since RES is not eough to disambiguate them. | ||||||
|  | +			 */ | ||||||
|  | +			cc->sflash.blocksize = 4 * 1024; | ||||||
|  | +			bcma_cc_write32(cc, BCMA_CC_FLASHADDR, 1); | ||||||
|  | +			bcma_sflash_cmd(cc, BCMA_CC_FLASHCTL_ST_RES); | ||||||
|  | +			id2 = bcma_cc_read32(cc, BCMA_CC_FLASHDATA); | ||||||
|  | +			switch (id2) { | ||||||
|  | +			case 1: | ||||||
|  | +				/* SST25WF512 512 Kbit Serial Flash */ | ||||||
|  | +			case 0x48: | ||||||
|  | +				/* SST25VF512 512 Kbit Serial Flash */ | ||||||
|  | +				cc->sflash.numblocks = 16; | ||||||
|  | +				break; | ||||||
|  | +			case 2: | ||||||
|  | +				/* SST25WF010 1 Mbit Serial Flash */ | ||||||
|  | +			case 0x49: | ||||||
|  | +				/* SST25VF010 1 Mbit Serial Flash */ | ||||||
|  | +				cc->sflash.numblocks = 32; | ||||||
|  | +				break; | ||||||
|  | +			case 3: | ||||||
|  | +				/* SST25WF020 2 Mbit Serial Flash */ | ||||||
|  | +			case 0x43: | ||||||
|  | +				/* SST25VF020 2 Mbit Serial Flash */ | ||||||
|  | +				cc->sflash.numblocks = 64; | ||||||
|  | +				break; | ||||||
|  | +			case 4: | ||||||
|  | +				/* SST25WF040 4 Mbit Serial Flash */ | ||||||
|  | +			case 0x44: | ||||||
|  | +				/* SST25VF040 4 Mbit Serial Flash */ | ||||||
|  | +			case 0x8d: | ||||||
|  | +				/* SST25VF040B 4 Mbit Serial Flash */ | ||||||
|  | +				cc->sflash.numblocks = 128; | ||||||
|  | +				break; | ||||||
|  | +			case 5: | ||||||
|  | +				/* SST25WF080 8 Mbit Serial Flash */ | ||||||
|  | +			case 0x8e: | ||||||
|  | +				/* SST25VF080B 8 Mbit Serial Flash */ | ||||||
|  | +				cc->sflash.numblocks = 256; | ||||||
|  | +				break; | ||||||
|  | +			case 0x41: | ||||||
|  | +				/* SST25VF016 16 Mbit Serial Flash */ | ||||||
|  | +				cc->sflash.numblocks = 512; | ||||||
|  | +				break; | ||||||
|  | +			case 0x4a: | ||||||
|  | +				/* SST25VF032 32 Mbit Serial Flash */ | ||||||
|  | +				cc->sflash.numblocks = 1024; | ||||||
|  | +				break; | ||||||
|  | +			case 0x4b: | ||||||
|  | +				/* SST25VF064 64 Mbit Serial Flash */ | ||||||
|  | +				cc->sflash.numblocks = 2048; | ||||||
|  | +				break; | ||||||
|  | +			} | ||||||
|  | +			break; | ||||||
|  | +		} | ||||||
|  | +		break; | ||||||
|  | + | ||||||
|  | +	case BCMA_CC_FLASHT_ATSER: | ||||||
|  | +		/* Probe for Atmel chips */ | ||||||
|  | +		bcma_sflash_cmd(cc, BCMA_CC_FLASHCTL_AT_STATUS); | ||||||
|  | +		id = bcma_cc_read32(cc, BCMA_CC_FLASHDATA) & 0x3c; | ||||||
|  | +		switch (id) { | ||||||
|  | +		case 0xc: | ||||||
|  | +			/* Atmel AT45DB011 1Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.blocksize = 256; | ||||||
|  | +			cc->sflash.numblocks = 512; | ||||||
|  | +			break; | ||||||
|  | +		case 0x14: | ||||||
|  | +			/* Atmel AT45DB021 2Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.blocksize = 256; | ||||||
|  | +			cc->sflash.numblocks = 1024; | ||||||
|  | +			break; | ||||||
|  | +		case 0x1c: | ||||||
|  | +			/* Atmel AT45DB041 4Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.blocksize = 256; | ||||||
|  | +			cc->sflash.numblocks = 2048; | ||||||
|  | +			break; | ||||||
|  | +		case 0x24: | ||||||
|  | +			/* Atmel AT45DB081 8Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.blocksize = 256; | ||||||
|  | +			cc->sflash.numblocks = 4096; | ||||||
|  | +			break; | ||||||
|  | +		case 0x2c: | ||||||
|  | +			/* Atmel AT45DB161 16Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.blocksize = 512; | ||||||
|  | +			cc->sflash.numblocks = 4096; | ||||||
|  | +			break; | ||||||
|  | +		case 0x34: | ||||||
|  | +			/* Atmel AT45DB321 32Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.blocksize = 512; | ||||||
|  | +			cc->sflash.numblocks = 8192; | ||||||
|  | +			break; | ||||||
|  | +		case 0x3c: | ||||||
|  | +			/* Atmel AT45DB642 64Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.blocksize = 1024; | ||||||
|  | +			cc->sflash.numblocks = 8192; | ||||||
|  | +			break; | ||||||
|  | +		} | ||||||
|  | +		break; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	cc->sflash.size = cc->sflash.blocksize * cc->sflash.numblocks; | ||||||
|  | + | ||||||
|  | +	return cc->sflash.size ? 0 : -ENODEV; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +/* Read len bytes starting at offset into buf. Returns number of bytes read. */ | ||||||
|  | +int bcma_sflash_read(struct bcma_drv_cc *cc, u32 offset, u32 len, u8 *buf) | ||||||
|  | +{ | ||||||
|  | +	u8 *from, *to; | ||||||
|  | +	u32 cnt, i; | ||||||
|  | + | ||||||
|  | +	if (!len) | ||||||
|  | +		return 0; | ||||||
|  | + | ||||||
|  | +	if ((offset + len) > cc->sflash.size) | ||||||
|  | +		return -EINVAL; | ||||||
|  | + | ||||||
|  | +	if ((len >= 4) && (offset & 3)) | ||||||
|  | +		cnt = 4 - (offset & 3); | ||||||
|  | +	else if ((len >= 4) && ((u32)buf & 3)) | ||||||
|  | +		cnt = 4 - ((u32)buf & 3); | ||||||
|  | +	else | ||||||
|  | +		cnt = len; | ||||||
|  | + | ||||||
|  | +	from = (u8 *)KSEG0ADDR(BCMA_FLASH2 + offset); | ||||||
|  | + | ||||||
|  | +	to = (u8 *)buf; | ||||||
|  | + | ||||||
|  | +	if (cnt < 4) { | ||||||
|  | +		for (i = 0; i < cnt; i++) { | ||||||
|  | +			*to = readb(from); | ||||||
|  | +			from++; | ||||||
|  | +			to++; | ||||||
|  | +		} | ||||||
|  | +		return cnt; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	while (cnt >= 4) { | ||||||
|  | +		*(u32 *)to = readl(from); | ||||||
|  | +		from += 4; | ||||||
|  | +		to += 4; | ||||||
|  | +		cnt -= 4; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return len - cnt; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +/* Poll for command completion. Returns zero when complete. */ | ||||||
|  | +int bcma_sflash_poll(struct bcma_drv_cc *cc, u32 offset) | ||||||
|  | +{ | ||||||
|  | +	if (offset >= cc->sflash.size) | ||||||
|  | +		return -22; | ||||||
|  | + | ||||||
|  | +	switch (cc->capabilities & BCMA_CC_CAP_FLASHT) { | ||||||
|  | +	case BCMA_CC_FLASHT_STSER: | ||||||
|  | +		/* Check for ST Write In Progress bit */ | ||||||
|  | +		bcma_sflash_cmd(cc, BCMA_CC_FLASHCTL_ST_RDSR); | ||||||
|  | +		return bcma_cc_read32(cc, BCMA_CC_FLASHDATA) | ||||||
|  | +				& BCMA_CC_FLASHDATA_ST_WIP; | ||||||
|  | +	case BCMA_CC_FLASHT_ATSER: | ||||||
|  | +		/* Check for Atmel Ready bit */ | ||||||
|  | +		bcma_sflash_cmd(cc, BCMA_CC_FLASHCTL_AT_STATUS); | ||||||
|  | +		return !(bcma_cc_read32(cc, BCMA_CC_FLASHDATA) | ||||||
|  | +				& BCMA_CC_FLASHDATA_AT_READY); | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | + | ||||||
|  | +static int sflash_st_write(struct bcma_drv_cc *cc, u32 offset, u32 len, | ||||||
|  | +			   const u8 *buf) | ||||||
|  | +{ | ||||||
|  | +	int written = 1; | ||||||
|  | + | ||||||
|  | +	/* Enable writes */ | ||||||
|  | +	bcma_sflash_cmd(cc, BCMA_CC_FLASHCTL_ST_WREN); | ||||||
|  | +	bcma_sflash_write_u8(cc, offset, *buf++); | ||||||
|  | +	/* Issue a page program with CSA bit set */ | ||||||
|  | +	bcma_sflash_cmd(cc, BCMA_CC_FLASHCTL_ST_CSA | BCMA_CC_FLASHCTL_ST_PP); | ||||||
|  | +	offset++; | ||||||
|  | +	len--; | ||||||
|  | +	while (len > 0) { | ||||||
|  | +		if ((offset & 255) == 0) { | ||||||
|  | +			/* Page boundary, poll droping cs and return */ | ||||||
|  | +			bcma_cc_write32(cc, BCMA_CC_FLASHCTL, 0); | ||||||
|  | +			udelay(1); | ||||||
|  | +			if (!bcma_sflash_poll(cc, offset)) { | ||||||
|  | +				/* Flash rejected command */ | ||||||
|  | +				return -EAGAIN; | ||||||
|  | +			} | ||||||
|  | +			return written; | ||||||
|  | +		} else { | ||||||
|  | +			/* Write single byte */ | ||||||
|  | +			bcma_sflash_cmd(cc, | ||||||
|  | +					BCMA_CC_FLASHCTL_ST_CSA | | ||||||
|  | +					*buf++); | ||||||
|  | +		} | ||||||
|  | +		written++; | ||||||
|  | +		offset++; | ||||||
|  | +		len--; | ||||||
|  | +	} | ||||||
|  | +	/* All done, drop cs & poll */ | ||||||
|  | +	bcma_cc_write32(cc, BCMA_CC_FLASHCTL, 0); | ||||||
|  | +	udelay(1); | ||||||
|  | +	if (!bcma_sflash_poll(cc, offset)) { | ||||||
|  | +		/* Flash rejected command */ | ||||||
|  | +		return -EAGAIN; | ||||||
|  | +	} | ||||||
|  | +	return written; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int sflash_at_write(struct bcma_drv_cc *cc, u32 offset, u32 len, | ||||||
|  | +			   const u8 *buf) | ||||||
|  | +{ | ||||||
|  | +	struct bcma_sflash *sfl = &cc->sflash; | ||||||
|  | +	u32 page, byte, mask; | ||||||
|  | +	int ret = 0; | ||||||
|  | + | ||||||
|  | +	mask = sfl->blocksize - 1; | ||||||
|  | +	page = (offset & ~mask) << 1; | ||||||
|  | +	byte = offset & mask; | ||||||
|  | +	/* Read main memory page into buffer 1 */ | ||||||
|  | +	if (byte || (len < sfl->blocksize)) { | ||||||
|  | +		int i = 100; | ||||||
|  | +		bcma_cc_write32(cc, BCMA_CC_FLASHADDR, page); | ||||||
|  | +		bcma_sflash_cmd(cc, BCMA_CC_FLASHCTL_AT_BUF1_LOAD); | ||||||
|  | +		/* 250 us for AT45DB321B */ | ||||||
|  | +		while (i > 0 && bcma_sflash_poll(cc, offset)) { | ||||||
|  | +			udelay(10); | ||||||
|  | +			i--; | ||||||
|  | +		} | ||||||
|  | +		BUG_ON(!bcma_sflash_poll(cc, offset)); | ||||||
|  | +	} | ||||||
|  | +	/* Write into buffer 1 */ | ||||||
|  | +	for (ret = 0; (ret < (int)len) && (byte < sfl->blocksize); ret++) { | ||||||
|  | +		bcma_sflash_write_u8(cc, byte++, *buf++); | ||||||
|  | +		bcma_sflash_cmd(cc, BCMA_CC_FLASHCTL_AT_BUF1_WRITE); | ||||||
|  | +	} | ||||||
|  | +	/* Write buffer 1 into main memory page */ | ||||||
|  | +	bcma_cc_write32(cc, BCMA_CC_FLASHADDR, page); | ||||||
|  | +	bcma_sflash_cmd(cc, BCMA_CC_FLASHCTL_AT_BUF1_PROGRAM); | ||||||
|  | + | ||||||
|  | +	return ret; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +/* Write len bytes starting at offset into buf. Returns number of bytes | ||||||
|  | + * written. Caller should poll for completion. | ||||||
|  | + */ | ||||||
|  | +int bcma_sflash_write(struct bcma_drv_cc *cc, u32 offset, u32 len, | ||||||
|  | +		      const u8 *buf) | ||||||
|  | +{ | ||||||
|  | +	struct bcma_sflash *sfl; | ||||||
|  | +	int ret = 0, tries = NUM_RETRIES; | ||||||
|  | + | ||||||
|  | +	if (!len) | ||||||
|  | +		return 0; | ||||||
|  | + | ||||||
|  | +	if ((offset + len) > cc->sflash.size) | ||||||
|  | +		return -EINVAL; | ||||||
|  | + | ||||||
|  | +	sfl = &cc->sflash; | ||||||
|  | +	switch (cc->capabilities & BCMA_CC_CAP_FLASHT) { | ||||||
|  | +	case BCMA_CC_FLASHT_STSER: | ||||||
|  | +		do { | ||||||
|  | +			ret = sflash_st_write(cc, offset, len, buf); | ||||||
|  | +			tries--; | ||||||
|  | +		} while (ret == -EAGAIN && tries > 0); | ||||||
|  | + | ||||||
|  | +		if (ret == -EAGAIN && tries == 0) { | ||||||
|  | +			pr_info("ST Flash rejected write\n"); | ||||||
|  | +			ret = -EIO; | ||||||
|  | +		} | ||||||
|  | +		break; | ||||||
|  | +	case BCMA_CC_FLASHT_ATSER: | ||||||
|  | +		ret = sflash_at_write(cc, offset, len, buf); | ||||||
|  | +		break; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return ret; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +/* Erase a region. Returns number of bytes scheduled for erasure. | ||||||
|  | + * Caller should poll for completion. | ||||||
|  | + */ | ||||||
|  | +int bcma_sflash_erase(struct bcma_drv_cc *cc, u32 offset) | ||||||
|  | +{ | ||||||
|  | +	struct bcma_sflash *sfl; | ||||||
|  | + | ||||||
|  | +	if (offset >= cc->sflash.size) | ||||||
|  | +		return -EINVAL; | ||||||
|  | + | ||||||
|  | +	sfl = &cc->sflash; | ||||||
|  | +	switch (cc->capabilities & BCMA_CC_CAP_FLASHT) { | ||||||
|  | +	case BCMA_CC_FLASHT_STSER: | ||||||
|  | +		bcma_sflash_cmd(cc, BCMA_CC_FLASHCTL_ST_WREN); | ||||||
|  | +		bcma_cc_write32(cc, BCMA_CC_FLASHADDR, offset); | ||||||
|  | +		/* Newer flashes have "sub-sectors" which can be erased independently | ||||||
|  | +		 * with a new command: ST_SSE. The ST_SE command erases 64KB just as | ||||||
|  | +		 * before. | ||||||
|  | +		 */ | ||||||
|  | +		if (sfl->blocksize < (64 * 1024)) | ||||||
|  | +			bcma_sflash_cmd(cc, BCMA_CC_FLASHCTL_ST_SSE); | ||||||
|  | +		else | ||||||
|  | +			bcma_sflash_cmd(cc, BCMA_CC_FLASHCTL_ST_SE); | ||||||
|  | +		return sfl->blocksize; | ||||||
|  | +	case BCMA_CC_FLASHT_ATSER: | ||||||
|  | +		bcma_cc_write32(cc, BCMA_CC_FLASHADDR, offset << 1); | ||||||
|  | +		bcma_sflash_cmd(cc, BCMA_CC_FLASHCTL_AT_PAGE_ERASE); | ||||||
|  | +		return sfl->blocksize; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | --- a/drivers/bcma/driver_mips.c | ||||||
|  | +++ b/drivers/bcma/driver_mips.c | ||||||
|  | @@ -185,7 +185,13 @@ static void bcma_core_mips_flash_detect( | ||||||
|  |  	switch (bus->drv_cc.capabilities & BCMA_CC_CAP_FLASHT) { | ||||||
|  |  	case BCMA_CC_FLASHT_STSER: | ||||||
|  |  	case BCMA_CC_FLASHT_ATSER: | ||||||
|  | -		pr_err("Serial flash not supported.\n"); | ||||||
|  | +#ifdef CONFIG_BCMA_SFLASH | ||||||
|  | +		pr_info("found serial flash.\n"); | ||||||
|  | +		bus->drv_cc.flash_type = BCMA_SFLASH; | ||||||
|  | +		bcma_sflash_init(&bus->drv_cc); | ||||||
|  | +#else | ||||||
|  | +		pr_info("serial flash not supported.\n"); | ||||||
|  | +#endif /* CONFIG_BCMA_SFLASH */ | ||||||
|  |  		break; | ||||||
|  |  	case BCMA_CC_FLASHT_PARA: | ||||||
|  |  		pr_info("found parallel flash.\n"); | ||||||
|  | --- a/include/linux/bcma/bcma_driver_chipcommon.h | ||||||
|  | +++ b/include/linux/bcma/bcma_driver_chipcommon.h | ||||||
|  | @@ -399,6 +399,7 @@ struct bcma_chipcommon_pmu { | ||||||
|  |  #ifdef CONFIG_BCMA_DRIVER_MIPS | ||||||
|  |  enum bcma_flash_type { | ||||||
|  |  	BCMA_PFLASH, | ||||||
|  | +	BCMA_SFLASH, | ||||||
|  |  }; | ||||||
|  |   | ||||||
|  |  struct bcma_pflash { | ||||||
|  | @@ -407,6 +408,14 @@ struct bcma_pflash { | ||||||
|  |  	u32 window_size; | ||||||
|  |  }; | ||||||
|  |   | ||||||
|  | +#ifdef CONFIG_BCMA_SFLASH | ||||||
|  | +struct bcma_sflash { | ||||||
|  | +	u32 blocksize;		/* Block size */ | ||||||
|  | +	u32 numblocks;		/* Number of blocks */ | ||||||
|  | +	u32 size;		/* Total size in bytes */ | ||||||
|  | +}; | ||||||
|  | +#endif /* CONFIG_BCMA_SFLASH */ | ||||||
|  | + | ||||||
|  |  struct bcma_serial_port { | ||||||
|  |  	void *regs; | ||||||
|  |  	unsigned long clockspeed; | ||||||
|  | @@ -429,6 +438,9 @@ struct bcma_drv_cc { | ||||||
|  |  	enum bcma_flash_type flash_type; | ||||||
|  |  	union { | ||||||
|  |  		struct bcma_pflash pflash; | ||||||
|  | +#ifdef CONFIG_BCMA_SFLASH | ||||||
|  | +		struct bcma_sflash sflash; | ||||||
|  | +#endif /* CONFIG_BCMA_SFLASH */ | ||||||
|  |  	}; | ||||||
|  |   | ||||||
|  |  	int nr_serial_ports; | ||||||
|  | @@ -483,4 +495,14 @@ extern void bcma_chipco_chipctl_maskset( | ||||||
|  |  extern void bcma_chipco_regctl_maskset(struct bcma_drv_cc *cc, | ||||||
|  |  				       u32 offset, u32 mask, u32 set); | ||||||
|  |   | ||||||
|  | +#ifdef CONFIG_BCMA_SFLASH | ||||||
|  | +/* Chipcommon sflash support. */ | ||||||
|  | +int bcma_sflash_read(struct bcma_drv_cc *cc, u32 offset, u32 len, | ||||||
|  | +			   u8 *buf); | ||||||
|  | +int bcma_sflash_poll(struct bcma_drv_cc *cc, u32 offset); | ||||||
|  | +int bcma_sflash_write(struct bcma_drv_cc *cc, u32 offset, u32 len, | ||||||
|  | +			    const u8 *buf); | ||||||
|  | +int bcma_sflash_erase(struct bcma_drv_cc *cc, u32 offset); | ||||||
|  | +#endif /* CONFIG_BCMA_SFLASH */ | ||||||
|  | + | ||||||
|  |  #endif /* LINUX_BCMA_DRIVER_CC_H_ */ | ||||||
| @@ -0,0 +1,134 @@ | |||||||
|  | --- a/arch/mips/bcm47xx/nvram.c | ||||||
|  | +++ b/arch/mips/bcm47xx/nvram.c | ||||||
|  | @@ -27,7 +27,7 @@ static char nvram_buf[NVRAM_SPACE]; | ||||||
|  |  static void early_nvram_init(void) | ||||||
|  |  { | ||||||
|  |  #ifdef CONFIG_BCM47XX_SSB | ||||||
|  | -	struct ssb_mipscore *mcore_ssb; | ||||||
|  | +	struct ssb_chipcommon *ssb_cc; | ||||||
|  |  #endif | ||||||
|  |  #ifdef CONFIG_BCM47XX_BCMA | ||||||
|  |  	struct bcma_drv_cc *bcma_cc; | ||||||
|  | @@ -42,9 +42,9 @@ static void early_nvram_init(void) | ||||||
|  |  	switch (bcm47xx_bus_type) { | ||||||
|  |  #ifdef CONFIG_BCM47XX_SSB | ||||||
|  |  	case BCM47XX_BUS_TYPE_SSB: | ||||||
|  | -		mcore_ssb = &bcm47xx_bus.ssb.mipscore; | ||||||
|  | -		base = mcore_ssb->flash_window; | ||||||
|  | -		lim = mcore_ssb->flash_window_size; | ||||||
|  | +		ssb_cc = &bcm47xx_bus.ssb.chipco; | ||||||
|  | +		base = ssb_cc->pflash.window; | ||||||
|  | +		lim = ssb_cc->pflash.window_size; | ||||||
|  |  		break; | ||||||
|  |  #endif | ||||||
|  |  #ifdef CONFIG_BCM47XX_BCMA | ||||||
|  | --- a/arch/mips/bcm47xx/wgt634u.c | ||||||
|  | +++ b/arch/mips/bcm47xx/wgt634u.c | ||||||
|  | @@ -156,10 +156,10 @@ static int __init wgt634u_init(void) | ||||||
|  |  					    SSB_CHIPCO_IRQ_GPIO); | ||||||
|  |  		} | ||||||
|  |   | ||||||
|  | -		wgt634u_flash_data.width = mcore->flash_buswidth; | ||||||
|  | -		wgt634u_flash_resource.start = mcore->flash_window; | ||||||
|  | -		wgt634u_flash_resource.end = mcore->flash_window | ||||||
|  | -					   + mcore->flash_window_size | ||||||
|  | +		wgt634u_flash_data.width = mcore->pflash.buswidth; | ||||||
|  | +		wgt634u_flash_resource.start = mcore->pflash.window; | ||||||
|  | +		wgt634u_flash_resource.end = mcore->pflash.window | ||||||
|  | +					   + mcore->pflash.window_size | ||||||
|  |  					   - 1; | ||||||
|  |  		return platform_add_devices(wgt634u_devices, | ||||||
|  |  					    ARRAY_SIZE(wgt634u_devices)); | ||||||
|  | --- a/drivers/ssb/driver_mipscore.c | ||||||
|  | +++ b/drivers/ssb/driver_mipscore.c | ||||||
|  | @@ -190,16 +190,34 @@ static void ssb_mips_flash_detect(struct | ||||||
|  |  { | ||||||
|  |  	struct ssb_bus *bus = mcore->dev->bus; | ||||||
|  |   | ||||||
|  | -	mcore->flash_buswidth = 2; | ||||||
|  | -	if (bus->chipco.dev) { | ||||||
|  | -		mcore->flash_window = 0x1c000000; | ||||||
|  | -		mcore->flash_window_size = 0x02000000; | ||||||
|  | +	/* When there is no chipcommon on the bus there is 4MB flash */ | ||||||
|  | +	if (!bus->chipco.dev) { | ||||||
|  | +		pr_info("found parallel flash.\n"); | ||||||
|  | +		bus->chipco.flash_type = SSB_PFLASH; | ||||||
|  | +		bus->chipco.pflash.window = SSB_FLASH1; | ||||||
|  | +		bus->chipco.pflash.window_size = SSB_FLASH1_SZ; | ||||||
|  | +		bus->chipco.pflash.buswidth = 2; | ||||||
|  | +		return; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	switch (bus->chipco.capabilities & SSB_CHIPCO_CAP_FLASHT) { | ||||||
|  | +	case SSB_CHIPCO_FLASHT_STSER: | ||||||
|  | +	case SSB_CHIPCO_FLASHT_ATSER: | ||||||
|  | +		pr_info("serial flash not supported.\n"); | ||||||
|  | +		break; | ||||||
|  | +	case SSB_CHIPCO_FLASHT_PARA: | ||||||
|  | +		pr_info("found parallel flash.\n"); | ||||||
|  | +		bus->chipco.flash_type = SSB_PFLASH; | ||||||
|  | +		bus->chipco.pflash.window = SSB_FLASH2; | ||||||
|  | +		bus->chipco.pflash.window_size = SSB_FLASH2_SZ; | ||||||
|  |  		if ((ssb_read32(bus->chipco.dev, SSB_CHIPCO_FLASH_CFG) | ||||||
|  | -		               & SSB_CHIPCO_CFG_DS16) == 0) | ||||||
|  | -			mcore->flash_buswidth = 1; | ||||||
|  | -	} else { | ||||||
|  | -		mcore->flash_window = 0x1fc00000; | ||||||
|  | -		mcore->flash_window_size = 0x00400000; | ||||||
|  | +		     & SSB_CHIPCO_CFG_DS16) == 0) | ||||||
|  | +			bus->chipco.pflash.buswidth = 1; | ||||||
|  | +		else | ||||||
|  | +			bus->chipco.pflash.buswidth = 2; | ||||||
|  | +		break; | ||||||
|  | +	default: | ||||||
|  | +		pr_err("flash not supported.\n"); | ||||||
|  |  	} | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | --- a/include/linux/ssb/ssb_driver_chipcommon.h | ||||||
|  | +++ b/include/linux/ssb/ssb_driver_chipcommon.h | ||||||
|  | @@ -582,6 +582,18 @@ struct ssb_chipcommon_pmu { | ||||||
|  |  	u32 crystalfreq;	/* The active crystal frequency (in kHz) */ | ||||||
|  |  }; | ||||||
|  |   | ||||||
|  | +#ifdef CONFIG_SSB_DRIVER_MIPS | ||||||
|  | +enum ssb_flash_type { | ||||||
|  | +	SSB_PFLASH, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +struct ssb_pflash { | ||||||
|  | +	u8 buswidth; | ||||||
|  | +	u32 window; | ||||||
|  | +	u32 window_size; | ||||||
|  | +}; | ||||||
|  | +#endif /* CONFIG_SSB_DRIVER_MIPS */ | ||||||
|  | + | ||||||
|  |  struct ssb_chipcommon { | ||||||
|  |  	struct ssb_device *dev; | ||||||
|  |  	u32 capabilities; | ||||||
|  | @@ -589,6 +601,12 @@ struct ssb_chipcommon { | ||||||
|  |  	/* Fast Powerup Delay constant */ | ||||||
|  |  	u16 fast_pwrup_delay; | ||||||
|  |  	struct ssb_chipcommon_pmu pmu; | ||||||
|  | +#ifdef CONFIG_SSB_DRIVER_MIPS | ||||||
|  | +	enum ssb_flash_type flash_type; | ||||||
|  | +	union { | ||||||
|  | +		struct ssb_pflash pflash; | ||||||
|  | +	}; | ||||||
|  | +#endif /* CONFIG_SSB_DRIVER_MIPS */ | ||||||
|  |  }; | ||||||
|  |   | ||||||
|  |  static inline bool ssb_chipco_available(struct ssb_chipcommon *cc) | ||||||
|  | --- a/include/linux/ssb/ssb_driver_mips.h | ||||||
|  | +++ b/include/linux/ssb/ssb_driver_mips.h | ||||||
|  | @@ -19,10 +19,6 @@ struct ssb_mipscore { | ||||||
|  |   | ||||||
|  |  	int nr_serial_ports; | ||||||
|  |  	struct ssb_serial_port serial_ports[4]; | ||||||
|  | - | ||||||
|  | -	u8 flash_buswidth; | ||||||
|  | -	u32 flash_window; | ||||||
|  | -	u32 flash_window_size; | ||||||
|  |  }; | ||||||
|  |   | ||||||
|  |  extern void ssb_mipscore_init(struct ssb_mipscore *mcore); | ||||||
| @@ -0,0 +1,573 @@ | |||||||
|  | --- a/drivers/ssb/Kconfig | ||||||
|  | +++ b/drivers/ssb/Kconfig | ||||||
|  | @@ -137,6 +137,12 @@ config SSB_DRIVER_MIPS | ||||||
|  |   | ||||||
|  |  	  If unsure, say N | ||||||
|  |   | ||||||
|  | +config SSB_SFLASH | ||||||
|  | +	bool | ||||||
|  | +	depends on SSB_DRIVER_MIPS | ||||||
|  | +	default y | ||||||
|  | + | ||||||
|  | + | ||||||
|  |  # Assumption: We are on embedded, if we compile the MIPS core. | ||||||
|  |  config SSB_EMBEDDED | ||||||
|  |  	bool | ||||||
|  | --- a/drivers/ssb/Makefile | ||||||
|  | +++ b/drivers/ssb/Makefile | ||||||
|  | @@ -11,6 +11,7 @@ ssb-$(CONFIG_SSB_SDIOHOST)		+= sdio.o | ||||||
|  |  # built-in drivers | ||||||
|  |  ssb-y					+= driver_chipcommon.o | ||||||
|  |  ssb-y					+= driver_chipcommon_pmu.o | ||||||
|  | +ssb-$(CONFIG_SSB_SFLASH)		+= driver_chipcommon_sflash.o | ||||||
|  |  ssb-$(CONFIG_SSB_DRIVER_MIPS)		+= driver_mipscore.o | ||||||
|  |  ssb-$(CONFIG_SSB_DRIVER_EXTIF)		+= driver_extif.o | ||||||
|  |  ssb-$(CONFIG_SSB_DRIVER_PCICORE)	+= driver_pcicore.o | ||||||
|  | --- /dev/null | ||||||
|  | +++ b/drivers/ssb/driver_chipcommon_sflash.c | ||||||
|  | @@ -0,0 +1,451 @@ | ||||||
|  | +/* | ||||||
|  | + * Broadcom SiliconBackplane chipcommon serial flash interface | ||||||
|  | + * | ||||||
|  | + * Copyright 2011, Jonas Gorski <jonas.gorski@gmail.com> | ||||||
|  | + * Copyright 2011, 2012, Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | + * Copyright 2010, Broadcom Corporation | ||||||
|  | + * | ||||||
|  | + * Licensed under the GNU/GPL. See COPYING for details. | ||||||
|  | + */ | ||||||
|  | + | ||||||
|  | +#include <linux/ssb/ssb.h> | ||||||
|  | +#include <linux/ssb/ssb_driver_chipcommon.h> | ||||||
|  | +#include <linux/delay.h> | ||||||
|  | + | ||||||
|  | +#include "ssb_private.h" | ||||||
|  | + | ||||||
|  | +#define NUM_RETRIES	3 | ||||||
|  | + | ||||||
|  | + | ||||||
|  | +/* Issue a serial flash command */ | ||||||
|  | +static inline void ssb_sflash_cmd(struct ssb_chipcommon *cc, u32 opcode) | ||||||
|  | +{ | ||||||
|  | +	chipco_write32(cc, SSB_CHIPCO_FLASHCTL, | ||||||
|  | +			SSB_CHIPCO_FLASHCTL_START | opcode); | ||||||
|  | +	while (chipco_read32(cc, SSB_CHIPCO_FLASHCTL) | ||||||
|  | +			& SSB_CHIPCO_FLASHCTL_BUSY) | ||||||
|  | +		; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | + | ||||||
|  | +static inline void ssb_sflash_write_u8(struct ssb_chipcommon *cc, | ||||||
|  | +				       u32 offset, u8 byte) | ||||||
|  | +{ | ||||||
|  | +	chipco_write32(cc, SSB_CHIPCO_FLASHADDR, offset); | ||||||
|  | +	chipco_write32(cc, SSB_CHIPCO_FLASHDATA, byte); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +/* Initialize serial flash access */ | ||||||
|  | +int ssb_sflash_init(struct ssb_chipcommon *cc) | ||||||
|  | +{ | ||||||
|  | +	u32 id, id2; | ||||||
|  | + | ||||||
|  | +	memset(&cc->sflash, 0, sizeof(struct ssb_sflash)); | ||||||
|  | + | ||||||
|  | +	switch (cc->capabilities & SSB_CHIPCO_CAP_FLASHT) { | ||||||
|  | +	case SSB_CHIPCO_FLASHT_STSER: | ||||||
|  | +		/* Probe for ST chips */ | ||||||
|  | +		ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_ST_DP); | ||||||
|  | +		chipco_write32(cc, SSB_CHIPCO_FLASHADDR, 0); | ||||||
|  | +		ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_ST_RES); | ||||||
|  | +		id = chipco_read32(cc, SSB_CHIPCO_FLASHDATA); | ||||||
|  | +		cc->sflash.blocksize = 64 * 1024; | ||||||
|  | +		switch (id) { | ||||||
|  | +		case 0x11: | ||||||
|  | +			/* ST M25P20 2 Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.numblocks = 4; | ||||||
|  | +			break; | ||||||
|  | +		case 0x12: | ||||||
|  | +			/* ST M25P40 4 Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.numblocks = 8; | ||||||
|  | +			break; | ||||||
|  | +		case 0x13: | ||||||
|  | +			/* ST M25P80 8 Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.numblocks = 16; | ||||||
|  | +			break; | ||||||
|  | +		case 0x14: | ||||||
|  | +			/* ST M25P16 16 Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.numblocks = 32; | ||||||
|  | +			break; | ||||||
|  | +		case 0x15: | ||||||
|  | +			/* ST M25P32 32 Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.numblocks = 64; | ||||||
|  | +			break; | ||||||
|  | +		case 0x16: | ||||||
|  | +			/* ST M25P64 64 Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.numblocks = 128; | ||||||
|  | +			break; | ||||||
|  | +		case 0x17: | ||||||
|  | +			/* ST M25FL128 128 Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.numblocks = 256; | ||||||
|  | +			break; | ||||||
|  | +		case 0xbf: | ||||||
|  | +			/* All of the following flashes are SST with | ||||||
|  | +			 * 4KB subsectors. Others should be added but | ||||||
|  | +			 * We'll have to revamp the way we identify them | ||||||
|  | +			 * since RES is not eough to disambiguate them. | ||||||
|  | +			 */ | ||||||
|  | +			cc->sflash.blocksize = 4 * 1024; | ||||||
|  | +			chipco_write32(cc, SSB_CHIPCO_FLASHADDR, 1); | ||||||
|  | +			ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_ST_RES); | ||||||
|  | +			id2 = chipco_read32(cc, SSB_CHIPCO_FLASHDATA); | ||||||
|  | +			switch (id2) { | ||||||
|  | +			case 1: | ||||||
|  | +				/* SST25WF512 512 Kbit Serial Flash */ | ||||||
|  | +			case 0x48: | ||||||
|  | +				/* SST25VF512 512 Kbit Serial Flash */ | ||||||
|  | +				cc->sflash.numblocks = 16; | ||||||
|  | +				break; | ||||||
|  | +			case 2: | ||||||
|  | +				/* SST25WF010 1 Mbit Serial Flash */ | ||||||
|  | +			case 0x49: | ||||||
|  | +				/* SST25VF010 1 Mbit Serial Flash */ | ||||||
|  | +				cc->sflash.numblocks = 32; | ||||||
|  | +				break; | ||||||
|  | +			case 3: | ||||||
|  | +				/* SST25WF020 2 Mbit Serial Flash */ | ||||||
|  | +			case 0x43: | ||||||
|  | +				/* SST25VF020 2 Mbit Serial Flash */ | ||||||
|  | +				cc->sflash.numblocks = 64; | ||||||
|  | +				break; | ||||||
|  | +			case 4: | ||||||
|  | +				/* SST25WF040 4 Mbit Serial Flash */ | ||||||
|  | +			case 0x44: | ||||||
|  | +				/* SST25VF040 4 Mbit Serial Flash */ | ||||||
|  | +			case 0x8d: | ||||||
|  | +				/* SST25VF040B 4 Mbit Serial Flash */ | ||||||
|  | +				cc->sflash.numblocks = 128; | ||||||
|  | +				break; | ||||||
|  | +			case 5: | ||||||
|  | +				/* SST25WF080 8 Mbit Serial Flash */ | ||||||
|  | +			case 0x8e: | ||||||
|  | +				/* SST25VF080B 8 Mbit Serial Flash */ | ||||||
|  | +				cc->sflash.numblocks = 256; | ||||||
|  | +				break; | ||||||
|  | +			case 0x41: | ||||||
|  | +				/* SST25VF016 16 Mbit Serial Flash */ | ||||||
|  | +				cc->sflash.numblocks = 512; | ||||||
|  | +				break; | ||||||
|  | +			case 0x4a: | ||||||
|  | +				/* SST25VF032 32 Mbit Serial Flash */ | ||||||
|  | +				cc->sflash.numblocks = 1024; | ||||||
|  | +				break; | ||||||
|  | +			case 0x4b: | ||||||
|  | +				/* SST25VF064 64 Mbit Serial Flash */ | ||||||
|  | +				cc->sflash.numblocks = 2048; | ||||||
|  | +				break; | ||||||
|  | +			} | ||||||
|  | +			break; | ||||||
|  | +		} | ||||||
|  | +		break; | ||||||
|  | + | ||||||
|  | +	case SSB_CHIPCO_FLASHT_ATSER: | ||||||
|  | +		/* Probe for Atmel chips */ | ||||||
|  | +		ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_AT_STATUS); | ||||||
|  | +		id = chipco_read32(cc, SSB_CHIPCO_FLASHDATA) & 0x3c; | ||||||
|  | +		switch (id) { | ||||||
|  | +		case 0xc: | ||||||
|  | +			/* Atmel AT45DB011 1Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.blocksize = 256; | ||||||
|  | +			cc->sflash.numblocks = 512; | ||||||
|  | +			break; | ||||||
|  | +		case 0x14: | ||||||
|  | +			/* Atmel AT45DB021 2Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.blocksize = 256; | ||||||
|  | +			cc->sflash.numblocks = 1024; | ||||||
|  | +			break; | ||||||
|  | +		case 0x1c: | ||||||
|  | +			/* Atmel AT45DB041 4Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.blocksize = 256; | ||||||
|  | +			cc->sflash.numblocks = 2048; | ||||||
|  | +			break; | ||||||
|  | +		case 0x24: | ||||||
|  | +			/* Atmel AT45DB081 8Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.blocksize = 256; | ||||||
|  | +			cc->sflash.numblocks = 4096; | ||||||
|  | +			break; | ||||||
|  | +		case 0x2c: | ||||||
|  | +			/* Atmel AT45DB161 16Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.blocksize = 512; | ||||||
|  | +			cc->sflash.numblocks = 4096; | ||||||
|  | +			break; | ||||||
|  | +		case 0x34: | ||||||
|  | +			/* Atmel AT45DB321 32Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.blocksize = 512; | ||||||
|  | +			cc->sflash.numblocks = 8192; | ||||||
|  | +			break; | ||||||
|  | +		case 0x3c: | ||||||
|  | +			/* Atmel AT45DB642 64Mbit Serial Flash */ | ||||||
|  | +			cc->sflash.blocksize = 1024; | ||||||
|  | +			cc->sflash.numblocks = 8192; | ||||||
|  | +			break; | ||||||
|  | +		} | ||||||
|  | +		break; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	cc->sflash.size = cc->sflash.blocksize * cc->sflash.numblocks; | ||||||
|  | + | ||||||
|  | +	return cc->sflash.size ? 0 : -ENODEV; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +/* Read len bytes starting at offset into buf. Returns number of bytes read. */ | ||||||
|  | +int ssb_sflash_read(struct ssb_chipcommon *cc, u32 offset, u32 len, u8 *buf) | ||||||
|  | +{ | ||||||
|  | +	u8 *from, *to; | ||||||
|  | +	u32 cnt, i; | ||||||
|  | + | ||||||
|  | +	if (!len) | ||||||
|  | +		return 0; | ||||||
|  | + | ||||||
|  | +	if ((offset + len) > cc->sflash.size) | ||||||
|  | +		return -EINVAL; | ||||||
|  | + | ||||||
|  | +	if ((len >= 4) && (offset & 3)) | ||||||
|  | +		cnt = 4 - (offset & 3); | ||||||
|  | +	else if ((len >= 4) && ((u32)buf & 3)) | ||||||
|  | +		cnt = 4 - ((u32)buf & 3); | ||||||
|  | +	else | ||||||
|  | +		cnt = len; | ||||||
|  | + | ||||||
|  | + | ||||||
|  | +	if (cc->dev->id.revision == 12) | ||||||
|  | +		from = (u8 *)KSEG1ADDR(SSB_FLASH2 + offset); | ||||||
|  | +	else | ||||||
|  | +		from = (u8 *)KSEG0ADDR(SSB_FLASH2 + offset); | ||||||
|  | + | ||||||
|  | +	to = (u8 *)buf; | ||||||
|  | + | ||||||
|  | +	if (cnt < 4) { | ||||||
|  | +		for (i = 0; i < cnt; i++) { | ||||||
|  | +			*to = readb(from); | ||||||
|  | +			from++; | ||||||
|  | +			to++; | ||||||
|  | +		} | ||||||
|  | +		return cnt; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	while (cnt >= 4) { | ||||||
|  | +		*(u32 *)to = readl(from); | ||||||
|  | +		from += 4; | ||||||
|  | +		to += 4; | ||||||
|  | +		cnt -= 4; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return len - cnt; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +/* Poll for command completion. Returns zero when complete. */ | ||||||
|  | +int ssb_sflash_poll(struct ssb_chipcommon *cc, u32 offset) | ||||||
|  | +{ | ||||||
|  | +	if (offset >= cc->sflash.size) | ||||||
|  | +		return -22; | ||||||
|  | + | ||||||
|  | +	switch (cc->capabilities & SSB_CHIPCO_CAP_FLASHT) { | ||||||
|  | +	case SSB_CHIPCO_FLASHT_STSER: | ||||||
|  | +		/* Check for ST Write In Progress bit */ | ||||||
|  | +		ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_ST_RDSR); | ||||||
|  | +		return chipco_read32(cc, SSB_CHIPCO_FLASHDATA) | ||||||
|  | +				& SSB_CHIPCO_FLASHSTA_ST_WIP; | ||||||
|  | +	case SSB_CHIPCO_FLASHT_ATSER: | ||||||
|  | +		/* Check for Atmel Ready bit */ | ||||||
|  | +		ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_AT_STATUS); | ||||||
|  | +		return !(chipco_read32(cc, SSB_CHIPCO_FLASHDATA) | ||||||
|  | +				& SSB_CHIPCO_FLASHSTA_AT_READY); | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | + | ||||||
|  | +static int sflash_st_write(struct ssb_chipcommon *cc, u32 offset, u32 len, | ||||||
|  | +			   const u8 *buf) | ||||||
|  | +{ | ||||||
|  | +	struct ssb_bus *bus = cc->dev->bus; | ||||||
|  | +	int ret = 0; | ||||||
|  | +	bool is4712b0 = (bus->chip_id == 0x4712) && (bus->chip_rev == 3); | ||||||
|  | +	u32 mask; | ||||||
|  | + | ||||||
|  | +	/* Enable writes */ | ||||||
|  | +	ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_ST_WREN); | ||||||
|  | +	if (is4712b0) { | ||||||
|  | +		mask = 1 << 14; | ||||||
|  | +		ssb_sflash_write_u8(cc, offset, *buf++); | ||||||
|  | +		/* Set chip select */ | ||||||
|  | +		chipco_set32(cc, SSB_CHIPCO_GPIOOUT, mask); | ||||||
|  | +		/* Issue a page program with the first byte */ | ||||||
|  | +		ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_ST_PP); | ||||||
|  | +		ret = 1; | ||||||
|  | +		offset++; | ||||||
|  | +		len--; | ||||||
|  | +		while (len > 0) { | ||||||
|  | +			if ((offset & 255) == 0) { | ||||||
|  | +				/* Page boundary, drop cs and return */ | ||||||
|  | +				chipco_mask32(cc, SSB_CHIPCO_GPIOOUT, ~mask); | ||||||
|  | +				udelay(1); | ||||||
|  | +				if (!ssb_sflash_poll(cc, offset)) { | ||||||
|  | +					/* Flash rejected command */ | ||||||
|  | +					return -EAGAIN; | ||||||
|  | +				} | ||||||
|  | +				return ret; | ||||||
|  | +			} else { | ||||||
|  | +				/* Write single byte */ | ||||||
|  | +				ssb_sflash_cmd(cc, *buf++); | ||||||
|  | +			} | ||||||
|  | +			ret++; | ||||||
|  | +			offset++; | ||||||
|  | +			len--; | ||||||
|  | +		} | ||||||
|  | +		/* All done, drop cs */ | ||||||
|  | +		chipco_mask32(cc, SSB_CHIPCO_GPIOOUT, ~mask); | ||||||
|  | +		udelay(1); | ||||||
|  | +		if (!ssb_sflash_poll(cc, offset)) { | ||||||
|  | +			/* Flash rejected command */ | ||||||
|  | +			return -EAGAIN; | ||||||
|  | +		} | ||||||
|  | +	} else if (cc->dev->id.revision >= 20) { | ||||||
|  | +		ssb_sflash_write_u8(cc, offset, *buf++); | ||||||
|  | +		/* Issue a page program with CSA bit set */ | ||||||
|  | +		ssb_sflash_cmd(cc, | ||||||
|  | +				SSB_CHIPCO_FLASHCTL_ST_CSA | | ||||||
|  | +				SSB_CHIPCO_FLASHCTL_ST_PP); | ||||||
|  | +		ret = 1; | ||||||
|  | +		offset++; | ||||||
|  | +		len--; | ||||||
|  | +		while (len > 0) { | ||||||
|  | +			if ((offset & 255) == 0) { | ||||||
|  | +				/* Page boundary, poll droping cs and return */ | ||||||
|  | +				chipco_write32(cc, SSB_CHIPCO_FLASHCTL, 0); | ||||||
|  | +				udelay(1); | ||||||
|  | +				if (!ssb_sflash_poll(cc, offset)) { | ||||||
|  | +					/* Flash rejected command */ | ||||||
|  | +					return -EAGAIN; | ||||||
|  | +				} | ||||||
|  | +				return ret; | ||||||
|  | +			} else { | ||||||
|  | +				/* Write single byte */ | ||||||
|  | +				ssb_sflash_cmd(cc, | ||||||
|  | +						SSB_CHIPCO_FLASHCTL_ST_CSA | | ||||||
|  | +						*buf++); | ||||||
|  | +			} | ||||||
|  | +			ret++; | ||||||
|  | +			offset++; | ||||||
|  | +			len--; | ||||||
|  | +		} | ||||||
|  | +		/* All done, drop cs & poll */ | ||||||
|  | +		chipco_write32(cc, SSB_CHIPCO_FLASHCTL, 0); | ||||||
|  | +		udelay(1); | ||||||
|  | +		if (!ssb_sflash_poll(cc, offset)) { | ||||||
|  | +			/* Flash rejected command */ | ||||||
|  | +			return -EAGAIN; | ||||||
|  | +		} | ||||||
|  | +	} else { | ||||||
|  | +		ret = 1; | ||||||
|  | +		ssb_sflash_write_u8(cc, offset, *buf); | ||||||
|  | +		/* Page program */ | ||||||
|  | +		ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_ST_PP); | ||||||
|  | +	} | ||||||
|  | +	return ret; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int sflash_at_write(struct ssb_chipcommon *cc, u32 offset, u32 len, | ||||||
|  | +			   const u8 *buf) | ||||||
|  | +{ | ||||||
|  | +	struct ssb_sflash *sfl = &cc->sflash; | ||||||
|  | +	u32 page, byte, mask; | ||||||
|  | +	int ret = 0; | ||||||
|  | +	mask = sfl->blocksize - 1; | ||||||
|  | +	page = (offset & ~mask) << 1; | ||||||
|  | +	byte = offset & mask; | ||||||
|  | +	/* Read main memory page into buffer 1 */ | ||||||
|  | +	if (byte || (len < sfl->blocksize)) { | ||||||
|  | +		int i = 100; | ||||||
|  | +		chipco_write32(cc, SSB_CHIPCO_FLASHADDR, page); | ||||||
|  | +		ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_AT_BUF1_LOAD); | ||||||
|  | +		/* 250 us for AT45DB321B */ | ||||||
|  | +		while (i > 0 && ssb_sflash_poll(cc, offset)) { | ||||||
|  | +			udelay(10); | ||||||
|  | +			i--; | ||||||
|  | +		} | ||||||
|  | +		BUG_ON(!ssb_sflash_poll(cc, offset)); | ||||||
|  | +	} | ||||||
|  | +	/* Write into buffer 1 */ | ||||||
|  | +	for (ret = 0; (ret < (int)len) && (byte < sfl->blocksize); ret++) { | ||||||
|  | +		ssb_sflash_write_u8(cc, byte++, *buf++); | ||||||
|  | +		ssb_sflash_cmd(cc, | ||||||
|  | +				SSB_CHIPCO_FLASHCTL_AT_BUF1_WRITE); | ||||||
|  | +	} | ||||||
|  | +	/* Write buffer 1 into main memory page */ | ||||||
|  | +	chipco_write32(cc, SSB_CHIPCO_FLASHADDR, page); | ||||||
|  | +	ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_AT_BUF1_PROGRAM); | ||||||
|  | + | ||||||
|  | +	return ret; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +/* Write len bytes starting at offset into buf. Returns number of bytes | ||||||
|  | + * written. Caller should poll for completion. | ||||||
|  | + */ | ||||||
|  | +int ssb_sflash_write(struct ssb_chipcommon *cc, u32 offset, u32 len, | ||||||
|  | +			    const u8 *buf) | ||||||
|  | +{ | ||||||
|  | +	struct ssb_sflash *sfl; | ||||||
|  | +	int ret = 0, tries = NUM_RETRIES; | ||||||
|  | + | ||||||
|  | +	if (!len) | ||||||
|  | +		return 0; | ||||||
|  | + | ||||||
|  | +	if ((offset + len) > cc->sflash.size) | ||||||
|  | +		return -EINVAL; | ||||||
|  | + | ||||||
|  | +	sfl = &cc->sflash; | ||||||
|  | +	switch (cc->capabilities & SSB_CHIPCO_CAP_FLASHT) { | ||||||
|  | +	case SSB_CHIPCO_FLASHT_STSER: | ||||||
|  | +		do { | ||||||
|  | +			ret = sflash_st_write(cc, offset, len, buf); | ||||||
|  | +			tries--; | ||||||
|  | +		} while (ret == -EAGAIN && tries > 0); | ||||||
|  | + | ||||||
|  | +		if (ret == -EAGAIN && tries == 0) { | ||||||
|  | +			pr_info("ST Flash rejected write\n"); | ||||||
|  | +			ret = -EIO; | ||||||
|  | +		} | ||||||
|  | +		break; | ||||||
|  | +	case SSB_CHIPCO_FLASHT_ATSER: | ||||||
|  | +		ret = sflash_at_write(cc, offset, len, buf); | ||||||
|  | +		break; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return ret; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +/* Erase a region. Returns number of bytes scheduled for erasure. | ||||||
|  | + * Caller should poll for completion. | ||||||
|  | + */ | ||||||
|  | +int ssb_sflash_erase(struct ssb_chipcommon *cc, u32 offset) | ||||||
|  | +{ | ||||||
|  | +	struct ssb_sflash *sfl; | ||||||
|  | + | ||||||
|  | +	if (offset >= cc->sflash.size) | ||||||
|  | +		return -EINVAL; | ||||||
|  | + | ||||||
|  | +	sfl = &cc->sflash; | ||||||
|  | +	switch (cc->capabilities & SSB_CHIPCO_CAP_FLASHT) { | ||||||
|  | +	case SSB_CHIPCO_FLASHT_STSER: | ||||||
|  | +		ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_ST_WREN); | ||||||
|  | +		chipco_write32(cc, SSB_CHIPCO_FLASHADDR, offset); | ||||||
|  | +		/* Newer flashes have "sub-sectors" which can be erased | ||||||
|  | +		 * independently with a new command: ST_SSE. The ST_SE command | ||||||
|  | +		 * erases 64KB just as before. | ||||||
|  | +		 */ | ||||||
|  | +		if (sfl->blocksize < (64 * 1024)) | ||||||
|  | +			ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_ST_SSE); | ||||||
|  | +		else | ||||||
|  | +			ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_ST_SE); | ||||||
|  | +		return sfl->blocksize; | ||||||
|  | +	case SSB_CHIPCO_FLASHT_ATSER: | ||||||
|  | +		chipco_write32(cc, SSB_CHIPCO_FLASHADDR, offset << 1); | ||||||
|  | +		ssb_sflash_cmd(cc, SSB_CHIPCO_FLASHCTL_AT_PAGE_ERASE); | ||||||
|  | +		return sfl->blocksize; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | --- a/drivers/ssb/driver_mipscore.c | ||||||
|  | +++ b/drivers/ssb/driver_mipscore.c | ||||||
|  | @@ -203,7 +203,13 @@ static void ssb_mips_flash_detect(struct | ||||||
|  |  	switch (bus->chipco.capabilities & SSB_CHIPCO_CAP_FLASHT) { | ||||||
|  |  	case SSB_CHIPCO_FLASHT_STSER: | ||||||
|  |  	case SSB_CHIPCO_FLASHT_ATSER: | ||||||
|  | +#ifdef CONFIG_SSB_SFLASH | ||||||
|  | +		pr_info("found serial flash.\n"); | ||||||
|  | +		bus->chipco.flash_type = SSB_SFLASH; | ||||||
|  | +		ssb_sflash_init(&bus->chipco); | ||||||
|  | +#else | ||||||
|  |  		pr_info("serial flash not supported.\n"); | ||||||
|  | +#endif /* CONFIG_SSB_SFLASH */ | ||||||
|  |  		break; | ||||||
|  |  	case SSB_CHIPCO_FLASHT_PARA: | ||||||
|  |  		pr_info("found parallel flash.\n"); | ||||||
|  | --- a/drivers/ssb/ssb_private.h | ||||||
|  | +++ b/drivers/ssb/ssb_private.h | ||||||
|  | @@ -192,6 +192,10 @@ extern int ssb_devices_freeze(struct ssb | ||||||
|  |  extern int ssb_devices_thaw(struct ssb_freeze_context *ctx); | ||||||
|  |   | ||||||
|  |   | ||||||
|  | +#ifdef CONFIG_SSB_SFLASH | ||||||
|  | +/* driver_chipcommon_sflash.c */ | ||||||
|  | +int ssb_sflash_init(struct ssb_chipcommon *cc); | ||||||
|  | +#endif /* CONFIG_SSB_SFLASH */ | ||||||
|  |   | ||||||
|  |  /* b43_pci_bridge.c */ | ||||||
|  |  #ifdef CONFIG_SSB_B43_PCI_BRIDGE | ||||||
|  | --- a/include/linux/ssb/ssb_driver_chipcommon.h | ||||||
|  | +++ b/include/linux/ssb/ssb_driver_chipcommon.h | ||||||
|  | @@ -503,8 +503,10 @@ | ||||||
|  |  #define SSB_CHIPCO_FLASHCTL_ST_PP	0x0302		/* Page Program */ | ||||||
|  |  #define SSB_CHIPCO_FLASHCTL_ST_SE	0x02D8		/* Sector Erase */ | ||||||
|  |  #define SSB_CHIPCO_FLASHCTL_ST_BE	0x00C7		/* Bulk Erase */ | ||||||
|  | -#define SSB_CHIPCO_FLASHCTL_ST_DP	0x00B9		/* Deep Power-down */ | ||||||
|  | -#define SSB_CHIPCO_FLASHCTL_ST_RSIG	0x03AB		/* Read Electronic Signature */ | ||||||
|  | +#define SSB_CHIPCO_FLASHCTL_ST_DP	0x00D9		/* Deep Power-down */ | ||||||
|  | +#define SSB_CHIPCO_FLASHCTL_ST_RES	0x03AB		/* Read Electronic Signature */ | ||||||
|  | +#define SSB_CHIPCO_FLASHCTL_ST_CSA	0x1000		/* Keep chip select asserted */ | ||||||
|  | +#define SSB_CHIPCO_FLASHCTL_ST_SSE	0x0220		/* Sub-sector Erase */ | ||||||
|  |   | ||||||
|  |  /* Status register bits for ST flashes */ | ||||||
|  |  #define SSB_CHIPCO_FLASHSTA_ST_WIP	0x01		/* Write In Progress */ | ||||||
|  | @@ -585,6 +587,7 @@ struct ssb_chipcommon_pmu { | ||||||
|  |  #ifdef CONFIG_SSB_DRIVER_MIPS | ||||||
|  |  enum ssb_flash_type { | ||||||
|  |  	SSB_PFLASH, | ||||||
|  | +	SSB_SFLASH, | ||||||
|  |  }; | ||||||
|  |   | ||||||
|  |  struct ssb_pflash { | ||||||
|  | @@ -592,6 +595,14 @@ struct ssb_pflash { | ||||||
|  |  	u32 window; | ||||||
|  |  	u32 window_size; | ||||||
|  |  }; | ||||||
|  | + | ||||||
|  | +#ifdef CONFIG_SSB_SFLASH | ||||||
|  | +struct ssb_sflash { | ||||||
|  | +	u32 blocksize;		/* Block size */ | ||||||
|  | +	u32 numblocks;		/* Number of blocks */ | ||||||
|  | +	u32 size;		/* Total size in bytes */ | ||||||
|  | +}; | ||||||
|  | +#endif /* CONFIG_SSB_SFLASH */ | ||||||
|  |  #endif /* CONFIG_SSB_DRIVER_MIPS */ | ||||||
|  |   | ||||||
|  |  struct ssb_chipcommon { | ||||||
|  | @@ -605,6 +616,9 @@ struct ssb_chipcommon { | ||||||
|  |  	enum ssb_flash_type flash_type; | ||||||
|  |  	union { | ||||||
|  |  		struct ssb_pflash pflash; | ||||||
|  | +#ifdef CONFIG_SSB_SFLASH | ||||||
|  | +		struct ssb_sflash sflash; | ||||||
|  | +#endif /* CONFIG_SSB_SFLASH */ | ||||||
|  |  	}; | ||||||
|  |  #endif /* CONFIG_SSB_DRIVER_MIPS */ | ||||||
|  |  }; | ||||||
|  | @@ -666,6 +680,16 @@ extern int ssb_chipco_serial_init(struct | ||||||
|  |  				  struct ssb_serial_port *ports); | ||||||
|  |  #endif /* CONFIG_SSB_SERIAL */ | ||||||
|  |   | ||||||
|  | +#ifdef CONFIG_SSB_SFLASH | ||||||
|  | +/* Chipcommon sflash support. */ | ||||||
|  | +int ssb_sflash_read(struct ssb_chipcommon *cc, u32 offset, u32 len, | ||||||
|  | +			   u8 *buf); | ||||||
|  | +int ssb_sflash_poll(struct ssb_chipcommon *cc, u32 offset); | ||||||
|  | +int ssb_sflash_write(struct ssb_chipcommon *cc, u32 offset, u32 len, | ||||||
|  | +			    const u8 *buf); | ||||||
|  | +int ssb_sflash_erase(struct ssb_chipcommon *cc, u32 offset); | ||||||
|  | +#endif /* CONFIG_SSB_SFLASH */ | ||||||
|  | + | ||||||
|  |  /* PMU support */ | ||||||
|  |  extern void ssb_pmu_init(struct ssb_chipcommon *cc); | ||||||
|  |   | ||||||
| @@ -0,0 +1,164 @@ | |||||||
|  | --- a/arch/mips/bcm47xx/Makefile | ||||||
|  | +++ b/arch/mips/bcm47xx/Makefile | ||||||
|  | @@ -3,5 +3,5 @@ | ||||||
|  |  # under Linux. | ||||||
|  |  # | ||||||
|  |   | ||||||
|  | -obj-y 				+= gpio.o irq.o nvram.o prom.o serial.o setup.o time.o | ||||||
|  | +obj-y 				+= gpio.o irq.o nvram.o prom.o serial.o setup.o time.o bus.o | ||||||
|  |  obj-$(CONFIG_BCM47XX_SSB)	+= wgt634u.o | ||||||
|  | --- /dev/null | ||||||
|  | +++ b/arch/mips/bcm47xx/bus.c | ||||||
|  | @@ -0,0 +1,82 @@ | ||||||
|  | +/* | ||||||
|  | + * BCM947xx nvram variable access | ||||||
|  | + * | ||||||
|  | + * Copyright (C) 2011 Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | + * | ||||||
|  | + * This program is free software; you can redistribute  it and/or modify it | ||||||
|  | + * under  the terms of  the GNU General  Public License as published by the | ||||||
|  | + * Free Software Foundation;  either version 2 of the  License, or (at your | ||||||
|  | + * option) any later version. | ||||||
|  | + */ | ||||||
|  | + | ||||||
|  | +#include <bus.h> | ||||||
|  | + | ||||||
|  | +static int bcm47xx_sflash_bcma_read(struct bcm47xx_sflash *dev, u32 offset, u32 len, u8 *buf) | ||||||
|  | +{ | ||||||
|  | +	return bcma_sflash_read(dev->bcc, offset, len, buf); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int bcm47xx_sflash_bcma_poll(struct bcm47xx_sflash *dev, u32 offset) | ||||||
|  | +{ | ||||||
|  | +	return bcma_sflash_poll(dev->bcc, offset); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int bcm47xx_sflash_bcma_write(struct bcm47xx_sflash *dev, u32 offset, u32 len, const u8 *buf) | ||||||
|  | +{ | ||||||
|  | +	return bcma_sflash_write(dev->bcc, offset, len, buf); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int bcm47xx_sflash_bcma_erase(struct bcm47xx_sflash *dev, u32 offset) | ||||||
|  | +{ | ||||||
|  | +	return bcma_sflash_erase(dev->bcc, offset); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +void bcm47xx_sflash_struct_bcma_init(struct bcm47xx_sflash *sflash, struct bcma_drv_cc *bcc) | ||||||
|  | +{ | ||||||
|  | +	sflash->sflash_type = BCM47XX_BUS_TYPE_BCMA; | ||||||
|  | +	sflash->bcc = bcc; | ||||||
|  | + | ||||||
|  | +	sflash->read = bcm47xx_sflash_bcma_read; | ||||||
|  | +	sflash->poll = bcm47xx_sflash_bcma_poll; | ||||||
|  | +	sflash->write = bcm47xx_sflash_bcma_write; | ||||||
|  | +	sflash->erase = bcm47xx_sflash_bcma_erase; | ||||||
|  | + | ||||||
|  | +	sflash->blocksize = bcc->sflash.blocksize; | ||||||
|  | +	sflash->numblocks = bcc->sflash.numblocks; | ||||||
|  | +	sflash->size = bcc->sflash.size; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int bcm47xx_sflash_ssb_read(struct bcm47xx_sflash *dev, u32 offset, u32 len, u8 *buf) | ||||||
|  | +{ | ||||||
|  | +	return ssb_sflash_read(dev->scc, offset, len, buf); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int bcm47xx_sflash_ssb_poll(struct bcm47xx_sflash *dev, u32 offset) | ||||||
|  | +{ | ||||||
|  | +	return ssb_sflash_poll(dev->scc, offset); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int bcm47xx_sflash_ssb_write(struct bcm47xx_sflash *dev, u32 offset, u32 len, const u8 *buf) | ||||||
|  | +{ | ||||||
|  | +	return ssb_sflash_write(dev->scc, offset, len, buf); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int bcm47xx_sflash_ssb_erase(struct bcm47xx_sflash *dev, u32 offset) | ||||||
|  | +{ | ||||||
|  | +	return ssb_sflash_erase(dev->scc, offset); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +void bcm47xx_sflash_struct_ssb_init(struct bcm47xx_sflash *sflash, struct ssb_chipcommon *scc) | ||||||
|  | +{ | ||||||
|  | +	sflash->sflash_type = BCM47XX_BUS_TYPE_SSB; | ||||||
|  | +	sflash->scc = scc; | ||||||
|  | + | ||||||
|  | +	sflash->read = bcm47xx_sflash_ssb_read; | ||||||
|  | +	sflash->poll = bcm47xx_sflash_ssb_poll; | ||||||
|  | +	sflash->write = bcm47xx_sflash_ssb_write; | ||||||
|  | +	sflash->erase = bcm47xx_sflash_ssb_erase; | ||||||
|  | + | ||||||
|  | +	sflash->blocksize = scc->sflash.blocksize; | ||||||
|  | +	sflash->numblocks = scc->sflash.numblocks; | ||||||
|  | +	sflash->size = scc->sflash.size; | ||||||
|  | +} | ||||||
|  | --- a/arch/mips/bcm47xx/setup.c | ||||||
|  | +++ b/arch/mips/bcm47xx/setup.c | ||||||
|  | @@ -43,6 +43,8 @@ EXPORT_SYMBOL(bcm47xx_bus); | ||||||
|  |  enum bcm47xx_bus_type bcm47xx_bus_type; | ||||||
|  |  EXPORT_SYMBOL(bcm47xx_bus_type); | ||||||
|  |   | ||||||
|  | +struct bcm47xx_sflash bcm47xx_sflash; | ||||||
|  | + | ||||||
|  |  static void bcm47xx_machine_restart(char *command) | ||||||
|  |  { | ||||||
|  |  	printk(KERN_ALERT "Please stand by while rebooting the system...\n"); | ||||||
|  | @@ -291,6 +293,9 @@ static void __init bcm47xx_register_ssb( | ||||||
|  |  	if (err) | ||||||
|  |  		panic("Failed to initialize SSB bus (err %d)", err); | ||||||
|  |   | ||||||
|  | +	if (bcm47xx_bus.ssb.chipco.flash_type == SSB_SFLASH) | ||||||
|  | +		bcm47xx_sflash_struct_ssb_init(&bcm47xx_sflash, &bcm47xx_bus.ssb.chipco); | ||||||
|  | + | ||||||
|  |  	mcore = &bcm47xx_bus.ssb.mipscore; | ||||||
|  |  	if (nvram_getenv("kernel_args", buf, sizeof(buf)) >= 0) { | ||||||
|  |  		if (strstr(buf, "console=ttyS1")) { | ||||||
|  | @@ -315,6 +320,9 @@ static void __init bcm47xx_register_bcma | ||||||
|  |  	err = bcma_host_soc_register(&bcm47xx_bus.bcma); | ||||||
|  |  	if (err) | ||||||
|  |  		panic("Failed to initialize BCMA bus (err %d)", err); | ||||||
|  | + | ||||||
|  | +	if (bcm47xx_bus.bcma.bus.drv_cc.flash_type == BCMA_SFLASH) | ||||||
|  | +		bcm47xx_sflash_struct_bcma_init(&bcm47xx_sflash, &bcm47xx_bus.bcma.bus.drv_cc); | ||||||
|  |  } | ||||||
|  |  #endif | ||||||
|  |   | ||||||
|  | --- /dev/null | ||||||
|  | +++ b/arch/mips/include/asm/mach-bcm47xx/bus.h | ||||||
|  | @@ -0,0 +1,36 @@ | ||||||
|  | +/* | ||||||
|  | + * BCM947xx nvram variable access | ||||||
|  | + * | ||||||
|  | + * Copyright (C) 2011 Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | + * | ||||||
|  | + * This program is free software; you can redistribute  it and/or modify it | ||||||
|  | + * under  the terms of  the GNU General  Public License as published by the | ||||||
|  | + * Free Software Foundation;  either version 2 of the  License, or (at your | ||||||
|  | + * option) any later version. | ||||||
|  | + */ | ||||||
|  | + | ||||||
|  | +#include <linux/ssb/ssb.h> | ||||||
|  | +#include <linux/bcma/bcma.h> | ||||||
|  | +#include <bcm47xx.h> | ||||||
|  | + | ||||||
|  | +struct bcm47xx_sflash { | ||||||
|  | +	enum bcm47xx_bus_type sflash_type; | ||||||
|  | +	union { | ||||||
|  | +		struct ssb_chipcommon *scc; | ||||||
|  | +		struct bcma_drv_cc *bcc; | ||||||
|  | +	}; | ||||||
|  | + | ||||||
|  | +	int (*read)(struct bcm47xx_sflash *dev, u32 offset, u32 len, u8 *buf); | ||||||
|  | +	int (*poll)(struct bcm47xx_sflash *dev, u32 offset); | ||||||
|  | +	int (*write)(struct bcm47xx_sflash *dev, u32 offset, u32 len, const u8 *buf); | ||||||
|  | +	int (*erase)(struct bcm47xx_sflash *dev, u32 offset); | ||||||
|  | + | ||||||
|  | +	u32 blocksize;		/* Block size */ | ||||||
|  | +	u32 numblocks;		/* Number of blocks */ | ||||||
|  | +	u32 size;		/* Total size in bytes */ | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +void bcm47xx_sflash_struct_bcma_init(struct bcm47xx_sflash *sflash, struct bcma_drv_cc *bcc); | ||||||
|  | +void bcm47xx_sflash_struct_ssb_init(struct bcm47xx_sflash *sflash, struct ssb_chipcommon *scc); | ||||||
|  | + | ||||||
|  | +extern struct bcm47xx_sflash bcm47xx_sflash; | ||||||
| @@ -0,0 +1,571 @@ | |||||||
|  | --- a/drivers/mtd/Kconfig | ||||||
|  | +++ b/drivers/mtd/Kconfig | ||||||
|  | @@ -172,6 +172,13 @@ config MTD_MYLOADER_PARTS | ||||||
|  |  	  You will still need the parsing functions to be called by the driver | ||||||
|  |  	  for your particular device. It won't happen automatically. | ||||||
|  |   | ||||||
|  | +config MTD_BCM47XX_PARTS | ||||||
|  | +	tristate "BCM47XX partitioning support" | ||||||
|  | +	default y | ||||||
|  | +	depends on BCM47XX | ||||||
|  | +	---help--- | ||||||
|  | +	  bcm47XX partitioning support | ||||||
|  | + | ||||||
|  |  comment "User Modules And Translation Layers" | ||||||
|  |   | ||||||
|  |  config MTD_CHAR | ||||||
|  | --- a/drivers/mtd/Makefile | ||||||
|  | +++ b/drivers/mtd/Makefile | ||||||
|  | @@ -13,6 +13,7 @@ obj-$(CONFIG_MTD_AFS_PARTS)	+= afs.o | ||||||
|  |  obj-$(CONFIG_MTD_AR7_PARTS)	+= ar7part.o | ||||||
|  |  obj-$(CONFIG_MTD_BCM63XX_PARTS)	+= bcm63xxpart.o | ||||||
|  |  obj-$(CONFIG_MTD_MYLOADER_PARTS) += myloader.o | ||||||
|  | +obj-$(CONFIG_MTD_BCM47XX_PARTS)	+= bcm47xxpart.o | ||||||
|  |   | ||||||
|  |  # 'Users' - code which presents functionality to userspace. | ||||||
|  |  obj-$(CONFIG_MTD_CHAR)		+= mtdchar.o | ||||||
|  | --- /dev/null | ||||||
|  | +++ b/drivers/mtd/bcm47xxpart.c | ||||||
|  | @@ -0,0 +1,542 @@ | ||||||
|  | +/* | ||||||
|  | + *  Copyright (C) 2006 Felix Fietkau <nbd@openwrt.org> | ||||||
|  | + *  Copyright (C) 2005 Waldemar Brodkorb <wbx@openwrt.org> | ||||||
|  | + *  Copyright (C) 2004 Florian Schirmer (jolt@tuxbox.org) | ||||||
|  | + * | ||||||
|  | + *  original functions for finding root filesystem from Mike Baker | ||||||
|  | + * | ||||||
|  | + *  This program is free software; you can redistribute  it and/or modify it | ||||||
|  | + *  under  the terms of  the GNU General  Public License as published by the | ||||||
|  | + *  Free Software Foundation;  either version 2 of the  License, or (at your | ||||||
|  | + *  option) any later version. | ||||||
|  | + * | ||||||
|  | + *  THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED | ||||||
|  | + *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF | ||||||
|  | + *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN | ||||||
|  | + *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT, | ||||||
|  | + *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT | ||||||
|  | + *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF | ||||||
|  | + *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON | ||||||
|  | + *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT | ||||||
|  | + *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF | ||||||
|  | + *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | ||||||
|  | + * | ||||||
|  | + *  You should have received a copy of the  GNU General Public License along | ||||||
|  | + *  with this program; if not, write  to the Free Software Foundation, Inc., | ||||||
|  | + *  675 Mass Ave, Cambridge, MA 02139, USA. | ||||||
|  | + * | ||||||
|  | + *  Copyright 2001-2003, Broadcom Corporation | ||||||
|  | + *  All Rights Reserved. | ||||||
|  | + * | ||||||
|  | + *  THIS SOFTWARE IS OFFERED "AS IS", AND BROADCOM GRANTS NO WARRANTIES OF ANY | ||||||
|  | + *  KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM | ||||||
|  | + *  SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS | ||||||
|  | + *  FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE. | ||||||
|  | + * | ||||||
|  | + *  Flash mapping for BCM947XX boards | ||||||
|  | + */ | ||||||
|  | + | ||||||
|  | +#define pr_fmt(fmt) "bcm47xx_part: " fmt | ||||||
|  | +#include <linux/init.h> | ||||||
|  | +#include <linux/module.h> | ||||||
|  | +#include <linux/types.h> | ||||||
|  | +#include <linux/kernel.h> | ||||||
|  | +#include <linux/sched.h> | ||||||
|  | +#include <linux/wait.h> | ||||||
|  | +#include <linux/mtd/mtd.h> | ||||||
|  | +#include <linux/mtd/partitions.h> | ||||||
|  | +#include <linux/crc32.h> | ||||||
|  | +#include <linux/io.h> | ||||||
|  | +#include <asm/mach-bcm47xx/nvram.h> | ||||||
|  | +#include <asm/mach-bcm47xx/bcm47xx.h> | ||||||
|  | +#include <asm/fw/cfe/cfe_api.h> | ||||||
|  | + | ||||||
|  | + | ||||||
|  | +#define TRX_MAGIC	0x30524448	/* "HDR0" */ | ||||||
|  | +#define TRX_VERSION	1 | ||||||
|  | +#define TRX_MAX_LEN	0x3A0000 | ||||||
|  | +#define TRX_NO_HEADER	1		/* Do not write TRX header */ | ||||||
|  | +#define TRX_GZ_FILES	0x2     /* Contains up to TRX_MAX_OFFSET individual gzip files */ | ||||||
|  | +#define TRX_MAX_OFFSET	3 | ||||||
|  | + | ||||||
|  | +struct trx_header { | ||||||
|  | +	u32 magic;		/* "HDR0" */ | ||||||
|  | +	u32 len;		/* Length of file including header */ | ||||||
|  | +	u32 crc32;		/* 32-bit CRC from flag_version to end of file */ | ||||||
|  | +	u32 flag_version;	/* 0:15 flags, 16:31 version */ | ||||||
|  | +	u32 offsets[TRX_MAX_OFFSET];	/* Offsets of partitions from start of header */ | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +/* for Edimax Print servers which use an additional header | ||||||
|  | + * then the firmware on flash looks like : | ||||||
|  | + * EDIMAX HEADER | TRX HEADER | ||||||
|  | + * As this header is 12 bytes long we have to handle it | ||||||
|  | + * and skip it to find the TRX header | ||||||
|  | + */ | ||||||
|  | +#define EDIMAX_PS_HEADER_MAGIC	0x36315350 /*  "PS16"  */ | ||||||
|  | +#define EDIMAX_PS_HEADER_LEN	0xc /* 12 bytes long for edimax header */ | ||||||
|  | + | ||||||
|  | +#define NVRAM_SPACE 0x8000 | ||||||
|  | + | ||||||
|  | +#define ROUTER_NETGEAR_WGR614L		1 | ||||||
|  | +#define ROUTER_NETGEAR_WNR834B		2 | ||||||
|  | +#define ROUTER_NETGEAR_WNDR3300		3 | ||||||
|  | +#define ROUTER_NETGEAR_WNR3500L		4 | ||||||
|  | +#define ROUTER_SIMPLETECH_SIMPLESHARE	5 | ||||||
|  | +#define ROUTER_NETGEAR_WNDR3400		6 | ||||||
|  | + | ||||||
|  | +static int | ||||||
|  | +find_cfe_size(struct mtd_info *mtd) | ||||||
|  | +{ | ||||||
|  | +	struct trx_header *trx; | ||||||
|  | +	unsigned char buf[512]; | ||||||
|  | +	int off; | ||||||
|  | +	size_t len; | ||||||
|  | +	int blocksize; | ||||||
|  | + | ||||||
|  | +	trx = (struct trx_header *) buf; | ||||||
|  | + | ||||||
|  | +	blocksize = mtd->erasesize; | ||||||
|  | +	if (blocksize < 0x10000) | ||||||
|  | +		blocksize = 0x10000; | ||||||
|  | + | ||||||
|  | +	for (off = (128*1024); off < mtd->size; off += blocksize) { | ||||||
|  | +		memset(buf, 0xe5, sizeof(buf)); | ||||||
|  | + | ||||||
|  | +		/* | ||||||
|  | +		 * Read into buffer | ||||||
|  | +		 */ | ||||||
|  | +		if (mtd->read(mtd, off, sizeof(buf), &len, buf) || | ||||||
|  | +		    len != sizeof(buf)) | ||||||
|  | +			continue; | ||||||
|  | + | ||||||
|  | +		if (le32_to_cpu(trx->magic) == EDIMAX_PS_HEADER_MAGIC) { | ||||||
|  | +			if (mtd->read(mtd, off + EDIMAX_PS_HEADER_LEN, | ||||||
|  | +			    sizeof(buf), &len, buf) || len != sizeof(buf)) { | ||||||
|  | +				continue; | ||||||
|  | +			} else { | ||||||
|  | +				pr_notice("Found edimax header\n"); | ||||||
|  | +			} | ||||||
|  | +		} | ||||||
|  | + | ||||||
|  | +		/* found a TRX header */ | ||||||
|  | +		if (le32_to_cpu(trx->magic) == TRX_MAGIC) | ||||||
|  | +			goto found; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	pr_notice("%s: Couldn't find bootloader size\n", mtd->name); | ||||||
|  | +	return -1; | ||||||
|  | + | ||||||
|  | + found: | ||||||
|  | +	pr_notice("bootloader size: %d\n", off); | ||||||
|  | +	return off; | ||||||
|  | + | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +/* | ||||||
|  | + * Copied from mtdblock.c | ||||||
|  | + * | ||||||
|  | + * Cache stuff... | ||||||
|  | + * | ||||||
|  | + * Since typical flash erasable sectors are much larger than what Linux's | ||||||
|  | + * buffer cache can handle, we must implement read-modify-write on flash | ||||||
|  | + * sectors for each block write requests.  To avoid over-erasing flash sectors | ||||||
|  | + * and to speed things up, we locally cache a whole flash sector while it is | ||||||
|  | + * being written to until a different sector is required. | ||||||
|  | + */ | ||||||
|  | + | ||||||
|  | +static void erase_callback(struct erase_info *done) | ||||||
|  | +{ | ||||||
|  | +	wait_queue_head_t *wait_q = (wait_queue_head_t *)done->priv; | ||||||
|  | +	wake_up(wait_q); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int erase_write(struct mtd_info *mtd, unsigned long pos, | ||||||
|  | +			int len, const char *buf) | ||||||
|  | +{ | ||||||
|  | +	struct erase_info erase; | ||||||
|  | +	DECLARE_WAITQUEUE(wait, current); | ||||||
|  | +	wait_queue_head_t wait_q; | ||||||
|  | +	size_t retlen; | ||||||
|  | +	int ret; | ||||||
|  | + | ||||||
|  | +	/* | ||||||
|  | +	 * First, let's erase the flash block. | ||||||
|  | +	 */ | ||||||
|  | + | ||||||
|  | +	init_waitqueue_head(&wait_q); | ||||||
|  | +	erase.mtd = mtd; | ||||||
|  | +	erase.callback = erase_callback; | ||||||
|  | +	erase.addr = pos; | ||||||
|  | +	erase.len = len; | ||||||
|  | +	erase.priv = (u_long)&wait_q; | ||||||
|  | + | ||||||
|  | +	set_current_state(TASK_INTERRUPTIBLE); | ||||||
|  | +	add_wait_queue(&wait_q, &wait); | ||||||
|  | + | ||||||
|  | +	ret = mtd->erase(mtd, &erase); | ||||||
|  | +	if (ret) { | ||||||
|  | +		set_current_state(TASK_RUNNING); | ||||||
|  | +		remove_wait_queue(&wait_q, &wait); | ||||||
|  | +		pr_warn("erase of region [0x%lx, 0x%x] on \"%s\" failed\n", | ||||||
|  | +			pos, len, mtd->name); | ||||||
|  | +		return ret; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	schedule();  /* Wait for erase to finish. */ | ||||||
|  | +	remove_wait_queue(&wait_q, &wait); | ||||||
|  | + | ||||||
|  | +	/* | ||||||
|  | +	 * Next, write data to flash. | ||||||
|  | +	 */ | ||||||
|  | + | ||||||
|  | +	ret = mtd->write(mtd, pos, len, &retlen, buf); | ||||||
|  | +	if (ret) | ||||||
|  | +		return ret; | ||||||
|  | +	if (retlen != len) | ||||||
|  | +		return -EIO; | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | + | ||||||
|  | +static int | ||||||
|  | +find_dual_image_off(struct mtd_info *mtd) | ||||||
|  | +{ | ||||||
|  | +	struct trx_header trx; | ||||||
|  | +	int off, blocksize; | ||||||
|  | +	size_t len; | ||||||
|  | + | ||||||
|  | +	blocksize = mtd->erasesize; | ||||||
|  | +	if (blocksize < 0x10000) | ||||||
|  | +		blocksize = 0x10000; | ||||||
|  | + | ||||||
|  | +	for (off = (128*1024); off < mtd->size; off += blocksize) { | ||||||
|  | +		memset(&trx, 0xe5, sizeof(trx)); | ||||||
|  | +		/* | ||||||
|  | +		* Read into buffer | ||||||
|  | +		*/ | ||||||
|  | +		if (mtd->read(mtd, off, sizeof(trx), &len, (char *) &trx) || | ||||||
|  | +		    len != sizeof(trx)) | ||||||
|  | +			continue; | ||||||
|  | +		/* found last TRX header */ | ||||||
|  | +		if (le32_to_cpu(trx.magic) == TRX_MAGIC) { | ||||||
|  | +			if (le32_to_cpu(trx.flag_version >> 16) == 2) { | ||||||
|  | +				pr_notice("dual image TRX header found\n"); | ||||||
|  | +				return mtd->size / 2; | ||||||
|  | +			} else { | ||||||
|  | +				return 0; | ||||||
|  | +			} | ||||||
|  | +		} | ||||||
|  | +	} | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | + | ||||||
|  | +static int | ||||||
|  | +find_root(struct mtd_info *mtd, struct mtd_partition *part) | ||||||
|  | +{ | ||||||
|  | +	struct trx_header trx, *trx2; | ||||||
|  | +	unsigned char buf[512], *block; | ||||||
|  | +	int off, blocksize, trxoff = 0; | ||||||
|  | +	u32 i, crc = ~0; | ||||||
|  | +	size_t len; | ||||||
|  | +	bool edimax = false; | ||||||
|  | + | ||||||
|  | +	blocksize = mtd->erasesize; | ||||||
|  | +	if (blocksize < 0x10000) | ||||||
|  | +		blocksize = 0x10000; | ||||||
|  | + | ||||||
|  | +	for (off = (128*1024); off < mtd->size; off += blocksize) { | ||||||
|  | +		memset(&trx, 0xe5, sizeof(trx)); | ||||||
|  | + | ||||||
|  | +		/* | ||||||
|  | +		 * Read into buffer | ||||||
|  | +		 */ | ||||||
|  | +		if (mtd->read(mtd, off, sizeof(trx), &len, (char *) &trx) || | ||||||
|  | +		    len != sizeof(trx)) | ||||||
|  | +			continue; | ||||||
|  | + | ||||||
|  | +		/* found an edimax header */ | ||||||
|  | +		if (le32_to_cpu(trx.magic) == EDIMAX_PS_HEADER_MAGIC) { | ||||||
|  | +			/* read the correct trx header */ | ||||||
|  | +			if (mtd->read(mtd, off + EDIMAX_PS_HEADER_LEN, | ||||||
|  | +			    sizeof(trx), &len, (char *) &trx) || | ||||||
|  | +			    len != sizeof(trx)) { | ||||||
|  | +				continue; | ||||||
|  | +			} else { | ||||||
|  | +				pr_notice("Found an edimax ps header\n"); | ||||||
|  | +				edimax = true; | ||||||
|  | +			} | ||||||
|  | +		} | ||||||
|  | + | ||||||
|  | +		/* found a TRX header */ | ||||||
|  | +		if (le32_to_cpu(trx.magic) == TRX_MAGIC) { | ||||||
|  | +			part->offset = le32_to_cpu(trx.offsets[2]) ? : | ||||||
|  | +				le32_to_cpu(trx.offsets[1]); | ||||||
|  | +			part->size = le32_to_cpu(trx.len); | ||||||
|  | + | ||||||
|  | +			part->size -= part->offset; | ||||||
|  | +			part->offset += off; | ||||||
|  | +			if (edimax) { | ||||||
|  | +				off += EDIMAX_PS_HEADER_LEN; | ||||||
|  | +				trxoff = EDIMAX_PS_HEADER_LEN; | ||||||
|  | +			} | ||||||
|  | + | ||||||
|  | +			goto found; | ||||||
|  | +		} | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	pr_warn("%s: Couldn't find root filesystem\n", | ||||||
|  | +	       mtd->name); | ||||||
|  | +	return -1; | ||||||
|  | + | ||||||
|  | + found: | ||||||
|  | +	pr_notice("TRX offset : %x\n", trxoff); | ||||||
|  | +	if (part->size == 0) | ||||||
|  | +		return 0; | ||||||
|  | + | ||||||
|  | +	if (mtd->read(mtd, part->offset, sizeof(buf), &len, buf) || len != sizeof(buf)) | ||||||
|  | +		return 0; | ||||||
|  | + | ||||||
|  | +	/* Move the fs outside of the trx */ | ||||||
|  | +	part->size = 0; | ||||||
|  | + | ||||||
|  | +	if (trx.len != part->offset + part->size - off) { | ||||||
|  | +		/* Update the trx offsets and length */ | ||||||
|  | +		trx.len = part->offset + part->size - off; | ||||||
|  | + | ||||||
|  | +		/* Update the trx crc32 */ | ||||||
|  | +		for (i = (u32) &(((struct trx_header *)NULL)->flag_version); i <= trx.len; i += sizeof(buf)) { | ||||||
|  | +			if (mtd->read(mtd, off + i, sizeof(buf), &len, buf) || len != sizeof(buf)) | ||||||
|  | +				return 0; | ||||||
|  | +			crc = crc32_le(crc, buf, min(sizeof(buf), trx.len - i)); | ||||||
|  | +		} | ||||||
|  | +		trx.crc32 = crc; | ||||||
|  | + | ||||||
|  | +		/* read first eraseblock from the trx */ | ||||||
|  | +		block = kmalloc(mtd->erasesize, GFP_KERNEL); | ||||||
|  | +		trx2 = (struct trx_header *) block; | ||||||
|  | +		if (mtd->read(mtd, off - trxoff, mtd->erasesize, &len, block) || len != mtd->erasesize) { | ||||||
|  | +			pr_err("Error accessing the first trx eraseblock\n"); | ||||||
|  | +			return 0; | ||||||
|  | +		} | ||||||
|  | + | ||||||
|  | +		pr_notice("Updating TRX offsets and length:\n"); | ||||||
|  | +		pr_notice("old trx = [0x%08x, 0x%08x, 0x%08x], len=0x%08x crc32=0x%08x\n", trx2->offsets[0], trx2->offsets[1], trx2->offsets[2], trx2->len, trx2->crc32); | ||||||
|  | +		pr_notice("new trx = [0x%08x, 0x%08x, 0x%08x], len=0x%08x crc32=0x%08x\n",   trx.offsets[0],   trx.offsets[1],   trx.offsets[2],   trx.len, trx.crc32); | ||||||
|  | + | ||||||
|  | +		/* Write updated trx header to the flash */ | ||||||
|  | +		memcpy(block + trxoff, &trx, sizeof(trx)); | ||||||
|  | +		if (mtd->unlock) | ||||||
|  | +			mtd->unlock(mtd, off - trxoff, mtd->erasesize); | ||||||
|  | +		erase_write(mtd, off - trxoff, mtd->erasesize, block); | ||||||
|  | +		if (mtd->sync) | ||||||
|  | +			mtd->sync(mtd); | ||||||
|  | +		kfree(block); | ||||||
|  | +		pr_notice("Done\n"); | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return part->size; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int get_router(void) | ||||||
|  | +{ | ||||||
|  | +	char buf[20]; | ||||||
|  | +	u32 boardnum = 0; | ||||||
|  | +	u16 boardtype = 0; | ||||||
|  | +	u16 boardrev = 0; | ||||||
|  | +	u32 boardflags = 0; | ||||||
|  | +	u16 sdram_init = 0; | ||||||
|  | +	u16 cardbus = 0; | ||||||
|  | +	u16 strev = 0; | ||||||
|  | + | ||||||
|  | +	if (nvram_getenv("boardnum", buf, sizeof(buf)) >= 0) | ||||||
|  | +		boardnum = simple_strtoul(buf, NULL, 0); | ||||||
|  | +	if (nvram_getenv("boardtype", buf, sizeof(buf)) >= 0) | ||||||
|  | +		boardtype = simple_strtoul(buf, NULL, 0); | ||||||
|  | +	if (nvram_getenv("boardrev", buf, sizeof(buf)) >= 0) | ||||||
|  | +		boardrev = simple_strtoul(buf, NULL, 0); | ||||||
|  | +	if (nvram_getenv("boardflags", buf, sizeof(buf)) >= 0) | ||||||
|  | +		boardflags = simple_strtoul(buf, NULL, 0); | ||||||
|  | +	if (nvram_getenv("sdram_init", buf, sizeof(buf)) >= 0) | ||||||
|  | +		sdram_init = simple_strtoul(buf, NULL, 0); | ||||||
|  | +	if (nvram_getenv("cardbus", buf, sizeof(buf)) >= 0) | ||||||
|  | +		cardbus = simple_strtoul(buf, NULL, 0); | ||||||
|  | +	if (nvram_getenv("st_rev", buf, sizeof(buf)) >= 0) | ||||||
|  | +		strev = simple_strtoul(buf, NULL, 0); | ||||||
|  | + | ||||||
|  | +	if ((boardnum == 8 || boardnum == 01) | ||||||
|  | +	  && boardtype == 0x0472 && cardbus == 1) { | ||||||
|  | +		/* Netgear WNR834B, Netgear WNR834Bv2 */ | ||||||
|  | +		return ROUTER_NETGEAR_WNR834B; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	if (boardnum == 01 && boardtype == 0x0472 && boardrev == 0x23) { | ||||||
|  | +		/* Netgear WNDR-3300 */ | ||||||
|  | +		return ROUTER_NETGEAR_WNDR3300; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	if ((boardnum == 83258 || boardnum == 01) | ||||||
|  | +	  && boardtype == 0x048e | ||||||
|  | +	  && (boardrev == 0x11 || boardrev == 0x10) | ||||||
|  | +	  && boardflags == 0x750 | ||||||
|  | +	  && sdram_init == 0x000A) { | ||||||
|  | +		/* Netgear WGR614v8/L/WW 16MB ram, cfe v1.3 or v1.5 */ | ||||||
|  | +		return ROUTER_NETGEAR_WGR614L; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	if ((boardnum == 1 || boardnum == 3500) | ||||||
|  | +	  && boardtype == 0x04CF | ||||||
|  | +	  && (boardrev == 0x1213 || boardrev == 02)) { | ||||||
|  | +		/* Netgear WNR3500v2/U/L */ | ||||||
|  | +		return ROUTER_NETGEAR_WNR3500L; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	if (boardnum == 1 && boardtype == 0xb4cf && boardrev == 0x1100) { | ||||||
|  | +		/* Netgear WNDR3400 */ | ||||||
|  | +		return ROUTER_NETGEAR_WNDR3400; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	if (boardtype == 0x042f | ||||||
|  | +	  && boardrev == 0x10 | ||||||
|  | +	  && boardflags == 0 | ||||||
|  | +	  && strev == 0x11) { | ||||||
|  | +		/* Simpletech Simpleshare */ | ||||||
|  | +		return ROUTER_SIMPLETECH_SIMPLESHARE; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int parse_bcm47xx_partitions(struct mtd_info *mtd, | ||||||
|  | +				    struct mtd_partition **pparts, | ||||||
|  | +				    struct mtd_part_parser_data *data) | ||||||
|  | +{ | ||||||
|  | +	int cfe_size; | ||||||
|  | +	int dual_image_offset = 0; | ||||||
|  | +	/* e.g Netgear 0x003e0000-0x003f0000 : "board_data", we exclude this | ||||||
|  | +	 * part from our mapping to prevent overwriting len/checksum on e.g. | ||||||
|  | +	 * Netgear WGR614v8/L/WW | ||||||
|  | +	 */ | ||||||
|  | +	int custom_data_size = 0; | ||||||
|  | +	struct mtd_partition *bcm47xx_parts; | ||||||
|  | + | ||||||
|  | +	cfe_size = find_cfe_size(mtd); | ||||||
|  | +	if (cfe_size < 0) | ||||||
|  | +		return 0; | ||||||
|  | + | ||||||
|  | +	bcm47xx_parts = kzalloc(sizeof(struct mtd_partition) * 6, GFP_KERNEL); | ||||||
|  | + | ||||||
|  | +	bcm47xx_parts[0].name = "cfe"; | ||||||
|  | +	bcm47xx_parts[1].name = "linux"; | ||||||
|  | +	bcm47xx_parts[2].name = "rootfs"; | ||||||
|  | +	bcm47xx_parts[3].name = "nvram"; | ||||||
|  | + | ||||||
|  | +	/* boot loader */ | ||||||
|  | +	bcm47xx_parts[0].mask_flags = MTD_WRITEABLE; | ||||||
|  | +	bcm47xx_parts[0].offset = 0; | ||||||
|  | +	bcm47xx_parts[0].size   = cfe_size; | ||||||
|  | + | ||||||
|  | +	/* nvram */ | ||||||
|  | +	if (cfe_size != 384 * 1024) { | ||||||
|  | + | ||||||
|  | +		switch (get_router()) { | ||||||
|  | +		case ROUTER_NETGEAR_WGR614L: | ||||||
|  | +		case ROUTER_NETGEAR_WNR834B: | ||||||
|  | +		case ROUTER_NETGEAR_WNDR3300: | ||||||
|  | +		case ROUTER_NETGEAR_WNR3500L: | ||||||
|  | +		case ROUTER_NETGEAR_WNDR3400: | ||||||
|  | +			/* Netgear: checksum is @ 0x003AFFF8 for 4M flash or checksum | ||||||
|  | +			 * is @ 0x007AFFF8 for 8M flash | ||||||
|  | +			 */ | ||||||
|  | +			custom_data_size = mtd->erasesize; | ||||||
|  | + | ||||||
|  | +			bcm47xx_parts[3].offset = mtd->size - roundup(NVRAM_SPACE, mtd->erasesize); | ||||||
|  | +			bcm47xx_parts[3].size   = roundup(NVRAM_SPACE, mtd->erasesize); | ||||||
|  | + | ||||||
|  | +			/* Place CFE board_data into a partition */ | ||||||
|  | +			bcm47xx_parts[4].name = "board_data"; | ||||||
|  | +			bcm47xx_parts[4].offset = bcm47xx_parts[3].offset - custom_data_size; | ||||||
|  | +			bcm47xx_parts[4].size   = custom_data_size; | ||||||
|  | +			break; | ||||||
|  | + | ||||||
|  | +		case ROUTER_SIMPLETECH_SIMPLESHARE: | ||||||
|  | +			/* Fixup Simpletech Simple share nvram  */ | ||||||
|  | + | ||||||
|  | +			pr_notice("Setting up simpletech nvram\n"); | ||||||
|  | +			custom_data_size = mtd->erasesize; | ||||||
|  | + | ||||||
|  | +			bcm47xx_parts[3].offset = mtd->size - roundup(NVRAM_SPACE, mtd->erasesize) * 2; | ||||||
|  | +			bcm47xx_parts[3].size   = roundup(NVRAM_SPACE, mtd->erasesize); | ||||||
|  | + | ||||||
|  | +			/* Place backup nvram into a partition */ | ||||||
|  | +			bcm47xx_parts[4].name = "nvram_copy"; | ||||||
|  | +			bcm47xx_parts[4].offset = mtd->size - roundup(NVRAM_SPACE, mtd->erasesize); | ||||||
|  | +			bcm47xx_parts[4].size   = roundup(NVRAM_SPACE, mtd->erasesize); | ||||||
|  | +			break; | ||||||
|  | + | ||||||
|  | +		default: | ||||||
|  | +			bcm47xx_parts[3].offset = mtd->size - roundup(NVRAM_SPACE, mtd->erasesize); | ||||||
|  | +			bcm47xx_parts[3].size   = roundup(NVRAM_SPACE, mtd->erasesize); | ||||||
|  | +		} | ||||||
|  | + | ||||||
|  | +	} else { | ||||||
|  | +		/* nvram (old 128kb config partition on netgear wgt634u) */ | ||||||
|  | +		bcm47xx_parts[3].offset = bcm47xx_parts[0].size; | ||||||
|  | +		bcm47xx_parts[3].size   = roundup(NVRAM_SPACE, mtd->erasesize); | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	/* dual image offset*/ | ||||||
|  | +	pr_notice("Looking for dual image\n"); | ||||||
|  | +	dual_image_offset = find_dual_image_off(mtd); | ||||||
|  | +	/* linux (kernel and rootfs) */ | ||||||
|  | +	if (cfe_size != 384 * 1024) { | ||||||
|  | +		if (get_router() == ROUTER_SIMPLETECH_SIMPLESHARE) { | ||||||
|  | +			bcm47xx_parts[1].offset = bcm47xx_parts[0].size; | ||||||
|  | +			bcm47xx_parts[1].size   = bcm47xx_parts[4].offset - dual_image_offset - | ||||||
|  | +				bcm47xx_parts[1].offset - custom_data_size; | ||||||
|  | +		} else { | ||||||
|  | +			bcm47xx_parts[1].offset = bcm47xx_parts[0].size; | ||||||
|  | +			bcm47xx_parts[1].size   = bcm47xx_parts[3].offset - dual_image_offset - | ||||||
|  | +				bcm47xx_parts[1].offset - custom_data_size; | ||||||
|  | +		} | ||||||
|  | +	} else { | ||||||
|  | +		/* do not count the elf loader, which is on one block */ | ||||||
|  | +		bcm47xx_parts[1].offset = bcm47xx_parts[0].size + | ||||||
|  | +			bcm47xx_parts[3].size + mtd->erasesize; | ||||||
|  | +		bcm47xx_parts[1].size   = mtd->size - | ||||||
|  | +			bcm47xx_parts[0].size - | ||||||
|  | +			(2*bcm47xx_parts[3].size) - | ||||||
|  | +			mtd->erasesize - custom_data_size; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	/* find and size rootfs */ | ||||||
|  | +	find_root(mtd, &bcm47xx_parts[2]); | ||||||
|  | +	bcm47xx_parts[2].size = mtd->size - dual_image_offset - | ||||||
|  | +				bcm47xx_parts[2].offset - | ||||||
|  | +				bcm47xx_parts[3].size - custom_data_size; | ||||||
|  | +	*pparts = bcm47xx_parts; | ||||||
|  | +	return bcm47xx_parts[4].name == NULL ? 4 : 5; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static struct mtd_part_parser bcm47xx_parser = { | ||||||
|  | +	.owner = THIS_MODULE, | ||||||
|  | +	.parse_fn = parse_bcm47xx_partitions, | ||||||
|  | +	.name = "bcm47xx", | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static int __init bcm47xx_parser_init(void) | ||||||
|  | +{ | ||||||
|  | +	return register_mtd_parser(&bcm47xx_parser); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void __exit bcm47xx_parser_exit(void) | ||||||
|  | +{ | ||||||
|  | +	deregister_mtd_parser(&bcm47xx_parser); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +module_init(bcm47xx_parser_init); | ||||||
|  | +module_exit(bcm47xx_parser_exit); | ||||||
|  | + | ||||||
|  | +MODULE_LICENSE("GPL"); | ||||||
|  | +MODULE_DESCRIPTION("Parsing code for flash partitions on bcm47xx SoCs"); | ||||||
| @@ -0,0 +1,216 @@ | |||||||
|  | --- a/drivers/mtd/maps/Kconfig | ||||||
|  | +++ b/drivers/mtd/maps/Kconfig | ||||||
|  | @@ -248,6 +248,15 @@ config MTD_LANTIQ | ||||||
|  |  	help | ||||||
|  |  	  Support for NOR flash attached to the Lantiq SoC's External Bus Unit. | ||||||
|  |   | ||||||
|  | +config MTD_BCM47XX_PFLASH | ||||||
|  | +	tristate "bcm47xx parallel flash support" | ||||||
|  | +	default y | ||||||
|  | +	depends on BCM47XX | ||||||
|  | +	select MTD_PARTITIONS | ||||||
|  | +	select MTD_BCM47XX_PARTS | ||||||
|  | +	help | ||||||
|  | +	  Support for bcm47xx parallel flash | ||||||
|  | + | ||||||
|  |  config MTD_DILNETPC | ||||||
|  |  	tristate "CFI Flash device mapped on DIL/Net PC" | ||||||
|  |  	depends on X86 && MTD_CFI_INTELEXT && BROKEN | ||||||
|  | --- a/drivers/mtd/maps/Makefile | ||||||
|  | +++ b/drivers/mtd/maps/Makefile | ||||||
|  | @@ -57,3 +57,4 @@ obj-$(CONFIG_MTD_VMU)		+= vmu-flash.o | ||||||
|  |  obj-$(CONFIG_MTD_GPIO_ADDR)	+= gpio-addr-flash.o | ||||||
|  |  obj-$(CONFIG_MTD_LATCH_ADDR)	+= latch-addr-flash.o | ||||||
|  |  obj-$(CONFIG_MTD_LANTIQ)	+= lantiq-flash.o | ||||||
|  | +obj-$(CONFIG_MTD_BCM47XX_PFLASH)+= bcm47xx-pflash.o | ||||||
|  | --- /dev/null | ||||||
|  | +++ b/drivers/mtd/maps/bcm47xx-pflash.c | ||||||
|  | @@ -0,0 +1,188 @@ | ||||||
|  | +/* | ||||||
|  | + *  Copyright (C) 2006 Felix Fietkau <nbd@openwrt.org> | ||||||
|  | + *  Copyright (C) 2005 Waldemar Brodkorb <wbx@openwrt.org> | ||||||
|  | + *  Copyright (C) 2004 Florian Schirmer (jolt@tuxbox.org) | ||||||
|  | + * | ||||||
|  | + *  original functions for finding root filesystem from Mike Baker | ||||||
|  | + * | ||||||
|  | + *  This program is free software; you can redistribute  it and/or modify it | ||||||
|  | + *  under  the terms of  the GNU General  Public License as published by the | ||||||
|  | + *  Free Software Foundation;  either version 2 of the  License, or (at your | ||||||
|  | + *  option) any later version. | ||||||
|  | + * | ||||||
|  | + *  THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED | ||||||
|  | + *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF | ||||||
|  | + *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN | ||||||
|  | + *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT, | ||||||
|  | + *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT | ||||||
|  | + *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF | ||||||
|  | + *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON | ||||||
|  | + *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT | ||||||
|  | + *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF | ||||||
|  | + *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | ||||||
|  | + * | ||||||
|  | + *  You should have received a copy of the  GNU General Public License along | ||||||
|  | + *  with this program; if not, write  to the Free Software Foundation, Inc., | ||||||
|  | + *  675 Mass Ave, Cambridge, MA 02139, USA. | ||||||
|  | + * | ||||||
|  | + *  Copyright 2001-2003, Broadcom Corporation | ||||||
|  | + *  All Rights Reserved. | ||||||
|  | + * | ||||||
|  | + *  THIS SOFTWARE IS OFFERED "AS IS", AND BROADCOM GRANTS NO WARRANTIES OF ANY | ||||||
|  | + *  KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM | ||||||
|  | + *  SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS | ||||||
|  | + *  FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE. | ||||||
|  | + * | ||||||
|  | + *  Flash mapping for BCM947XX boards | ||||||
|  | + */ | ||||||
|  | + | ||||||
|  | +#define pr_fmt(fmt) "bcm47xx_pflash: " fmt | ||||||
|  | +#include <linux/init.h> | ||||||
|  | +#include <linux/module.h> | ||||||
|  | +#include <linux/types.h> | ||||||
|  | +#include <linux/kernel.h> | ||||||
|  | +#include <linux/sched.h> | ||||||
|  | +#include <linux/mtd/mtd.h> | ||||||
|  | +#include <linux/mtd/map.h> | ||||||
|  | +#include <linux/mtd/partitions.h> | ||||||
|  | +#include <linux/io.h> | ||||||
|  | +#include <asm/mach-bcm47xx/bcm47xx.h> | ||||||
|  | +#include <linux/platform_device.h> | ||||||
|  | + | ||||||
|  | +#define WINDOW_ADDR 0x1fc00000 | ||||||
|  | +#define WINDOW_SIZE 0x400000 | ||||||
|  | +#define BUSWIDTH 2 | ||||||
|  | + | ||||||
|  | +static struct mtd_info *bcm47xx_mtd; | ||||||
|  | + | ||||||
|  | +static void bcm47xx_map_copy_from(struct map_info *map, void *to, unsigned long from, ssize_t len) | ||||||
|  | +{ | ||||||
|  | +	if (len == 1) { | ||||||
|  | +		memcpy_fromio(to, map->virt + from, len); | ||||||
|  | +	} else { | ||||||
|  | +		int i; | ||||||
|  | +		u16 *dest = (u16 *) to; | ||||||
|  | +		u16 *src  = (u16 *) (map->virt + from); | ||||||
|  | +		for (i = 0; i < (len / 2); i++) | ||||||
|  | +			dest[i] = src[i]; | ||||||
|  | +		if (len & 1) | ||||||
|  | +			*((u8 *)dest+len-1) = src[i] & 0xff; | ||||||
|  | +	} | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static struct map_info bcm47xx_map = { | ||||||
|  | +	name: "Physically mapped flash", | ||||||
|  | +	size : WINDOW_SIZE, | ||||||
|  | +	bankwidth : BUSWIDTH, | ||||||
|  | +	phys : WINDOW_ADDR, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static const char *probes[] = { "bcm47xx", NULL }; | ||||||
|  | + | ||||||
|  | +static int bcm47xx_mtd_probe(struct platform_device *pdev) | ||||||
|  | +{ | ||||||
|  | +#ifdef CONFIG_BCM47XX_SSB | ||||||
|  | +	struct ssb_chipcommon *ssb_cc; | ||||||
|  | +#endif | ||||||
|  | +#ifdef CONFIG_BCM47XX_BCMA | ||||||
|  | +	struct bcma_drv_cc *bcma_cc; | ||||||
|  | +#endif | ||||||
|  | +	int ret = 0; | ||||||
|  | + | ||||||
|  | +	switch (bcm47xx_bus_type) { | ||||||
|  | +#ifdef CONFIG_BCM47XX_SSB | ||||||
|  | +	case BCM47XX_BUS_TYPE_SSB: | ||||||
|  | +		ssb_cc = &bcm47xx_bus.ssb.chipco; | ||||||
|  | +		if (ssb_cc->flash_type != SSB_PFLASH) | ||||||
|  | +			return -ENODEV; | ||||||
|  | + | ||||||
|  | +		bcm47xx_map.phys = ssb_cc->pflash.window; | ||||||
|  | +		bcm47xx_map.size = ssb_cc->pflash.window_size; | ||||||
|  | +		bcm47xx_map.bankwidth = ssb_cc->pflash.buswidth; | ||||||
|  | +		break; | ||||||
|  | +#endif | ||||||
|  | +#ifdef CONFIG_BCM47XX_BCMA | ||||||
|  | +	case BCM47XX_BUS_TYPE_BCMA: | ||||||
|  | +		bcma_cc = &bcm47xx_bus.bcma.bus.drv_cc; | ||||||
|  | +		if (bcma_cc->flash_type != BCMA_PFLASH) | ||||||
|  | +			return -ENODEV; | ||||||
|  | + | ||||||
|  | +		bcm47xx_map.phys = bcma_cc->pflash.window; | ||||||
|  | +		bcm47xx_map.size = bcma_cc->pflash.window_size; | ||||||
|  | +		bcm47xx_map.bankwidth = bcma_cc->pflash.buswidth; | ||||||
|  | +		break; | ||||||
|  | +#endif | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	pr_notice("flash init: 0x%08x 0x%08lx\n", bcm47xx_map.phys, bcm47xx_map.size); | ||||||
|  | +	bcm47xx_map.virt = ioremap_nocache(bcm47xx_map.phys, bcm47xx_map.size); | ||||||
|  | + | ||||||
|  | +	if (!bcm47xx_map.virt) { | ||||||
|  | +		pr_err("Failed to ioremap\n"); | ||||||
|  | +		return -EIO; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	simple_map_init(&bcm47xx_map); | ||||||
|  | +	/* override copy_from routine */ | ||||||
|  | +	bcm47xx_map.copy_from = bcm47xx_map_copy_from; | ||||||
|  | + | ||||||
|  | +	bcm47xx_mtd = do_map_probe("cfi_probe", &bcm47xx_map); | ||||||
|  | +	if (!bcm47xx_mtd) { | ||||||
|  | +		pr_err("Failed to do_map_probe\n"); | ||||||
|  | +		ret = -ENXIO; | ||||||
|  | +		goto err_unmap; | ||||||
|  | +	} | ||||||
|  | +	bcm47xx_mtd->owner = THIS_MODULE; | ||||||
|  | + | ||||||
|  | +	pr_notice("Flash device: 0x%lx at 0x%x\n", bcm47xx_map.size, WINDOW_ADDR); | ||||||
|  | + | ||||||
|  | +	ret = mtd_device_parse_register(bcm47xx_mtd, probes, NULL, NULL, 0); | ||||||
|  | + | ||||||
|  | +	if (ret) { | ||||||
|  | +		pr_err("Flash: mtd_device_register failed\n"); | ||||||
|  | +		goto err_destroy; | ||||||
|  | +	} | ||||||
|  | +	return 0; | ||||||
|  | + | ||||||
|  | +err_destroy: | ||||||
|  | +	map_destroy(bcm47xx_mtd); | ||||||
|  | +err_unmap: | ||||||
|  | +	iounmap(bcm47xx_map.virt); | ||||||
|  | +	return ret; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int __devexit bcm47xx_mtd_remove(struct platform_device *pdev) | ||||||
|  | +{ | ||||||
|  | +	mtd_device_unregister(bcm47xx_mtd); | ||||||
|  | +	map_destroy(bcm47xx_mtd); | ||||||
|  | +	iounmap(bcm47xx_map.virt); | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static struct platform_driver bcm47xx_mtd_driver = { | ||||||
|  | +	.remove = __devexit_p(bcm47xx_mtd_remove), | ||||||
|  | +	.driver = { | ||||||
|  | +		.name = "bcm47xx_pflash", | ||||||
|  | +		.owner = THIS_MODULE, | ||||||
|  | +	}, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static int __init init_bcm47xx_mtd(void) | ||||||
|  | +{ | ||||||
|  | +	int ret = platform_driver_probe(&bcm47xx_mtd_driver, bcm47xx_mtd_probe); | ||||||
|  | + | ||||||
|  | +	if (ret) | ||||||
|  | +		pr_err("error registering platform driver: %i\n", ret); | ||||||
|  | +	return ret; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void __exit exit_bcm47xx_mtd(void) | ||||||
|  | +{ | ||||||
|  | +	platform_driver_unregister(&bcm47xx_mtd_driver); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +module_init(init_bcm47xx_mtd); | ||||||
|  | +module_exit(exit_bcm47xx_mtd); | ||||||
|  | + | ||||||
|  | +MODULE_LICENSE("GPL"); | ||||||
|  | +MODULE_DESCRIPTION("BCM47XX parallel flash driver"); | ||||||
| @@ -0,0 +1,310 @@ | |||||||
|  | --- a/arch/mips/include/asm/mach-bcm47xx/bus.h | ||||||
|  | +++ b/arch/mips/include/asm/mach-bcm47xx/bus.h | ||||||
|  | @@ -11,6 +11,7 @@ | ||||||
|  |   | ||||||
|  |  #include <linux/ssb/ssb.h> | ||||||
|  |  #include <linux/bcma/bcma.h> | ||||||
|  | +#include <linux/mtd/mtd.h> | ||||||
|  |  #include <bcm47xx.h> | ||||||
|  |   | ||||||
|  |  struct bcm47xx_sflash { | ||||||
|  | @@ -28,6 +29,8 @@ struct bcm47xx_sflash { | ||||||
|  |  	u32 blocksize;		/* Block size */ | ||||||
|  |  	u32 numblocks;		/* Number of blocks */ | ||||||
|  |  	u32 size;		/* Total size in bytes */ | ||||||
|  | + | ||||||
|  | +	struct mtd_info *mtd; | ||||||
|  |  }; | ||||||
|  |   | ||||||
|  |  void bcm47xx_sflash_struct_bcma_init(struct bcm47xx_sflash *sflash, struct bcma_drv_cc *bcc); | ||||||
|  | --- a/drivers/mtd/maps/Kconfig | ||||||
|  | +++ b/drivers/mtd/maps/Kconfig | ||||||
|  | @@ -257,6 +257,15 @@ config MTD_BCM47XX_PFLASH | ||||||
|  |  	help | ||||||
|  |  	  Support for bcm47xx parallel flash | ||||||
|  |   | ||||||
|  | +config MTD_BCM47XX_SFLASH | ||||||
|  | +	tristate "bcm47xx serial flash support" | ||||||
|  | +	default y | ||||||
|  | +	depends on BCM47XX | ||||||
|  | +	select MTD_PARTITIONS | ||||||
|  | +	select MTD_BCM47XX_PARTS | ||||||
|  | +	help | ||||||
|  | +	  Support for bcm47xx parallel flash | ||||||
|  | + | ||||||
|  |  config MTD_DILNETPC | ||||||
|  |  	tristate "CFI Flash device mapped on DIL/Net PC" | ||||||
|  |  	depends on X86 && MTD_CFI_INTELEXT && BROKEN | ||||||
|  | --- a/drivers/mtd/maps/Makefile | ||||||
|  | +++ b/drivers/mtd/maps/Makefile | ||||||
|  | @@ -58,3 +58,4 @@ obj-$(CONFIG_MTD_GPIO_ADDR)	+= gpio-addr | ||||||
|  |  obj-$(CONFIG_MTD_LATCH_ADDR)	+= latch-addr-flash.o | ||||||
|  |  obj-$(CONFIG_MTD_LANTIQ)	+= lantiq-flash.o | ||||||
|  |  obj-$(CONFIG_MTD_BCM47XX_PFLASH)+= bcm47xx-pflash.o | ||||||
|  | +obj-$(CONFIG_MTD_BCM47XX_SFLASH)+= bcm47xx-sflash.o | ||||||
|  | --- /dev/null | ||||||
|  | +++ b/drivers/mtd/maps/bcm47xx-sflash.c | ||||||
|  | @@ -0,0 +1,263 @@ | ||||||
|  | +/* | ||||||
|  | + * Broadcom SiliconBackplane chipcommon serial flash interface | ||||||
|  | + * | ||||||
|  | + * Copyright 2011, 2012, Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | + * Copyright 2006, Broadcom Corporation | ||||||
|  | + * All Rights Reserved. | ||||||
|  | + * | ||||||
|  | + * Licensed under the GNU/GPL. See COPYING for details. | ||||||
|  | + */ | ||||||
|  | + | ||||||
|  | +#define pr_fmt(fmt) "bcm47xx_sflash: " fmt | ||||||
|  | +#include <linux/module.h> | ||||||
|  | +#include <linux/slab.h> | ||||||
|  | +#include <linux/ioport.h> | ||||||
|  | +#include <linux/sched.h> | ||||||
|  | +#include <linux/mtd/mtd.h> | ||||||
|  | +#include <linux/mtd/map.h> | ||||||
|  | +#include <linux/mtd/partitions.h> | ||||||
|  | +#include <linux/errno.h> | ||||||
|  | +#include <linux/delay.h> | ||||||
|  | +#include <linux/platform_device.h> | ||||||
|  | +#include <bcm47xx.h> | ||||||
|  | +#include <bus.h> | ||||||
|  | + | ||||||
|  | +static int | ||||||
|  | +sflash_mtd_poll(struct bcm47xx_sflash *sflash, unsigned int offset, int timeout) | ||||||
|  | +{ | ||||||
|  | +	unsigned long now = jiffies; | ||||||
|  | + | ||||||
|  | +	for (;;) { | ||||||
|  | +		if (!sflash->poll(sflash, offset)) { | ||||||
|  | +			break; | ||||||
|  | +		} | ||||||
|  | +		if (time_after(jiffies, now + timeout)) { | ||||||
|  | +			pr_err("timeout while polling\n"); | ||||||
|  | +			return -ETIMEDOUT; | ||||||
|  | + | ||||||
|  | +		} | ||||||
|  | +		cpu_relax(); | ||||||
|  | +		udelay(1); | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int | ||||||
|  | +sflash_mtd_read(struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen, u_char *buf) | ||||||
|  | +{ | ||||||
|  | +	struct bcm47xx_sflash *sflash = (struct bcm47xx_sflash *)mtd->priv; | ||||||
|  | + | ||||||
|  | +	/* Check address range */ | ||||||
|  | +	if (!len) | ||||||
|  | +		return 0; | ||||||
|  | + | ||||||
|  | +	if ((from + len) > mtd->size) | ||||||
|  | +		return -EINVAL; | ||||||
|  | + | ||||||
|  | +	*retlen = 0; | ||||||
|  | +	while (len) { | ||||||
|  | +		int ret = sflash->read(sflash, from, len, buf); | ||||||
|  | +		if (ret < 0) | ||||||
|  | +			return ret; | ||||||
|  | + | ||||||
|  | +		from += (loff_t) ret; | ||||||
|  | +		len -= ret; | ||||||
|  | +		buf += ret; | ||||||
|  | +		*retlen += ret; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int | ||||||
|  | +sflash_mtd_write(struct mtd_info *mtd, loff_t to, size_t len, size_t *retlen, const u_char *buf) | ||||||
|  | +{ | ||||||
|  | +	int bytes; | ||||||
|  | +	int ret; | ||||||
|  | +	struct bcm47xx_sflash *sflash = (struct bcm47xx_sflash *)mtd->priv; | ||||||
|  | + | ||||||
|  | +	/* Check address range */ | ||||||
|  | +	if (!len) | ||||||
|  | +		return 0; | ||||||
|  | + | ||||||
|  | +	if ((to + len) > mtd->size) | ||||||
|  | +		return -EINVAL; | ||||||
|  | + | ||||||
|  | +	*retlen = 0; | ||||||
|  | +	while (len) { | ||||||
|  | +		ret = sflash->write(sflash, to, len, buf); | ||||||
|  | +		if (ret < 0) | ||||||
|  | +			return ret; | ||||||
|  | + | ||||||
|  | +		bytes = ret; | ||||||
|  | + | ||||||
|  | +		ret = sflash_mtd_poll(sflash, (unsigned int) to, HZ / 10); | ||||||
|  | +		if (ret) | ||||||
|  | +			return ret; | ||||||
|  | + | ||||||
|  | +		to += (loff_t) bytes; | ||||||
|  | +		len -= bytes; | ||||||
|  | +		buf += bytes; | ||||||
|  | +		*retlen += bytes; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int | ||||||
|  | +sflash_mtd_erase(struct mtd_info *mtd, struct erase_info *erase) | ||||||
|  | +{ | ||||||
|  | +	struct bcm47xx_sflash *sflash = (struct bcm47xx_sflash *) mtd->priv; | ||||||
|  | +	int i, j, ret = 0; | ||||||
|  | +	unsigned int addr, len; | ||||||
|  | + | ||||||
|  | +	/* Check address range */ | ||||||
|  | +	if (!erase->len) | ||||||
|  | +		return 0; | ||||||
|  | +	if ((erase->addr + erase->len) > mtd->size) | ||||||
|  | +		return -EINVAL; | ||||||
|  | + | ||||||
|  | +	addr = erase->addr; | ||||||
|  | +	len = erase->len; | ||||||
|  | + | ||||||
|  | +	/* Ensure that requested regions are aligned */ | ||||||
|  | +	for (i = 0; i < mtd->numeraseregions; i++) { | ||||||
|  | +		for (j = 0; j < mtd->eraseregions[i].numblocks; j++) { | ||||||
|  | +			if (addr == mtd->eraseregions[i].offset + | ||||||
|  | +					mtd->eraseregions[i].erasesize * j && | ||||||
|  | +			    len >= mtd->eraseregions[i].erasesize) { | ||||||
|  | +				ret = sflash->erase(sflash, addr); | ||||||
|  | +				if (ret < 0) | ||||||
|  | +					break; | ||||||
|  | +				ret = sflash_mtd_poll(sflash, addr, 10 * HZ); | ||||||
|  | +				if (ret) | ||||||
|  | +					break; | ||||||
|  | +				addr += mtd->eraseregions[i].erasesize; | ||||||
|  | +				len -= mtd->eraseregions[i].erasesize; | ||||||
|  | +			} | ||||||
|  | +		} | ||||||
|  | +		if (ret) | ||||||
|  | +			break; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	/* Set erase status */ | ||||||
|  | +	if (ret) | ||||||
|  | +		erase->state = MTD_ERASE_FAILED; | ||||||
|  | +	else | ||||||
|  | +		erase->state = MTD_ERASE_DONE; | ||||||
|  | + | ||||||
|  | +	/* Call erase callback */ | ||||||
|  | +	if (erase->callback) | ||||||
|  | +		erase->callback(erase); | ||||||
|  | + | ||||||
|  | +	return ret; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static const char *probes[] = { "bcm47xx", NULL }; | ||||||
|  | + | ||||||
|  | +static int bcm47xx_sflash_probe(struct platform_device *pdev) | ||||||
|  | +{ | ||||||
|  | +	struct bcm47xx_sflash *sflash = dev_get_platdata(&pdev->dev); | ||||||
|  | +	struct mtd_info *mtd; | ||||||
|  | +	struct mtd_erase_region_info *eraseregions; | ||||||
|  | +	int ret = 0; | ||||||
|  | + | ||||||
|  | +	mtd = kzalloc(sizeof(struct mtd_info), GFP_KERNEL); | ||||||
|  | +	if (!mtd){ | ||||||
|  | +		ret =  -ENOMEM; | ||||||
|  | +		goto err_out; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	eraseregions = kzalloc(sizeof(struct mtd_erase_region_info), GFP_KERNEL); | ||||||
|  | +	if (!eraseregions) { | ||||||
|  | +		ret =  -ENOMEM; | ||||||
|  | +		goto err_free_mtd; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	pr_info("found serial flash: blocksize=%dKB, numblocks=%d, size=%dKB\n", | ||||||
|  | +		sflash->blocksize / 1024, sflash->numblocks, sflash->size / 1024); | ||||||
|  | + | ||||||
|  | +	/* Setup region info */ | ||||||
|  | +	eraseregions->offset = 0; | ||||||
|  | +	eraseregions->erasesize = sflash->blocksize; | ||||||
|  | +	eraseregions->numblocks = sflash->numblocks; | ||||||
|  | +	if (eraseregions->erasesize > mtd->erasesize) | ||||||
|  | +		mtd->erasesize = eraseregions->erasesize; | ||||||
|  | +	mtd->size = sflash->size; | ||||||
|  | +	mtd->numeraseregions = 1; | ||||||
|  | + | ||||||
|  | +	/* Register with MTD */ | ||||||
|  | +	mtd->name = "bcm47xx-sflash"; | ||||||
|  | +	mtd->type = MTD_NORFLASH; | ||||||
|  | +	mtd->flags = MTD_CAP_NORFLASH; | ||||||
|  | +	mtd->eraseregions = eraseregions; | ||||||
|  | +	mtd->erase = sflash_mtd_erase; | ||||||
|  | +	mtd->read = sflash_mtd_read; | ||||||
|  | +	mtd->write = sflash_mtd_write; | ||||||
|  | +	mtd->writesize = 1; | ||||||
|  | +	mtd->priv = sflash; | ||||||
|  | +	ret = dev_set_drvdata(&pdev->dev, mtd); | ||||||
|  | +	mtd->owner = THIS_MODULE; | ||||||
|  | +	if (ret) { | ||||||
|  | +		pr_err("adding private data failed\n"); | ||||||
|  | +		goto err_free_eraseregions; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	ret = mtd_device_parse_register(mtd, probes, NULL, NULL, 0); | ||||||
|  | + | ||||||
|  | +	if (ret) { | ||||||
|  | +		pr_err("mtd_device_register failed\n"); | ||||||
|  | +		goto err_free_eraseregions; | ||||||
|  | +	} | ||||||
|  | +	return 0; | ||||||
|  | + | ||||||
|  | +err_free_eraseregions: | ||||||
|  | +	kfree(eraseregions); | ||||||
|  | +err_free_mtd: | ||||||
|  | +	kfree(mtd); | ||||||
|  | +err_out: | ||||||
|  | +	return ret; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int __devexit bcm47xx_sflash_remove(struct platform_device *pdev) | ||||||
|  | +{ | ||||||
|  | +	struct mtd_info *mtd = dev_get_drvdata(&pdev->dev); | ||||||
|  | + | ||||||
|  | +	if (mtd) { | ||||||
|  | +		mtd_device_unregister(mtd); | ||||||
|  | +		map_destroy(mtd); | ||||||
|  | +		kfree(mtd->eraseregions); | ||||||
|  | +		kfree(mtd); | ||||||
|  | +		dev_set_drvdata(&pdev->dev, NULL); | ||||||
|  | +	} | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static struct platform_driver bcm47xx_sflash_driver = { | ||||||
|  | +	.remove = __devexit_p(bcm47xx_sflash_remove), | ||||||
|  | +	.driver = { | ||||||
|  | +		.name = "bcm47xx_sflash", | ||||||
|  | +		.owner = THIS_MODULE, | ||||||
|  | +	}, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static int __init init_bcm47xx_sflash(void) | ||||||
|  | +{ | ||||||
|  | +	int ret = platform_driver_probe(&bcm47xx_sflash_driver, bcm47xx_sflash_probe); | ||||||
|  | + | ||||||
|  | +	if (ret) | ||||||
|  | +		pr_err("error registering platform driver: %i\n", ret); | ||||||
|  | +	return ret; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void __exit exit_bcm47xx_sflash(void) | ||||||
|  | +{ | ||||||
|  | +	platform_driver_unregister(&bcm47xx_sflash_driver); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +module_init(init_bcm47xx_sflash); | ||||||
|  | +module_exit(exit_bcm47xx_sflash); | ||||||
|  | + | ||||||
|  | +MODULE_LICENSE("GPL"); | ||||||
|  | +MODULE_DESCRIPTION("BCM47XX parallel flash driver"); | ||||||
| @@ -0,0 +1,136 @@ | |||||||
|  | --- a/arch/mips/bcm47xx/Kconfig | ||||||
|  | +++ b/arch/mips/bcm47xx/Kconfig | ||||||
|  | @@ -9,6 +9,7 @@ config BCM47XX_SSB | ||||||
|  |  	select SSB_EMBEDDED | ||||||
|  |  	select SSB_B43_PCI_BRIDGE if PCI | ||||||
|  |  	select SSB_PCICORE_HOSTMODE if PCI | ||||||
|  | +	select SSB_SFLASH | ||||||
|  |  	default y | ||||||
|  |  	help | ||||||
|  |  	 Add support for old Broadcom BCM47xx boards with Sonics Silicon Backplane support. | ||||||
|  | @@ -22,6 +23,7 @@ config BCM47XX_BCMA | ||||||
|  |  	select BCMA_HOST_SOC | ||||||
|  |  	select BCMA_DRIVER_MIPS | ||||||
|  |  	select BCMA_DRIVER_PCI_HOSTMODE if PCI | ||||||
|  | +	select BCMA_SFLASH | ||||||
|  |  	default y | ||||||
|  |  	help | ||||||
|  |  	 Add support for new Broadcom BCM47xx boards with Broadcom specific Advanced Microcontroller Bus. | ||||||
|  | --- a/arch/mips/bcm47xx/setup.c | ||||||
|  | +++ b/arch/mips/bcm47xx/setup.c | ||||||
|  | @@ -31,10 +31,12 @@ | ||||||
|  |  #include <linux/ssb/ssb.h> | ||||||
|  |  #include <linux/ssb/ssb_embedded.h> | ||||||
|  |  #include <linux/bcma/bcma_soc.h> | ||||||
|  | +#include <linux/platform_device.h> | ||||||
|  |  #include <asm/bootinfo.h> | ||||||
|  |  #include <asm/reboot.h> | ||||||
|  |  #include <asm/time.h> | ||||||
|  |  #include <bcm47xx.h> | ||||||
|  | +#include <bus.h> | ||||||
|  |  #include <asm/mach-bcm47xx/nvram.h> | ||||||
|  |   | ||||||
|  |  union bcm47xx_bus bcm47xx_bus; | ||||||
|  | @@ -45,6 +47,32 @@ EXPORT_SYMBOL(bcm47xx_bus_type); | ||||||
|  |   | ||||||
|  |  struct bcm47xx_sflash bcm47xx_sflash; | ||||||
|  |   | ||||||
|  | +static struct resource bcm47xx_pflash_resource = { | ||||||
|  | +	.name	= "bcm47xx_pflash", | ||||||
|  | +	.start	= 0, | ||||||
|  | +	.end	= 0, | ||||||
|  | +	.flags  = 0, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static struct platform_device bcm47xx_pflash_dev = { | ||||||
|  | +	.name		= "bcm47xx_pflash", | ||||||
|  | +	.resource	= &bcm47xx_pflash_resource, | ||||||
|  | +	.num_resources	= 1, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static struct resource bcm47xx_sflash_resource = { | ||||||
|  | +	.name	= "bcm47xx_sflash", | ||||||
|  | +	.start	= 0, | ||||||
|  | +	.end	= 0, | ||||||
|  | +	.flags  = 0, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static struct platform_device bcm47xx_sflash_dev = { | ||||||
|  | +	.name		= "bcm47xx_sflash", | ||||||
|  | +	.resource	= &bcm47xx_sflash_resource, | ||||||
|  | +	.num_resources	= 1, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  |  static void bcm47xx_machine_restart(char *command) | ||||||
|  |  { | ||||||
|  |  	printk(KERN_ALERT "Please stand by while rebooting the system...\n"); | ||||||
|  | @@ -310,6 +338,24 @@ static void __init bcm47xx_register_ssb( | ||||||
|  |  		} | ||||||
|  |  	} | ||||||
|  |  } | ||||||
|  | + | ||||||
|  | +static int __init bcm47xx_register_flash_ssb(void) | ||||||
|  | +{ | ||||||
|  | +	struct ssb_chipcommon *chipco = &bcm47xx_bus.ssb.chipco; | ||||||
|  | + | ||||||
|  | +	switch (chipco->flash_type) { | ||||||
|  | +	case SSB_PFLASH: | ||||||
|  | +		bcm47xx_pflash_resource.start = chipco->pflash.window; | ||||||
|  | +		bcm47xx_pflash_resource.end = chipco->pflash.window + chipco->pflash.window_size; | ||||||
|  | +		return platform_device_register(&bcm47xx_pflash_dev); | ||||||
|  | +	case SSB_SFLASH: | ||||||
|  | +		bcm47xx_sflash_dev.dev.platform_data = &bcm47xx_sflash; | ||||||
|  | +		return platform_device_register(&bcm47xx_sflash_dev); | ||||||
|  | +	default: | ||||||
|  | +		printk(KERN_ERR "No flash device found\n"); | ||||||
|  | +		return -1; | ||||||
|  | +	} | ||||||
|  | +} | ||||||
|  |  #endif | ||||||
|  |   | ||||||
|  |  #ifdef CONFIG_BCM47XX_BCMA | ||||||
|  | @@ -324,6 +370,24 @@ static void __init bcm47xx_register_bcma | ||||||
|  |  	if (bcm47xx_bus.bcma.bus.drv_cc.flash_type == BCMA_SFLASH) | ||||||
|  |  		bcm47xx_sflash_struct_bcma_init(&bcm47xx_sflash, &bcm47xx_bus.bcma.bus.drv_cc); | ||||||
|  |  } | ||||||
|  | + | ||||||
|  | +static int __init bcm47xx_register_flash_bcma(void) | ||||||
|  | +{ | ||||||
|  | +	struct bcma_drv_cc *drv_cc = &bcm47xx_bus.bcma.bus.drv_cc; | ||||||
|  | + | ||||||
|  | +	switch (drv_cc->flash_type) { | ||||||
|  | +	case BCMA_PFLASH: | ||||||
|  | +		bcm47xx_pflash_resource.start = drv_cc->pflash.window; | ||||||
|  | +		bcm47xx_pflash_resource.end = drv_cc->pflash.window + drv_cc->pflash.window_size; | ||||||
|  | +		return platform_device_register(&bcm47xx_pflash_dev); | ||||||
|  | +	case BCMA_SFLASH: | ||||||
|  | +		bcm47xx_sflash_dev.dev.platform_data = &bcm47xx_sflash; | ||||||
|  | +		return platform_device_register(&bcm47xx_sflash_dev); | ||||||
|  | +	default: | ||||||
|  | +		printk(KERN_ERR "No flash device found\n"); | ||||||
|  | +		return -1; | ||||||
|  | +	} | ||||||
|  | +} | ||||||
|  |  #endif | ||||||
|  |   | ||||||
|  |  void __init plat_mem_setup(void) | ||||||
|  | @@ -366,3 +430,19 @@ static int __init bcm47xx_register_bus_c | ||||||
|  |  	return 0; | ||||||
|  |  } | ||||||
|  |  device_initcall(bcm47xx_register_bus_complete); | ||||||
|  | + | ||||||
|  | +static int __init bcm47xx_register_flash(void) | ||||||
|  | +{ | ||||||
|  | +	switch (bcm47xx_bus_type) { | ||||||
|  | +#ifdef CONFIG_BCM47XX_SSB | ||||||
|  | +	case BCM47XX_BUS_TYPE_SSB: | ||||||
|  | +		return bcm47xx_register_flash_ssb(); | ||||||
|  | +#endif | ||||||
|  | +#ifdef CONFIG_BCM47XX_BCMA | ||||||
|  | +	case BCM47XX_BUS_TYPE_BCMA: | ||||||
|  | +		return bcm47xx_register_flash_bcma(); | ||||||
|  | +#endif | ||||||
|  | +	} | ||||||
|  | +	return -1; | ||||||
|  | +} | ||||||
|  | +fs_initcall(bcm47xx_register_flash); | ||||||
| @@ -0,0 +1,138 @@ | |||||||
|  | --- a/arch/mips/bcm47xx/nvram.c | ||||||
|  | +++ b/arch/mips/bcm47xx/nvram.c | ||||||
|  | @@ -20,11 +20,12 @@ | ||||||
|  |  #include <asm/addrspace.h> | ||||||
|  |  #include <asm/mach-bcm47xx/nvram.h> | ||||||
|  |  #include <asm/mach-bcm47xx/bcm47xx.h> | ||||||
|  | +#include <asm/mach-bcm47xx/bus.h> | ||||||
|  |   | ||||||
|  |  static char nvram_buf[NVRAM_SPACE]; | ||||||
|  |   | ||||||
|  |  /* Probe for NVRAM header */ | ||||||
|  | -static void early_nvram_init(void) | ||||||
|  | +static void early_nvram_init_pflash(void) | ||||||
|  |  { | ||||||
|  |  #ifdef CONFIG_BCM47XX_SSB | ||||||
|  |  	struct ssb_chipcommon *ssb_cc; | ||||||
|  | @@ -50,9 +51,6 @@ static void early_nvram_init(void) | ||||||
|  |  #ifdef CONFIG_BCM47XX_BCMA | ||||||
|  |  	case BCM47XX_BUS_TYPE_BCMA: | ||||||
|  |  		bcma_cc = &bcm47xx_bus.bcma.bus.drv_cc; | ||||||
|  | -		if (bcma_cc->flash_type != BCMA_PFLASH) | ||||||
|  | -			return; | ||||||
|  | - | ||||||
|  |  		base = bcma_cc->pflash.window; | ||||||
|  |  		lim = bcma_cc->pflash.window_size; | ||||||
|  |  		break; | ||||||
|  | @@ -86,7 +84,110 @@ found: | ||||||
|  |  	for (i = 0; i < sizeof(struct nvram_header); i += 4) | ||||||
|  |  		*dst++ = *src++; | ||||||
|  |  	for (; i < header->len && i < NVRAM_SPACE; i += 4) | ||||||
|  | -		*dst++ = le32_to_cpu(*src++); | ||||||
|  | +		*dst++ = *src++; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int early_nvram_init_sflash(void) | ||||||
|  | +{ | ||||||
|  | +	struct nvram_header header; | ||||||
|  | +	u32 off; | ||||||
|  | +	int ret; | ||||||
|  | +	char *dst; | ||||||
|  | +	int len; | ||||||
|  | + | ||||||
|  | +	/* check if the struct is already initilized */ | ||||||
|  | +	if (!bcm47xx_sflash.size) | ||||||
|  | +		return -1; | ||||||
|  | + | ||||||
|  | +	off = FLASH_MIN; | ||||||
|  | +	while (off <= bcm47xx_sflash.size) { | ||||||
|  | +		ret = bcm47xx_sflash.read(&bcm47xx_sflash, off - NVRAM_SPACE, sizeof(header), (u8 *)&header); | ||||||
|  | +		if (ret != sizeof(header)) | ||||||
|  | +			return ret; | ||||||
|  | +		if (header.magic == NVRAM_HEADER) | ||||||
|  | +			goto found; | ||||||
|  | +		off <<= 1; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	off = FLASH_MIN; | ||||||
|  | +	while (off <= bcm47xx_sflash.size) { | ||||||
|  | +		ret = bcm47xx_sflash.read(&bcm47xx_sflash, off - (2 * NVRAM_SPACE), sizeof(header), (u8 *)&header); | ||||||
|  | +		if (ret != sizeof(header)) | ||||||
|  | +			return ret; | ||||||
|  | +		if (header.magic == NVRAM_HEADER) | ||||||
|  | +			goto found; | ||||||
|  | +		off <<= 1; | ||||||
|  | +	} | ||||||
|  | +	return -1; | ||||||
|  | + | ||||||
|  | +found: | ||||||
|  | +	len = NVRAM_SPACE; | ||||||
|  | +	dst = nvram_buf; | ||||||
|  | +	while (len) { | ||||||
|  | +		ret = bcm47xx_sflash.read(&bcm47xx_sflash, off - (2 * NVRAM_SPACE), len, dst); | ||||||
|  | +		if (ret < 0) | ||||||
|  | +			return ret; | ||||||
|  | +		off += ret; | ||||||
|  | +		len -= ret; | ||||||
|  | +		dst += ret; | ||||||
|  | +	} | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +#ifdef CONFIG_BCM47XX_SSB | ||||||
|  | +static void early_nvram_init_ssb(void) | ||||||
|  | +{ | ||||||
|  | +	int err; | ||||||
|  | + | ||||||
|  | +	switch (bcm47xx_bus.ssb.chipco.flash_type) { | ||||||
|  | +	case SSB_PFLASH: | ||||||
|  | +		early_nvram_init_pflash(); | ||||||
|  | +		break; | ||||||
|  | +	case SSB_SFLASH: | ||||||
|  | +		err = early_nvram_init_sflash(); | ||||||
|  | +		if (err < 0) | ||||||
|  | +			printk(KERN_WARNING "can not read from flash: %i\n", err); | ||||||
|  | +		break; | ||||||
|  | +	default: | ||||||
|  | +		printk(KERN_WARNING "unknow flash type\n"); | ||||||
|  | +	} | ||||||
|  | +} | ||||||
|  | +#endif | ||||||
|  | + | ||||||
|  | +#ifdef CONFIG_BCM47XX_BCMA | ||||||
|  | +static void early_nvram_init_bcma(void) | ||||||
|  | +{ | ||||||
|  | +	int err; | ||||||
|  | + | ||||||
|  | +	switch (bcm47xx_bus.bcma.bus.drv_cc.flash_type) { | ||||||
|  | +	case BCMA_PFLASH: | ||||||
|  | +		early_nvram_init_pflash(); | ||||||
|  | +		break; | ||||||
|  | +	case BCMA_SFLASH: | ||||||
|  | +		err = early_nvram_init_sflash(); | ||||||
|  | +		if (err < 0) | ||||||
|  | +			printk(KERN_WARNING "can not read from flash: %i\n", err); | ||||||
|  | +		break; | ||||||
|  | +	default: | ||||||
|  | +		printk(KERN_WARNING "unknow flash type\n"); | ||||||
|  | +	} | ||||||
|  | +} | ||||||
|  | +#endif | ||||||
|  | + | ||||||
|  | +static void early_nvram_init(void) | ||||||
|  | +{ | ||||||
|  | +	switch (bcm47xx_bus_type) { | ||||||
|  | +#ifdef CONFIG_BCM47XX_SSB | ||||||
|  | +	case BCM47XX_BUS_TYPE_SSB: | ||||||
|  | +		early_nvram_init_ssb(); | ||||||
|  | +		break; | ||||||
|  | +#endif | ||||||
|  | +#ifdef CONFIG_BCM47XX_BCMA | ||||||
|  | +	case BCM47XX_BUS_TYPE_BCMA: | ||||||
|  | +		early_nvram_init_bcma(); | ||||||
|  | +		break; | ||||||
|  | +#endif | ||||||
|  | +	} | ||||||
|  |  } | ||||||
|  |   | ||||||
|  |  int nvram_getenv(char *name, char *val, size_t val_len) | ||||||
							
								
								
									
										1157
									
								
								target/linux/brcm47xx/patches-3.3/030-bcm47xx-bcma-nandflash.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										1157
									
								
								target/linux/brcm47xx/patches-3.3/030-bcm47xx-bcma-nandflash.patch
									
									
									
									
									
										Normal file
									
								
							
										
											
												File diff suppressed because it is too large
												Load Diff
											
										
									
								
							| @@ -0,0 +1,76 @@ | |||||||
|  | --- a/arch/mips/pci/pci-bcm47xx.c | ||||||
|  | +++ b/arch/mips/pci/pci-bcm47xx.c | ||||||
|  | @@ -25,6 +25,7 @@ | ||||||
|  |  #include <linux/types.h> | ||||||
|  |  #include <linux/pci.h> | ||||||
|  |  #include <linux/ssb/ssb.h> | ||||||
|  | +#include <linux/bcma/bcma.h> | ||||||
|  |  #include <bcm47xx.h> | ||||||
|  |   | ||||||
|  |  int __init pcibios_map_irq(const struct pci_dev *dev, u8 slot, u8 pin) | ||||||
|  | @@ -32,15 +33,12 @@ int __init pcibios_map_irq(const struct | ||||||
|  |  	return 0; | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | -int pcibios_plat_dev_init(struct pci_dev *dev) | ||||||
|  | -{ | ||||||
|  |  #ifdef CONFIG_BCM47XX_SSB | ||||||
|  | +static int bcm47xx_pcibios_plat_dev_init_ssb(struct pci_dev *dev) | ||||||
|  | +{ | ||||||
|  |  	int res; | ||||||
|  |  	u8 slot, pin; | ||||||
|  |   | ||||||
|  | -	if (bcm47xx_bus_type !=  BCM47XX_BUS_TYPE_SSB) | ||||||
|  | -		return 0; | ||||||
|  | - | ||||||
|  |  	res = ssb_pcibios_plat_dev_init(dev); | ||||||
|  |  	if (res < 0) { | ||||||
|  |  		printk(KERN_ALERT "PCI: Failed to init device %s\n", | ||||||
|  | @@ -60,6 +58,47 @@ int pcibios_plat_dev_init(struct pci_dev | ||||||
|  |  	} | ||||||
|  |   | ||||||
|  |  	dev->irq = res; | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  |  #endif | ||||||
|  | + | ||||||
|  | +#ifdef CONFIG_BCM47XX_BCMA | ||||||
|  | +static int bcm47xx_pcibios_plat_dev_init_bcma(struct pci_dev *dev) | ||||||
|  | +{ | ||||||
|  | +	int res; | ||||||
|  | + | ||||||
|  | +	res = bcma_core_pci_plat_dev_init(dev); | ||||||
|  | +	if (res < 0) { | ||||||
|  | +		printk(KERN_ALERT "PCI: Failed to init device %s\n", | ||||||
|  | +		       pci_name(dev)); | ||||||
|  | +		return res; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	res = bcma_core_pci_pcibios_map_irq(dev); | ||||||
|  | + | ||||||
|  | +	/* IRQ-0 and IRQ-1 are software interrupts. */ | ||||||
|  | +	if (res < 2) { | ||||||
|  | +		printk(KERN_ALERT "PCI: Failed to map IRQ of device %s\n", | ||||||
|  | +		       pci_name(dev)); | ||||||
|  | +		return res; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	dev->irq = res; | ||||||
|  |  	return 0; | ||||||
|  |  } | ||||||
|  | +#endif | ||||||
|  | + | ||||||
|  | +int pcibios_plat_dev_init(struct pci_dev *dev) | ||||||
|  | +{ | ||||||
|  | +#ifdef CONFIG_BCM47XX_SSB | ||||||
|  | +	if (bcm47xx_bus_type ==  BCM47XX_BUS_TYPE_SSB) | ||||||
|  | +		return bcm47xx_pcibios_plat_dev_init_ssb(dev); | ||||||
|  | +	else | ||||||
|  | +#endif | ||||||
|  | +#ifdef CONFIG_BCM47XX_BCMA | ||||||
|  | +	if  (bcm47xx_bus_type ==  BCM47XX_BUS_TYPE_BCMA) | ||||||
|  | +		return bcm47xx_pcibios_plat_dev_init_bcma(dev); | ||||||
|  | +	else | ||||||
|  | +#endif | ||||||
|  | +		return 0; | ||||||
|  | +} | ||||||
| @@ -0,0 +1,24 @@ | |||||||
|  | From 699c57a18b40ffbe1763915acdc1a3e4fb539d01 Mon Sep 17 00:00:00 2001 | ||||||
|  | From: Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | Date: Fri, 13 Jan 2012 17:42:15 +0100 | ||||||
|  | Subject: [PATCH 29/32] bcma: add new PCI ID | ||||||
|  |  | ||||||
|  | This ID was found on the PCIe wireless card on the board of a Netgear | ||||||
|  | WNDR3400 using a bcm4716. The device with this ID is identified by b43 | ||||||
|  | as "Broadcom 43224 WLAN". | ||||||
|  |  | ||||||
|  | Signed-off-by: Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | --- | ||||||
|  |  drivers/bcma/host_pci.c |    1 + | ||||||
|  |  1 files changed, 1 insertions(+), 0 deletions(-) | ||||||
|  |  | ||||||
|  | --- a/drivers/bcma/host_pci.c | ||||||
|  | +++ b/drivers/bcma/host_pci.c | ||||||
|  | @@ -269,6 +269,7 @@ static DEFINE_PCI_DEVICE_TABLE(bcma_pci_ | ||||||
|  |  	{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4353) }, | ||||||
|  |  	{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4357) }, | ||||||
|  |  	{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4727) }, | ||||||
|  | +	{ PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0xa8d8) }, | ||||||
|  |  	{ 0, }, | ||||||
|  |  }; | ||||||
|  |  MODULE_DEVICE_TABLE(pci, bcma_pci_bridge_tbl); | ||||||
| @@ -0,0 +1,47 @@ | |||||||
|  | From f6e41db3ee7ead99e1398def222c14893fc265de Mon Sep 17 00:00:00 2001 | ||||||
|  | From: Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | Date: Thu, 4 Aug 2011 21:09:48 +0200 | ||||||
|  | Subject: [PATCH 26/26] bcma: export needed gpio functions | ||||||
|  |  | ||||||
|  |  | ||||||
|  | Signed-off-by: Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | --- | ||||||
|  |  drivers/bcma/driver_chipcommon.c |    5 +++++ | ||||||
|  |  1 files changed, 5 insertions(+), 0 deletions(-) | ||||||
|  |  | ||||||
|  | --- a/drivers/bcma/driver_chipcommon.c | ||||||
|  | +++ b/drivers/bcma/driver_chipcommon.c | ||||||
|  | @@ -81,16 +81,19 @@ u32 bcma_chipco_gpio_in(struct bcma_drv_ | ||||||
|  |  { | ||||||
|  |  	return bcma_cc_read32(cc, BCMA_CC_GPIOIN) & mask; | ||||||
|  |  } | ||||||
|  | +EXPORT_SYMBOL_GPL(bcma_chipco_gpio_in); | ||||||
|  |   | ||||||
|  |  u32 bcma_chipco_gpio_out(struct bcma_drv_cc *cc, u32 mask, u32 value) | ||||||
|  |  { | ||||||
|  |  	return bcma_cc_write32_masked(cc, BCMA_CC_GPIOOUT, mask, value); | ||||||
|  |  } | ||||||
|  | +EXPORT_SYMBOL_GPL(bcma_chipco_gpio_out); | ||||||
|  |   | ||||||
|  |  u32 bcma_chipco_gpio_outen(struct bcma_drv_cc *cc, u32 mask, u32 value) | ||||||
|  |  { | ||||||
|  |  	return bcma_cc_write32_masked(cc, BCMA_CC_GPIOOUTEN, mask, value); | ||||||
|  |  } | ||||||
|  | +EXPORT_SYMBOL_GPL(bcma_chipco_gpio_outen); | ||||||
|  |   | ||||||
|  |  u32 bcma_chipco_gpio_control(struct bcma_drv_cc *cc, u32 mask, u32 value) | ||||||
|  |  { | ||||||
|  | @@ -102,11 +105,13 @@ u32 bcma_chipco_gpio_intmask(struct bcma | ||||||
|  |  { | ||||||
|  |  	return bcma_cc_write32_masked(cc, BCMA_CC_GPIOIRQ, mask, value); | ||||||
|  |  } | ||||||
|  | +EXPORT_SYMBOL_GPL(bcma_chipco_gpio_intmask); | ||||||
|  |   | ||||||
|  |  u32 bcma_chipco_gpio_polarity(struct bcma_drv_cc *cc, u32 mask, u32 value) | ||||||
|  |  { | ||||||
|  |  	return bcma_cc_write32_masked(cc, BCMA_CC_GPIOPOL, mask, value); | ||||||
|  |  } | ||||||
|  | +EXPORT_SYMBOL_GPL(bcma_chipco_gpio_polarity); | ||||||
|  |   | ||||||
|  |  #ifdef CONFIG_BCMA_DRIVER_MIPS | ||||||
|  |  void bcma_chipco_serial_init(struct bcma_drv_cc *cc) | ||||||
| @@ -0,0 +1,52 @@ | |||||||
|  | From efe89df0326b777563d197b8cf1c25209a31ceb0 Mon Sep 17 00:00:00 2001 | ||||||
|  | From: Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | Date: Sat, 21 Jan 2012 18:47:42 +0100 | ||||||
|  | Subject: [PATCH 32/34] bcma: complete workaround for BCMA43224 | ||||||
|  |  | ||||||
|  |  | ||||||
|  | Signed-off-by: Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | --- | ||||||
|  |  drivers/bcma/driver_chipcommon_pmu.c        |   15 +++++++++++---- | ||||||
|  |  include/linux/bcma/bcma_driver_chipcommon.h |    5 +++++ | ||||||
|  |  2 files changed, 16 insertions(+), 4 deletions(-) | ||||||
|  |  | ||||||
|  | --- a/drivers/bcma/driver_chipcommon_pmu.c | ||||||
|  | +++ b/drivers/bcma/driver_chipcommon_pmu.c | ||||||
|  | @@ -142,12 +142,19 @@ void bcma_pmu_workarounds(struct bcma_dr | ||||||
|  |  		/* BCM4331 workaround is SPROM-related, we put it in sprom.c */ | ||||||
|  |  		break; | ||||||
|  |  	case 43224: | ||||||
|  | +	case 43421: | ||||||
|  | +		/* enable 12 mA drive strenth for 43224 and set chipControl register bit 15 */ | ||||||
|  |  		if (bus->chipinfo.rev == 0) { | ||||||
|  | -			pr_err("Workarounds for 43224 rev 0 not fully " | ||||||
|  | -				"implemented\n"); | ||||||
|  | -			bcma_chipco_chipctl_maskset(cc, 0, ~0, 0x00F000F0); | ||||||
|  | +			bcma_cc_maskset32(cc, BCMA_CC_CHIPCTL, | ||||||
|  | +					  BCMA_CCTRL_43224_GPIO_TOGGLE, | ||||||
|  | +					  BCMA_CCTRL_43224_GPIO_TOGGLE); | ||||||
|  | +			bcma_chipco_chipctl_maskset(cc, 0, | ||||||
|  | +					 BCMA_CCTRL_43224A0_12MA_LED_DRIVE, | ||||||
|  | +					 BCMA_CCTRL_43224A0_12MA_LED_DRIVE); | ||||||
|  |  		} else { | ||||||
|  | -			bcma_chipco_chipctl_maskset(cc, 0, ~0, 0xF0); | ||||||
|  | +			bcma_chipco_chipctl_maskset(cc, 0, | ||||||
|  | +					BCMA_CCTRL_43224B0_12MA_LED_DRIVE, | ||||||
|  | +					BCMA_CCTRL_43224B0_12MA_LED_DRIVE); | ||||||
|  |  		} | ||||||
|  |  		break; | ||||||
|  |  	case 43225: | ||||||
|  | --- a/include/linux/bcma/bcma_driver_chipcommon.h | ||||||
|  | +++ b/include/linux/bcma/bcma_driver_chipcommon.h | ||||||
|  | @@ -382,6 +382,11 @@ | ||||||
|  |  #define BCMA_CHIPCTL_4331_BT_SHD0_ON_GPIO4	BIT(16)	/* enable bt_shd0 at gpio4 */ | ||||||
|  |  #define BCMA_CHIPCTL_4331_BT_SHD1_ON_GPIO5	BIT(17)	/* enable bt_shd1 at gpio5 */ | ||||||
|  |   | ||||||
|  | +/* 43224 chip-specific ChipControl register bits */ | ||||||
|  | +#define BCMA_CCTRL_43224_GPIO_TOGGLE		0x8000 /* gpio[3:0] pins as btcoex or s/w gpio */ | ||||||
|  | +#define BCMA_CCTRL_43224A0_12MA_LED_DRIVE	0x00F000F0 /* 12 mA drive strength */ | ||||||
|  | +#define BCMA_CCTRL_43224B0_12MA_LED_DRIVE	0xF0    /* 12 mA drive strength for later 43224s */ | ||||||
|  | + | ||||||
|  |  #define	BCMA_FLASH2			0x1c000000	/* Flash Region 2 (region 1 shadowed here) */ | ||||||
|  |  #define	BCMA_FLASH2_SZ			0x02000000	/* Size of Flash Region 2 */ | ||||||
|  |  #define	BCMA_FLASH1			0x1fc00000	/* MIPS Flash Region 1 */ | ||||||
| @@ -0,0 +1,24 @@ | |||||||
|  | --- a/drivers/bcma/sprom.c | ||||||
|  | +++ b/drivers/bcma/sprom.c | ||||||
|  | @@ -404,16 +404,19 @@ int bcma_sprom_get(struct bcma_bus *bus) | ||||||
|  |  		return -EOPNOTSUPP; | ||||||
|  |   | ||||||
|  |  	if (!bcma_sprom_ext_available(bus)) { | ||||||
|  | +		bool sprom_onchip; | ||||||
|  | + | ||||||
|  |  		/* | ||||||
|  |  		 * External SPROM takes precedence so check | ||||||
|  |  		 * on-chip OTP only when no external SPROM | ||||||
|  |  		 * is present. | ||||||
|  |  		 */ | ||||||
|  | -		if (bcma_sprom_onchip_available(bus)) { | ||||||
|  | +		sprom_onchip = bcma_sprom_onchip_available(bus); | ||||||
|  | +		if (sprom_onchip) { | ||||||
|  |  			/* determine offset */ | ||||||
|  |  			offset = bcma_sprom_onchip_offset(bus); | ||||||
|  |  		} | ||||||
|  | -		if (!offset) { | ||||||
|  | +		if (!offset || !sprom_onchip) { | ||||||
|  |  			/* | ||||||
|  |  			 * Maybe there is no SPROM on the device? | ||||||
|  |  			 * Now we ask the arch code if there is some sprom | ||||||
| @@ -0,0 +1,69 @@ | |||||||
|  | From 9be402f069cc259ad5795b77567d66c4e7f6bef6 Mon Sep 17 00:00:00 2001 | ||||||
|  | From: Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | Date: Sun, 18 Jul 2010 14:59:24 +0200 | ||||||
|  | Subject: [PATCH 4/6] MIPS: BCM47xx: Setup and register serial early | ||||||
|  |  | ||||||
|  | Swap the first and second serial if console=ttyS1 was set. | ||||||
|  | Set it up and register it for early serial support. | ||||||
|  |  | ||||||
|  | This patch has been in OpenWRT for a long time. | ||||||
|  |  | ||||||
|  | Signed-off-by: Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | --- | ||||||
|  |  arch/mips/bcm47xx/setup.c |   39 ++++++++++++++++++++++++++++++++++++++- | ||||||
|  |  1 files changed, 38 insertions(+), 1 deletions(-) | ||||||
|  |  | ||||||
|  | --- a/arch/mips/bcm47xx/setup.c | ||||||
|  | +++ b/arch/mips/bcm47xx/setup.c | ||||||
|  | @@ -33,6 +33,8 @@ | ||||||
|  |  #include <linux/ssb/ssb_embedded.h> | ||||||
|  |  #include <linux/bcma/bcma_soc.h> | ||||||
|  |  #include <linux/platform_device.h> | ||||||
|  | +#include <linux/serial.h> | ||||||
|  | +#include <linux/serial_8250.h> | ||||||
|  |  #include <asm/bootinfo.h> | ||||||
|  |  #include <asm/reboot.h> | ||||||
|  |  #include <asm/time.h> | ||||||
|  | @@ -320,6 +322,31 @@ static int bcm47xx_get_invariants(struct | ||||||
|  |  	return 0; | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | +#ifdef CONFIG_SERIAL_8250 | ||||||
|  | +static void __init bcm47xx_early_serial_setup(struct ssb_mipscore *mcore) | ||||||
|  | +{ | ||||||
|  | +	int i; | ||||||
|  | + | ||||||
|  | +	for (i = 0; i < mcore->nr_serial_ports; i++) { | ||||||
|  | +		struct ssb_serial_port *port = &(mcore->serial_ports[i]); | ||||||
|  | +		struct uart_port s; | ||||||
|  | + | ||||||
|  | +		memset(&s, 0, sizeof(s)); | ||||||
|  | +		s.line = i; | ||||||
|  | +		s.mapbase = (unsigned int) port->regs; | ||||||
|  | +		s.membase = port->regs; | ||||||
|  | +		s.irq = port->irq + 2; | ||||||
|  | +		s.uartclk = port->baud_base; | ||||||
|  | +		s.flags = UPF_BOOT_AUTOCONF | UPF_SHARE_IRQ; | ||||||
|  | +		s.iotype = SERIAL_IO_MEM; | ||||||
|  | +		s.regshift = port->reg_shift; | ||||||
|  | + | ||||||
|  | +		early_serial_setup(&s); | ||||||
|  | +	} | ||||||
|  | +	printk(KERN_DEBUG "Serial init done.\n"); | ||||||
|  | +} | ||||||
|  | +#endif | ||||||
|  | + | ||||||
|  |  static void __init bcm47xx_register_ssb(void) | ||||||
|  |  { | ||||||
|  |  	int err; | ||||||
|  | @@ -352,6 +379,10 @@ static void __init bcm47xx_register_ssb( | ||||||
|  |  			memcpy(&mcore->serial_ports[1], &port, sizeof(port)); | ||||||
|  |  		} | ||||||
|  |  	} | ||||||
|  | + | ||||||
|  | +#ifdef CONFIG_SERIAL_8250 | ||||||
|  | +	bcm47xx_early_serial_setup(mcore); | ||||||
|  | +#endif | ||||||
|  |  } | ||||||
|  |   | ||||||
|  |  static int __init bcm47xx_register_flash_ssb(void) | ||||||
| @@ -0,0 +1,141 @@ | |||||||
|  | From 5219981646071abb6731634bf47781a53e248764 Mon Sep 17 00:00:00 2001 | ||||||
|  | From: Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | Date: Sun, 18 Jul 2010 15:11:26 +0200 | ||||||
|  | Subject: [PATCH 6/6] MIPS: BCM47xx: Remove CFE console | ||||||
|  |  | ||||||
|  | Do not use the CFE console. It causes hangs on some devices like the | ||||||
|  | Buffalo WHR-HP-G54. | ||||||
|  | This was reported in https://dev.openwrt.org/ticket/4061 and | ||||||
|  | https://forum.openwrt.org/viewtopic.php?id=17063 | ||||||
|  |  | ||||||
|  | Signed-off-by: Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | --- | ||||||
|  |  arch/mips/Kconfig        |    1 - | ||||||
|  |  arch/mips/bcm47xx/prom.c |   82 +++------------------------------------------ | ||||||
|  |  2 files changed, 6 insertions(+), 77 deletions(-) | ||||||
|  |  | ||||||
|  | --- a/arch/mips/Kconfig | ||||||
|  | +++ b/arch/mips/Kconfig | ||||||
|  | @@ -100,7 +100,6 @@ config BCM47XX | ||||||
|  |  	select SYS_SUPPORTS_32BIT_KERNEL | ||||||
|  |  	select SYS_SUPPORTS_LITTLE_ENDIAN | ||||||
|  |  	select GENERIC_GPIO | ||||||
|  | -	select SYS_HAS_EARLY_PRINTK | ||||||
|  |  	select CFE | ||||||
|  |  	help | ||||||
|  |  	 Support for BCM47XX based boards | ||||||
|  | --- a/arch/mips/bcm47xx/prom.c | ||||||
|  | +++ b/arch/mips/bcm47xx/prom.c | ||||||
|  | @@ -31,96 +31,28 @@ | ||||||
|  |  #include <asm/fw/cfe/cfe_api.h> | ||||||
|  |  #include <asm/fw/cfe/cfe_error.h> | ||||||
|  |   | ||||||
|  | -static int cfe_cons_handle; | ||||||
|  | - | ||||||
|  |  const char *get_system_type(void) | ||||||
|  |  { | ||||||
|  |  	return "Broadcom BCM47XX"; | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | -void prom_putchar(char c) | ||||||
|  | -{ | ||||||
|  | -	while (cfe_write(cfe_cons_handle, &c, 1) == 0) | ||||||
|  | -		; | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -static __init void prom_init_cfe(void) | ||||||
|  | +static __init int prom_init_cfe(void) | ||||||
|  |  { | ||||||
|  |  	uint32_t cfe_ept; | ||||||
|  |  	uint32_t cfe_handle; | ||||||
|  |  	uint32_t cfe_eptseal; | ||||||
|  | -	int argc = fw_arg0; | ||||||
|  | -	char **envp = (char **) fw_arg2; | ||||||
|  | -	int *prom_vec = (int *) fw_arg3; | ||||||
|  | - | ||||||
|  | -	/* | ||||||
|  | -	 * Check if a loader was used; if NOT, the 4 arguments are | ||||||
|  | -	 * what CFE gives us (handle, 0, EPT and EPTSEAL) | ||||||
|  | -	 */ | ||||||
|  | -	if (argc < 0) { | ||||||
|  | -		cfe_handle = (uint32_t)argc; | ||||||
|  | -		cfe_ept = (uint32_t)envp; | ||||||
|  | -		cfe_eptseal = (uint32_t)prom_vec; | ||||||
|  | -	} else { | ||||||
|  | -		if ((int)prom_vec < 0) { | ||||||
|  | -			/* | ||||||
|  | -			 * Old loader; all it gives us is the handle, | ||||||
|  | -			 * so use the "known" entrypoint and assume | ||||||
|  | -			 * the seal. | ||||||
|  | -			 */ | ||||||
|  | -			cfe_handle = (uint32_t)prom_vec; | ||||||
|  | -			cfe_ept = 0xBFC00500; | ||||||
|  | -			cfe_eptseal = CFE_EPTSEAL; | ||||||
|  | -		} else { | ||||||
|  | -			/* | ||||||
|  | -			 * Newer loaders bundle the handle/ept/eptseal | ||||||
|  | -			 * Note: prom_vec is in the loader's useg | ||||||
|  | -			 * which is still alive in the TLB. | ||||||
|  | -			 */ | ||||||
|  | -			cfe_handle = prom_vec[0]; | ||||||
|  | -			cfe_ept = prom_vec[2]; | ||||||
|  | -			cfe_eptseal = prom_vec[3]; | ||||||
|  | -		} | ||||||
|  | -	} | ||||||
|  | + | ||||||
|  | +	cfe_eptseal = (uint32_t) fw_arg3; | ||||||
|  | +	cfe_handle = (uint32_t) fw_arg0; | ||||||
|  | +	cfe_ept = (uint32_t) fw_arg2; | ||||||
|  |   | ||||||
|  |  	if (cfe_eptseal != CFE_EPTSEAL) { | ||||||
|  | -		/* too early for panic to do any good */ | ||||||
|  |  		printk(KERN_ERR "CFE's entrypoint seal doesn't match."); | ||||||
|  | -		while (1) ; | ||||||
|  | +		return -1; | ||||||
|  |  	} | ||||||
|  |   | ||||||
|  |  	cfe_init(cfe_handle, cfe_ept); | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -static __init void prom_init_console(void) | ||||||
|  | -{ | ||||||
|  | -	/* Initialize CFE console */ | ||||||
|  | -	cfe_cons_handle = cfe_getstdhandle(CFE_STDHANDLE_CONSOLE); | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -static __init void prom_init_cmdline(void) | ||||||
|  | -{ | ||||||
|  | -	static char buf[COMMAND_LINE_SIZE] __initdata; | ||||||
|  | - | ||||||
|  | -	/* Get the kernel command line from CFE */ | ||||||
|  | -	if (cfe_getenv("LINUX_CMDLINE", buf, COMMAND_LINE_SIZE) >= 0) { | ||||||
|  | -		buf[COMMAND_LINE_SIZE - 1] = 0; | ||||||
|  | -		strcpy(arcs_cmdline, buf); | ||||||
|  | -	} | ||||||
|  | - | ||||||
|  | -	/* Force a console handover by adding a console= argument if needed, | ||||||
|  | -	 * as CFE is not available anymore later in the boot process. */ | ||||||
|  | -	if ((strstr(arcs_cmdline, "console=")) == NULL) { | ||||||
|  | -		/* Try to read the default serial port used by CFE */ | ||||||
|  | -		if ((cfe_getenv("BOOT_CONSOLE", buf, COMMAND_LINE_SIZE) < 0) | ||||||
|  | -		    || (strncmp("uart", buf, 4))) | ||||||
|  | -			/* Default to uart0 */ | ||||||
|  | -			strcpy(buf, "uart0"); | ||||||
|  | - | ||||||
|  | -		/* Compute the new command line */ | ||||||
|  | -		snprintf(arcs_cmdline, COMMAND_LINE_SIZE, "%s console=ttyS%c,115200", | ||||||
|  | -			 arcs_cmdline, buf[4]); | ||||||
|  | -	} | ||||||
|  | +	return 0; | ||||||
|  |  } | ||||||
|  |   | ||||||
|  |  static __init void prom_init_mem(void) | ||||||
|  | @@ -161,8 +93,6 @@ static __init void prom_init_mem(void) | ||||||
|  |  void __init prom_init(void) | ||||||
|  |  { | ||||||
|  |  	prom_init_cfe(); | ||||||
|  | -	prom_init_console(); | ||||||
|  | -	prom_init_cmdline(); | ||||||
|  |  	prom_init_mem(); | ||||||
|  |  } | ||||||
|  |   | ||||||
							
								
								
									
										42
									
								
								target/linux/brcm47xx/patches-3.3/119-fix-boot.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										42
									
								
								target/linux/brcm47xx/patches-3.3/119-fix-boot.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,42 @@ | |||||||
|  | --- a/arch/mips/kernel/head.S | ||||||
|  | +++ b/arch/mips/kernel/head.S | ||||||
|  | @@ -121,14 +121,6 @@ | ||||||
|  |  #endif | ||||||
|  |  	.endm | ||||||
|  |   | ||||||
|  | -#ifndef CONFIG_NO_EXCEPT_FILL | ||||||
|  | -	/* | ||||||
|  | -	 * Reserved space for exception handlers. | ||||||
|  | -	 * Necessary for machines which link their kernels at KSEG0. | ||||||
|  | -	 */ | ||||||
|  | -	.fill	0x400 | ||||||
|  | -#endif | ||||||
|  | - | ||||||
|  |  EXPORT(_stext) | ||||||
|  |   | ||||||
|  |  #ifdef CONFIG_BOOT_RAW | ||||||
|  | @@ -141,6 +133,14 @@ FEXPORT(__kernel_entry) | ||||||
|  |  	j	kernel_entry | ||||||
|  |  #endif | ||||||
|  |   | ||||||
|  | +#ifndef CONFIG_NO_EXCEPT_FILL | ||||||
|  | +	/* | ||||||
|  | +	 * Reserved space for exception handlers. | ||||||
|  | +	 * Necessary for machines which link their kernels at KSEG0. | ||||||
|  | +	 */ | ||||||
|  | +	.fill	0x400 | ||||||
|  | +#endif | ||||||
|  | + | ||||||
|  |  #ifdef CONFIG_IMAGE_CMDLINE_HACK | ||||||
|  |  	.ascii	"CMDLINE:" | ||||||
|  |  EXPORT(__image_cmdline) | ||||||
|  | --- a/arch/mips/Kconfig | ||||||
|  | +++ b/arch/mips/Kconfig | ||||||
|  | @@ -92,6 +92,7 @@ config ATH79 | ||||||
|  |   | ||||||
|  |  config BCM47XX | ||||||
|  |  	bool "Broadcom BCM47XX based boards" | ||||||
|  | +	select BOOT_RAW | ||||||
|  |  	select CEVT_R4K | ||||||
|  |  	select CSRC_R4K | ||||||
|  |  	select DMA_NONCOHERENT | ||||||
| @@ -0,0 +1,12 @@ | |||||||
|  | --- a/arch/mips/include/asm/mach-bcm47xx/gpio.h | ||||||
|  | +++ b/arch/mips/include/asm/mach-bcm47xx/gpio.h | ||||||
|  | @@ -151,5 +151,9 @@ static inline int gpio_polarity(unsigned | ||||||
|  |  	return -EINVAL; | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | +static inline int gpio_set_debounce(unsigned gpio, unsigned debounce) | ||||||
|  | +{ | ||||||
|  | +	return -ENOSYS; | ||||||
|  | +} | ||||||
|  |   | ||||||
|  |  #endif /* __BCM47XX_GPIO_H */ | ||||||
							
								
								
									
										367
									
								
								target/linux/brcm47xx/patches-3.3/150-cpu_fixes.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										367
									
								
								target/linux/brcm47xx/patches-3.3/150-cpu_fixes.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,367 @@ | |||||||
|  | --- a/arch/mips/include/asm/r4kcache.h | ||||||
|  | +++ b/arch/mips/include/asm/r4kcache.h | ||||||
|  | @@ -17,6 +17,20 @@ | ||||||
|  |  #include <asm/cpu-features.h> | ||||||
|  |  #include <asm/mipsmtregs.h> | ||||||
|  |   | ||||||
|  | +#ifdef CONFIG_BCM47XX | ||||||
|  | +#include <asm/paccess.h> | ||||||
|  | +#include <linux/ssb/ssb.h> | ||||||
|  | +#define BCM4710_DUMMY_RREG() ((void) *((u8 *) KSEG1ADDR(SSB_ENUM_BASE))) | ||||||
|  | + | ||||||
|  | +#define BCM4710_FILL_TLB(addr) (*(volatile unsigned long *)(addr)) | ||||||
|  | +#define BCM4710_PROTECTED_FILL_TLB(addr) ({ unsigned long x; get_dbe(x, (volatile unsigned long *)(addr)); }) | ||||||
|  | +#else | ||||||
|  | +#define BCM4710_DUMMY_RREG() | ||||||
|  | + | ||||||
|  | +#define BCM4710_FILL_TLB(addr) | ||||||
|  | +#define BCM4710_PROTECTED_FILL_TLB(addr) | ||||||
|  | +#endif | ||||||
|  | + | ||||||
|  |  /* | ||||||
|  |   * This macro return a properly sign-extended address suitable as base address | ||||||
|  |   * for indexed cache operations.  Two issues here: | ||||||
|  | @@ -150,6 +164,7 @@ static inline void flush_icache_line_ind | ||||||
|  |  static inline void flush_dcache_line_indexed(unsigned long addr) | ||||||
|  |  { | ||||||
|  |  	__dflush_prologue | ||||||
|  | +	BCM4710_DUMMY_RREG(); | ||||||
|  |  	cache_op(Index_Writeback_Inv_D, addr); | ||||||
|  |  	__dflush_epilogue | ||||||
|  |  } | ||||||
|  | @@ -169,6 +184,7 @@ static inline void flush_icache_line(uns | ||||||
|  |  static inline void flush_dcache_line(unsigned long addr) | ||||||
|  |  { | ||||||
|  |  	__dflush_prologue | ||||||
|  | +	BCM4710_DUMMY_RREG(); | ||||||
|  |  	cache_op(Hit_Writeback_Inv_D, addr); | ||||||
|  |  	__dflush_epilogue | ||||||
|  |  } | ||||||
|  | @@ -176,6 +192,7 @@ static inline void flush_dcache_line(uns | ||||||
|  |  static inline void invalidate_dcache_line(unsigned long addr) | ||||||
|  |  { | ||||||
|  |  	__dflush_prologue | ||||||
|  | +	BCM4710_DUMMY_RREG(); | ||||||
|  |  	cache_op(Hit_Invalidate_D, addr); | ||||||
|  |  	__dflush_epilogue | ||||||
|  |  } | ||||||
|  | @@ -208,6 +225,7 @@ static inline void flush_scache_line(uns | ||||||
|  |   */ | ||||||
|  |  static inline void protected_flush_icache_line(unsigned long addr) | ||||||
|  |  { | ||||||
|  | +	BCM4710_DUMMY_RREG(); | ||||||
|  |  	protected_cache_op(Hit_Invalidate_I, addr); | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | @@ -219,6 +237,7 @@ static inline void protected_flush_icach | ||||||
|  |   */ | ||||||
|  |  static inline void protected_writeback_dcache_line(unsigned long addr) | ||||||
|  |  { | ||||||
|  | +	BCM4710_DUMMY_RREG(); | ||||||
|  |  	protected_cache_op(Hit_Writeback_Inv_D, addr); | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | @@ -339,8 +358,52 @@ static inline void invalidate_tcache_pag | ||||||
|  |  		: "r" (base),						\ | ||||||
|  |  		  "i" (op)); | ||||||
|  |   | ||||||
|  | +static inline void blast_dcache(void) | ||||||
|  | +{ | ||||||
|  | +	unsigned long start = KSEG0; | ||||||
|  | +	unsigned long dcache_size = current_cpu_data.dcache.waysize * current_cpu_data.dcache.ways; | ||||||
|  | +	unsigned long end = (start + dcache_size); | ||||||
|  | + | ||||||
|  | +	do { | ||||||
|  | +		BCM4710_DUMMY_RREG(); | ||||||
|  | +		cache_op(Index_Writeback_Inv_D, start); | ||||||
|  | +		start += current_cpu_data.dcache.linesz; | ||||||
|  | +	} while(start < end); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static inline void blast_dcache_page(unsigned long page) | ||||||
|  | +{ | ||||||
|  | +	unsigned long start = page; | ||||||
|  | +	unsigned long end = start + PAGE_SIZE; | ||||||
|  | + | ||||||
|  | +	BCM4710_FILL_TLB(start); | ||||||
|  | +	do { | ||||||
|  | +		BCM4710_DUMMY_RREG(); | ||||||
|  | +		cache_op(Hit_Writeback_Inv_D, start); | ||||||
|  | +		start += current_cpu_data.dcache.linesz; | ||||||
|  | +	} while(start < end); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static inline void blast_dcache_page_indexed(unsigned long page) | ||||||
|  | +{ | ||||||
|  | +	unsigned long start = page; | ||||||
|  | +	unsigned long end = start + PAGE_SIZE; | ||||||
|  | +	unsigned long ws_inc = 1UL << current_cpu_data.dcache.waybit; | ||||||
|  | +	unsigned long ws_end = current_cpu_data.dcache.ways << | ||||||
|  | +	                       current_cpu_data.dcache.waybit; | ||||||
|  | +	unsigned long ws, addr; | ||||||
|  | +	for (ws = 0; ws < ws_end; ws += ws_inc) { | ||||||
|  | +		start = page + ws; | ||||||
|  | +		for (addr = start; addr < end; addr += current_cpu_data.dcache.linesz) { | ||||||
|  | +			BCM4710_DUMMY_RREG(); | ||||||
|  | +			cache_op(Index_Writeback_Inv_D, addr); | ||||||
|  | +		} | ||||||
|  | +	} | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | + | ||||||
|  |  /* build blast_xxx, blast_xxx_page, blast_xxx_page_indexed */ | ||||||
|  | -#define __BUILD_BLAST_CACHE(pfx, desc, indexop, hitop, lsize) \ | ||||||
|  | +#define __BUILD_BLAST_CACHE(pfx, desc, indexop, hitop, lsize, war) \ | ||||||
|  |  static inline void blast_##pfx##cache##lsize(void)			\ | ||||||
|  |  {									\ | ||||||
|  |  	unsigned long start = INDEX_BASE;				\ | ||||||
|  | @@ -352,6 +415,7 @@ static inline void blast_##pfx##cache##l | ||||||
|  |  									\ | ||||||
|  |  	__##pfx##flush_prologue						\ | ||||||
|  |  									\ | ||||||
|  | +	war								\ | ||||||
|  |  	for (ws = 0; ws < ws_end; ws += ws_inc)				\ | ||||||
|  |  		for (addr = start; addr < end; addr += lsize * 32)	\ | ||||||
|  |  			cache##lsize##_unroll32(addr|ws, indexop);	\ | ||||||
|  | @@ -366,6 +430,7 @@ static inline void blast_##pfx##cache##l | ||||||
|  |  									\ | ||||||
|  |  	__##pfx##flush_prologue						\ | ||||||
|  |  									\ | ||||||
|  | +	war								\ | ||||||
|  |  	do {								\ | ||||||
|  |  		cache##lsize##_unroll32(start, hitop);			\ | ||||||
|  |  		start += lsize * 32;					\ | ||||||
|  | @@ -384,6 +449,8 @@ static inline void blast_##pfx##cache##l | ||||||
|  |  	                       current_cpu_data.desc.waybit;		\ | ||||||
|  |  	unsigned long ws, addr;						\ | ||||||
|  |  									\ | ||||||
|  | +	war								\ | ||||||
|  | +									\ | ||||||
|  |  	__##pfx##flush_prologue						\ | ||||||
|  |  									\ | ||||||
|  |  	for (ws = 0; ws < ws_end; ws += ws_inc)				\ | ||||||
|  | @@ -393,36 +460,38 @@ static inline void blast_##pfx##cache##l | ||||||
|  |  	__##pfx##flush_epilogue						\ | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | -__BUILD_BLAST_CACHE(d, dcache, Index_Writeback_Inv_D, Hit_Writeback_Inv_D, 16) | ||||||
|  | -__BUILD_BLAST_CACHE(i, icache, Index_Invalidate_I, Hit_Invalidate_I, 16) | ||||||
|  | -__BUILD_BLAST_CACHE(s, scache, Index_Writeback_Inv_SD, Hit_Writeback_Inv_SD, 16) | ||||||
|  | -__BUILD_BLAST_CACHE(d, dcache, Index_Writeback_Inv_D, Hit_Writeback_Inv_D, 32) | ||||||
|  | -__BUILD_BLAST_CACHE(i, icache, Index_Invalidate_I, Hit_Invalidate_I, 32) | ||||||
|  | -__BUILD_BLAST_CACHE(s, scache, Index_Writeback_Inv_SD, Hit_Writeback_Inv_SD, 32) | ||||||
|  | -__BUILD_BLAST_CACHE(d, dcache, Index_Writeback_Inv_D, Hit_Writeback_Inv_D, 64) | ||||||
|  | -__BUILD_BLAST_CACHE(i, icache, Index_Invalidate_I, Hit_Invalidate_I, 64) | ||||||
|  | -__BUILD_BLAST_CACHE(s, scache, Index_Writeback_Inv_SD, Hit_Writeback_Inv_SD, 64) | ||||||
|  | -__BUILD_BLAST_CACHE(s, scache, Index_Writeback_Inv_SD, Hit_Writeback_Inv_SD, 128) | ||||||
|  | - | ||||||
|  | -__BUILD_BLAST_CACHE(inv_d, dcache, Index_Writeback_Inv_D, Hit_Invalidate_D, 16) | ||||||
|  | -__BUILD_BLAST_CACHE(inv_d, dcache, Index_Writeback_Inv_D, Hit_Invalidate_D, 32) | ||||||
|  | -__BUILD_BLAST_CACHE(inv_s, scache, Index_Writeback_Inv_SD, Hit_Invalidate_SD, 16) | ||||||
|  | -__BUILD_BLAST_CACHE(inv_s, scache, Index_Writeback_Inv_SD, Hit_Invalidate_SD, 32) | ||||||
|  | -__BUILD_BLAST_CACHE(inv_s, scache, Index_Writeback_Inv_SD, Hit_Invalidate_SD, 64) | ||||||
|  | -__BUILD_BLAST_CACHE(inv_s, scache, Index_Writeback_Inv_SD, Hit_Invalidate_SD, 128) | ||||||
|  | +__BUILD_BLAST_CACHE(d, dcache, Index_Writeback_Inv_D, Hit_Writeback_Inv_D, 16, ) | ||||||
|  | +__BUILD_BLAST_CACHE(i, icache, Index_Invalidate_I, Hit_Invalidate_I, 16, BCM4710_FILL_TLB(start);) | ||||||
|  | +__BUILD_BLAST_CACHE(s, scache, Index_Writeback_Inv_SD, Hit_Writeback_Inv_SD, 16, ) | ||||||
|  | +__BUILD_BLAST_CACHE(d, dcache, Index_Writeback_Inv_D, Hit_Writeback_Inv_D, 32, ) | ||||||
|  | +__BUILD_BLAST_CACHE(i, icache, Index_Invalidate_I, Hit_Invalidate_I, 32, BCM4710_FILL_TLB(start);) | ||||||
|  | +__BUILD_BLAST_CACHE(s, scache, Index_Writeback_Inv_SD, Hit_Writeback_Inv_SD, 32, ) | ||||||
|  | +__BUILD_BLAST_CACHE(d, dcache, Index_Writeback_Inv_D, Hit_Writeback_Inv_D, 64, ) | ||||||
|  | +__BUILD_BLAST_CACHE(i, icache, Index_Invalidate_I, Hit_Invalidate_I, 64, BCM4710_FILL_TLB(start);) | ||||||
|  | +__BUILD_BLAST_CACHE(s, scache, Index_Writeback_Inv_SD, Hit_Writeback_Inv_SD, 64, ) | ||||||
|  | +__BUILD_BLAST_CACHE(s, scache, Index_Writeback_Inv_SD, Hit_Writeback_Inv_SD, 128, ) | ||||||
|  | + | ||||||
|  | +__BUILD_BLAST_CACHE(inv_d, dcache, Index_Writeback_Inv_D, Hit_Invalidate_D, 16, ) | ||||||
|  | +__BUILD_BLAST_CACHE(inv_d, dcache, Index_Writeback_Inv_D, Hit_Invalidate_D, 32, ) | ||||||
|  | +__BUILD_BLAST_CACHE(inv_s, scache, Index_Writeback_Inv_SD, Hit_Invalidate_SD, 16, ) | ||||||
|  | +__BUILD_BLAST_CACHE(inv_s, scache, Index_Writeback_Inv_SD, Hit_Invalidate_SD, 32, ) | ||||||
|  | +__BUILD_BLAST_CACHE(inv_s, scache, Index_Writeback_Inv_SD, Hit_Invalidate_SD, 64, ) | ||||||
|  | +__BUILD_BLAST_CACHE(inv_s, scache, Index_Writeback_Inv_SD, Hit_Invalidate_SD, 128, ) | ||||||
|  |   | ||||||
|  |  /* build blast_xxx_range, protected_blast_xxx_range */ | ||||||
|  | -#define __BUILD_BLAST_CACHE_RANGE(pfx, desc, hitop, prot) \ | ||||||
|  | +#define __BUILD_BLAST_CACHE_RANGE(pfx, desc, hitop, prot, war, war2) \ | ||||||
|  |  static inline void prot##blast_##pfx##cache##_range(unsigned long start, \ | ||||||
|  |  						    unsigned long end)	\ | ||||||
|  |  {									\ | ||||||
|  |  	unsigned long lsize = cpu_##desc##_line_size();			\ | ||||||
|  |  	unsigned long addr = start & ~(lsize - 1);			\ | ||||||
|  |  	unsigned long aend = (end - 1) & ~(lsize - 1);			\ | ||||||
|  | +	war								\ | ||||||
|  |  									\ | ||||||
|  |  	__##pfx##flush_prologue						\ | ||||||
|  |  									\ | ||||||
|  |  	while (1) {							\ | ||||||
|  | +		war2						\ | ||||||
|  |  		prot##cache_op(hitop, addr);				\ | ||||||
|  |  		if (addr == aend)					\ | ||||||
|  |  			break;						\ | ||||||
|  | @@ -432,13 +501,13 @@ static inline void prot##blast_##pfx##ca | ||||||
|  |  	__##pfx##flush_epilogue						\ | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | -__BUILD_BLAST_CACHE_RANGE(d, dcache, Hit_Writeback_Inv_D, protected_) | ||||||
|  | -__BUILD_BLAST_CACHE_RANGE(s, scache, Hit_Writeback_Inv_SD, protected_) | ||||||
|  | -__BUILD_BLAST_CACHE_RANGE(i, icache, Hit_Invalidate_I, protected_) | ||||||
|  | -__BUILD_BLAST_CACHE_RANGE(d, dcache, Hit_Writeback_Inv_D, ) | ||||||
|  | -__BUILD_BLAST_CACHE_RANGE(s, scache, Hit_Writeback_Inv_SD, ) | ||||||
|  | +__BUILD_BLAST_CACHE_RANGE(d, dcache, Hit_Writeback_Inv_D, protected_, BCM4710_PROTECTED_FILL_TLB(addr); BCM4710_PROTECTED_FILL_TLB(aend);, BCM4710_DUMMY_RREG();) | ||||||
|  | +__BUILD_BLAST_CACHE_RANGE(s, scache, Hit_Writeback_Inv_SD, protected_,, ) | ||||||
|  | +__BUILD_BLAST_CACHE_RANGE(i, icache, Hit_Invalidate_I, protected_,, ) | ||||||
|  | +__BUILD_BLAST_CACHE_RANGE(d, dcache, Hit_Writeback_Inv_D,, BCM4710_FILL_TLB(addr); BCM4710_FILL_TLB(aend);, BCM4710_DUMMY_RREG();) | ||||||
|  | +__BUILD_BLAST_CACHE_RANGE(s, scache, Hit_Writeback_Inv_SD,,, ) | ||||||
|  |  /* blast_inv_dcache_range */ | ||||||
|  | -__BUILD_BLAST_CACHE_RANGE(inv_d, dcache, Hit_Invalidate_D, ) | ||||||
|  | -__BUILD_BLAST_CACHE_RANGE(inv_s, scache, Hit_Invalidate_SD, ) | ||||||
|  | +__BUILD_BLAST_CACHE_RANGE(inv_d, dcache, Hit_Invalidate_D,,,BCM4710_DUMMY_RREG();) | ||||||
|  | +__BUILD_BLAST_CACHE_RANGE(inv_s, scache, Hit_Invalidate_SD,,, ) | ||||||
|  |   | ||||||
|  |  #endif /* _ASM_R4KCACHE_H */ | ||||||
|  | --- a/arch/mips/include/asm/stackframe.h | ||||||
|  | +++ b/arch/mips/include/asm/stackframe.h | ||||||
|  | @@ -449,6 +449,10 @@ | ||||||
|  |  		.macro	RESTORE_SP_AND_RET | ||||||
|  |  		LONG_L	sp, PT_R29(sp) | ||||||
|  |  		.set	mips3 | ||||||
|  | +#ifdef CONFIG_BCM47XX | ||||||
|  | +		nop | ||||||
|  | +		nop | ||||||
|  | +#endif | ||||||
|  |  		eret | ||||||
|  |  		.set	mips0 | ||||||
|  |  		.endm | ||||||
|  | --- a/arch/mips/kernel/genex.S | ||||||
|  | +++ b/arch/mips/kernel/genex.S | ||||||
|  | @@ -52,6 +52,10 @@ NESTED(except_vec1_generic, 0, sp) | ||||||
|  |  NESTED(except_vec3_generic, 0, sp) | ||||||
|  |  	.set	push | ||||||
|  |  	.set	noat | ||||||
|  | +#ifdef CONFIG_BCM47XX | ||||||
|  | +	nop | ||||||
|  | +	nop | ||||||
|  | +#endif | ||||||
|  |  #if R5432_CP0_INTERRUPT_WAR | ||||||
|  |  	mfc0	k0, CP0_INDEX | ||||||
|  |  #endif | ||||||
|  | --- a/arch/mips/mm/c-r4k.c | ||||||
|  | +++ b/arch/mips/mm/c-r4k.c | ||||||
|  | @@ -35,6 +35,9 @@ | ||||||
|  |  #include <asm/cacheflush.h> /* for run_uncached() */ | ||||||
|  |   | ||||||
|  |   | ||||||
|  | +/* For enabling BCM4710 cache workarounds */ | ||||||
|  | +int bcm4710 = 0; | ||||||
|  | + | ||||||
|  |  /* | ||||||
|  |   * Special Variant of smp_call_function for use by cache functions: | ||||||
|  |   * | ||||||
|  | @@ -111,6 +114,9 @@ static void __cpuinit r4k_blast_dcache_p | ||||||
|  |  { | ||||||
|  |  	unsigned long  dc_lsize = cpu_dcache_line_size(); | ||||||
|  |   | ||||||
|  | +	if (bcm4710) | ||||||
|  | +		r4k_blast_dcache_page = blast_dcache_page; | ||||||
|  | +	else | ||||||
|  |  	if (dc_lsize == 0) | ||||||
|  |  		r4k_blast_dcache_page = (void *)cache_noop; | ||||||
|  |  	else if (dc_lsize == 16) | ||||||
|  | @@ -127,6 +133,9 @@ static void __cpuinit r4k_blast_dcache_p | ||||||
|  |  { | ||||||
|  |  	unsigned long dc_lsize = cpu_dcache_line_size(); | ||||||
|  |   | ||||||
|  | +	if (bcm4710) | ||||||
|  | +		r4k_blast_dcache_page_indexed = blast_dcache_page_indexed; | ||||||
|  | +	else | ||||||
|  |  	if (dc_lsize == 0) | ||||||
|  |  		r4k_blast_dcache_page_indexed = (void *)cache_noop; | ||||||
|  |  	else if (dc_lsize == 16) | ||||||
|  | @@ -143,6 +152,9 @@ static void __cpuinit r4k_blast_dcache_s | ||||||
|  |  { | ||||||
|  |  	unsigned long dc_lsize = cpu_dcache_line_size(); | ||||||
|  |   | ||||||
|  | +	if (bcm4710) | ||||||
|  | +		r4k_blast_dcache = blast_dcache; | ||||||
|  | +	else | ||||||
|  |  	if (dc_lsize == 0) | ||||||
|  |  		r4k_blast_dcache = (void *)cache_noop; | ||||||
|  |  	else if (dc_lsize == 16) | ||||||
|  | @@ -683,6 +695,8 @@ static void local_r4k_flush_cache_sigtra | ||||||
|  |  	unsigned long addr = (unsigned long) arg; | ||||||
|  |   | ||||||
|  |  	R4600_HIT_CACHEOP_WAR_IMPL; | ||||||
|  | +	BCM4710_PROTECTED_FILL_TLB(addr); | ||||||
|  | +	BCM4710_PROTECTED_FILL_TLB(addr + 4); | ||||||
|  |  	if (dc_lsize) | ||||||
|  |  		protected_writeback_dcache_line(addr & ~(dc_lsize - 1)); | ||||||
|  |  	if (!cpu_icache_snoops_remote_store && scache_size) | ||||||
|  | @@ -1349,6 +1363,17 @@ static void __cpuinit coherency_setup(vo | ||||||
|  |  	 * silly idea of putting something else there ... | ||||||
|  |  	 */ | ||||||
|  |  	switch (current_cpu_type()) { | ||||||
|  | +	case CPU_BMIPS3300: | ||||||
|  | +		{ | ||||||
|  | +			u32 cm; | ||||||
|  | +			cm = read_c0_diag(); | ||||||
|  | +			/* Enable icache */ | ||||||
|  | +			cm |= (1 << 31); | ||||||
|  | +			/* Enable dcache */ | ||||||
|  | +			cm |= (1 << 30); | ||||||
|  | +			write_c0_diag(cm); | ||||||
|  | +		} | ||||||
|  | +		break; | ||||||
|  |  	case CPU_R4000PC: | ||||||
|  |  	case CPU_R4000SC: | ||||||
|  |  	case CPU_R4000MC: | ||||||
|  | @@ -1405,6 +1430,15 @@ void __cpuinit r4k_cache_init(void) | ||||||
|  |  		break; | ||||||
|  |  	} | ||||||
|  |   | ||||||
|  | +	/* Check if special workarounds are required */ | ||||||
|  | +#ifdef CONFIG_BCM47XX | ||||||
|  | +	if (current_cpu_data.cputype == CPU_BMIPS32 && (current_cpu_data.processor_id & 0xff) == 0) { | ||||||
|  | +		printk("Enabling BCM4710A0 cache workarounds.\n"); | ||||||
|  | +		bcm4710 = 1; | ||||||
|  | +	} else | ||||||
|  | +#endif | ||||||
|  | +		bcm4710 = 0; | ||||||
|  | + | ||||||
|  |  	probe_pcache(); | ||||||
|  |  	setup_scache(); | ||||||
|  |   | ||||||
|  | @@ -1465,5 +1499,13 @@ void __cpuinit r4k_cache_init(void) | ||||||
|  |  #if !defined(CONFIG_MIPS_CMP) | ||||||
|  |  	local_r4k___flush_cache_all(NULL); | ||||||
|  |  #endif | ||||||
|  | +#ifdef CONFIG_BCM47XX | ||||||
|  | +	{ | ||||||
|  | +		static void (*_coherency_setup)(void); | ||||||
|  | +		_coherency_setup = (void (*)(void)) KSEG1ADDR(coherency_setup); | ||||||
|  | +		_coherency_setup(); | ||||||
|  | +	} | ||||||
|  | +#else | ||||||
|  |  	coherency_setup(); | ||||||
|  | +#endif | ||||||
|  |  } | ||||||
|  | --- a/arch/mips/mm/tlbex.c | ||||||
|  | +++ b/arch/mips/mm/tlbex.c | ||||||
|  | @@ -1264,6 +1264,9 @@ static void __cpuinit build_r4000_tlb_re | ||||||
|  |  			/* No need for uasm_i_nop */ | ||||||
|  |  		} | ||||||
|  |   | ||||||
|  | +#ifdef CONFIG_BCM47XX | ||||||
|  | +		uasm_i_nop(&p); | ||||||
|  | +#endif | ||||||
|  |  #ifdef CONFIG_64BIT | ||||||
|  |  		build_get_pmde64(&p, &l, &r, K0, K1); /* get pmd in K1 */ | ||||||
|  |  #else | ||||||
|  | @@ -1794,6 +1797,9 @@ build_r4000_tlbchange_handler_head(u32 * | ||||||
|  |  { | ||||||
|  |  	struct work_registers wr = build_get_work_registers(p); | ||||||
|  |   | ||||||
|  | +#ifdef CONFIG_BCM47XX | ||||||
|  | +	uasm_i_nop(p); | ||||||
|  | +#endif | ||||||
|  |  #ifdef CONFIG_64BIT | ||||||
|  |  	build_get_pmde64(p, l, r, wr.r1, wr.r2); /* get pmd in ptr */ | ||||||
|  |  #else | ||||||
							
								
								
									
										77
									
								
								target/linux/brcm47xx/patches-3.3/160-kmap_coherent.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										77
									
								
								target/linux/brcm47xx/patches-3.3/160-kmap_coherent.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,77 @@ | |||||||
|  | --- a/arch/mips/include/asm/cpu-features.h | ||||||
|  | +++ b/arch/mips/include/asm/cpu-features.h | ||||||
|  | @@ -110,6 +110,9 @@ | ||||||
|  |  #ifndef cpu_has_pindexed_dcache | ||||||
|  |  #define cpu_has_pindexed_dcache	(cpu_data[0].dcache.flags & MIPS_CACHE_PINDEX) | ||||||
|  |  #endif | ||||||
|  | +#ifndef cpu_use_kmap_coherent | ||||||
|  | +#define cpu_use_kmap_coherent 1 | ||||||
|  | +#endif | ||||||
|  |   | ||||||
|  |  /* | ||||||
|  |   * I-Cache snoops remote store.  This only matters on SMP.  Some multiprocessors | ||||||
|  | --- /dev/null | ||||||
|  | +++ b/arch/mips/include/asm/mach-bcm47xx/cpu-feature-overrides.h | ||||||
|  | @@ -0,0 +1,13 @@ | ||||||
|  | +/* | ||||||
|  | + * 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) 2005 Ralf Baechle (ralf@linux-mips.org) | ||||||
|  | + */ | ||||||
|  | +#ifndef __ASM_MACH_BCM47XX_CPU_FEATURE_OVERRIDES_H | ||||||
|  | +#define __ASM_MACH_BCM47XX_CPU_FEATURE_OVERRIDES_H | ||||||
|  | + | ||||||
|  | +#define cpu_use_kmap_coherent	0 | ||||||
|  | + | ||||||
|  | +#endif /* __ASM_MACH_BCM47XX_CPU_FEATURE_OVERRIDES_H */ | ||||||
|  | --- a/arch/mips/mm/c-r4k.c | ||||||
|  | +++ b/arch/mips/mm/c-r4k.c | ||||||
|  | @@ -507,7 +507,7 @@ static inline void local_r4k_flush_cache | ||||||
|  |  		 */ | ||||||
|  |  		map_coherent = (cpu_has_dc_aliases && | ||||||
|  |  				page_mapped(page) && !Page_dcache_dirty(page)); | ||||||
|  | -		if (map_coherent) | ||||||
|  | +		if (map_coherent && cpu_use_kmap_coherent) | ||||||
|  |  			vaddr = kmap_coherent(page, addr); | ||||||
|  |  		else | ||||||
|  |  			vaddr = kmap_atomic(page, KM_USER0); | ||||||
|  | @@ -530,7 +530,7 @@ static inline void local_r4k_flush_cache | ||||||
|  |  	} | ||||||
|  |   | ||||||
|  |  	if (vaddr) { | ||||||
|  | -		if (map_coherent) | ||||||
|  | +		if (map_coherent && cpu_use_kmap_coherent) | ||||||
|  |  			kunmap_coherent(); | ||||||
|  |  		else | ||||||
|  |  			kunmap_atomic(vaddr, KM_USER0); | ||||||
|  | --- a/arch/mips/mm/init.c | ||||||
|  | +++ b/arch/mips/mm/init.c | ||||||
|  | @@ -208,7 +208,7 @@ void copy_user_highpage(struct page *to, | ||||||
|  |  	void *vfrom, *vto; | ||||||
|  |   | ||||||
|  |  	vto = kmap_atomic(to, KM_USER1); | ||||||
|  | -	if (cpu_has_dc_aliases && | ||||||
|  | +	if (cpu_has_dc_aliases && cpu_use_kmap_coherent && | ||||||
|  |  	    page_mapped(from) && !Page_dcache_dirty(from)) { | ||||||
|  |  		vfrom = kmap_coherent(from, vaddr); | ||||||
|  |  		copy_page(vto, vfrom); | ||||||
|  | @@ -230,7 +230,7 @@ void copy_to_user_page(struct vm_area_st | ||||||
|  |  	struct page *page, unsigned long vaddr, void *dst, const void *src, | ||||||
|  |  	unsigned long len) | ||||||
|  |  { | ||||||
|  | -	if (cpu_has_dc_aliases && | ||||||
|  | +	if (cpu_has_dc_aliases && cpu_use_kmap_coherent && | ||||||
|  |  	    page_mapped(page) && !Page_dcache_dirty(page)) { | ||||||
|  |  		void *vto = kmap_coherent(page, vaddr) + (vaddr & ~PAGE_MASK); | ||||||
|  |  		memcpy(vto, src, len); | ||||||
|  | @@ -248,7 +248,7 @@ void copy_from_user_page(struct vm_area_ | ||||||
|  |  	struct page *page, unsigned long vaddr, void *dst, const void *src, | ||||||
|  |  	unsigned long len) | ||||||
|  |  { | ||||||
|  | -	if (cpu_has_dc_aliases && | ||||||
|  | +	if (cpu_has_dc_aliases && cpu_use_kmap_coherent && | ||||||
|  |  	    page_mapped(page) && !Page_dcache_dirty(page)) { | ||||||
|  |  		void *vfrom = kmap_coherent(page, vaddr) + (vaddr & ~PAGE_MASK); | ||||||
|  |  		memcpy(dst, vfrom, len); | ||||||
| @@ -0,0 +1,271 @@ | |||||||
|  | --- a/drivers/usb/host/Kconfig | ||||||
|  | +++ b/drivers/usb/host/Kconfig | ||||||
|  | @@ -393,6 +393,16 @@ config USB_CNS3XXX_OHCI | ||||||
|  |  	  Enable support for the CNS3XXX SOC's on-chip OHCI controller. | ||||||
|  |  	  It is needed for low-speed USB 1.0 device support. | ||||||
|  |   | ||||||
|  | +config USB_OHCI_HCD_PLATFORM | ||||||
|  | +	bool "Generic OHCI driver for a platform device" | ||||||
|  | +	depends on USB_OHCI_HCD && EXPERIMENTAL | ||||||
|  | +	default n | ||||||
|  | +	---help--- | ||||||
|  | +	  Adds an OHCI host driver for a generic platform device, which | ||||||
|  | +	  provieds a memory space and an irq. | ||||||
|  | + | ||||||
|  | +	  If unsure, say N. | ||||||
|  | + | ||||||
|  |  config USB_OHCI_BIG_ENDIAN_DESC | ||||||
|  |  	bool | ||||||
|  |  	depends on USB_OHCI_HCD | ||||||
|  | --- a/drivers/usb/host/ohci-hcd.c | ||||||
|  | +++ b/drivers/usb/host/ohci-hcd.c | ||||||
|  | @@ -1121,6 +1121,11 @@ MODULE_LICENSE ("GPL"); | ||||||
|  |  #define PLATFORM_DRIVER		ohci_xls_driver | ||||||
|  |  #endif | ||||||
|  |   | ||||||
|  | +#ifdef CONFIG_USB_OHCI_HCD_PLATFORM | ||||||
|  | +#include "ohci-platform.c" | ||||||
|  | +#define PLATFORM_DRIVER		ohci_platform_driver | ||||||
|  | +#endif | ||||||
|  | + | ||||||
|  |  #if	!defined(PCI_DRIVER) &&		\ | ||||||
|  |  	!defined(PLATFORM_DRIVER) &&	\ | ||||||
|  |  	!defined(OMAP1_PLATFORM_DRIVER) &&	\ | ||||||
|  | --- /dev/null | ||||||
|  | +++ b/drivers/usb/host/ohci-platform.c | ||||||
|  | @@ -0,0 +1,194 @@ | ||||||
|  | +/* | ||||||
|  | + * Generic platform ohci driver | ||||||
|  | + * | ||||||
|  | + * Copyright 2007 Michael Buesch <m@bues.ch> | ||||||
|  | + * Copyright 2011-2012 Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | + * | ||||||
|  | + * Derived from the OCHI-SSB driver | ||||||
|  | + * Derived from the OHCI-PCI driver | ||||||
|  | + * Copyright 1999 Roman Weissgaerber | ||||||
|  | + * Copyright 2000-2002 David Brownell | ||||||
|  | + * Copyright 1999 Linus Torvalds | ||||||
|  | + * Copyright 1999 Gregory P. Smith | ||||||
|  | + * | ||||||
|  | + * Licensed under the GNU/GPL. See COPYING for details. | ||||||
|  | + */ | ||||||
|  | +#include <linux/platform_device.h> | ||||||
|  | +#include <linux/usb/ohci_pdriver.h> | ||||||
|  | + | ||||||
|  | +static int ohci_platform_reset(struct usb_hcd *hcd) | ||||||
|  | +{ | ||||||
|  | +	struct platform_device *pdev = to_platform_device(hcd->self.controller); | ||||||
|  | +	struct usb_ohci_pdata *pdata = pdev->dev.platform_data; | ||||||
|  | +	struct ohci_hcd *ohci = hcd_to_ohci(hcd); | ||||||
|  | +	int err; | ||||||
|  | + | ||||||
|  | +	if (pdata->big_endian_desc) | ||||||
|  | +		ohci->flags |= OHCI_QUIRK_BE_DESC; | ||||||
|  | +	if (pdata->big_endian_mmio) | ||||||
|  | +		ohci->flags |= OHCI_QUIRK_BE_MMIO; | ||||||
|  | +	if (pdata->no_big_frame_no) | ||||||
|  | +		ohci->flags |= OHCI_QUIRK_FRAME_NO; | ||||||
|  | + | ||||||
|  | +	ohci_hcd_init(ohci); | ||||||
|  | +	err = ohci_init(ohci); | ||||||
|  | + | ||||||
|  | +	return err; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int ohci_platform_start(struct usb_hcd *hcd) | ||||||
|  | +{ | ||||||
|  | +	struct ohci_hcd *ohci = hcd_to_ohci(hcd); | ||||||
|  | +	int err; | ||||||
|  | + | ||||||
|  | +	err = ohci_run(ohci); | ||||||
|  | +	if (err < 0) { | ||||||
|  | +		ohci_err(ohci, "can't start\n"); | ||||||
|  | +		ohci_stop(hcd); | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return err; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static const struct hc_driver ohci_platform_hc_driver = { | ||||||
|  | +	.description		= hcd_name, | ||||||
|  | +	.product_desc		= "Generic Platform OHCI Controller", | ||||||
|  | +	.hcd_priv_size		= sizeof(struct ohci_hcd), | ||||||
|  | + | ||||||
|  | +	.irq			= ohci_irq, | ||||||
|  | +	.flags			= HCD_MEMORY | HCD_USB11, | ||||||
|  | + | ||||||
|  | +	.reset			= ohci_platform_reset, | ||||||
|  | +	.start			= ohci_platform_start, | ||||||
|  | +	.stop			= ohci_stop, | ||||||
|  | +	.shutdown		= ohci_shutdown, | ||||||
|  | + | ||||||
|  | +	.urb_enqueue		= ohci_urb_enqueue, | ||||||
|  | +	.urb_dequeue		= ohci_urb_dequeue, | ||||||
|  | +	.endpoint_disable	= ohci_endpoint_disable, | ||||||
|  | + | ||||||
|  | +	.get_frame_number	= ohci_get_frame, | ||||||
|  | + | ||||||
|  | +	.hub_status_data	= ohci_hub_status_data, | ||||||
|  | +	.hub_control		= ohci_hub_control, | ||||||
|  | +#ifdef	CONFIG_PM | ||||||
|  | +	.bus_suspend		= ohci_bus_suspend, | ||||||
|  | +	.bus_resume		= ohci_bus_resume, | ||||||
|  | +#endif | ||||||
|  | + | ||||||
|  | +	.start_port_reset	= ohci_start_port_reset, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static int __devinit ohci_platform_probe(struct platform_device *dev) | ||||||
|  | +{ | ||||||
|  | +	struct usb_hcd *hcd; | ||||||
|  | +	struct resource *res_mem; | ||||||
|  | +	int irq; | ||||||
|  | +	int err = -ENOMEM; | ||||||
|  | + | ||||||
|  | +	BUG_ON(!dev->dev.platform_data); | ||||||
|  | + | ||||||
|  | +	if (usb_disabled()) | ||||||
|  | +		return -ENODEV; | ||||||
|  | + | ||||||
|  | +	irq = platform_get_irq(dev, 0); | ||||||
|  | +	if (irq < 0) { | ||||||
|  | +		pr_err("no irq provieded"); | ||||||
|  | +		return irq; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	res_mem = platform_get_resource(dev, IORESOURCE_MEM, 0); | ||||||
|  | +	if (!res_mem) { | ||||||
|  | +		pr_err("no memory recourse provieded"); | ||||||
|  | +		return -ENXIO; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	hcd = usb_create_hcd(&ohci_platform_hc_driver, &dev->dev, | ||||||
|  | +			dev_name(&dev->dev)); | ||||||
|  | +	if (!hcd) | ||||||
|  | +		return -ENOMEM; | ||||||
|  | + | ||||||
|  | +	hcd->rsrc_start = res_mem->start; | ||||||
|  | +	hcd->rsrc_len = resource_size(res_mem); | ||||||
|  | + | ||||||
|  | +	if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len, hcd_name)) { | ||||||
|  | +		pr_err("controller already in use"); | ||||||
|  | +		err = -EBUSY; | ||||||
|  | +		goto err_put_hcd; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	hcd->regs = ioremap_nocache(hcd->rsrc_start, hcd->rsrc_len); | ||||||
|  | +	if (!hcd->regs) | ||||||
|  | +		goto err_release_region; | ||||||
|  | +	err = usb_add_hcd(hcd, irq, IRQF_SHARED); | ||||||
|  | +	if (err) | ||||||
|  | +		goto err_iounmap; | ||||||
|  | + | ||||||
|  | +	platform_set_drvdata(dev, hcd); | ||||||
|  | + | ||||||
|  | +	return err; | ||||||
|  | + | ||||||
|  | +err_iounmap: | ||||||
|  | +	iounmap(hcd->regs); | ||||||
|  | +err_release_region: | ||||||
|  | +	release_mem_region(hcd->rsrc_start, hcd->rsrc_len); | ||||||
|  | +err_put_hcd: | ||||||
|  | +	usb_put_hcd(hcd); | ||||||
|  | +	return err; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int __devexit ohci_platform_remove(struct platform_device *dev) | ||||||
|  | +{ | ||||||
|  | +	struct usb_hcd *hcd = platform_get_drvdata(dev); | ||||||
|  | + | ||||||
|  | +	usb_remove_hcd(hcd); | ||||||
|  | +	iounmap(hcd->regs); | ||||||
|  | +	release_mem_region(hcd->rsrc_start, hcd->rsrc_len); | ||||||
|  | +	usb_put_hcd(hcd); | ||||||
|  | +	platform_set_drvdata(dev, NULL); | ||||||
|  | + | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +#ifdef CONFIG_PM | ||||||
|  | + | ||||||
|  | +static int ohci_platform_suspend(struct device *dev) | ||||||
|  | +{ | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int ohci_platform_resume(struct device *dev) | ||||||
|  | +{ | ||||||
|  | +	struct usb_hcd *hcd = dev_get_drvdata(dev); | ||||||
|  | + | ||||||
|  | +	ohci_finish_controller_resume(hcd); | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +#else /* !CONFIG_PM */ | ||||||
|  | +#define ohci_platform_suspend	NULL | ||||||
|  | +#define ohci_platform_resume	NULL | ||||||
|  | +#endif /* CONFIG_PM */ | ||||||
|  | + | ||||||
|  | +static const struct platform_device_id ohci_platform_table[] = { | ||||||
|  | +	{ "ohci-platform", 0 }, | ||||||
|  | +	{ } | ||||||
|  | +}; | ||||||
|  | +MODULE_DEVICE_TABLE(platform, ohci_platform_table); | ||||||
|  | + | ||||||
|  | +static const struct dev_pm_ops ohci_platform_pm_ops = { | ||||||
|  | +	.suspend	= ohci_platform_suspend, | ||||||
|  | +	.resume		= ohci_platform_resume, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static struct platform_driver ohci_platform_driver = { | ||||||
|  | +	.id_table	= ohci_platform_table, | ||||||
|  | +	.probe		= ohci_platform_probe, | ||||||
|  | +	.remove		= __devexit_p(ohci_platform_remove), | ||||||
|  | +	.shutdown	= usb_hcd_platform_shutdown, | ||||||
|  | +	.driver		= { | ||||||
|  | +		.owner	= THIS_MODULE, | ||||||
|  | +		.name	= "ohci-platform", | ||||||
|  | +		.pm	= &ohci_platform_pm_ops, | ||||||
|  | +	} | ||||||
|  | +}; | ||||||
|  | --- /dev/null | ||||||
|  | +++ b/include/linux/usb/ohci_pdriver.h | ||||||
|  | @@ -0,0 +1,38 @@ | ||||||
|  | +/* | ||||||
|  | + * Copyright (C) 2012 Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | + * | ||||||
|  | + * This program is free software; you can redistribute it and/or modify it | ||||||
|  | + * under the terms of the GNU General Public License as published by the | ||||||
|  | + * Free Software Foundation; either version 2 of the License, or (at your | ||||||
|  | + * option) any later version. | ||||||
|  | + * | ||||||
|  | + * This program is distributed in the hope that it will be useful, but | ||||||
|  | + * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY | ||||||
|  | + * or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License | ||||||
|  | + * for more details. | ||||||
|  | + * | ||||||
|  | + * You should have received a copy of the GNU General Public License | ||||||
|  | + * along with this program; if not, write to the Free Software Foundation, | ||||||
|  | + * Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||||||
|  | + */ | ||||||
|  | + | ||||||
|  | +#ifndef __USB_CORE_OHCI_PDRIVER_H | ||||||
|  | +#define __USB_CORE_OHCI_PDRIVER_H | ||||||
|  | + | ||||||
|  | +/** | ||||||
|  | + * struct usb_ohci_pdata - platform_data for generic ohci driver | ||||||
|  | + * | ||||||
|  | + * @big_endian_desc:	BE descriptors | ||||||
|  | + * @big_endian_mmio:	BE registers | ||||||
|  | + * @no_big_frame_no:	no big endian frame_no shift | ||||||
|  | + * | ||||||
|  | + * These are general configuration options for the OHCI controller. All of | ||||||
|  | + * these options are activating more or less workarounds for some hardware. | ||||||
|  | + */ | ||||||
|  | +struct usb_ohci_pdata { | ||||||
|  | +	unsigned	big_endian_desc:1; | ||||||
|  | +	unsigned	big_endian_mmio:1; | ||||||
|  | +	unsigned	no_big_frame_no:1; | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +#endif /* __USB_CORE_OHCI_PDRIVER_H */ | ||||||
| @@ -0,0 +1,283 @@ | |||||||
|  | --- a/drivers/usb/host/Kconfig | ||||||
|  | +++ b/drivers/usb/host/Kconfig | ||||||
|  | @@ -403,6 +403,16 @@ config USB_OHCI_HCD_PLATFORM | ||||||
|  |   | ||||||
|  |  	  If unsure, say N. | ||||||
|  |   | ||||||
|  | +config USB_EHCI_HCD_PLATFORM | ||||||
|  | +	bool "Generic EHCI driver for a platform device" | ||||||
|  | +	depends on USB_EHCI_HCD && EXPERIMENTAL | ||||||
|  | +	default n | ||||||
|  | +	---help--- | ||||||
|  | +	  Adds an EHCI host driver for a generic platform device, which | ||||||
|  | +	  provieds a memory space and an irq. | ||||||
|  | + | ||||||
|  | +	  If unsure, say N. | ||||||
|  | + | ||||||
|  |  config USB_OHCI_BIG_ENDIAN_DESC | ||||||
|  |  	bool | ||||||
|  |  	depends on USB_OHCI_HCD | ||||||
|  | --- a/drivers/usb/host/ehci-hcd.c | ||||||
|  | +++ b/drivers/usb/host/ehci-hcd.c | ||||||
|  | @@ -1381,6 +1381,11 @@ MODULE_LICENSE ("GPL"); | ||||||
|  |  #define        PLATFORM_DRIVER         ehci_mv_driver | ||||||
|  |  #endif | ||||||
|  |   | ||||||
|  | +#ifdef CONFIG_USB_EHCI_HCD_PLATFORM | ||||||
|  | +#include "ehci-platform.c" | ||||||
|  | +#define PLATFORM_DRIVER		ehci_platform_driver | ||||||
|  | +#endif | ||||||
|  | + | ||||||
|  |  #if !defined(PCI_DRIVER) && !defined(PLATFORM_DRIVER) && \ | ||||||
|  |      !defined(PS3_SYSTEM_BUS_DRIVER) && !defined(OF_PLATFORM_DRIVER) && \ | ||||||
|  |      !defined(XILINX_OF_PLATFORM_DRIVER) | ||||||
|  | --- /dev/null | ||||||
|  | +++ b/drivers/usb/host/ehci-platform.c | ||||||
|  | @@ -0,0 +1,198 @@ | ||||||
|  | +/* | ||||||
|  | + * Generic platform ehci driver | ||||||
|  | + * | ||||||
|  | + * Copyright 2007 Steven Brown <sbrown@cortland.com> | ||||||
|  | + * Copyright 2010-2012 Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | + * | ||||||
|  | + * Derived from the ohci-ssb driver | ||||||
|  | + * Copyright 2007 Michael Buesch <m@bues.ch> | ||||||
|  | + * | ||||||
|  | + * Derived from the EHCI-PCI driver | ||||||
|  | + * Copyright (c) 2000-2004 by David Brownell | ||||||
|  | + * | ||||||
|  | + * Derived from the ohci-pci driver | ||||||
|  | + * Copyright 1999 Roman Weissgaerber | ||||||
|  | + * Copyright 2000-2002 David Brownell | ||||||
|  | + * Copyright 1999 Linus Torvalds | ||||||
|  | + * Copyright 1999 Gregory P. Smith | ||||||
|  | + * | ||||||
|  | + * Licensed under the GNU/GPL. See COPYING for details. | ||||||
|  | + */ | ||||||
|  | +#include <linux/platform_device.h> | ||||||
|  | +#include <linux/usb/ehci_pdriver.h> | ||||||
|  | + | ||||||
|  | +static int ehci_platform_reset(struct usb_hcd *hcd) | ||||||
|  | +{ | ||||||
|  | +	struct platform_device *pdev = to_platform_device(hcd->self.controller); | ||||||
|  | +	struct usb_ehci_pdata *pdata = pdev->dev.platform_data; | ||||||
|  | +	struct ehci_hcd *ehci = hcd_to_ehci(hcd); | ||||||
|  | +	int retval; | ||||||
|  | + | ||||||
|  | +	hcd->has_tt = pdata->has_tt; | ||||||
|  | +	ehci->has_synopsys_hc_bug = pdata->has_synopsys_hc_bug; | ||||||
|  | +	ehci->big_endian_desc = pdata->big_endian_desc; | ||||||
|  | +	ehci->big_endian_mmio = pdata->big_endian_mmio; | ||||||
|  | + | ||||||
|  | +	ehci->caps = hcd->regs + pdata->caps_offset; | ||||||
|  | +	retval = ehci_setup(hcd); | ||||||
|  | +	if (retval) | ||||||
|  | +		return retval; | ||||||
|  | + | ||||||
|  | +	if (pdata->port_power_on) | ||||||
|  | +		ehci_port_power(ehci, 1); | ||||||
|  | +	if (pdata->port_power_off) | ||||||
|  | +		ehci_port_power(ehci, 0); | ||||||
|  | + | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static const struct hc_driver ehci_platform_hc_driver = { | ||||||
|  | +	.description		= hcd_name, | ||||||
|  | +	.product_desc		= "Generic Platform EHCI Controller", | ||||||
|  | +	.hcd_priv_size		= sizeof(struct ehci_hcd), | ||||||
|  | + | ||||||
|  | +	.irq			= ehci_irq, | ||||||
|  | +	.flags			= HCD_MEMORY | HCD_USB2, | ||||||
|  | + | ||||||
|  | +	.reset			= ehci_platform_reset, | ||||||
|  | +	.start			= ehci_run, | ||||||
|  | +	.stop			= ehci_stop, | ||||||
|  | +	.shutdown		= ehci_shutdown, | ||||||
|  | + | ||||||
|  | +	.urb_enqueue		= ehci_urb_enqueue, | ||||||
|  | +	.urb_dequeue		= ehci_urb_dequeue, | ||||||
|  | +	.endpoint_disable	= ehci_endpoint_disable, | ||||||
|  | +	.endpoint_reset		= ehci_endpoint_reset, | ||||||
|  | + | ||||||
|  | +	.get_frame_number	= ehci_get_frame, | ||||||
|  | + | ||||||
|  | +	.hub_status_data	= ehci_hub_status_data, | ||||||
|  | +	.hub_control		= ehci_hub_control, | ||||||
|  | +#if defined(CONFIG_PM) | ||||||
|  | +	.bus_suspend		= ehci_bus_suspend, | ||||||
|  | +	.bus_resume		= ehci_bus_resume, | ||||||
|  | +#endif | ||||||
|  | +	.relinquish_port	= ehci_relinquish_port, | ||||||
|  | +	.port_handed_over	= ehci_port_handed_over, | ||||||
|  | + | ||||||
|  | +	.update_device		= ehci_update_device, | ||||||
|  | + | ||||||
|  | +	.clear_tt_buffer_complete = ehci_clear_tt_buffer_complete, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static int __devinit ehci_platform_probe(struct platform_device *dev) | ||||||
|  | +{ | ||||||
|  | +	struct usb_hcd *hcd; | ||||||
|  | +	struct resource *res_mem; | ||||||
|  | +	int irq; | ||||||
|  | +	int err = -ENOMEM; | ||||||
|  | + | ||||||
|  | +	BUG_ON(!dev->dev.platform_data); | ||||||
|  | + | ||||||
|  | +	if (usb_disabled()) | ||||||
|  | +		return -ENODEV; | ||||||
|  | + | ||||||
|  | +	irq = platform_get_irq(dev, 0); | ||||||
|  | +	if (irq < 0) { | ||||||
|  | +		pr_err("no irq provieded"); | ||||||
|  | +		return irq; | ||||||
|  | +	} | ||||||
|  | +	res_mem = platform_get_resource(dev, IORESOURCE_MEM, 0); | ||||||
|  | +	if (!res_mem) { | ||||||
|  | +		pr_err("no memory recourse provieded"); | ||||||
|  | +		return -ENXIO; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	hcd = usb_create_hcd(&ehci_platform_hc_driver, &dev->dev, | ||||||
|  | +			     dev_name(&dev->dev)); | ||||||
|  | +	if (!hcd) | ||||||
|  | +		return -ENOMEM; | ||||||
|  | + | ||||||
|  | +	hcd->rsrc_start = res_mem->start; | ||||||
|  | +	hcd->rsrc_len = resource_size(res_mem); | ||||||
|  | + | ||||||
|  | +	if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len, hcd_name)) { | ||||||
|  | +		pr_err("controller already in use"); | ||||||
|  | +		err = -EBUSY; | ||||||
|  | +		goto err_put_hcd; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	hcd->regs = ioremap_nocache(hcd->rsrc_start, hcd->rsrc_len); | ||||||
|  | +	if (!hcd->regs) | ||||||
|  | +		goto err_release_region; | ||||||
|  | +	err = usb_add_hcd(hcd, irq, IRQF_SHARED); | ||||||
|  | +	if (err) | ||||||
|  | +		goto err_iounmap; | ||||||
|  | + | ||||||
|  | +	platform_set_drvdata(dev, hcd); | ||||||
|  | + | ||||||
|  | +	return err; | ||||||
|  | + | ||||||
|  | +err_iounmap: | ||||||
|  | +	iounmap(hcd->regs); | ||||||
|  | +err_release_region: | ||||||
|  | +	release_mem_region(hcd->rsrc_start, hcd->rsrc_len); | ||||||
|  | +err_put_hcd: | ||||||
|  | +	usb_put_hcd(hcd); | ||||||
|  | +	return err; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int __devexit ehci_platform_remove(struct platform_device *dev) | ||||||
|  | +{ | ||||||
|  | +	struct usb_hcd *hcd = platform_get_drvdata(dev); | ||||||
|  | + | ||||||
|  | +	usb_remove_hcd(hcd); | ||||||
|  | +	iounmap(hcd->regs); | ||||||
|  | +	release_mem_region(hcd->rsrc_start, hcd->rsrc_len); | ||||||
|  | +	usb_put_hcd(hcd); | ||||||
|  | +	platform_set_drvdata(dev, NULL); | ||||||
|  | + | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +#ifdef CONFIG_PM | ||||||
|  | + | ||||||
|  | +static int ehci_platform_suspend(struct device *dev) | ||||||
|  | +{ | ||||||
|  | +	struct usb_hcd *hcd = dev_get_drvdata(dev); | ||||||
|  | +	bool wakeup = device_may_wakeup(dev); | ||||||
|  | + | ||||||
|  | +	ehci_prepare_ports_for_controller_suspend(hcd_to_ehci(hcd), wakeup); | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int ehci_platform_resume(struct device *dev) | ||||||
|  | +{ | ||||||
|  | +	struct usb_hcd *hcd = dev_get_drvdata(dev); | ||||||
|  | + | ||||||
|  | +	ehci_prepare_ports_for_controller_resume(hcd_to_ehci(hcd)); | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +#else /* !CONFIG_PM */ | ||||||
|  | +#define ehci_platform_suspend	NULL | ||||||
|  | +#define ehci_platform_resume	NULL | ||||||
|  | +#endif /* CONFIG_PM */ | ||||||
|  | + | ||||||
|  | +static const struct platform_device_id ehci_platform_table[] = { | ||||||
|  | +	{ "ehci-platform", 0 }, | ||||||
|  | +	{ } | ||||||
|  | +}; | ||||||
|  | +MODULE_DEVICE_TABLE(platform, ehci_platform_table); | ||||||
|  | + | ||||||
|  | +static const struct dev_pm_ops ehci_platform_pm_ops = { | ||||||
|  | +	.suspend	= ehci_platform_suspend, | ||||||
|  | +	.resume		= ehci_platform_resume, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static struct platform_driver ehci_platform_driver = { | ||||||
|  | +	.id_table	= ehci_platform_table, | ||||||
|  | +	.probe		= ehci_platform_probe, | ||||||
|  | +	.remove		= __devexit_p(ehci_platform_remove), | ||||||
|  | +	.shutdown	= usb_hcd_platform_shutdown, | ||||||
|  | +	.driver		= { | ||||||
|  | +		.owner	= THIS_MODULE, | ||||||
|  | +		.name	= "ehci-platform", | ||||||
|  | +		.pm	= &ehci_platform_pm_ops, | ||||||
|  | +	} | ||||||
|  | +}; | ||||||
|  | --- /dev/null | ||||||
|  | +++ b/include/linux/usb/ehci_pdriver.h | ||||||
|  | @@ -0,0 +1,46 @@ | ||||||
|  | +/* | ||||||
|  | + * Copyright (C) 2012 Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | + * | ||||||
|  | + * This program is free software; you can redistribute it and/or modify it | ||||||
|  | + * under the terms of the GNU General Public License as published by the | ||||||
|  | + * Free Software Foundation; either version 2 of the License, or (at your | ||||||
|  | + * option) any later version. | ||||||
|  | + * | ||||||
|  | + * This program is distributed in the hope that it will be useful, but | ||||||
|  | + * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY | ||||||
|  | + * or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License | ||||||
|  | + * for more details. | ||||||
|  | + * | ||||||
|  | + * You should have received a copy of the GNU General Public License | ||||||
|  | + * along with this program; if not, write to the Free Software Foundation, | ||||||
|  | + * Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||||||
|  | + */ | ||||||
|  | + | ||||||
|  | +#ifndef __USB_CORE_EHCI_PDRIVER_H | ||||||
|  | +#define __USB_CORE_EHCI_PDRIVER_H | ||||||
|  | + | ||||||
|  | +/** | ||||||
|  | + * struct usb_ehci_pdata - platform_data for generic ehci driver | ||||||
|  | + * | ||||||
|  | + * @caps_offset:	offset of the EHCI Capability Registers to the start of | ||||||
|  | + *			the io memory region provided to the driver. | ||||||
|  | + * @has_tt:		set to 1 if TT is integrated in root hub. | ||||||
|  | + * @port_power_on:	set to 1 if the controller needs a power up after | ||||||
|  | + *			initialization. | ||||||
|  | + * @port_power_off:	set to 1 if the controller needs to be powered down | ||||||
|  | + *			after initialization. | ||||||
|  | + * | ||||||
|  | + * These are general configuration options for the EHCI controller. All of | ||||||
|  | + * these options are activating more or less workarounds for some hardware. | ||||||
|  | + */ | ||||||
|  | +struct usb_ehci_pdata { | ||||||
|  | +	int		caps_offset; | ||||||
|  | +	unsigned	has_tt:1; | ||||||
|  | +	unsigned	has_synopsys_hc_bug:1; | ||||||
|  | +	unsigned	big_endian_desc:1; | ||||||
|  | +	unsigned	big_endian_mmio:1; | ||||||
|  | +	unsigned	port_power_on:1; | ||||||
|  | +	unsigned	port_power_off:1; | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +#endif /* __USB_CORE_EHCI_PDRIVER_H */ | ||||||
| @@ -0,0 +1,45 @@ | |||||||
|  | --- a/drivers/bcma/scan.c | ||||||
|  | +++ b/drivers/bcma/scan.c | ||||||
|  | @@ -297,6 +297,23 @@ static int bcma_get_next_core(struct bcm | ||||||
|  |  			return -EILSEQ; | ||||||
|  |  	} | ||||||
|  |   | ||||||
|  | +	/* First Slave Address Descriptor should be port 0: | ||||||
|  | +	 * the main register space for the core | ||||||
|  | +	 */ | ||||||
|  | +	tmp = bcma_erom_get_addr_desc(bus, eromptr, SCAN_ADDR_TYPE_SLAVE, 0); | ||||||
|  | +	if (tmp <= 0) { | ||||||
|  | +		/* Try again to see if it is a bridge */ | ||||||
|  | +		tmp = bcma_erom_get_addr_desc(bus, eromptr, | ||||||
|  | +					      SCAN_ADDR_TYPE_BRIDGE, 0); | ||||||
|  | +		if (tmp <= 0) { | ||||||
|  | +			return -EILSEQ; | ||||||
|  | +		} else { | ||||||
|  | +			pr_info("Bridge found\n"); | ||||||
|  | +			return -ENXIO; | ||||||
|  | +		} | ||||||
|  | +	} | ||||||
|  | +	core->addr = tmp; | ||||||
|  | + | ||||||
|  |  	/* get & parse slave ports */ | ||||||
|  |  	for (i = 0; i < ports[1]; i++) { | ||||||
|  |  		for (j = 0; ; j++) { | ||||||
|  | @@ -309,7 +326,7 @@ static int bcma_get_next_core(struct bcm | ||||||
|  |  				break; | ||||||
|  |  			} else { | ||||||
|  |  				if (i == 0 && j == 0) | ||||||
|  | -					core->addr = tmp; | ||||||
|  | +					core->addr1 = tmp; | ||||||
|  |  			} | ||||||
|  |  		} | ||||||
|  |  	} | ||||||
|  | --- a/include/linux/bcma/bcma.h | ||||||
|  | +++ b/include/linux/bcma/bcma.h | ||||||
|  | @@ -139,6 +139,7 @@ struct bcma_device { | ||||||
|  |  	u8 core_unit; | ||||||
|  |   | ||||||
|  |  	u32 addr; | ||||||
|  | +	u32 addr1; | ||||||
|  |  	u32 wrap; | ||||||
|  |   | ||||||
|  |  	void __iomem *io_addr; | ||||||
| @@ -0,0 +1,362 @@ | |||||||
|  | --- a/drivers/usb/host/Kconfig | ||||||
|  | +++ b/drivers/usb/host/Kconfig | ||||||
|  | @@ -633,3 +633,15 @@ config USB_PXA168_EHCI | ||||||
|  |  	help | ||||||
|  |  	  Enable support for Marvell PXA168 SoC's on-chip EHCI | ||||||
|  |  	  host controller | ||||||
|  | + | ||||||
|  | +config USB_HCD_BCMA | ||||||
|  | +	tristate "BCMA usb host driver" | ||||||
|  | +	depends on BCMA && EXPERIMENTAL | ||||||
|  | +	select USB_OHCI_HCD_PLATFORM if USB_OHCI_HCD | ||||||
|  | +	select USB_EHCI_HCD_PLATFORM if USB_EHCI_HCD | ||||||
|  | +	help | ||||||
|  | +	  Enbale support for the EHCI and OCHI host controller on an bcma bus. | ||||||
|  | +	  It converts the bcma driver into two platform device drivers | ||||||
|  | +	  for ehci and ohci. | ||||||
|  | + | ||||||
|  | +	  If unsure, say N. | ||||||
|  | --- a/drivers/usb/host/Makefile | ||||||
|  | +++ b/drivers/usb/host/Makefile | ||||||
|  | @@ -37,3 +37,4 @@ obj-$(CONFIG_USB_IMX21_HCD)	+= imx21-hcd | ||||||
|  |  obj-$(CONFIG_USB_FSL_MPH_DR_OF)	+= fsl-mph-dr-of.o | ||||||
|  |  obj-$(CONFIG_USB_OCTEON2_COMMON) += octeon2-common.o | ||||||
|  |  obj-$(CONFIG_MIPS_ALCHEMY)	+= alchemy-common.o | ||||||
|  | +obj-$(CONFIG_USB_HCD_BCMA)	+= bcma-hcd.o | ||||||
|  | --- /dev/null | ||||||
|  | +++ b/drivers/usb/host/bcma-hcd.c | ||||||
|  | @@ -0,0 +1,334 @@ | ||||||
|  | +/* | ||||||
|  | + * Broadcom specific Advanced Microcontroller Bus | ||||||
|  | + * Broadcom USB-core driver (BCMA bus glue) | ||||||
|  | + * | ||||||
|  | + * Copyright 2011-2012 Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | + * | ||||||
|  | + * Based on ssb-ohci driver | ||||||
|  | + * Copyright 2007 Michael Buesch <m@bues.ch> | ||||||
|  | + * | ||||||
|  | + * Derived from the OHCI-PCI driver | ||||||
|  | + * Copyright 1999 Roman Weissgaerber | ||||||
|  | + * Copyright 2000-2002 David Brownell | ||||||
|  | + * Copyright 1999 Linus Torvalds | ||||||
|  | + * Copyright 1999 Gregory P. Smith | ||||||
|  | + * | ||||||
|  | + * Derived from the USBcore related parts of Broadcom-SB | ||||||
|  | + * Copyright 2005-2011 Broadcom Corporation | ||||||
|  | + * | ||||||
|  | + * Licensed under the GNU/GPL. See COPYING for details. | ||||||
|  | + */ | ||||||
|  | +#include <linux/bcma/bcma.h> | ||||||
|  | +#include <linux/delay.h> | ||||||
|  | +#include <linux/platform_device.h> | ||||||
|  | +#include <linux/module.h> | ||||||
|  | +#include <linux/usb/ehci_pdriver.h> | ||||||
|  | +#include <linux/usb/ohci_pdriver.h> | ||||||
|  | + | ||||||
|  | +MODULE_AUTHOR("Hauke Mehrtens"); | ||||||
|  | +MODULE_DESCRIPTION("Common USB driver for BCMA Bus"); | ||||||
|  | +MODULE_LICENSE("GPL"); | ||||||
|  | + | ||||||
|  | +struct bcma_hcd_device { | ||||||
|  | +	struct platform_device *ehci_dev; | ||||||
|  | +	struct platform_device *ohci_dev; | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +/* Wait for bitmask in a register to get set or cleared. | ||||||
|  | + * timeout is in units of ten-microseconds. | ||||||
|  | + */ | ||||||
|  | +static int bcma_wait_bits(struct bcma_device *dev, u16 reg, u32 bitmask, | ||||||
|  | +			  int timeout) | ||||||
|  | +{ | ||||||
|  | +	int i; | ||||||
|  | +	u32 val; | ||||||
|  | + | ||||||
|  | +	for (i = 0; i < timeout; i++) { | ||||||
|  | +		val = bcma_read32(dev, reg); | ||||||
|  | +		if ((val & bitmask) == bitmask) | ||||||
|  | +			return 0; | ||||||
|  | +		udelay(10); | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return -ETIMEDOUT; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void __devinit bcma_hcd_4716wa(struct bcma_device *dev) | ||||||
|  | +{ | ||||||
|  | +#ifdef CONFIG_BCMA_DRIVER_MIPS | ||||||
|  | +	/* Work around for 4716 failures. */ | ||||||
|  | +	if (dev->bus->chipinfo.id == 0x4716) { | ||||||
|  | +		u32 tmp; | ||||||
|  | + | ||||||
|  | +		tmp = bcma_cpu_clock(&dev->bus->drv_mips); | ||||||
|  | +		if (tmp >= 480000000) | ||||||
|  | +			tmp = 0x1846b; /* set CDR to 0x11(fast) */ | ||||||
|  | +		else if (tmp == 453000000) | ||||||
|  | +			tmp = 0x1046b; /* set CDR to 0x10(slow) */ | ||||||
|  | +		else | ||||||
|  | +			tmp = 0; | ||||||
|  | + | ||||||
|  | +		/* Change Shim mdio control reg to fix host not acking at | ||||||
|  | +		 * high frequencies | ||||||
|  | +		 */ | ||||||
|  | +		if (tmp) { | ||||||
|  | +			bcma_write32(dev, 0x524, 0x1); /* write sel to enable */ | ||||||
|  | +			udelay(500); | ||||||
|  | + | ||||||
|  | +			bcma_write32(dev, 0x524, tmp); | ||||||
|  | +			udelay(500); | ||||||
|  | +			bcma_write32(dev, 0x524, 0x4ab); | ||||||
|  | +			udelay(500); | ||||||
|  | +			bcma_read32(dev, 0x528); | ||||||
|  | +			bcma_write32(dev, 0x528, 0x80000000); | ||||||
|  | +		} | ||||||
|  | +	} | ||||||
|  | +#endif /* CONFIG_BCMA_DRIVER_MIPS */ | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +/* based on arch/mips/brcm-boards/bcm947xx/pcibios.c */ | ||||||
|  | +static void __devinit bcma_hcd_init_chip(struct bcma_device *dev) | ||||||
|  | +{ | ||||||
|  | +	u32 tmp; | ||||||
|  | + | ||||||
|  | +	/* | ||||||
|  | +	 * USB 2.0 special considerations: | ||||||
|  | +	 * | ||||||
|  | +	 * 1. Since the core supports both OHCI and EHCI functions, it must | ||||||
|  | +	 *    only be reset once. | ||||||
|  | +	 * | ||||||
|  | +	 * 2. In addition to the standard SI reset sequence, the Host Control | ||||||
|  | +	 *    Register must be programmed to bring the USB core and various | ||||||
|  | +	 *    phy components out of reset. | ||||||
|  | +	 */ | ||||||
|  | +	if (!bcma_core_is_enabled(dev)) { | ||||||
|  | +		bcma_core_enable(dev, 0); | ||||||
|  | +		mdelay(10); | ||||||
|  | +		if (dev->id.rev >= 5) { | ||||||
|  | +			/* Enable Misc PLL */ | ||||||
|  | +			tmp = bcma_read32(dev, 0x1e0); | ||||||
|  | +			tmp |= 0x100; | ||||||
|  | +			bcma_write32(dev, 0x1e0, tmp); | ||||||
|  | +			if (bcma_wait_bits(dev, 0x1e0, 1 << 24, 100)) | ||||||
|  | +				printk(KERN_EMERG "Failed to enable misc PPL!\n"); | ||||||
|  | + | ||||||
|  | +			/* Take out of resets */ | ||||||
|  | +			bcma_write32(dev, 0x200, 0x4ff); | ||||||
|  | +			udelay(25); | ||||||
|  | +			bcma_write32(dev, 0x200, 0x6ff); | ||||||
|  | +			udelay(25); | ||||||
|  | + | ||||||
|  | +			/* Make sure digital and AFE are locked in USB PHY */ | ||||||
|  | +			bcma_write32(dev, 0x524, 0x6b); | ||||||
|  | +			udelay(50); | ||||||
|  | +			tmp = bcma_read32(dev, 0x524); | ||||||
|  | +			udelay(50); | ||||||
|  | +			bcma_write32(dev, 0x524, 0xab); | ||||||
|  | +			udelay(50); | ||||||
|  | +			tmp = bcma_read32(dev, 0x524); | ||||||
|  | +			udelay(50); | ||||||
|  | +			bcma_write32(dev, 0x524, 0x2b); | ||||||
|  | +			udelay(50); | ||||||
|  | +			tmp = bcma_read32(dev, 0x524); | ||||||
|  | +			udelay(50); | ||||||
|  | +			bcma_write32(dev, 0x524, 0x10ab); | ||||||
|  | +			udelay(50); | ||||||
|  | +			tmp = bcma_read32(dev, 0x524); | ||||||
|  | + | ||||||
|  | +			if (bcma_wait_bits(dev, 0x528, 0xc000, 10000)) { | ||||||
|  | +				tmp = bcma_read32(dev, 0x528); | ||||||
|  | +				printk(KERN_EMERG | ||||||
|  | +				       "USB20H mdio_rddata 0x%08x\n", tmp); | ||||||
|  | +			} | ||||||
|  | +			bcma_write32(dev, 0x528, 0x80000000); | ||||||
|  | +			tmp = bcma_read32(dev, 0x314); | ||||||
|  | +			udelay(265); | ||||||
|  | +			bcma_write32(dev, 0x200, 0x7ff); | ||||||
|  | +			udelay(10); | ||||||
|  | + | ||||||
|  | +			/* Take USB and HSIC out of non-driving modes */ | ||||||
|  | +			bcma_write32(dev, 0x510, 0); | ||||||
|  | +		} else { | ||||||
|  | +			bcma_write32(dev, 0x200, 0x7ff); | ||||||
|  | + | ||||||
|  | +			udelay(1); | ||||||
|  | +		} | ||||||
|  | + | ||||||
|  | +		bcma_hcd_4716wa(dev); | ||||||
|  | +	} | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static const struct usb_ehci_pdata ehci_pdata = { | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static const struct usb_ohci_pdata ohci_pdata = { | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static struct platform_device * __devinit | ||||||
|  | +bcma_hcd_create_pdev(struct bcma_device *dev, bool ohci, u32 addr) | ||||||
|  | +{ | ||||||
|  | +	struct platform_device *hci_dev; | ||||||
|  | +	struct resource hci_res[2]; | ||||||
|  | +	int ret = -ENOMEM; | ||||||
|  | + | ||||||
|  | +	memset(hci_res, 0, sizeof(hci_res)); | ||||||
|  | + | ||||||
|  | +	hci_res[0].start = addr; | ||||||
|  | +	hci_res[0].end = hci_res[0].start + 0x1000 - 1; | ||||||
|  | +	hci_res[0].flags = IORESOURCE_MEM; | ||||||
|  | + | ||||||
|  | +	hci_res[1].start = dev->irq; | ||||||
|  | +	hci_res[1].flags = IORESOURCE_IRQ; | ||||||
|  | + | ||||||
|  | +	hci_dev = platform_device_alloc(ohci ? "ohci-platform" : | ||||||
|  | +					"ehci-platform" , 0); | ||||||
|  | +	if (!hci_dev) | ||||||
|  | +		return NULL; | ||||||
|  | + | ||||||
|  | +	hci_dev->dev.parent = &dev->dev; | ||||||
|  | +	hci_dev->dev.dma_mask = &hci_dev->dev.coherent_dma_mask; | ||||||
|  | + | ||||||
|  | +	ret = platform_device_add_resources(hci_dev, hci_res, | ||||||
|  | +					    ARRAY_SIZE(hci_res)); | ||||||
|  | +	if (ret) | ||||||
|  | +		goto err_alloc; | ||||||
|  | +	if (ohci) | ||||||
|  | +		ret = platform_device_add_data(hci_dev, &ohci_pdata, | ||||||
|  | +					       sizeof(ohci_pdata)); | ||||||
|  | +	else | ||||||
|  | +		ret = platform_device_add_data(hci_dev, &ehci_pdata, | ||||||
|  | +					       sizeof(ehci_pdata)); | ||||||
|  | +	if (ret) | ||||||
|  | +		goto err_alloc; | ||||||
|  | +	ret = platform_device_add(hci_dev); | ||||||
|  | +	if (ret) | ||||||
|  | +		goto err_alloc; | ||||||
|  | + | ||||||
|  | +	return hci_dev; | ||||||
|  | + | ||||||
|  | +err_alloc: | ||||||
|  | +	platform_device_put(hci_dev); | ||||||
|  | +	return ERR_PTR(ret); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int __devinit bcma_hcd_probe(struct bcma_device *dev) | ||||||
|  | +{ | ||||||
|  | +	int err; | ||||||
|  | +	u16 chipid_top; | ||||||
|  | +	u32 ohci_addr; | ||||||
|  | +	struct bcma_hcd_device *usb_dev; | ||||||
|  | +	struct bcma_chipinfo *chipinfo; | ||||||
|  | + | ||||||
|  | +	chipinfo = &dev->bus->chipinfo; | ||||||
|  | +	/* USBcores are only connected on embedded devices. */ | ||||||
|  | +	chipid_top = (chipinfo->id & 0xFF00); | ||||||
|  | +	if (chipid_top != 0x4700 && chipid_top != 0x5300) | ||||||
|  | +		return -ENODEV; | ||||||
|  | + | ||||||
|  | +	/* TODO: Probably need checks here; is the core connected? */ | ||||||
|  | + | ||||||
|  | +	if (dma_set_mask(dev->dma_dev, DMA_BIT_MASK(32)) || | ||||||
|  | +	    dma_set_coherent_mask(dev->dma_dev, DMA_BIT_MASK(32))) | ||||||
|  | +		return -EOPNOTSUPP; | ||||||
|  | + | ||||||
|  | +	usb_dev = kzalloc(sizeof(struct bcma_hcd_device), GFP_KERNEL); | ||||||
|  | +	if (!usb_dev) | ||||||
|  | +		return -ENOMEM; | ||||||
|  | + | ||||||
|  | +	bcma_hcd_init_chip(dev); | ||||||
|  | + | ||||||
|  | +	/* In AI chips EHCI is addrspace 0, OHCI is 1 */ | ||||||
|  | +	ohci_addr = dev->addr1; | ||||||
|  | +	if ((chipinfo->id == 0x5357 || chipinfo->id == 0x4749) | ||||||
|  | +	    && chipinfo->rev == 0) | ||||||
|  | +		ohci_addr = 0x18009000; | ||||||
|  | + | ||||||
|  | +	usb_dev->ohci_dev = bcma_hcd_create_pdev(dev, true, ohci_addr); | ||||||
|  | +	if (IS_ERR(usb_dev->ohci_dev)) { | ||||||
|  | +		err = PTR_ERR(usb_dev->ohci_dev); | ||||||
|  | +		goto err_free_usb_dev; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	usb_dev->ehci_dev = bcma_hcd_create_pdev(dev, false, dev->addr); | ||||||
|  | +	if (IS_ERR(usb_dev->ehci_dev)) { | ||||||
|  | +		err = PTR_ERR(usb_dev->ehci_dev); | ||||||
|  | +		goto err_unregister_ohci_dev; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	bcma_set_drvdata(dev, usb_dev); | ||||||
|  | +	return 0; | ||||||
|  | + | ||||||
|  | +err_unregister_ohci_dev: | ||||||
|  | +	platform_device_unregister(usb_dev->ohci_dev); | ||||||
|  | +err_free_usb_dev: | ||||||
|  | +	kfree(usb_dev); | ||||||
|  | +	return err; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void __devexit bcma_hcd_remove(struct bcma_device *dev) | ||||||
|  | +{ | ||||||
|  | +	struct bcma_hcd_device *usb_dev = bcma_get_drvdata(dev); | ||||||
|  | +	struct platform_device *ohci_dev = usb_dev->ohci_dev; | ||||||
|  | +	struct platform_device *ehci_dev = usb_dev->ehci_dev; | ||||||
|  | + | ||||||
|  | +	if (ohci_dev) | ||||||
|  | +		platform_device_unregister(ohci_dev); | ||||||
|  | +	if (ehci_dev) | ||||||
|  | +		platform_device_unregister(ehci_dev); | ||||||
|  | + | ||||||
|  | +	bcma_core_disable(dev, 0); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void bcma_hcd_shutdown(struct bcma_device *dev) | ||||||
|  | +{ | ||||||
|  | +	bcma_core_disable(dev, 0); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +#ifdef CONFIG_PM | ||||||
|  | + | ||||||
|  | +static int bcma_hcd_suspend(struct bcma_device *dev, pm_message_t state) | ||||||
|  | +{ | ||||||
|  | +	bcma_core_disable(dev, 0); | ||||||
|  | + | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int bcma_hcd_resume(struct bcma_device *dev) | ||||||
|  | +{ | ||||||
|  | +	bcma_core_enable(dev, 0); | ||||||
|  | + | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +#else /* !CONFIG_PM */ | ||||||
|  | +#define bcma_hcd_suspend	NULL | ||||||
|  | +#define bcma_hcd_resume	NULL | ||||||
|  | +#endif /* CONFIG_PM */ | ||||||
|  | + | ||||||
|  | +static const struct bcma_device_id bcma_hcd_table[] __devinitconst = { | ||||||
|  | +	BCMA_CORE(BCMA_MANUF_BCM, BCMA_CORE_USB20_HOST, BCMA_ANY_REV, BCMA_ANY_CLASS), | ||||||
|  | +	BCMA_CORETABLE_END | ||||||
|  | +}; | ||||||
|  | +MODULE_DEVICE_TABLE(bcma, bcma_hcd_table); | ||||||
|  | + | ||||||
|  | +static struct bcma_driver bcma_hcd_driver = { | ||||||
|  | +	.name		= KBUILD_MODNAME, | ||||||
|  | +	.id_table	= bcma_hcd_table, | ||||||
|  | +	.probe		= bcma_hcd_probe, | ||||||
|  | +	.remove		= __devexit_p(bcma_hcd_remove), | ||||||
|  | +	.shutdown	= bcma_hcd_shutdown, | ||||||
|  | +	.suspend	= bcma_hcd_suspend, | ||||||
|  | +	.resume		= bcma_hcd_resume, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static int __init bcma_hcd_init(void) | ||||||
|  | +{ | ||||||
|  | +	return bcma_driver_register(&bcma_hcd_driver); | ||||||
|  | +} | ||||||
|  | +module_init(bcma_hcd_init); | ||||||
|  | + | ||||||
|  | +static void __exit bcma_hcd_exit(void) | ||||||
|  | +{ | ||||||
|  | +	bcma_driver_unregister(&bcma_hcd_driver); | ||||||
|  | +} | ||||||
|  | +module_exit(bcma_hcd_exit); | ||||||
| @@ -0,0 +1,308 @@ | |||||||
|  |  | ||||||
|  | --- a/drivers/usb/host/Kconfig | ||||||
|  | +++ b/drivers/usb/host/Kconfig | ||||||
|  | @@ -645,3 +645,15 @@ config USB_HCD_BCMA | ||||||
|  |  	  for ehci and ohci. | ||||||
|  |   | ||||||
|  |  	  If unsure, say N. | ||||||
|  | + | ||||||
|  | +config USB_HCD_SSB | ||||||
|  | +	tristate "SSB usb host driver" | ||||||
|  | +	depends on SSB && EXPERIMENTAL | ||||||
|  | +	select USB_OHCI_HCD_PLATFORM if USB_OHCI_HCD | ||||||
|  | +	select USB_EHCI_HCD_PLATFORM if USB_EHCI_HCD | ||||||
|  | +	help | ||||||
|  | +	  Enbale support for the EHCI and OCHI host controller on an bcma bus. | ||||||
|  | +	  It converts the bcma driver into two platform device drivers | ||||||
|  | +	  for ehci and ohci. | ||||||
|  | + | ||||||
|  | +	  If unsure, say N. | ||||||
|  | --- a/drivers/usb/host/Makefile | ||||||
|  | +++ b/drivers/usb/host/Makefile | ||||||
|  | @@ -38,3 +38,4 @@ obj-$(CONFIG_USB_FSL_MPH_DR_OF)	+= fsl-m | ||||||
|  |  obj-$(CONFIG_USB_OCTEON2_COMMON) += octeon2-common.o | ||||||
|  |  obj-$(CONFIG_MIPS_ALCHEMY)	+= alchemy-common.o | ||||||
|  |  obj-$(CONFIG_USB_HCD_BCMA)	+= bcma-hcd.o | ||||||
|  | +obj-$(CONFIG_USB_HCD_SSB)	+= ssb-hcd.o | ||||||
|  | --- /dev/null | ||||||
|  | +++ b/drivers/usb/host/ssb-hcd.c | ||||||
|  | @@ -0,0 +1,279 @@ | ||||||
|  | +/* | ||||||
|  | + * Sonics Silicon Backplane | ||||||
|  | + * Broadcom USB-core driver  (SSB bus glue) | ||||||
|  | + * | ||||||
|  | + * Copyright 2011-2012 Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | + * | ||||||
|  | + * Based on ssb-ohci driver | ||||||
|  | + * Copyright 2007 Michael Buesch <m@bues.ch> | ||||||
|  | + * | ||||||
|  | + * Derived from the OHCI-PCI driver | ||||||
|  | + * Copyright 1999 Roman Weissgaerber | ||||||
|  | + * Copyright 2000-2002 David Brownell | ||||||
|  | + * Copyright 1999 Linus Torvalds | ||||||
|  | + * Copyright 1999 Gregory P. Smith | ||||||
|  | + * | ||||||
|  | + * Derived from the USBcore related parts of Broadcom-SB | ||||||
|  | + * Copyright 2005-2011 Broadcom Corporation | ||||||
|  | + * | ||||||
|  | + * Licensed under the GNU/GPL. See COPYING for details. | ||||||
|  | + */ | ||||||
|  | +#include <linux/ssb/ssb.h> | ||||||
|  | +#include <linux/delay.h> | ||||||
|  | +#include <linux/platform_device.h> | ||||||
|  | +#include <linux/module.h> | ||||||
|  | +#include <linux/usb/ehci_pdriver.h> | ||||||
|  | +#include <linux/usb/ohci_pdriver.h> | ||||||
|  | + | ||||||
|  | +MODULE_AUTHOR("Hauke Mehrtens"); | ||||||
|  | +MODULE_DESCRIPTION("Common USB driver for SSB Bus"); | ||||||
|  | +MODULE_LICENSE("GPL"); | ||||||
|  | + | ||||||
|  | +#define SSB_HCD_TMSLOW_HOSTMODE	(1 << 29) | ||||||
|  | + | ||||||
|  | +struct ssb_hcd_device { | ||||||
|  | +	struct platform_device *ehci_dev; | ||||||
|  | +	struct platform_device *ohci_dev; | ||||||
|  | + | ||||||
|  | +	u32 enable_flags; | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static void __devinit ssb_hcd_5354wa(struct ssb_device *dev) | ||||||
|  | +{ | ||||||
|  | +#ifdef CONFIG_SSB_DRIVER_MIPS | ||||||
|  | +	/* Work around for 5354 failures */ | ||||||
|  | +	if (dev->id.revision == 2 && dev->bus->chip_id == 0x5354) { | ||||||
|  | +		/* Change syn01 reg */ | ||||||
|  | +		ssb_write32(dev, 0x894, 0x00fe00fe); | ||||||
|  | + | ||||||
|  | +		/* Change syn03 reg */ | ||||||
|  | +		ssb_write32(dev, 0x89c, ssb_read32(dev, 0x89c) | 0x1); | ||||||
|  | +	} | ||||||
|  | +#endif | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void __devinit ssb_hcd_usb20wa(struct ssb_device *dev) | ||||||
|  | +{ | ||||||
|  | +	if (dev->id.coreid == SSB_DEV_USB20_HOST) { | ||||||
|  | +		/* | ||||||
|  | +		 * USB 2.0 special considerations: | ||||||
|  | +		 * | ||||||
|  | +		 * In addition to the standard SSB reset sequence, the Host | ||||||
|  | +		 * Control Register must be programmed to bring the USB core | ||||||
|  | +		 * and various phy components out of reset. | ||||||
|  | +		 */ | ||||||
|  | +		ssb_write32(dev, 0x200, 0x7ff); | ||||||
|  | + | ||||||
|  | +		/* Change Flush control reg */ | ||||||
|  | +		ssb_write32(dev, 0x400, ssb_read32(dev, 0x400) & ~8); | ||||||
|  | +		ssb_read32(dev, 0x400); | ||||||
|  | + | ||||||
|  | +		/* Change Shim control reg */ | ||||||
|  | +		ssb_write32(dev, 0x304, ssb_read32(dev, 0x304) & ~0x100); | ||||||
|  | +		ssb_read32(dev, 0x304); | ||||||
|  | + | ||||||
|  | +		udelay(1); | ||||||
|  | + | ||||||
|  | +		ssb_hcd_5354wa(dev); | ||||||
|  | +	} | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +/* based on arch/mips/brcm-boards/bcm947xx/pcibios.c */ | ||||||
|  | +static u32 __devinit ssb_hcd_init_chip(struct ssb_device *dev) | ||||||
|  | +{ | ||||||
|  | +	u32 flags = 0; | ||||||
|  | + | ||||||
|  | +	if (dev->id.coreid == SSB_DEV_USB11_HOSTDEV) | ||||||
|  | +		/* Put the device into host-mode. */ | ||||||
|  | +		flags |= SSB_HCD_TMSLOW_HOSTMODE; | ||||||
|  | + | ||||||
|  | +	ssb_device_enable(dev, flags); | ||||||
|  | + | ||||||
|  | +	ssb_hcd_usb20wa(dev); | ||||||
|  | + | ||||||
|  | +	return flags; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static const struct usb_ehci_pdata ehci_pdata = { | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static const struct usb_ohci_pdata ohci_pdata = { | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static struct platform_device * __devinit | ||||||
|  | +ssb_hcd_create_pdev(struct ssb_device *dev, bool ohci, u32 addr, u32 len) | ||||||
|  | +{ | ||||||
|  | +	struct platform_device *hci_dev; | ||||||
|  | +	struct resource hci_res[2]; | ||||||
|  | +	int ret = -ENOMEM; | ||||||
|  | + | ||||||
|  | +	memset(hci_res, 0, sizeof(hci_res)); | ||||||
|  | + | ||||||
|  | +	hci_res[0].start = addr; | ||||||
|  | +	hci_res[0].end = hci_res[0].start + len - 1; | ||||||
|  | +	hci_res[0].flags = IORESOURCE_MEM; | ||||||
|  | + | ||||||
|  | +	hci_res[1].start = dev->irq; | ||||||
|  | +	hci_res[1].flags = IORESOURCE_IRQ; | ||||||
|  | + | ||||||
|  | +	hci_dev = platform_device_alloc(ohci ? "ohci-platform" : | ||||||
|  | +					"ehci-platform" , 0); | ||||||
|  | +	if (!hci_dev) | ||||||
|  | +		return NULL; | ||||||
|  | + | ||||||
|  | +	hci_dev->dev.parent = dev->dev; | ||||||
|  | +	hci_dev->dev.dma_mask = &hci_dev->dev.coherent_dma_mask; | ||||||
|  | + | ||||||
|  | +	ret = platform_device_add_resources(hci_dev, hci_res, | ||||||
|  | +					    ARRAY_SIZE(hci_res)); | ||||||
|  | +	if (ret) | ||||||
|  | +		goto err_alloc; | ||||||
|  | +	if (ohci) | ||||||
|  | +		ret = platform_device_add_data(hci_dev, &ohci_pdata, | ||||||
|  | +					       sizeof(ohci_pdata)); | ||||||
|  | +	else | ||||||
|  | +		ret = platform_device_add_data(hci_dev, &ehci_pdata, | ||||||
|  | +					       sizeof(ehci_pdata)); | ||||||
|  | +	if (ret) | ||||||
|  | +		goto err_alloc; | ||||||
|  | +	ret = platform_device_add(hci_dev); | ||||||
|  | +	if (ret) | ||||||
|  | +		goto err_alloc; | ||||||
|  | + | ||||||
|  | +	return hci_dev; | ||||||
|  | + | ||||||
|  | +err_alloc: | ||||||
|  | +	platform_device_put(hci_dev); | ||||||
|  | +	return ERR_PTR(ret); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int __devinit ssb_hcd_probe(struct ssb_device *dev, | ||||||
|  | +				   const struct ssb_device_id *id) | ||||||
|  | +{ | ||||||
|  | +	int err, tmp; | ||||||
|  | +	int start, len; | ||||||
|  | +	u16 chipid_top; | ||||||
|  | +	u16 coreid = dev->id.coreid; | ||||||
|  | +	struct ssb_hcd_device *usb_dev; | ||||||
|  | + | ||||||
|  | +	/* USBcores are only connected on embedded devices. */ | ||||||
|  | +	chipid_top = (dev->bus->chip_id & 0xFF00); | ||||||
|  | +	if (chipid_top != 0x4700 && chipid_top != 0x5300) | ||||||
|  | +		return -ENODEV; | ||||||
|  | + | ||||||
|  | +	/* TODO: Probably need checks here; is the core connected? */ | ||||||
|  | + | ||||||
|  | +	if (dma_set_mask(dev->dma_dev, DMA_BIT_MASK(32)) || | ||||||
|  | +	    dma_set_coherent_mask(dev->dma_dev, DMA_BIT_MASK(32))) | ||||||
|  | +		return -EOPNOTSUPP; | ||||||
|  | + | ||||||
|  | +	usb_dev = kzalloc(sizeof(struct ssb_hcd_device), GFP_KERNEL); | ||||||
|  | +	if (!usb_dev) | ||||||
|  | +		return -ENOMEM; | ||||||
|  | + | ||||||
|  | +	/* We currently always attach SSB_DEV_USB11_HOSTDEV | ||||||
|  | +	 * as HOST OHCI. If we want to attach it as Client device, | ||||||
|  | +	 * we must branch here and call into the (yet to | ||||||
|  | +	 * be written) Client mode driver. Same for remove(). */ | ||||||
|  | +	usb_dev->enable_flags = ssb_hcd_init_chip(dev); | ||||||
|  | + | ||||||
|  | +	tmp = ssb_read32(dev, SSB_ADMATCH0); | ||||||
|  | + | ||||||
|  | +	start = ssb_admatch_base(tmp); | ||||||
|  | +	len = (coreid == SSB_DEV_USB20_HOST) ? 0x800 : ssb_admatch_size(tmp); | ||||||
|  | +	usb_dev->ohci_dev = ssb_hcd_create_pdev(dev, true, start, len); | ||||||
|  | +	if (IS_ERR(usb_dev->ohci_dev)) { | ||||||
|  | +		err = PTR_ERR(usb_dev->ohci_dev); | ||||||
|  | +		goto err_free_usb_dev; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	if (coreid == SSB_DEV_USB20_HOST) { | ||||||
|  | +		start = ssb_admatch_base(tmp) + 0x800; /* ehci core offset */ | ||||||
|  | +		usb_dev->ehci_dev = ssb_hcd_create_pdev(dev, false, start, len); | ||||||
|  | +		if (IS_ERR(usb_dev->ehci_dev)) { | ||||||
|  | +			err = PTR_ERR(usb_dev->ehci_dev); | ||||||
|  | +			goto err_unregister_ohci_dev; | ||||||
|  | +		} | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	ssb_set_drvdata(dev, usb_dev); | ||||||
|  | +	return 0; | ||||||
|  | + | ||||||
|  | +err_unregister_ohci_dev: | ||||||
|  | +	platform_device_unregister(usb_dev->ohci_dev); | ||||||
|  | +err_free_usb_dev: | ||||||
|  | +	kfree(usb_dev); | ||||||
|  | +	return err; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void __devexit ssb_hcd_remove(struct ssb_device *dev) | ||||||
|  | +{ | ||||||
|  | +	struct ssb_hcd_device *usb_dev = ssb_get_drvdata(dev); | ||||||
|  | +	struct platform_device *ohci_dev = usb_dev->ohci_dev; | ||||||
|  | +	struct platform_device *ehci_dev = usb_dev->ehci_dev; | ||||||
|  | + | ||||||
|  | +	if (ohci_dev) | ||||||
|  | +		platform_device_unregister(ohci_dev); | ||||||
|  | +	if (ehci_dev) | ||||||
|  | +		platform_device_unregister(ehci_dev); | ||||||
|  | + | ||||||
|  | +	ssb_device_disable(dev, 0); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void __devexit ssb_hcd_shutdown(struct ssb_device *dev) | ||||||
|  | +{ | ||||||
|  | +	ssb_device_disable(dev, 0); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +#ifdef CONFIG_PM | ||||||
|  | + | ||||||
|  | +static int ssb_hcd_suspend(struct ssb_device *dev, pm_message_t state) | ||||||
|  | +{ | ||||||
|  | +	ssb_device_disable(dev, 0); | ||||||
|  | + | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int ssb_hcd_resume(struct ssb_device *dev) | ||||||
|  | +{ | ||||||
|  | +	struct ssb_hcd_device *usb_dev = ssb_get_drvdata(dev); | ||||||
|  | + | ||||||
|  | +	ssb_device_enable(dev, usb_dev->enable_flags); | ||||||
|  | + | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +#else /* !CONFIG_PM */ | ||||||
|  | +#define ssb_hcd_suspend	NULL | ||||||
|  | +#define ssb_hcd_resume	NULL | ||||||
|  | +#endif /* CONFIG_PM */ | ||||||
|  | + | ||||||
|  | +static const struct ssb_device_id ssb_hcd_table[] __devinitconst = { | ||||||
|  | +	SSB_DEVICE(SSB_VENDOR_BROADCOM, SSB_DEV_USB11_HOSTDEV, SSB_ANY_REV), | ||||||
|  | +	SSB_DEVICE(SSB_VENDOR_BROADCOM, SSB_DEV_USB11_HOST, SSB_ANY_REV), | ||||||
|  | +	SSB_DEVICE(SSB_VENDOR_BROADCOM, SSB_DEV_USB20_HOST, SSB_ANY_REV), | ||||||
|  | +	SSB_DEVTABLE_END | ||||||
|  | +}; | ||||||
|  | +MODULE_DEVICE_TABLE(ssb, ssb_hcd_table); | ||||||
|  | + | ||||||
|  | +static struct ssb_driver ssb_hcd_driver = { | ||||||
|  | +	.name		= KBUILD_MODNAME, | ||||||
|  | +	.id_table	= ssb_hcd_table, | ||||||
|  | +	.probe		= ssb_hcd_probe, | ||||||
|  | +	.remove		= __devexit_p(ssb_hcd_remove), | ||||||
|  | +	.shutdown	= ssb_hcd_shutdown, | ||||||
|  | +	.suspend	= ssb_hcd_suspend, | ||||||
|  | +	.resume		= ssb_hcd_resume, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static int __init ssb_hcd_init(void) | ||||||
|  | +{ | ||||||
|  | +	return ssb_driver_register(&ssb_hcd_driver); | ||||||
|  | +} | ||||||
|  | +module_init(ssb_hcd_init); | ||||||
|  | + | ||||||
|  | +static void __exit ssb_hcd_exit(void) | ||||||
|  | +{ | ||||||
|  | +	ssb_driver_unregister(&ssb_hcd_driver); | ||||||
|  | +} | ||||||
|  | +module_exit(ssb_hcd_exit); | ||||||
| @@ -0,0 +1,340 @@ | |||||||
|  | --- a/drivers/usb/host/Kconfig | ||||||
|  | +++ b/drivers/usb/host/Kconfig | ||||||
|  | @@ -361,10 +361,15 @@ config USB_OHCI_HCD_PCI | ||||||
|  |  	  If unsure, say Y. | ||||||
|  |   | ||||||
|  |  config USB_OHCI_HCD_SSB | ||||||
|  | -	bool "OHCI support for Broadcom SSB OHCI core" | ||||||
|  | +	bool "OHCI support for Broadcom SSB OHCI core (DEPRECATED)" | ||||||
|  |  	depends on USB_OHCI_HCD && (SSB = y || SSB = USB_OHCI_HCD) && EXPERIMENTAL | ||||||
|  | +	select USB_HCD_SSB | ||||||
|  | +	select USB_OHCI_HCD_PLATFORM | ||||||
|  |  	default n | ||||||
|  |  	---help--- | ||||||
|  | +	  This option is deprecated now and the driver was removed, use | ||||||
|  | +	  USB_HCD_SSB and USB_OHCI_HCD_PLATFORM instead. | ||||||
|  | + | ||||||
|  |  	  Support for the Sonics Silicon Backplane (SSB) attached | ||||||
|  |  	  Broadcom USB OHCI core. | ||||||
|  |   | ||||||
|  | --- a/drivers/usb/host/ohci-hcd.c | ||||||
|  | +++ b/drivers/usb/host/ohci-hcd.c | ||||||
|  | @@ -1081,11 +1081,6 @@ MODULE_LICENSE ("GPL"); | ||||||
|  |  #define PS3_SYSTEM_BUS_DRIVER	ps3_ohci_driver | ||||||
|  |  #endif | ||||||
|  |   | ||||||
|  | -#ifdef CONFIG_USB_OHCI_HCD_SSB | ||||||
|  | -#include "ohci-ssb.c" | ||||||
|  | -#define SSB_OHCI_DRIVER		ssb_ohci_driver | ||||||
|  | -#endif | ||||||
|  | - | ||||||
|  |  #ifdef CONFIG_MFD_SM501 | ||||||
|  |  #include "ohci-sm501.c" | ||||||
|  |  #define SM501_OHCI_DRIVER	ohci_hcd_sm501_driver | ||||||
|  | @@ -1134,8 +1129,7 @@ MODULE_LICENSE ("GPL"); | ||||||
|  |  	!defined(SA1111_DRIVER) &&	\ | ||||||
|  |  	!defined(PS3_SYSTEM_BUS_DRIVER) && \ | ||||||
|  |  	!defined(SM501_OHCI_DRIVER) && \ | ||||||
|  | -	!defined(TMIO_OHCI_DRIVER) && \ | ||||||
|  | -	!defined(SSB_OHCI_DRIVER) | ||||||
|  | +	!defined(TMIO_OHCI_DRIVER) | ||||||
|  |  #error "missing bus glue for ohci-hcd" | ||||||
|  |  #endif | ||||||
|  |   | ||||||
|  | @@ -1201,12 +1195,6 @@ static int __init ohci_hcd_mod_init(void | ||||||
|  |  		goto error_pci; | ||||||
|  |  #endif | ||||||
|  |   | ||||||
|  | -#ifdef SSB_OHCI_DRIVER | ||||||
|  | -	retval = ssb_driver_register(&SSB_OHCI_DRIVER); | ||||||
|  | -	if (retval) | ||||||
|  | -		goto error_ssb; | ||||||
|  | -#endif | ||||||
|  | - | ||||||
|  |  #ifdef SM501_OHCI_DRIVER | ||||||
|  |  	retval = platform_driver_register(&SM501_OHCI_DRIVER); | ||||||
|  |  	if (retval < 0) | ||||||
|  | @@ -1230,10 +1218,6 @@ static int __init ohci_hcd_mod_init(void | ||||||
|  |  	platform_driver_unregister(&SM501_OHCI_DRIVER); | ||||||
|  |   error_sm501: | ||||||
|  |  #endif | ||||||
|  | -#ifdef SSB_OHCI_DRIVER | ||||||
|  | -	ssb_driver_unregister(&SSB_OHCI_DRIVER); | ||||||
|  | - error_ssb: | ||||||
|  | -#endif | ||||||
|  |  #ifdef PCI_DRIVER | ||||||
|  |  	pci_unregister_driver(&PCI_DRIVER); | ||||||
|  |   error_pci: | ||||||
|  | @@ -1281,9 +1265,6 @@ static void __exit ohci_hcd_mod_exit(voi | ||||||
|  |  #ifdef SM501_OHCI_DRIVER | ||||||
|  |  	platform_driver_unregister(&SM501_OHCI_DRIVER); | ||||||
|  |  #endif | ||||||
|  | -#ifdef SSB_OHCI_DRIVER | ||||||
|  | -	ssb_driver_unregister(&SSB_OHCI_DRIVER); | ||||||
|  | -#endif | ||||||
|  |  #ifdef PCI_DRIVER | ||||||
|  |  	pci_unregister_driver(&PCI_DRIVER); | ||||||
|  |  #endif | ||||||
|  | --- a/drivers/usb/host/ohci-ssb.c | ||||||
|  | +++ /dev/null | ||||||
|  | @@ -1,260 +0,0 @@ | ||||||
|  | -/* | ||||||
|  | - * Sonics Silicon Backplane | ||||||
|  | - * Broadcom USB-core OHCI driver | ||||||
|  | - * | ||||||
|  | - * Copyright 2007 Michael Buesch <m@bues.ch> | ||||||
|  | - * | ||||||
|  | - * Derived from the OHCI-PCI driver | ||||||
|  | - * Copyright 1999 Roman Weissgaerber | ||||||
|  | - * Copyright 2000-2002 David Brownell | ||||||
|  | - * Copyright 1999 Linus Torvalds | ||||||
|  | - * Copyright 1999 Gregory P. Smith | ||||||
|  | - * | ||||||
|  | - * Derived from the USBcore related parts of Broadcom-SB | ||||||
|  | - * Copyright 2005 Broadcom Corporation | ||||||
|  | - * | ||||||
|  | - * Licensed under the GNU/GPL. See COPYING for details. | ||||||
|  | - */ | ||||||
|  | -#include <linux/ssb/ssb.h> | ||||||
|  | - | ||||||
|  | - | ||||||
|  | -#define SSB_OHCI_TMSLOW_HOSTMODE	(1 << 29) | ||||||
|  | - | ||||||
|  | -struct ssb_ohci_device { | ||||||
|  | -	struct ohci_hcd ohci; /* _must_ be at the beginning. */ | ||||||
|  | - | ||||||
|  | -	u32 enable_flags; | ||||||
|  | -}; | ||||||
|  | - | ||||||
|  | -static inline | ||||||
|  | -struct ssb_ohci_device *hcd_to_ssb_ohci(struct usb_hcd *hcd) | ||||||
|  | -{ | ||||||
|  | -	return (struct ssb_ohci_device *)(hcd->hcd_priv); | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | - | ||||||
|  | -static int ssb_ohci_reset(struct usb_hcd *hcd) | ||||||
|  | -{ | ||||||
|  | -	struct ssb_ohci_device *ohcidev = hcd_to_ssb_ohci(hcd); | ||||||
|  | -	struct ohci_hcd *ohci = &ohcidev->ohci; | ||||||
|  | -	int err; | ||||||
|  | - | ||||||
|  | -	ohci_hcd_init(ohci); | ||||||
|  | -	err = ohci_init(ohci); | ||||||
|  | - | ||||||
|  | -	return err; | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -static int ssb_ohci_start(struct usb_hcd *hcd) | ||||||
|  | -{ | ||||||
|  | -	struct ssb_ohci_device *ohcidev = hcd_to_ssb_ohci(hcd); | ||||||
|  | -	struct ohci_hcd *ohci = &ohcidev->ohci; | ||||||
|  | -	int err; | ||||||
|  | - | ||||||
|  | -	err = ohci_run(ohci); | ||||||
|  | -	if (err < 0) { | ||||||
|  | -		ohci_err(ohci, "can't start\n"); | ||||||
|  | -		ohci_stop(hcd); | ||||||
|  | -	} | ||||||
|  | - | ||||||
|  | -	return err; | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -static const struct hc_driver ssb_ohci_hc_driver = { | ||||||
|  | -	.description		= "ssb-usb-ohci", | ||||||
|  | -	.product_desc		= "SSB OHCI Controller", | ||||||
|  | -	.hcd_priv_size		= sizeof(struct ssb_ohci_device), | ||||||
|  | - | ||||||
|  | -	.irq			= ohci_irq, | ||||||
|  | -	.flags			= HCD_MEMORY | HCD_USB11, | ||||||
|  | - | ||||||
|  | -	.reset			= ssb_ohci_reset, | ||||||
|  | -	.start			= ssb_ohci_start, | ||||||
|  | -	.stop			= ohci_stop, | ||||||
|  | -	.shutdown		= ohci_shutdown, | ||||||
|  | - | ||||||
|  | -	.urb_enqueue		= ohci_urb_enqueue, | ||||||
|  | -	.urb_dequeue		= ohci_urb_dequeue, | ||||||
|  | -	.endpoint_disable	= ohci_endpoint_disable, | ||||||
|  | - | ||||||
|  | -	.get_frame_number	= ohci_get_frame, | ||||||
|  | - | ||||||
|  | -	.hub_status_data	= ohci_hub_status_data, | ||||||
|  | -	.hub_control		= ohci_hub_control, | ||||||
|  | -#ifdef	CONFIG_PM | ||||||
|  | -	.bus_suspend		= ohci_bus_suspend, | ||||||
|  | -	.bus_resume		= ohci_bus_resume, | ||||||
|  | -#endif | ||||||
|  | - | ||||||
|  | -	.start_port_reset	= ohci_start_port_reset, | ||||||
|  | -}; | ||||||
|  | - | ||||||
|  | -static void ssb_ohci_detach(struct ssb_device *dev) | ||||||
|  | -{ | ||||||
|  | -	struct usb_hcd *hcd = ssb_get_drvdata(dev); | ||||||
|  | - | ||||||
|  | -	if (hcd->driver->shutdown) | ||||||
|  | -		hcd->driver->shutdown(hcd); | ||||||
|  | -	usb_remove_hcd(hcd); | ||||||
|  | -	iounmap(hcd->regs); | ||||||
|  | -	release_mem_region(hcd->rsrc_start, hcd->rsrc_len); | ||||||
|  | -	usb_put_hcd(hcd); | ||||||
|  | -	ssb_device_disable(dev, 0); | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -static int ssb_ohci_attach(struct ssb_device *dev) | ||||||
|  | -{ | ||||||
|  | -	struct ssb_ohci_device *ohcidev; | ||||||
|  | -	struct usb_hcd *hcd; | ||||||
|  | -	int err = -ENOMEM; | ||||||
|  | -	u32 tmp, flags = 0; | ||||||
|  | - | ||||||
|  | -	if (dma_set_mask(dev->dma_dev, DMA_BIT_MASK(32)) || | ||||||
|  | -	    dma_set_coherent_mask(dev->dma_dev, DMA_BIT_MASK(32))) | ||||||
|  | -		return -EOPNOTSUPP; | ||||||
|  | - | ||||||
|  | -	if (dev->id.coreid == SSB_DEV_USB11_HOSTDEV) { | ||||||
|  | -		/* Put the device into host-mode. */ | ||||||
|  | -		flags |= SSB_OHCI_TMSLOW_HOSTMODE; | ||||||
|  | -		ssb_device_enable(dev, flags); | ||||||
|  | -	} else if (dev->id.coreid == SSB_DEV_USB20_HOST) { | ||||||
|  | -		/* | ||||||
|  | -		 * USB 2.0 special considerations: | ||||||
|  | -		 * | ||||||
|  | -		 * In addition to the standard SSB reset sequence, the Host | ||||||
|  | -		 * Control Register must be programmed to bring the USB core | ||||||
|  | -		 * and various phy components out of reset. | ||||||
|  | -		 */ | ||||||
|  | -		ssb_device_enable(dev, 0); | ||||||
|  | -		ssb_write32(dev, 0x200, 0x7ff); | ||||||
|  | - | ||||||
|  | -		/* Change Flush control reg */ | ||||||
|  | -		tmp = ssb_read32(dev, 0x400); | ||||||
|  | -		tmp &= ~8; | ||||||
|  | -		ssb_write32(dev, 0x400, tmp); | ||||||
|  | -		tmp = ssb_read32(dev, 0x400); | ||||||
|  | - | ||||||
|  | -		/* Change Shim control reg */ | ||||||
|  | -		tmp = ssb_read32(dev, 0x304); | ||||||
|  | -		tmp &= ~0x100; | ||||||
|  | -		ssb_write32(dev, 0x304, tmp); | ||||||
|  | -		tmp = ssb_read32(dev, 0x304); | ||||||
|  | - | ||||||
|  | -		udelay(1); | ||||||
|  | - | ||||||
|  | -		/* Work around for 5354 failures */ | ||||||
|  | -		if (dev->id.revision == 2 && dev->bus->chip_id == 0x5354) { | ||||||
|  | -			/* Change syn01 reg */ | ||||||
|  | -			tmp = 0x00fe00fe; | ||||||
|  | -			ssb_write32(dev, 0x894, tmp); | ||||||
|  | - | ||||||
|  | -			/* Change syn03 reg */ | ||||||
|  | -			tmp = ssb_read32(dev, 0x89c); | ||||||
|  | -			tmp |= 0x1; | ||||||
|  | -			ssb_write32(dev, 0x89c, tmp); | ||||||
|  | -		} | ||||||
|  | -	} else | ||||||
|  | -		ssb_device_enable(dev, 0); | ||||||
|  | - | ||||||
|  | -	hcd = usb_create_hcd(&ssb_ohci_hc_driver, dev->dev, | ||||||
|  | -			dev_name(dev->dev)); | ||||||
|  | -	if (!hcd) | ||||||
|  | -		goto err_dev_disable; | ||||||
|  | -	ohcidev = hcd_to_ssb_ohci(hcd); | ||||||
|  | -	ohcidev->enable_flags = flags; | ||||||
|  | - | ||||||
|  | -	tmp = ssb_read32(dev, SSB_ADMATCH0); | ||||||
|  | -	hcd->rsrc_start = ssb_admatch_base(tmp); | ||||||
|  | -	hcd->rsrc_len = ssb_admatch_size(tmp); | ||||||
|  | -	hcd->regs = ioremap_nocache(hcd->rsrc_start, hcd->rsrc_len); | ||||||
|  | -	if (!hcd->regs) | ||||||
|  | -		goto err_put_hcd; | ||||||
|  | -	err = usb_add_hcd(hcd, dev->irq, IRQF_SHARED); | ||||||
|  | -	if (err) | ||||||
|  | -		goto err_iounmap; | ||||||
|  | - | ||||||
|  | -	ssb_set_drvdata(dev, hcd); | ||||||
|  | - | ||||||
|  | -	return err; | ||||||
|  | - | ||||||
|  | -err_iounmap: | ||||||
|  | -	iounmap(hcd->regs); | ||||||
|  | -err_put_hcd: | ||||||
|  | -	usb_put_hcd(hcd); | ||||||
|  | -err_dev_disable: | ||||||
|  | -	ssb_device_disable(dev, flags); | ||||||
|  | -	return err; | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -static int ssb_ohci_probe(struct ssb_device *dev, | ||||||
|  | -		const struct ssb_device_id *id) | ||||||
|  | -{ | ||||||
|  | -	int err; | ||||||
|  | -	u16 chipid_top; | ||||||
|  | - | ||||||
|  | -	/* USBcores are only connected on embedded devices. */ | ||||||
|  | -	chipid_top = (dev->bus->chip_id & 0xFF00); | ||||||
|  | -	if (chipid_top != 0x4700 && chipid_top != 0x5300) | ||||||
|  | -		return -ENODEV; | ||||||
|  | - | ||||||
|  | -	/* TODO: Probably need checks here; is the core connected? */ | ||||||
|  | - | ||||||
|  | -	if (usb_disabled()) | ||||||
|  | -		return -ENODEV; | ||||||
|  | - | ||||||
|  | -	/* We currently always attach SSB_DEV_USB11_HOSTDEV | ||||||
|  | -	 * as HOST OHCI. If we want to attach it as Client device, | ||||||
|  | -	 * we must branch here and call into the (yet to | ||||||
|  | -	 * be written) Client mode driver. Same for remove(). */ | ||||||
|  | - | ||||||
|  | -	err = ssb_ohci_attach(dev); | ||||||
|  | - | ||||||
|  | -	return err; | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -static void ssb_ohci_remove(struct ssb_device *dev) | ||||||
|  | -{ | ||||||
|  | -	ssb_ohci_detach(dev); | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -#ifdef CONFIG_PM | ||||||
|  | - | ||||||
|  | -static int ssb_ohci_suspend(struct ssb_device *dev, pm_message_t state) | ||||||
|  | -{ | ||||||
|  | -	ssb_device_disable(dev, 0); | ||||||
|  | - | ||||||
|  | -	return 0; | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -static int ssb_ohci_resume(struct ssb_device *dev) | ||||||
|  | -{ | ||||||
|  | -	struct usb_hcd *hcd = ssb_get_drvdata(dev); | ||||||
|  | -	struct ssb_ohci_device *ohcidev = hcd_to_ssb_ohci(hcd); | ||||||
|  | - | ||||||
|  | -	ssb_device_enable(dev, ohcidev->enable_flags); | ||||||
|  | - | ||||||
|  | -	ohci_finish_controller_resume(hcd); | ||||||
|  | -	return 0; | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -#else /* !CONFIG_PM */ | ||||||
|  | -#define ssb_ohci_suspend	NULL | ||||||
|  | -#define ssb_ohci_resume	NULL | ||||||
|  | -#endif /* CONFIG_PM */ | ||||||
|  | - | ||||||
|  | -static const struct ssb_device_id ssb_ohci_table[] = { | ||||||
|  | -	SSB_DEVICE(SSB_VENDOR_BROADCOM, SSB_DEV_USB11_HOSTDEV, SSB_ANY_REV), | ||||||
|  | -	SSB_DEVICE(SSB_VENDOR_BROADCOM, SSB_DEV_USB11_HOST, SSB_ANY_REV), | ||||||
|  | -	SSB_DEVICE(SSB_VENDOR_BROADCOM, SSB_DEV_USB20_HOST, SSB_ANY_REV), | ||||||
|  | -	SSB_DEVTABLE_END | ||||||
|  | -}; | ||||||
|  | -MODULE_DEVICE_TABLE(ssb, ssb_ohci_table); | ||||||
|  | - | ||||||
|  | -static struct ssb_driver ssb_ohci_driver = { | ||||||
|  | -	.name		= KBUILD_MODNAME, | ||||||
|  | -	.id_table	= ssb_ohci_table, | ||||||
|  | -	.probe		= ssb_ohci_probe, | ||||||
|  | -	.remove		= ssb_ohci_remove, | ||||||
|  | -	.suspend	= ssb_ohci_suspend, | ||||||
|  | -	.resume		= ssb_ohci_resume, | ||||||
|  | -}; | ||||||
| @@ -0,0 +1,13 @@ | |||||||
|  |  | ||||||
|  | --- a/arch/mips/bcm47xx/nvram.c | ||||||
|  | +++ b/arch/mips/bcm47xx/nvram.c | ||||||
|  | @@ -263,8 +263,7 @@ int nvram_getenv(char *name, char *val, | ||||||
|  |  		value = eq + 1; | ||||||
|  |  		if ((eq - var) == strlen(name) && | ||||||
|  |  			strncmp(var, name, (eq - var)) == 0) { | ||||||
|  | -			snprintf(val, val_len, "%s", value); | ||||||
|  | -			return 0; | ||||||
|  | +			return snprintf(val, val_len, "%s", value); | ||||||
|  |  		} | ||||||
|  |  	} | ||||||
|  |  	return NVRAM_ERR_ENVNOTFOUND; | ||||||
| @@ -0,0 +1,12 @@ | |||||||
|  |  | ||||||
|  | --- a/arch/mips/include/asm/mach-bcm47xx/nvram.h | ||||||
|  | +++ b/arch/mips/include/asm/mach-bcm47xx/nvram.h | ||||||
|  | @@ -37,7 +37,7 @@ struct nvram_header { | ||||||
|  |   | ||||||
|  |  extern int nvram_getenv(char *name, char *val, size_t val_len); | ||||||
|  |   | ||||||
|  | -static inline void nvram_parse_macaddr(char *buf, u8 *macaddr) | ||||||
|  | +static inline void nvram_parse_macaddr(char *buf, u8 macaddr[6]) | ||||||
|  |  { | ||||||
|  |  	if (strchr(buf, ':')) | ||||||
|  |  		sscanf(buf, "%hhx:%hhx:%hhx:%hhx:%hhx:%hhx", &macaddr[0], | ||||||
| @@ -0,0 +1,802 @@ | |||||||
|  | --- a/arch/mips/bcm47xx/Makefile | ||||||
|  | +++ b/arch/mips/bcm47xx/Makefile | ||||||
|  | @@ -3,5 +3,5 @@ | ||||||
|  |  # under Linux. | ||||||
|  |  # | ||||||
|  |   | ||||||
|  | -obj-y 				+= gpio.o irq.o nvram.o prom.o serial.o setup.o time.o bus.o | ||||||
|  | +obj-y 				+= gpio.o irq.o nvram.o prom.o serial.o setup.o time.o bus.o sprom.o | ||||||
|  |  obj-$(CONFIG_BCM47XX_SSB)	+= wgt634u.o | ||||||
|  | --- a/arch/mips/bcm47xx/setup.c | ||||||
|  | +++ b/arch/mips/bcm47xx/setup.c | ||||||
|  | @@ -132,156 +132,7 @@ static void bcm47xx_machine_halt(void) | ||||||
|  |  } | ||||||
|  |   | ||||||
|  |  #ifdef CONFIG_BCM47XX_SSB | ||||||
|  | -#define READ_FROM_NVRAM(_outvar, name, buf) \ | ||||||
|  | -	if (nvram_getprefix(prefix, name, buf, sizeof(buf)) >= 0)\ | ||||||
|  | -		sprom->_outvar = simple_strtoul(buf, NULL, 0); | ||||||
|  | - | ||||||
|  | -#define READ_FROM_NVRAM2(_outvar, name1, name2, buf) \ | ||||||
|  | -	if (nvram_getprefix(prefix, name1, buf, sizeof(buf)) >= 0 || \ | ||||||
|  | -	    nvram_getprefix(prefix, name2, buf, sizeof(buf)) >= 0)\ | ||||||
|  | -		sprom->_outvar = simple_strtoul(buf, NULL, 0); | ||||||
|  | - | ||||||
|  | -static inline int nvram_getprefix(const char *prefix, char *name, | ||||||
|  | -				  char *buf, int len) | ||||||
|  | -{ | ||||||
|  | -	if (prefix) { | ||||||
|  | -		char key[100]; | ||||||
|  | - | ||||||
|  | -		snprintf(key, sizeof(key), "%s%s", prefix, name); | ||||||
|  | -		return nvram_getenv(key, buf, len); | ||||||
|  | -	} | ||||||
|  | - | ||||||
|  | -	return nvram_getenv(name, buf, len); | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -static u32 nvram_getu32(const char *name, char *buf, int len) | ||||||
|  | -{ | ||||||
|  | -	int rv; | ||||||
|  | -	char key[100]; | ||||||
|  | -	u16 var0, var1; | ||||||
|  | - | ||||||
|  | -	snprintf(key, sizeof(key), "%s0", name); | ||||||
|  | -	rv = nvram_getenv(key, buf, len); | ||||||
|  | -	/* return 0 here so this looks like unset */ | ||||||
|  | -	if (rv < 0) | ||||||
|  | -		return 0; | ||||||
|  | -	var0 = simple_strtoul(buf, NULL, 0); | ||||||
|  | - | ||||||
|  | -	snprintf(key, sizeof(key), "%s1", name); | ||||||
|  | -	rv = nvram_getenv(key, buf, len); | ||||||
|  | -	if (rv < 0) | ||||||
|  | -		return 0; | ||||||
|  | -	var1 = simple_strtoul(buf, NULL, 0); | ||||||
|  | -	return var1 << 16 | var0; | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -static void bcm47xx_fill_sprom(struct ssb_sprom *sprom, const char *prefix) | ||||||
|  | -{ | ||||||
|  | -	char buf[100]; | ||||||
|  | -	u32 boardflags; | ||||||
|  | - | ||||||
|  | -	memset(sprom, 0, sizeof(struct ssb_sprom)); | ||||||
|  | - | ||||||
|  | -	sprom->revision = 1; /* Fallback: Old hardware does not define this. */ | ||||||
|  | -	READ_FROM_NVRAM(revision, "sromrev", buf); | ||||||
|  | -	if (nvram_getprefix(prefix, "il0macaddr", buf, sizeof(buf)) >= 0 || | ||||||
|  | -	    nvram_getprefix(prefix, "macaddr", buf, sizeof(buf)) >= 0) | ||||||
|  | -		nvram_parse_macaddr(buf, sprom->il0mac); | ||||||
|  | -	if (nvram_getprefix(prefix, "et0macaddr", buf, sizeof(buf)) >= 0) | ||||||
|  | -		nvram_parse_macaddr(buf, sprom->et0mac); | ||||||
|  | -	if (nvram_getprefix(prefix, "et1macaddr", buf, sizeof(buf)) >= 0) | ||||||
|  | -		nvram_parse_macaddr(buf, sprom->et1mac); | ||||||
|  | -	READ_FROM_NVRAM(et0phyaddr, "et0phyaddr", buf); | ||||||
|  | -	READ_FROM_NVRAM(et1phyaddr, "et1phyaddr", buf); | ||||||
|  | -	READ_FROM_NVRAM(et0mdcport, "et0mdcport", buf); | ||||||
|  | -	READ_FROM_NVRAM(et1mdcport, "et1mdcport", buf); | ||||||
|  | -	READ_FROM_NVRAM(board_rev, "boardrev", buf); | ||||||
|  | -	READ_FROM_NVRAM(country_code, "ccode", buf); | ||||||
|  | -	READ_FROM_NVRAM(ant_available_a, "aa5g", buf); | ||||||
|  | -	READ_FROM_NVRAM(ant_available_bg, "aa2g", buf); | ||||||
|  | -	READ_FROM_NVRAM(pa0b0, "pa0b0", buf); | ||||||
|  | -	READ_FROM_NVRAM(pa0b1, "pa0b1", buf); | ||||||
|  | -	READ_FROM_NVRAM(pa0b2, "pa0b2", buf); | ||||||
|  | -	READ_FROM_NVRAM(pa1b0, "pa1b0", buf); | ||||||
|  | -	READ_FROM_NVRAM(pa1b1, "pa1b1", buf); | ||||||
|  | -	READ_FROM_NVRAM(pa1b2, "pa1b2", buf); | ||||||
|  | -	READ_FROM_NVRAM(pa1lob0, "pa1lob0", buf); | ||||||
|  | -	READ_FROM_NVRAM(pa1lob2, "pa1lob1", buf); | ||||||
|  | -	READ_FROM_NVRAM(pa1lob1, "pa1lob2", buf); | ||||||
|  | -	READ_FROM_NVRAM(pa1hib0, "pa1hib0", buf); | ||||||
|  | -	READ_FROM_NVRAM(pa1hib2, "pa1hib1", buf); | ||||||
|  | -	READ_FROM_NVRAM(pa1hib1, "pa1hib2", buf); | ||||||
|  | -	READ_FROM_NVRAM2(gpio0, "ledbh0", "wl0gpio0", buf); | ||||||
|  | -	READ_FROM_NVRAM2(gpio1, "ledbh1", "wl0gpio1", buf); | ||||||
|  | -	READ_FROM_NVRAM2(gpio2, "ledbh2", "wl0gpio2", buf); | ||||||
|  | -	READ_FROM_NVRAM2(gpio3, "ledbh3", "wl0gpio3", buf); | ||||||
|  | -	READ_FROM_NVRAM2(maxpwr_bg, "maxp2ga0", "pa0maxpwr", buf); | ||||||
|  | -	READ_FROM_NVRAM2(maxpwr_al, "maxp5gla0", "pa1lomaxpwr", buf); | ||||||
|  | -	READ_FROM_NVRAM2(maxpwr_a, "maxp5ga0", "pa1maxpwr", buf); | ||||||
|  | -	READ_FROM_NVRAM2(maxpwr_ah, "maxp5gha0", "pa1himaxpwr", buf); | ||||||
|  | -	READ_FROM_NVRAM2(itssi_bg, "itt5ga0", "pa0itssit", buf); | ||||||
|  | -	READ_FROM_NVRAM2(itssi_a, "itt2ga0", "pa1itssit", buf); | ||||||
|  | -	READ_FROM_NVRAM(tri2g, "tri2g", buf); | ||||||
|  | -	READ_FROM_NVRAM(tri5gl, "tri5gl", buf); | ||||||
|  | -	READ_FROM_NVRAM(tri5g, "tri5g", buf); | ||||||
|  | -	READ_FROM_NVRAM(tri5gh, "tri5gh", buf); | ||||||
|  | -	READ_FROM_NVRAM(txpid2g[0], "txpid2ga0", buf); | ||||||
|  | -	READ_FROM_NVRAM(txpid2g[1], "txpid2ga1", buf); | ||||||
|  | -	READ_FROM_NVRAM(txpid2g[2], "txpid2ga2", buf); | ||||||
|  | -	READ_FROM_NVRAM(txpid2g[3], "txpid2ga3", buf); | ||||||
|  | -	READ_FROM_NVRAM(txpid5g[0], "txpid5ga0", buf); | ||||||
|  | -	READ_FROM_NVRAM(txpid5g[1], "txpid5ga1", buf); | ||||||
|  | -	READ_FROM_NVRAM(txpid5g[2], "txpid5ga2", buf); | ||||||
|  | -	READ_FROM_NVRAM(txpid5g[3], "txpid5ga3", buf); | ||||||
|  | -	READ_FROM_NVRAM(txpid5gl[0], "txpid5gla0", buf); | ||||||
|  | -	READ_FROM_NVRAM(txpid5gl[1], "txpid5gla1", buf); | ||||||
|  | -	READ_FROM_NVRAM(txpid5gl[2], "txpid5gla2", buf); | ||||||
|  | -	READ_FROM_NVRAM(txpid5gl[3], "txpid5gla3", buf); | ||||||
|  | -	READ_FROM_NVRAM(txpid5gh[0], "txpid5gha0", buf); | ||||||
|  | -	READ_FROM_NVRAM(txpid5gh[1], "txpid5gha1", buf); | ||||||
|  | -	READ_FROM_NVRAM(txpid5gh[2], "txpid5gha2", buf); | ||||||
|  | -	READ_FROM_NVRAM(txpid5gh[3], "txpid5gha3", buf); | ||||||
|  | -	READ_FROM_NVRAM(rxpo2g, "rxpo2g", buf); | ||||||
|  | -	READ_FROM_NVRAM(rxpo5g, "rxpo5g", buf); | ||||||
|  | -	READ_FROM_NVRAM(rssisav2g, "rssisav2g", buf); | ||||||
|  | -	READ_FROM_NVRAM(rssismc2g, "rssismc2g", buf); | ||||||
|  | -	READ_FROM_NVRAM(rssismf2g, "rssismf2g", buf); | ||||||
|  | -	READ_FROM_NVRAM(bxa2g, "bxa2g", buf); | ||||||
|  | -	READ_FROM_NVRAM(rssisav5g, "rssisav5g", buf); | ||||||
|  | -	READ_FROM_NVRAM(rssismc5g, "rssismc5g", buf); | ||||||
|  | -	READ_FROM_NVRAM(rssismf5g, "rssismf5g", buf); | ||||||
|  | -	READ_FROM_NVRAM(bxa5g, "bxa5g", buf); | ||||||
|  | -	READ_FROM_NVRAM(cck2gpo, "cck2gpo", buf); | ||||||
|  | - | ||||||
|  | -	sprom->ofdm2gpo = nvram_getu32("ofdm2gpo", buf, sizeof(buf)); | ||||||
|  | -	sprom->ofdm5glpo = nvram_getu32("ofdm5glpo", buf, sizeof(buf)); | ||||||
|  | -	sprom->ofdm5gpo = nvram_getu32("ofdm5gpo", buf, sizeof(buf)); | ||||||
|  | -	sprom->ofdm5ghpo = nvram_getu32("ofdm5ghpo", buf, sizeof(buf)); | ||||||
|  | - | ||||||
|  | -	READ_FROM_NVRAM(antenna_gain.ghz24.a0, "ag0", buf); | ||||||
|  | -	READ_FROM_NVRAM(antenna_gain.ghz24.a1, "ag1", buf); | ||||||
|  | -	READ_FROM_NVRAM(antenna_gain.ghz24.a2, "ag2", buf); | ||||||
|  | -	READ_FROM_NVRAM(antenna_gain.ghz24.a3, "ag3", buf); | ||||||
|  | -	memcpy(&sprom->antenna_gain.ghz5, &sprom->antenna_gain.ghz24, | ||||||
|  | -	       sizeof(sprom->antenna_gain.ghz5)); | ||||||
|  | - | ||||||
|  | -	if (nvram_getprefix(prefix, "boardflags", buf, sizeof(buf)) >= 0) { | ||||||
|  | -		boardflags = simple_strtoul(buf, NULL, 0); | ||||||
|  | -		if (boardflags) { | ||||||
|  | -			sprom->boardflags_lo = (boardflags & 0x0000FFFFU); | ||||||
|  | -			sprom->boardflags_hi = (boardflags & 0xFFFF0000U) >> 16; | ||||||
|  | -		} | ||||||
|  | -	} | ||||||
|  | -	if (nvram_getprefix(prefix, "boardflags2", buf, sizeof(buf)) >= 0) { | ||||||
|  | -		boardflags = simple_strtoul(buf, NULL, 0); | ||||||
|  | -		if (boardflags) { | ||||||
|  | -			sprom->boardflags2_lo = (boardflags & 0x0000FFFFU); | ||||||
|  | -			sprom->boardflags2_hi = (boardflags & 0xFFFF0000U) >> 16; | ||||||
|  | -		} | ||||||
|  | -	} | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -int bcm47xx_get_sprom(struct ssb_bus *bus, struct ssb_sprom *out) | ||||||
|  | +static int bcm47xx_get_sprom(struct ssb_bus *bus, struct ssb_sprom *out) | ||||||
|  |  { | ||||||
|  |  	char prefix[10]; | ||||||
|  |   | ||||||
|  | --- /dev/null | ||||||
|  | +++ b/arch/mips/bcm47xx/sprom.c | ||||||
|  | @@ -0,0 +1,620 @@ | ||||||
|  | +/* | ||||||
|  | + *  Copyright (C) 2004 Florian Schirmer <jolt@tuxbox.org> | ||||||
|  | + *  Copyright (C) 2006 Felix Fietkau <nbd@openwrt.org> | ||||||
|  | + *  Copyright (C) 2006 Michael Buesch <m@bues.ch> | ||||||
|  | + *  Copyright (C) 2010 Waldemar Brodkorb <wbx@openadk.org> | ||||||
|  | + *  Copyright (C) 2010-2012 Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | + * | ||||||
|  | + *  This program is free software; you can redistribute  it and/or modify it | ||||||
|  | + *  under  the terms of  the GNU General  Public License as published by the | ||||||
|  | + *  Free Software Foundation;  either version 2 of the  License, or (at your | ||||||
|  | + *  option) any later version. | ||||||
|  | + * | ||||||
|  | + *  THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED | ||||||
|  | + *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF | ||||||
|  | + *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN | ||||||
|  | + *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT, | ||||||
|  | + *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT | ||||||
|  | + *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF | ||||||
|  | + *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON | ||||||
|  | + *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT | ||||||
|  | + *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF | ||||||
|  | + *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | ||||||
|  | + * | ||||||
|  | + *  You should have received a copy of the  GNU General Public License along | ||||||
|  | + *  with this program; if not, write  to the Free Software Foundation, Inc., | ||||||
|  | + *  675 Mass Ave, Cambridge, MA 02139, USA. | ||||||
|  | + */ | ||||||
|  | + | ||||||
|  | +#include <bcm47xx.h> | ||||||
|  | +#include <nvram.h> | ||||||
|  | + | ||||||
|  | +static void create_key(const char *prefix, const char *postfix, | ||||||
|  | +		       const char *name, char *buf, int len) | ||||||
|  | +{ | ||||||
|  | +	if (prefix && postfix) | ||||||
|  | +		snprintf(buf, len, "%s%s%s", prefix, name, postfix); | ||||||
|  | +	else if (prefix) | ||||||
|  | +		snprintf(buf, len, "%s%s", prefix, name); | ||||||
|  | +	else if (postfix) | ||||||
|  | +		snprintf(buf, len, "%s%s", name, postfix); | ||||||
|  | +	else | ||||||
|  | +		snprintf(buf, len, "%s", name); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +#define NVRAM_READ_VAL(type)						\ | ||||||
|  | +static void nvram_read_ ## type (const char *prefix,			\ | ||||||
|  | +				 const char *postfix, const char *name,	\ | ||||||
|  | +				 type *val, type allset)		\ | ||||||
|  | +{									\ | ||||||
|  | +	char buf[100];							\ | ||||||
|  | +	char key[40];							\ | ||||||
|  | +	int err;							\ | ||||||
|  | +	type var;							\ | ||||||
|  | +									\ | ||||||
|  | +	create_key(prefix, postfix, name, key, sizeof(key));		\ | ||||||
|  | +									\ | ||||||
|  | +	err = nvram_getenv(key, buf, sizeof(buf));			\ | ||||||
|  | +	if (err < 0)							\ | ||||||
|  | +		return;							\ | ||||||
|  | +	err = kstrto ## type (buf, 0, &var);				\ | ||||||
|  | +	if (err) {							\ | ||||||
|  | +		pr_warn("can not parse nvram name %s with value %s"	\ | ||||||
|  | +			" got %i", key, buf, err);			\ | ||||||
|  | +		return;							\ | ||||||
|  | +	}								\ | ||||||
|  | +	if (allset && var == allset)					\ | ||||||
|  | +		return;							\ | ||||||
|  | +	*val = var;							\ | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +NVRAM_READ_VAL(u8) | ||||||
|  | +NVRAM_READ_VAL(s8) | ||||||
|  | +NVRAM_READ_VAL(u16) | ||||||
|  | +NVRAM_READ_VAL(u32) | ||||||
|  | + | ||||||
|  | +#undef NVRAM_READ_VAL | ||||||
|  | + | ||||||
|  | +static void nvram_read_u32_2(const char *prefix, const char *name, | ||||||
|  | +			     u16 *val_lo, u16 *val_hi) | ||||||
|  | +{ | ||||||
|  | +	char buf[100]; | ||||||
|  | +	char key[40]; | ||||||
|  | +	int err; | ||||||
|  | +	u32 val; | ||||||
|  | + | ||||||
|  | +	create_key(prefix, NULL, name, key, sizeof(key)); | ||||||
|  | + | ||||||
|  | +	err = nvram_getenv(key, buf, sizeof(buf)); | ||||||
|  | +	if (err < 0) | ||||||
|  | +		return; | ||||||
|  | +	err = kstrtou32(buf, 0, &val); | ||||||
|  | +	if (err) { | ||||||
|  | +		pr_warn("can not parse nvram name %s with value %s got %i", | ||||||
|  | +			key, buf, err); | ||||||
|  | +		return; | ||||||
|  | +	} | ||||||
|  | +	*val_lo = (val & 0x0000FFFFU); | ||||||
|  | +	*val_hi = (val & 0xFFFF0000U) >> 16; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void nvram_read_leddc(const char *prefix, const char *name, | ||||||
|  | +			     u8 *leddc_on_time, u8 *leddc_off_time) | ||||||
|  | +{ | ||||||
|  | +	char buf[100]; | ||||||
|  | +	char key[40]; | ||||||
|  | +	int err; | ||||||
|  | +	u32 val; | ||||||
|  | + | ||||||
|  | +	create_key(prefix, NULL, name, key, sizeof(key)); | ||||||
|  | + | ||||||
|  | +	err = nvram_getenv(key, buf, sizeof(buf)); | ||||||
|  | +	if (err < 0) | ||||||
|  | +		return; | ||||||
|  | +	err = kstrtou32(buf, 0, &val); | ||||||
|  | +	if (err) { | ||||||
|  | +		pr_warn("can not parse nvram name %s with value %s got %i", | ||||||
|  | +			key, buf, err); | ||||||
|  | +		return; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	if (val == 0xffff || val == 0xffffffff) | ||||||
|  | +		return; | ||||||
|  | + | ||||||
|  | +	*leddc_on_time = val & 0xff; | ||||||
|  | +	*leddc_off_time = (val >> 16) & 0xff; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void nvram_read_macaddr(const char *prefix, const char *name, | ||||||
|  | +			       u8 (*val)[6]) | ||||||
|  | +{ | ||||||
|  | +	char buf[100]; | ||||||
|  | +	char key[40]; | ||||||
|  | +	int err; | ||||||
|  | + | ||||||
|  | +	create_key(prefix, NULL, name, key, sizeof(key)); | ||||||
|  | + | ||||||
|  | +	err = nvram_getenv(key, buf, sizeof(buf)); | ||||||
|  | +	if (err < 0) | ||||||
|  | +		return; | ||||||
|  | +	nvram_parse_macaddr(buf, *val); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void nvram_read_alpha2(const char *prefix, const char *name, | ||||||
|  | +			     char (*val)[2]) | ||||||
|  | +{ | ||||||
|  | +	char buf[10]; | ||||||
|  | +	char key[40]; | ||||||
|  | +	int err; | ||||||
|  | + | ||||||
|  | +	create_key(prefix, NULL, name, key, sizeof(key)); | ||||||
|  | + | ||||||
|  | +	err = nvram_getenv(key, buf, sizeof(buf)); | ||||||
|  | +	if (err < 0) | ||||||
|  | +		return; | ||||||
|  | +	if (buf[0] == '0') | ||||||
|  | +		return; | ||||||
|  | +	if (strlen(buf) > 2) { | ||||||
|  | +		pr_warn("alpha2 is too long %s", buf); | ||||||
|  | +		return; | ||||||
|  | +	} | ||||||
|  | +	memcpy(val, buf, sizeof(val)); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void bcm47xx_fill_sprom_r1234589(struct ssb_sprom *sprom, | ||||||
|  | +					const char *prefix) | ||||||
|  | +{ | ||||||
|  | +	nvram_read_u16(prefix, NULL, "boardrev", &sprom->board_rev, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "boardnum", &sprom->board_num, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "ledbh0", &sprom->gpio0, 0xff); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "ledbh1", &sprom->gpio1, 0xff); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "ledbh2", &sprom->gpio2, 0xff); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "ledbh3", &sprom->gpio3, 0xff); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "aa2g", &sprom->ant_available_bg, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "aa5g", &sprom->ant_available_a, 0); | ||||||
|  | +	nvram_read_s8(prefix, NULL, "ag0", &sprom->antenna_gain.a0, 0); | ||||||
|  | +	nvram_read_s8(prefix, NULL, "ag1", &sprom->antenna_gain.a1, 0); | ||||||
|  | +	nvram_read_alpha2(prefix, "ccode", &sprom->alpha2); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void bcm47xx_fill_sprom_r12389(struct ssb_sprom *sprom, | ||||||
|  | +				      const char *prefix) | ||||||
|  | +{ | ||||||
|  | +	nvram_read_u16(prefix, NULL, "pa0b0", &sprom->pa0b0, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "pa0b1", &sprom->pa0b1, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "pa0b2", &sprom->pa0b2, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "pa0itssit", &sprom->itssi_bg, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "pa0maxpwr", &sprom->maxpwr_bg, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "pa1b0", &sprom->pa1b0, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "pa1b1", &sprom->pa1b1, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "pa1b2", &sprom->pa1b2, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "pa1itssit", &sprom->itssi_a, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "pa1maxpwr", &sprom->maxpwr_a, 0); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void bcm47xx_fill_sprom_r1(struct ssb_sprom *sprom, const char *prefix) | ||||||
|  | +{ | ||||||
|  | +	nvram_read_u16(prefix, NULL, "boardflags", &sprom->boardflags_lo, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "cc", &sprom->country_code, 0); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void bcm47xx_fill_sprom_r2389(struct ssb_sprom *sprom, | ||||||
|  | +				     const char *prefix) | ||||||
|  | +{ | ||||||
|  | +	nvram_read_u8(prefix, NULL, "opo", &sprom->opo, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "pa1lob0", &sprom->pa1lob0, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "pa1lob1", &sprom->pa1lob1, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "pa1lob2", &sprom->pa1lob2, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "pa1hib0", &sprom->pa1hib0, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "pa1hib1", &sprom->pa1hib1, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "pa1hib2", &sprom->pa1hib2, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "pa1lomaxpwr", &sprom->maxpwr_al, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "pa1himaxpwr", &sprom->maxpwr_ah, 0); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void bcm47xx_fill_sprom_r2(struct ssb_sprom *sprom, const char *prefix) | ||||||
|  | +{ | ||||||
|  | +	nvram_read_u32_2(prefix, "boardflags", &sprom->boardflags_lo, | ||||||
|  | +			 &sprom->boardflags_hi); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "boardtype", &sprom->board_type, 0); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void bcm47xx_fill_sprom_r389(struct ssb_sprom *sprom, const char *prefix) | ||||||
|  | +{ | ||||||
|  | +	nvram_read_u8(prefix, NULL, "bxa2g", &sprom->bxa2g, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rssisav2g", &sprom->rssisav2g, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rssismc2g", &sprom->rssismc2g, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rssismf2g", &sprom->rssismf2g, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "bxa5g", &sprom->bxa5g, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rssisav5g", &sprom->rssisav5g, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rssismc5g", &sprom->rssismc5g, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rssismf5g", &sprom->rssismf5g, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "tri2g", &sprom->tri2g, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "tri5g", &sprom->tri5g, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "tri5gl", &sprom->tri5gl, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "tri5gh", &sprom->tri5gh, 0); | ||||||
|  | +	nvram_read_s8(prefix, NULL, "rxpo2g", &sprom->rxpo2g, 0); | ||||||
|  | +	nvram_read_s8(prefix, NULL, "rxpo5g", &sprom->rxpo5g, 0); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void bcm47xx_fill_sprom_r3(struct ssb_sprom *sprom, const char *prefix) | ||||||
|  | +{ | ||||||
|  | +	nvram_read_u32_2(prefix, "boardflags", &sprom->boardflags_lo, | ||||||
|  | +			 &sprom->boardflags_hi); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "boardtype", &sprom->board_type, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "regrev", &sprom->regrev, 0); | ||||||
|  | +	nvram_read_leddc(prefix, "leddc", &sprom->leddc_on_time, | ||||||
|  | +			 &sprom->leddc_off_time); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void bcm47xx_fill_sprom_r4589(struct ssb_sprom *sprom, | ||||||
|  | +				     const char *prefix) | ||||||
|  | +{ | ||||||
|  | +	nvram_read_u32_2(prefix, "boardflags", &sprom->boardflags_lo, | ||||||
|  | +			 &sprom->boardflags_hi); | ||||||
|  | +	nvram_read_u32_2(prefix, "boardflags2", &sprom->boardflags2_lo, | ||||||
|  | +			 &sprom->boardflags2_hi); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "boardtype", &sprom->board_type, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "regrev", &sprom->regrev, 0); | ||||||
|  | +	nvram_read_s8(prefix, NULL, "ag2", &sprom->antenna_gain.a2, 0); | ||||||
|  | +	nvram_read_s8(prefix, NULL, "ag3", &sprom->antenna_gain.a3, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txchain", &sprom->txchain, 0xf); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rxchain", &sprom->rxchain, 0xf); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "antswitch", &sprom->antswitch, 0xff); | ||||||
|  | +	nvram_read_leddc(prefix, "leddc", &sprom->leddc_on_time, | ||||||
|  | +			 &sprom->leddc_off_time); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void bcm47xx_fill_sprom_r458(struct ssb_sprom *sprom, const char *prefix) | ||||||
|  | +{ | ||||||
|  | +	nvram_read_u16(prefix, NULL, "cck2gpo", &sprom->cck2gpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "ofdm2gpo", &sprom->ofdm2gpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "ofdm5gpo", &sprom->ofdm5gpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "ofdm5glpo", &sprom->ofdm5glpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "ofdm5ghpo", &sprom->ofdm5ghpo, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "cddpo", &sprom->cddpo, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "stbcpo", &sprom->stbcpo, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "bw40po", &sprom->bw40po, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "bwduppo", &sprom->bwduppo, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs2gpo0", &sprom->mcs2gpo[0], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs2gpo1", &sprom->mcs2gpo[1], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs2gpo2", &sprom->mcs2gpo[2], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs2gpo3", &sprom->mcs2gpo[3], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs2gpo4", &sprom->mcs2gpo[4], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs2gpo5", &sprom->mcs2gpo[5], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs2gpo6", &sprom->mcs2gpo[6], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs2gpo7", &sprom->mcs2gpo[7], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5gpo0", &sprom->mcs5gpo[0], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5gpo1", &sprom->mcs5gpo[1], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5gpo2", &sprom->mcs5gpo[2], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5gpo3", &sprom->mcs5gpo[3], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5gpo4", &sprom->mcs5gpo[4], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5gpo5", &sprom->mcs5gpo[5], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5gpo6", &sprom->mcs5gpo[6], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5gpo7", &sprom->mcs5gpo[7], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5glpo0", &sprom->mcs5glpo[0], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5glpo1", &sprom->mcs5glpo[1], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5glpo2", &sprom->mcs5glpo[2], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5glpo3", &sprom->mcs5glpo[3], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5glpo4", &sprom->mcs5glpo[4], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5glpo5", &sprom->mcs5glpo[5], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5glpo6", &sprom->mcs5glpo[6], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5glpo7", &sprom->mcs5glpo[7], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5ghpo0", &sprom->mcs5ghpo[0], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5ghpo1", &sprom->mcs5ghpo[1], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5ghpo2", &sprom->mcs5ghpo[2], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5ghpo3", &sprom->mcs5ghpo[3], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5ghpo4", &sprom->mcs5ghpo[4], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5ghpo5", &sprom->mcs5ghpo[5], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5ghpo6", &sprom->mcs5ghpo[6], 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs5ghpo7", &sprom->mcs5ghpo[7], 0); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void bcm47xx_fill_sprom_r45(struct ssb_sprom *sprom, const char *prefix) | ||||||
|  | +{ | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txpid2ga0", &sprom->txpid2g[0], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txpid2ga1", &sprom->txpid2g[1], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txpid2ga2", &sprom->txpid2g[2], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txpid2ga3", &sprom->txpid2g[3], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txpid5ga0", &sprom->txpid5g[0], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txpid5ga1", &sprom->txpid5g[1], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txpid5ga2", &sprom->txpid5g[2], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txpid5ga3", &sprom->txpid5g[3], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txpid5gla0", &sprom->txpid5gl[0], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txpid5gla1", &sprom->txpid5gl[1], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txpid5gla2", &sprom->txpid5gl[2], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txpid5gla3", &sprom->txpid5gl[3], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txpid5gha0", &sprom->txpid5gh[0], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txpid5gha1", &sprom->txpid5gh[1], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txpid5gha2", &sprom->txpid5gh[2], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "txpid5gha3", &sprom->txpid5gh[3], 0); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void bcm47xx_fill_sprom_r89(struct ssb_sprom *sprom, const char *prefix) | ||||||
|  | +{ | ||||||
|  | +	nvram_read_u8(prefix, NULL, "tssipos2g", &sprom->fem.ghz2.tssipos, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "extpagain2g", | ||||||
|  | +		      &sprom->fem.ghz2.extpa_gain, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "pdetrange2g", | ||||||
|  | +		      &sprom->fem.ghz2.pdet_range, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "triso2g", &sprom->fem.ghz2.tr_iso, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "antswctl2g", &sprom->fem.ghz2.antswlut, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "tssipos5g", &sprom->fem.ghz5.tssipos, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "extpagain5g", | ||||||
|  | +		      &sprom->fem.ghz5.extpa_gain, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "pdetrange5g", | ||||||
|  | +		      &sprom->fem.ghz5.pdet_range, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "triso5g", &sprom->fem.ghz5.tr_iso, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "antswctl5g", &sprom->fem.ghz5.antswlut, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "tempthresh", &sprom->tempthresh, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "tempoffset", &sprom->tempoffset, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "rawtempsense", &sprom->rawtempsense, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "measpower", &sprom->measpower, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "tempsense_slope", | ||||||
|  | +		      &sprom->tempsense_slope, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "tempcorrx", &sprom->tempcorrx, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "tempsense_option", | ||||||
|  | +		      &sprom->tempsense_option, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "freqoffset_corr", | ||||||
|  | +		      &sprom->freqoffset_corr, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "iqcal_swp_dis", &sprom->iqcal_swp_dis, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "hw_iqcal_en", &sprom->hw_iqcal_en, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "elna2g", &sprom->elna2g, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "elna5g", &sprom->elna5g, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "phycal_tempdelta", | ||||||
|  | +		      &sprom->phycal_tempdelta, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "temps_period", &sprom->temps_period, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "temps_hysteresis", | ||||||
|  | +		      &sprom->temps_hysteresis, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "measpower1", &sprom->measpower1, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "measpower2", &sprom->measpower2, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rxgainerr2ga0", | ||||||
|  | +		      &sprom->rxgainerr2ga[0], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rxgainerr2ga1", | ||||||
|  | +		      &sprom->rxgainerr2ga[1], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rxgainerr2ga2", | ||||||
|  | +		      &sprom->rxgainerr2ga[2], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rxgainerr5gla0", | ||||||
|  | +		      &sprom->rxgainerr5gla[0], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rxgainerr5gla1", | ||||||
|  | +		      &sprom->rxgainerr5gla[1], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rxgainerr5gla2", | ||||||
|  | +		      &sprom->rxgainerr5gla[2], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rxgainerr5gma0", | ||||||
|  | +		      &sprom->rxgainerr5gma[0], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rxgainerr5gma1", | ||||||
|  | +		      &sprom->rxgainerr5gma[1], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rxgainerr5gma2", | ||||||
|  | +		      &sprom->rxgainerr5gma[2], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rxgainerr5gha0", | ||||||
|  | +		      &sprom->rxgainerr5gha[0], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rxgainerr5gha1", | ||||||
|  | +		      &sprom->rxgainerr5gha[1], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rxgainerr5gha2", | ||||||
|  | +		      &sprom->rxgainerr5gha[2], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rxgainerr5gua0", | ||||||
|  | +		      &sprom->rxgainerr5gua[0], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rxgainerr5gua1", | ||||||
|  | +		      &sprom->rxgainerr5gua[1], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "rxgainerr5gua2", | ||||||
|  | +		      &sprom->rxgainerr5gua[2], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "noiselvl2ga0", &sprom->noiselvl2ga[0], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "noiselvl2ga1", &sprom->noiselvl2ga[1], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "noiselvl2ga2", &sprom->noiselvl2ga[2], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "noiselvl5gla0", | ||||||
|  | +		      &sprom->noiselvl5gla[0], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "noiselvl5gla1", | ||||||
|  | +		      &sprom->noiselvl5gla[1], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "noiselvl5gla2", | ||||||
|  | +		      &sprom->noiselvl5gla[2], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "noiselvl5gma0", | ||||||
|  | +		      &sprom->noiselvl5gma[0], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "noiselvl5gma1", | ||||||
|  | +		      &sprom->noiselvl5gma[1], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "noiselvl5gma2", | ||||||
|  | +		      &sprom->noiselvl5gma[2], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "noiselvl5gha0", | ||||||
|  | +		      &sprom->noiselvl5gha[0], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "noiselvl5gha1", | ||||||
|  | +		      &sprom->noiselvl5gha[1], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "noiselvl5gha2", | ||||||
|  | +		      &sprom->noiselvl5gha[2], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "noiselvl5gua0", | ||||||
|  | +		      &sprom->noiselvl5gua[0], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "noiselvl5gua1", | ||||||
|  | +		      &sprom->noiselvl5gua[1], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "noiselvl5gua2", | ||||||
|  | +		      &sprom->noiselvl5gua[2], 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "pcieingress_war", | ||||||
|  | +		      &sprom->pcieingress_war, 0); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void bcm47xx_fill_sprom_r9(struct ssb_sprom *sprom, const char *prefix) | ||||||
|  | +{ | ||||||
|  | +	nvram_read_u16(prefix, NULL, "cckbw202gpo", &sprom->cckbw202gpo, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "cckbw20ul2gpo", &sprom->cckbw20ul2gpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "legofdmbw202gpo", | ||||||
|  | +		       &sprom->legofdmbw202gpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "legofdmbw20ul2gpo", | ||||||
|  | +		       &sprom->legofdmbw20ul2gpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "legofdmbw205glpo", | ||||||
|  | +		       &sprom->legofdmbw205glpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "legofdmbw20ul5glpo", | ||||||
|  | +		       &sprom->legofdmbw20ul5glpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "legofdmbw205gmpo", | ||||||
|  | +		       &sprom->legofdmbw205gmpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "legofdmbw20ul5gmpo", | ||||||
|  | +		       &sprom->legofdmbw20ul5gmpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "legofdmbw205ghpo", | ||||||
|  | +		       &sprom->legofdmbw205ghpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "legofdmbw20ul5ghpo", | ||||||
|  | +		       &sprom->legofdmbw20ul5ghpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "mcsbw202gpo", &sprom->mcsbw202gpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "mcsbw20ul2gpo", &sprom->mcsbw20ul2gpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "mcsbw402gpo", &sprom->mcsbw402gpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "mcsbw205glpo", &sprom->mcsbw205glpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "mcsbw20ul5glpo", | ||||||
|  | +		       &sprom->mcsbw20ul5glpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "mcsbw405glpo", &sprom->mcsbw405glpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "mcsbw205gmpo", &sprom->mcsbw205gmpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "mcsbw20ul5gmpo", | ||||||
|  | +		       &sprom->mcsbw20ul5gmpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "mcsbw405gmpo", &sprom->mcsbw405gmpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "mcsbw205ghpo", &sprom->mcsbw205ghpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "mcsbw20ul5ghpo", | ||||||
|  | +		       &sprom->mcsbw20ul5ghpo, 0); | ||||||
|  | +	nvram_read_u32(prefix, NULL, "mcsbw405ghpo", &sprom->mcsbw405ghpo, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "mcs32po", &sprom->mcs32po, 0); | ||||||
|  | +	nvram_read_u16(prefix, NULL, "legofdm40duppo", | ||||||
|  | +		       &sprom->legofdm40duppo, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "sar2g", &sprom->sar2g, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "sar5g", &sprom->sar5g, 0); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void bcm47xx_fill_sprom_path_r4589(struct ssb_sprom *sprom, | ||||||
|  | +					  const char *prefix) | ||||||
|  | +{ | ||||||
|  | +	char postfix[2]; | ||||||
|  | +	int i; | ||||||
|  | + | ||||||
|  | +	for (i = 0; i < ARRAY_SIZE(sprom->core_pwr_info); i++) { | ||||||
|  | +		struct ssb_sprom_core_pwr_info *pwr_info = &sprom->core_pwr_info[i]; | ||||||
|  | +		snprintf(postfix, sizeof(postfix), "%i", i); | ||||||
|  | +		nvram_read_u8(prefix, postfix, "maxp2ga", | ||||||
|  | +			      &pwr_info->maxpwr_2g, 0); | ||||||
|  | +		nvram_read_u8(prefix, postfix, "itt2ga", | ||||||
|  | +			      &pwr_info->itssi_2g, 0); | ||||||
|  | +		nvram_read_u8(prefix, postfix, "itt5ga", | ||||||
|  | +			      &pwr_info->itssi_5g, 0); | ||||||
|  | +		nvram_read_u16(prefix, postfix, "pa2gw0a", | ||||||
|  | +			       &pwr_info->pa_2g[0], 0); | ||||||
|  | +		nvram_read_u16(prefix, postfix, "pa2gw1a", | ||||||
|  | +			       &pwr_info->pa_2g[1], 0); | ||||||
|  | +		nvram_read_u16(prefix, postfix, "pa2gw2a", | ||||||
|  | +			       &pwr_info->pa_2g[2], 0); | ||||||
|  | +		nvram_read_u8(prefix, postfix, "maxp5ga", | ||||||
|  | +			      &pwr_info->maxpwr_5g, 0); | ||||||
|  | +		nvram_read_u8(prefix, postfix, "maxp5gha", | ||||||
|  | +			      &pwr_info->maxpwr_5gh, 0); | ||||||
|  | +		nvram_read_u8(prefix, postfix, "maxp5gla", | ||||||
|  | +			      &pwr_info->maxpwr_5gl, 0); | ||||||
|  | +		nvram_read_u16(prefix, postfix, "pa5gw0a", | ||||||
|  | +			       &pwr_info->pa_5g[0], 0); | ||||||
|  | +		nvram_read_u16(prefix, postfix, "pa5gw1a", | ||||||
|  | +			       &pwr_info->pa_5g[1], 0); | ||||||
|  | +		nvram_read_u16(prefix, postfix, "pa5gw2a", | ||||||
|  | +			       &pwr_info->pa_5g[2], 0); | ||||||
|  | +		nvram_read_u16(prefix, postfix, "pa5glw0a", | ||||||
|  | +			       &pwr_info->pa_5gl[0], 0); | ||||||
|  | +		nvram_read_u16(prefix, postfix, "pa5glw1a", | ||||||
|  | +			       &pwr_info->pa_5gl[1], 0); | ||||||
|  | +		nvram_read_u16(prefix, postfix, "pa5glw2a", | ||||||
|  | +			       &pwr_info->pa_5gl[2], 0); | ||||||
|  | +		nvram_read_u16(prefix, postfix, "pa5ghw0a", | ||||||
|  | +			       &pwr_info->pa_5gh[0], 0); | ||||||
|  | +		nvram_read_u16(prefix, postfix, "pa5ghw1a", | ||||||
|  | +			       &pwr_info->pa_5gh[1], 0); | ||||||
|  | +		nvram_read_u16(prefix, postfix, "pa5ghw2a", | ||||||
|  | +			       &pwr_info->pa_5gh[2], 0); | ||||||
|  | +	} | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static void bcm47xx_fill_sprom_path_r45(struct ssb_sprom *sprom, | ||||||
|  | +					const char *prefix) | ||||||
|  | +{ | ||||||
|  | +	char postfix[2]; | ||||||
|  | +	int i; | ||||||
|  | + | ||||||
|  | +	for (i = 0; i < ARRAY_SIZE(sprom->core_pwr_info); i++) { | ||||||
|  | +		struct ssb_sprom_core_pwr_info *pwr_info = &sprom->core_pwr_info[i]; | ||||||
|  | +		snprintf(postfix, sizeof(postfix), "%i", i); | ||||||
|  | +		nvram_read_u16(prefix, postfix, "pa2gw3a", | ||||||
|  | +			       &pwr_info->pa_2g[3], 0); | ||||||
|  | +		nvram_read_u16(prefix, postfix, "pa5gw3a", | ||||||
|  | +			       &pwr_info->pa_5g[3], 0); | ||||||
|  | +		nvram_read_u16(prefix, postfix, "pa5glw3a", | ||||||
|  | +			       &pwr_info->pa_5gl[3], 0); | ||||||
|  | +		nvram_read_u16(prefix, postfix, "pa5ghw3a", | ||||||
|  | +			       &pwr_info->pa_5gh[3], 0); | ||||||
|  | +	} | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +void bcm47xx_fill_sprom_ethernet(struct ssb_sprom *sprom, const char *prefix) | ||||||
|  | +{ | ||||||
|  | +	nvram_read_macaddr(prefix, "et0macaddr", &sprom->et0mac); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "et0mdcport", &sprom->et0mdcport, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "et0phyaddr", &sprom->et0phyaddr, 0); | ||||||
|  | + | ||||||
|  | +	nvram_read_macaddr(prefix, "et1macaddr", &sprom->et1mac); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "et1mdcport", &sprom->et1mdcport, 0); | ||||||
|  | +	nvram_read_u8(prefix, NULL, "et1phyaddr", &sprom->et1phyaddr, 0); | ||||||
|  | + | ||||||
|  | +	nvram_read_macaddr(prefix, "macaddr", &sprom->il0mac); | ||||||
|  | +	nvram_read_macaddr(prefix, "il0macaddr", &sprom->il0mac); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +void bcm47xx_fill_sprom(struct ssb_sprom *sprom, const char *prefix) | ||||||
|  | +{ | ||||||
|  | +	memset(sprom, 0, sizeof(struct ssb_sprom)); | ||||||
|  | + | ||||||
|  | +	bcm47xx_fill_sprom_ethernet(sprom, prefix); | ||||||
|  | + | ||||||
|  | +	nvram_read_u8(prefix, NULL, "sromrev", &sprom->revision, 0); | ||||||
|  | + | ||||||
|  | +	switch (sprom->revision) { | ||||||
|  | +	case 1: | ||||||
|  | +		bcm47xx_fill_sprom_r1234589(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r12389(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r1(sprom, prefix); | ||||||
|  | +		break; | ||||||
|  | +	case 2: | ||||||
|  | +		bcm47xx_fill_sprom_r1234589(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r12389(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r2389(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r2(sprom, prefix); | ||||||
|  | +		break; | ||||||
|  | +	case 3: | ||||||
|  | +		bcm47xx_fill_sprom_r1234589(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r12389(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r2389(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r389(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r3(sprom, prefix); | ||||||
|  | +		break; | ||||||
|  | +	case 4: | ||||||
|  | +	case 5: | ||||||
|  | +		bcm47xx_fill_sprom_r1234589(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r4589(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r458(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r45(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_path_r4589(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_path_r45(sprom, prefix); | ||||||
|  | +		break; | ||||||
|  | +	case 8: | ||||||
|  | +		bcm47xx_fill_sprom_r1234589(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r12389(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r2389(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r389(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r4589(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r458(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r89(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_path_r4589(sprom, prefix); | ||||||
|  | +		break; | ||||||
|  | +	case 9: | ||||||
|  | +		bcm47xx_fill_sprom_r1234589(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r12389(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r2389(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r389(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r4589(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r89(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r9(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_path_r4589(sprom, prefix); | ||||||
|  | +		break; | ||||||
|  | +	default: | ||||||
|  | +		pr_warn("Unsupported SPROM revision %d detected. Will extract" | ||||||
|  | +			" v1\n", sprom->revision); | ||||||
|  | +		sprom->revision = 1; | ||||||
|  | +		bcm47xx_fill_sprom_r1234589(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r12389(sprom, prefix); | ||||||
|  | +		bcm47xx_fill_sprom_r1(sprom, prefix); | ||||||
|  | +	} | ||||||
|  | +} | ||||||
|  | --- a/arch/mips/include/asm/mach-bcm47xx/bcm47xx.h | ||||||
|  | +++ b/arch/mips/include/asm/mach-bcm47xx/bcm47xx.h | ||||||
|  | @@ -44,4 +44,7 @@ union bcm47xx_bus { | ||||||
|  |  extern union bcm47xx_bus bcm47xx_bus; | ||||||
|  |  extern enum bcm47xx_bus_type bcm47xx_bus_type; | ||||||
|  |   | ||||||
|  | +void bcm47xx_fill_sprom(struct ssb_sprom *sprom, const char *prefix); | ||||||
|  | +void bcm47xx_fill_sprom_ethernet(struct ssb_sprom *sprom, const char *prefix); | ||||||
|  | + | ||||||
|  |  #endif /* __ASM_BCM47XX_H */ | ||||||
| @@ -0,0 +1,80 @@ | |||||||
|  | --- a/arch/mips/bcm47xx/setup.c | ||||||
|  | +++ b/arch/mips/bcm47xx/setup.c | ||||||
|  | @@ -3,7 +3,7 @@ | ||||||
|  |   *  Copyright (C) 2006 Felix Fietkau <nbd@openwrt.org> | ||||||
|  |   *  Copyright (C) 2006 Michael Buesch <m@bues.ch> | ||||||
|  |   *  Copyright (C) 2010 Waldemar Brodkorb <wbx@openadk.org> | ||||||
|  | - *  Copyright (C) 2010-2011 Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | + *  Copyright (C) 2010-2012 Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  |   *  Copyright (C) 2011-2012 Tathagata Das <tathagata@alumnux.com> | ||||||
|  |   * | ||||||
|  |   *  This program is free software; you can redistribute  it and/or modify it | ||||||
|  | @@ -132,7 +132,7 @@ static void bcm47xx_machine_halt(void) | ||||||
|  |  } | ||||||
|  |   | ||||||
|  |  #ifdef CONFIG_BCM47XX_SSB | ||||||
|  | -static int bcm47xx_get_sprom(struct ssb_bus *bus, struct ssb_sprom *out) | ||||||
|  | +static int bcm47xx_get_sprom_ssb(struct ssb_bus *bus, struct ssb_sprom *out) | ||||||
|  |  { | ||||||
|  |  	char prefix[10]; | ||||||
|  |   | ||||||
|  | @@ -149,7 +149,7 @@ static int bcm47xx_get_sprom(struct ssb_ | ||||||
|  |  } | ||||||
|  |   | ||||||
|  |  static int bcm47xx_get_invariants(struct ssb_bus *bus, | ||||||
|  | -				   struct ssb_init_invariants *iv) | ||||||
|  | +				  struct ssb_init_invariants *iv) | ||||||
|  |  { | ||||||
|  |  	char buf[20]; | ||||||
|  |   | ||||||
|  | @@ -204,7 +204,7 @@ static void __init bcm47xx_register_ssb( | ||||||
|  |  	char buf[100]; | ||||||
|  |  	struct ssb_mipscore *mcore; | ||||||
|  |   | ||||||
|  | -	err = ssb_arch_register_fallback_sprom(&bcm47xx_get_sprom); | ||||||
|  | +	err = ssb_arch_register_fallback_sprom(&bcm47xx_get_sprom_ssb); | ||||||
|  |  	if (err) | ||||||
|  |  		printk(KERN_WARNING "bcm47xx: someone else already registered" | ||||||
|  |  			" a ssb SPROM callback handler (err %d)\n", err); | ||||||
|  | @@ -256,10 +256,41 @@ static int __init bcm47xx_register_flash | ||||||
|  |  #endif | ||||||
|  |   | ||||||
|  |  #ifdef CONFIG_BCM47XX_BCMA | ||||||
|  | +static int bcm47xx_get_sprom_bcma(struct bcma_bus *bus, struct ssb_sprom *out) | ||||||
|  | +{ | ||||||
|  | +	char prefix[10]; | ||||||
|  | +	struct bcma_device *core; | ||||||
|  | + | ||||||
|  | +	switch (bus->hosttype) { | ||||||
|  | +	case BCMA_HOSTTYPE_PCI: | ||||||
|  | +		snprintf(prefix, sizeof(prefix), "pci/%u/%u/", | ||||||
|  | +			 bus->host_pci->bus->number + 1, | ||||||
|  | +			 PCI_SLOT(bus->host_pci->devfn)); | ||||||
|  | +		bcm47xx_fill_sprom(out, prefix); | ||||||
|  | +		return 0; | ||||||
|  | +	case BCMA_HOSTTYPE_SOC: | ||||||
|  | +		bcm47xx_fill_sprom_ethernet(out, NULL); | ||||||
|  | +		core = bcma_find_core(bus, BCMA_CORE_80211); | ||||||
|  | +		if (core) { | ||||||
|  | +			snprintf(prefix, sizeof(prefix), "sb/%u/", | ||||||
|  | +				 core->core_index); | ||||||
|  | +			bcm47xx_fill_sprom(out, prefix); | ||||||
|  | +		} | ||||||
|  | +		return 0; | ||||||
|  | +	default: | ||||||
|  | +		pr_warn("bcm47xx: unable to fill SPROM for given bustype.\n"); | ||||||
|  | +		return -EINVAL; | ||||||
|  | +	} | ||||||
|  | +} | ||||||
|  | + | ||||||
|  |  static void __init bcm47xx_register_bcma(void) | ||||||
|  |  { | ||||||
|  |  	int err; | ||||||
|  |   | ||||||
|  | +	err = bcma_arch_register_fallback_sprom(&bcm47xx_get_sprom_bcma); | ||||||
|  | +	if (err) | ||||||
|  | +		pr_warn("bcm47xx: someone else already registered a bcma SPROM callback handler (err %d)\n", err); | ||||||
|  | + | ||||||
|  |  	err = bcma_host_soc_register(&bcm47xx_bus.bcma); | ||||||
|  |  	if (err) | ||||||
|  |  		panic("Failed to initialize BCMA bus (err %d)", err); | ||||||
							
								
								
									
										54
									
								
								target/linux/brcm47xx/patches-3.3/210-b44_phy_fix.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										54
									
								
								target/linux/brcm47xx/patches-3.3/210-b44_phy_fix.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,54 @@ | |||||||
|  | --- a/drivers/net/ethernet/broadcom/b44.c | ||||||
|  | +++ b/drivers/net/ethernet/broadcom/b44.c | ||||||
|  | @@ -410,10 +410,34 @@ static void b44_wap54g10_workaround(stru | ||||||
|  |  error: | ||||||
|  |  	pr_warning("PHY: cannot reset MII transceiver isolate bit\n"); | ||||||
|  |  } | ||||||
|  | + | ||||||
|  | +static void b44_bcm47xx_workarounds(struct b44 *bp) | ||||||
|  | +{ | ||||||
|  | +	char buf[20]; | ||||||
|  | +	struct ssb_device *sdev = bp->sdev; | ||||||
|  | + | ||||||
|  | +	/* Toshiba WRC-1000, Siemens SE505 v1, Askey RT-210W, RT-220W */ | ||||||
|  | +	if (sdev->bus->sprom.board_num == 100) { | ||||||
|  | +		bp->phy_addr = B44_PHY_ADDR_NO_PHY; | ||||||
|  | +	} else { | ||||||
|  | +		/* WL-HDD */ | ||||||
|  | +		if (nvram_getenv("hardware_version", buf, sizeof(buf)) >= 0 && | ||||||
|  | +		    !strncmp(buf, "WL300-", strlen("WL300-"))) { | ||||||
|  | +			if (sdev->bus->sprom.et0phyaddr == 0 && | ||||||
|  | +			    sdev->bus->sprom.et1phyaddr == 1) | ||||||
|  | +				bp->phy_addr = B44_PHY_ADDR_NO_PHY; | ||||||
|  | +		} | ||||||
|  | +	} | ||||||
|  | +	return; | ||||||
|  | +} | ||||||
|  |  #else | ||||||
|  |  static inline void b44_wap54g10_workaround(struct b44 *bp) | ||||||
|  |  { | ||||||
|  |  } | ||||||
|  | + | ||||||
|  | +static inline void b44_bcm47xx_workarounds(struct b44 *bp) | ||||||
|  | +{ | ||||||
|  | +} | ||||||
|  |  #endif | ||||||
|  |   | ||||||
|  |  static int b44_setup_phy(struct b44 *bp) | ||||||
|  | @@ -422,6 +446,7 @@ static int b44_setup_phy(struct b44 *bp) | ||||||
|  |  	int err; | ||||||
|  |   | ||||||
|  |  	b44_wap54g10_workaround(bp); | ||||||
|  | +	b44_bcm47xx_workarounds(bp); | ||||||
|  |   | ||||||
|  |  	if (bp->phy_addr == B44_PHY_ADDR_NO_PHY) | ||||||
|  |  		return 0; | ||||||
|  | @@ -2088,6 +2113,8 @@ static int __devinit b44_get_invariants( | ||||||
|  |  	 * valid PHY address. */ | ||||||
|  |  	bp->phy_addr &= 0x1F; | ||||||
|  |   | ||||||
|  | +	b44_bcm47xx_workarounds(bp); | ||||||
|  | + | ||||||
|  |  	memcpy(bp->dev->dev_addr, addr, 6); | ||||||
|  |   | ||||||
|  |  	if (!is_valid_ether_addr(&bp->dev->dev_addr[0])){ | ||||||
							
								
								
									
										15
									
								
								target/linux/brcm47xx/patches-3.3/211-b44_timeout_spam.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										15
									
								
								target/linux/brcm47xx/patches-3.3/211-b44_timeout_spam.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,15 @@ | |||||||
|  | --- a/drivers/net/ethernet/broadcom/b44.c | ||||||
|  | +++ b/drivers/net/ethernet/broadcom/b44.c | ||||||
|  | @@ -187,10 +187,11 @@ static int b44_wait_bit(struct b44 *bp, | ||||||
|  |  		udelay(10); | ||||||
|  |  	} | ||||||
|  |  	if (i == timeout) { | ||||||
|  | +#if 0 | ||||||
|  |  		if (net_ratelimit()) | ||||||
|  |  			netdev_err(bp->dev, "BUG!  Timeout waiting for bit %08x of register %lx to %s\n", | ||||||
|  |  				   bit, reg, clear ? "clear" : "set"); | ||||||
|  | - | ||||||
|  | +#endif | ||||||
|  |  		return -ENODEV; | ||||||
|  |  	} | ||||||
|  |  	return 0; | ||||||
| @@ -0,0 +1,99 @@ | |||||||
|  | --- a/drivers/bcma/scan.c | ||||||
|  | +++ b/drivers/bcma/scan.c | ||||||
|  | @@ -19,7 +19,14 @@ struct bcma_device_id_name { | ||||||
|  |  	u16 id; | ||||||
|  |  	const char *name; | ||||||
|  |  }; | ||||||
|  | -struct bcma_device_id_name bcma_device_names[] = { | ||||||
|  | + | ||||||
|  | +static const struct bcma_device_id_name bcma_arm_device_names[] = { | ||||||
|  | +	{ BCMA_CORE_ARM_1176, "ARM 1176" }, | ||||||
|  | +	{ BCMA_CORE_ARM_7TDMI, "ARM 7TDMI" }, | ||||||
|  | +	{ BCMA_CORE_ARM_CM3, "ARM CM3" }, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static const struct bcma_device_id_name bcma_bcm_device_names[] = { | ||||||
|  |  	{ BCMA_CORE_OOB_ROUTER, "OOB Router" }, | ||||||
|  |  	{ BCMA_CORE_INVALID, "Invalid" }, | ||||||
|  |  	{ BCMA_CORE_CHIPCOMMON, "ChipCommon" }, | ||||||
|  | @@ -27,7 +34,6 @@ struct bcma_device_id_name bcma_device_n | ||||||
|  |  	{ BCMA_CORE_SRAM, "SRAM" }, | ||||||
|  |  	{ BCMA_CORE_SDRAM, "SDRAM" }, | ||||||
|  |  	{ BCMA_CORE_PCI, "PCI" }, | ||||||
|  | -	{ BCMA_CORE_MIPS, "MIPS" }, | ||||||
|  |  	{ BCMA_CORE_ETHERNET, "Fast Ethernet" }, | ||||||
|  |  	{ BCMA_CORE_V90, "V90" }, | ||||||
|  |  	{ BCMA_CORE_USB11_HOSTDEV, "USB 1.1 Hostdev" }, | ||||||
|  | @@ -44,7 +50,6 @@ struct bcma_device_id_name bcma_device_n | ||||||
|  |  	{ BCMA_CORE_PHY_A, "PHY A" }, | ||||||
|  |  	{ BCMA_CORE_PHY_B, "PHY B" }, | ||||||
|  |  	{ BCMA_CORE_PHY_G, "PHY G" }, | ||||||
|  | -	{ BCMA_CORE_MIPS_3302, "MIPS 3302" }, | ||||||
|  |  	{ BCMA_CORE_USB11_HOST, "USB 1.1 Host" }, | ||||||
|  |  	{ BCMA_CORE_USB11_DEV, "USB 1.1 Device" }, | ||||||
|  |  	{ BCMA_CORE_USB20_HOST, "USB 2.0 Host" }, | ||||||
|  | @@ -58,15 +63,11 @@ struct bcma_device_id_name bcma_device_n | ||||||
|  |  	{ BCMA_CORE_PHY_N, "PHY N" }, | ||||||
|  |  	{ BCMA_CORE_SRAM_CTL, "SRAM Controller" }, | ||||||
|  |  	{ BCMA_CORE_MINI_MACPHY, "Mini MACPHY" }, | ||||||
|  | -	{ BCMA_CORE_ARM_1176, "ARM 1176" }, | ||||||
|  | -	{ BCMA_CORE_ARM_7TDMI, "ARM 7TDMI" }, | ||||||
|  |  	{ BCMA_CORE_PHY_LP, "PHY LP" }, | ||||||
|  |  	{ BCMA_CORE_PMU, "PMU" }, | ||||||
|  |  	{ BCMA_CORE_PHY_SSN, "PHY SSN" }, | ||||||
|  |  	{ BCMA_CORE_SDIO_DEV, "SDIO Device" }, | ||||||
|  | -	{ BCMA_CORE_ARM_CM3, "ARM CM3" }, | ||||||
|  |  	{ BCMA_CORE_PHY_HT, "PHY HT" }, | ||||||
|  | -	{ BCMA_CORE_MIPS_74K, "MIPS 74K" }, | ||||||
|  |  	{ BCMA_CORE_MAC_GBIT, "GBit MAC" }, | ||||||
|  |  	{ BCMA_CORE_DDR12_MEM_CTL, "DDR1/DDR2 Memory Controller" }, | ||||||
|  |  	{ BCMA_CORE_PCIE_RC, "PCIe Root Complex" }, | ||||||
|  | @@ -79,16 +80,41 @@ struct bcma_device_id_name bcma_device_n | ||||||
|  |  	{ BCMA_CORE_SHIM, "SHIM" }, | ||||||
|  |  	{ BCMA_CORE_DEFAULT, "Default" }, | ||||||
|  |  }; | ||||||
|  | -const char *bcma_device_name(struct bcma_device_id *id) | ||||||
|  | + | ||||||
|  | +static const struct bcma_device_id_name bcma_mips_device_names[] = { | ||||||
|  | +	{ BCMA_CORE_MIPS, "MIPS" }, | ||||||
|  | +	{ BCMA_CORE_MIPS_3302, "MIPS 3302" }, | ||||||
|  | +	{ BCMA_CORE_MIPS_74K, "MIPS 74K" }, | ||||||
|  | +}; | ||||||
|  | + | ||||||
|  | +static const char *bcma_device_name(const struct bcma_device_id *id) | ||||||
|  |  { | ||||||
|  | -	int i; | ||||||
|  | +	const struct bcma_device_id_name *names; | ||||||
|  | +	int size, i; | ||||||
|  |   | ||||||
|  | -	if (id->manuf == BCMA_MANUF_BCM) { | ||||||
|  | -		for (i = 0; i < ARRAY_SIZE(bcma_device_names); i++) { | ||||||
|  | -			if (bcma_device_names[i].id == id->id) | ||||||
|  | -				return bcma_device_names[i].name; | ||||||
|  | -		} | ||||||
|  | +	/* search manufacturer specific names */ | ||||||
|  | +	switch (id->manuf) { | ||||||
|  | +	case BCMA_MANUF_ARM: | ||||||
|  | +		names = bcma_arm_device_names; | ||||||
|  | +		size = ARRAY_SIZE(bcma_arm_device_names); | ||||||
|  | +		break; | ||||||
|  | +	case BCMA_MANUF_BCM: | ||||||
|  | +		names = bcma_bcm_device_names; | ||||||
|  | +		size = ARRAY_SIZE(bcma_bcm_device_names); | ||||||
|  | +		break; | ||||||
|  | +	case BCMA_MANUF_MIPS: | ||||||
|  | +		names = bcma_mips_device_names; | ||||||
|  | +		size = ARRAY_SIZE(bcma_mips_device_names); | ||||||
|  | +		break; | ||||||
|  | +	default: | ||||||
|  | +		return "UNKNOWN"; | ||||||
|  |  	} | ||||||
|  | + | ||||||
|  | +	for (i = 0; i < size; i++) { | ||||||
|  | +		if (names[i].id == id->id) | ||||||
|  | +			return names[i].name; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  |  	return "UNKNOWN"; | ||||||
|  |  } | ||||||
|  |   | ||||||
| @@ -0,0 +1,44 @@ | |||||||
|  | --- a/arch/mips/bcm47xx/setup.c | ||||||
|  | +++ b/arch/mips/bcm47xx/setup.c | ||||||
|  | @@ -137,6 +137,7 @@ static int bcm47xx_get_sprom_ssb(struct | ||||||
|  |  	char prefix[10]; | ||||||
|  |   | ||||||
|  |  	if (bus->bustype == SSB_BUSTYPE_PCI) { | ||||||
|  | +		memset(out, 0, sizeof(struct ssb_sprom)); | ||||||
|  |  		snprintf(prefix, sizeof(prefix), "pci/%u/%u/", | ||||||
|  |  			 bus->host_pci->bus->number + 1, | ||||||
|  |  			 PCI_SLOT(bus->host_pci->devfn)); | ||||||
|  | @@ -165,6 +166,7 @@ static int bcm47xx_get_invariants(struct | ||||||
|  |  	if (nvram_getenv("boardrev", buf, sizeof(buf)) >= 0) | ||||||
|  |  		iv->boardinfo.rev = (u16)simple_strtoul(buf, NULL, 0); | ||||||
|  |   | ||||||
|  | +	memset(&iv->sprom, 0, sizeof(struct ssb_sprom)); | ||||||
|  |  	bcm47xx_fill_sprom(&iv->sprom, NULL); | ||||||
|  |   | ||||||
|  |  	if (nvram_getenv("cardbus", buf, sizeof(buf)) >= 0) | ||||||
|  | @@ -263,12 +265,14 @@ static int bcm47xx_get_sprom_bcma(struct | ||||||
|  |   | ||||||
|  |  	switch (bus->hosttype) { | ||||||
|  |  	case BCMA_HOSTTYPE_PCI: | ||||||
|  | +		memset(out, 0, sizeof(struct ssb_sprom)); | ||||||
|  |  		snprintf(prefix, sizeof(prefix), "pci/%u/%u/", | ||||||
|  |  			 bus->host_pci->bus->number + 1, | ||||||
|  |  			 PCI_SLOT(bus->host_pci->devfn)); | ||||||
|  |  		bcm47xx_fill_sprom(out, prefix); | ||||||
|  |  		return 0; | ||||||
|  |  	case BCMA_HOSTTYPE_SOC: | ||||||
|  | +		memset(out, 0, sizeof(struct ssb_sprom)); | ||||||
|  |  		bcm47xx_fill_sprom_ethernet(out, NULL); | ||||||
|  |  		core = bcma_find_core(bus, BCMA_CORE_80211); | ||||||
|  |  		if (core) { | ||||||
|  | --- a/arch/mips/bcm47xx/sprom.c | ||||||
|  | +++ b/arch/mips/bcm47xx/sprom.c | ||||||
|  | @@ -555,8 +555,6 @@ void bcm47xx_fill_sprom_ethernet(struct | ||||||
|  |   | ||||||
|  |  void bcm47xx_fill_sprom(struct ssb_sprom *sprom, const char *prefix) | ||||||
|  |  { | ||||||
|  | -	memset(sprom, 0, sizeof(struct ssb_sprom)); | ||||||
|  | - | ||||||
|  |  	bcm47xx_fill_sprom_ethernet(sprom, prefix); | ||||||
|  |   | ||||||
|  |  	nvram_read_u8(prefix, NULL, "sromrev", &sprom->revision, 0); | ||||||
| @@ -0,0 +1,14 @@ | |||||||
|  | --- a/drivers/bcma/driver_pci_host.c | ||||||
|  | +++ b/drivers/bcma/driver_pci_host.c | ||||||
|  | @@ -491,8 +491,9 @@ void __devinit bcma_core_pci_hostmode_in | ||||||
|  |  	/* Ok, ready to run, register it to the system. | ||||||
|  |  	 * The following needs change, if we want to port hostmode | ||||||
|  |  	 * to non-MIPS platform. */ | ||||||
|  | -	io_map_base = (unsigned long)ioremap_nocache(BCMA_SOC_PCI_MEM, | ||||||
|  | -						     0x04000000); | ||||||
|  | +	io_map_base = (unsigned long)ioremap_nocache(pc_host->mem_resource.start, | ||||||
|  | +						     pc_host->mem_resource.end - | ||||||
|  | +						     pc_host->mem_resource.start + 1); | ||||||
|  |  	pc_host->pci_controller.io_map_base = io_map_base; | ||||||
|  |  	set_io_port_base(pc_host->pci_controller.io_map_base); | ||||||
|  |  	/* Give some time to the PCI controller to configure itself with the new | ||||||
| @@ -0,0 +1,29 @@ | |||||||
|  | --- a/drivers/bcma/driver_pci_host.c | ||||||
|  | +++ b/drivers/bcma/driver_pci_host.c | ||||||
|  | @@ -119,7 +119,7 @@ static int bcma_extpci_read_config(struc | ||||||
|  |  		if (unlikely(!addr)) | ||||||
|  |  			goto out; | ||||||
|  |  		err = -ENOMEM; | ||||||
|  | -		mmio = ioremap_nocache(addr, len); | ||||||
|  | +		mmio = ioremap_nocache(addr, sizeof(val)); | ||||||
|  |  		if (!mmio) | ||||||
|  |  			goto out; | ||||||
|  |   | ||||||
|  | @@ -171,7 +171,7 @@ static int bcma_extpci_write_config(stru | ||||||
|  |  			addr = pc->core->addr + BCMA_CORE_PCI_PCICFG0; | ||||||
|  |  			addr |= (func << 8); | ||||||
|  |  			addr |= (off & 0xfc); | ||||||
|  | -			mmio = ioremap_nocache(addr, len); | ||||||
|  | +			mmio = ioremap_nocache(addr, sizeof(val)); | ||||||
|  |  			if (!mmio) | ||||||
|  |  				goto out; | ||||||
|  |  		} | ||||||
|  | @@ -180,7 +180,7 @@ static int bcma_extpci_write_config(stru | ||||||
|  |  		if (unlikely(!addr)) | ||||||
|  |  			goto out; | ||||||
|  |  		err = -ENOMEM; | ||||||
|  | -		mmio = ioremap_nocache(addr, len); | ||||||
|  | +		mmio = ioremap_nocache(addr, sizeof(val)); | ||||||
|  |  		if (!mmio) | ||||||
|  |  			goto out; | ||||||
|  |   | ||||||
| @@ -0,0 +1,20 @@ | |||||||
|  | --- a/drivers/bcma/host_pci.c | ||||||
|  | +++ b/drivers/bcma/host_pci.c | ||||||
|  | @@ -222,7 +222,7 @@ err_kfree_bus: | ||||||
|  |  	return err; | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | -static void bcma_host_pci_remove(struct pci_dev *dev) | ||||||
|  | +static void __devexit bcma_host_pci_remove(struct pci_dev *dev) | ||||||
|  |  { | ||||||
|  |  	struct bcma_bus *bus = pci_get_drvdata(dev); | ||||||
|  |   | ||||||
|  | @@ -278,7 +278,7 @@ static struct pci_driver bcma_pci_bridge | ||||||
|  |  	.name = "bcma-pci-bridge", | ||||||
|  |  	.id_table = bcma_pci_bridge_tbl, | ||||||
|  |  	.probe = bcma_host_pci_probe, | ||||||
|  | -	.remove = bcma_host_pci_remove, | ||||||
|  | +	.remove = __devexit_p(bcma_host_pci_remove), | ||||||
|  |  	.driver.pm = BCMA_PM_OPS, | ||||||
|  |  }; | ||||||
|  |   | ||||||
| @@ -0,0 +1,10 @@ | |||||||
|  | --- a/drivers/bcma/core.c | ||||||
|  | +++ b/drivers/bcma/core.c | ||||||
|  | @@ -30,6 +30,7 @@ void bcma_core_disable(struct bcma_devic | ||||||
|  |  	udelay(10); | ||||||
|  |   | ||||||
|  |  	bcma_awrite32(core, BCMA_RESET_CTL, BCMA_RESET_CTL_RESET); | ||||||
|  | +	bcma_aread32(core, BCMA_RESET_CTL); | ||||||
|  |  	udelay(1); | ||||||
|  |  } | ||||||
|  |  EXPORT_SYMBOL_GPL(bcma_core_disable); | ||||||
| @@ -0,0 +1,104 @@ | |||||||
|  | --- a/drivers/bcma/driver_pci_host.c | ||||||
|  | +++ b/drivers/bcma/driver_pci_host.c | ||||||
|  | @@ -99,19 +99,19 @@ static int bcma_extpci_read_config(struc | ||||||
|  |  	if (dev == 0) { | ||||||
|  |  		/* we support only two functions on device 0 */ | ||||||
|  |  		if (func > 1) | ||||||
|  | -			return -EINVAL; | ||||||
|  | +			goto out; | ||||||
|  |   | ||||||
|  |  		/* accesses to config registers with offsets >= 256 | ||||||
|  |  		 * requires indirect access. | ||||||
|  |  		 */ | ||||||
|  |  		if (off >= PCI_CONFIG_SPACE_SIZE) { | ||||||
|  |  			addr = (func << 12); | ||||||
|  | -			addr |= (off & 0x0FFF); | ||||||
|  | +			addr |= (off & 0x0FFC); | ||||||
|  |  			val = bcma_pcie_read_config(pc, addr); | ||||||
|  |  		} else { | ||||||
|  |  			addr = BCMA_CORE_PCI_PCICFG0; | ||||||
|  |  			addr |= (func << 8); | ||||||
|  | -			addr |= (off & 0xfc); | ||||||
|  | +			addr |= (off & 0xFC); | ||||||
|  |  			val = pcicore_read32(pc, addr); | ||||||
|  |  		} | ||||||
|  |  	} else { | ||||||
|  | @@ -127,8 +127,6 @@ static int bcma_extpci_read_config(struc | ||||||
|  |  			val = 0xffffffff; | ||||||
|  |  			goto unmap; | ||||||
|  |  		} | ||||||
|  | - | ||||||
|  | -		val = readl(mmio); | ||||||
|  |  	} | ||||||
|  |  	val >>= (8 * (off & 3)); | ||||||
|  |   | ||||||
|  | @@ -156,7 +154,7 @@ static int bcma_extpci_write_config(stru | ||||||
|  |  				   const void *buf, int len) | ||||||
|  |  { | ||||||
|  |  	int err = -EINVAL; | ||||||
|  | -	u32 addr = 0, val = 0; | ||||||
|  | +	u32 addr, val; | ||||||
|  |  	void __iomem *mmio = 0; | ||||||
|  |  	u16 chipid = pc->core->bus->chipinfo.id; | ||||||
|  |   | ||||||
|  | @@ -164,16 +162,22 @@ static int bcma_extpci_write_config(stru | ||||||
|  |  	if (unlikely(len != 1 && len != 2 && len != 4)) | ||||||
|  |  		goto out; | ||||||
|  |  	if (dev == 0) { | ||||||
|  | +		/* we support only two functions on device 0 */ | ||||||
|  | +		if (func > 1) | ||||||
|  | +			goto out; | ||||||
|  | + | ||||||
|  |  		/* accesses to config registers with offsets >= 256 | ||||||
|  |  		 * requires indirect access. | ||||||
|  |  		 */ | ||||||
|  | -		if (off < PCI_CONFIG_SPACE_SIZE) { | ||||||
|  | -			addr = pc->core->addr + BCMA_CORE_PCI_PCICFG0; | ||||||
|  | +		if (off >= PCI_CONFIG_SPACE_SIZE) { | ||||||
|  | +			addr = (func << 12); | ||||||
|  | +			addr |= (off & 0x0FFC); | ||||||
|  | +			val = bcma_pcie_read_config(pc, addr); | ||||||
|  | +		} else { | ||||||
|  | +			addr = BCMA_CORE_PCI_PCICFG0; | ||||||
|  |  			addr |= (func << 8); | ||||||
|  | -			addr |= (off & 0xfc); | ||||||
|  | -			mmio = ioremap_nocache(addr, sizeof(val)); | ||||||
|  | -			if (!mmio) | ||||||
|  | -				goto out; | ||||||
|  | +			addr |= (off & 0xFC); | ||||||
|  | +			val = pcicore_read32(pc, addr); | ||||||
|  |  		} | ||||||
|  |  	} else { | ||||||
|  |  		addr = bcma_get_cfgspace_addr(pc, dev, func, off); | ||||||
|  | @@ -192,12 +196,10 @@ static int bcma_extpci_write_config(stru | ||||||
|  |   | ||||||
|  |  	switch (len) { | ||||||
|  |  	case 1: | ||||||
|  | -		val = readl(mmio); | ||||||
|  |  		val &= ~(0xFF << (8 * (off & 3))); | ||||||
|  |  		val |= *((const u8 *)buf) << (8 * (off & 3)); | ||||||
|  |  		break; | ||||||
|  |  	case 2: | ||||||
|  | -		val = readl(mmio); | ||||||
|  |  		val &= ~(0xFFFF << (8 * (off & 3))); | ||||||
|  |  		val |= *((const u16 *)buf) << (8 * (off & 3)); | ||||||
|  |  		break; | ||||||
|  | @@ -205,13 +207,14 @@ static int bcma_extpci_write_config(stru | ||||||
|  |  		val = *((const u32 *)buf); | ||||||
|  |  		break; | ||||||
|  |  	} | ||||||
|  | -	if (dev == 0 && !addr) { | ||||||
|  | +	if (dev == 0) { | ||||||
|  |  		/* accesses to config registers with offsets >= 256 | ||||||
|  |  		 * requires indirect access. | ||||||
|  |  		 */ | ||||||
|  | -		addr = (func << 12); | ||||||
|  | -		addr |= (off & 0x0FFF); | ||||||
|  | -		bcma_pcie_write_config(pc, addr, val); | ||||||
|  | +		if (off >= PCI_CONFIG_SPACE_SIZE) | ||||||
|  | +			bcma_pcie_write_config(pc, addr, val); | ||||||
|  | +		else | ||||||
|  | +			pcicore_write32(pc, addr, val); | ||||||
|  |  	} else { | ||||||
|  |  		writel(val, mmio); | ||||||
|  |   | ||||||
| @@ -0,0 +1,25 @@ | |||||||
|  | This prevents the options from being delete with make kernel_oldconfig. | ||||||
|  | --- | ||||||
|  |  drivers/ssb/Kconfig |    2 ++ | ||||||
|  |  1 file changed, 2 insertions(+) | ||||||
|  |  | ||||||
|  | --- a/drivers/bcma/Kconfig | ||||||
|  | +++ b/drivers/bcma/Kconfig | ||||||
|  | @@ -37,6 +37,7 @@ config BCMA_DRIVER_PCI_HOSTMODE | ||||||
|  |  config BCMA_HOST_SOC | ||||||
|  |  	bool | ||||||
|  |  	depends on BCMA_DRIVER_MIPS | ||||||
|  | +	select USB_HCD_BCMA if USB_EHCI_HCD || USB_OHCI_HCD | ||||||
|  |   | ||||||
|  |  config BCMA_SFLASH | ||||||
|  |  	bool | ||||||
|  | --- a/drivers/ssb/Kconfig | ||||||
|  | +++ b/drivers/ssb/Kconfig | ||||||
|  | @@ -147,6 +147,7 @@ config SSB_SFLASH | ||||||
|  |  config SSB_EMBEDDED | ||||||
|  |  	bool | ||||||
|  |  	depends on SSB_DRIVER_MIPS | ||||||
|  | +	select USB_HCD_SSB if USB_EHCI_HCD || USB_OHCI_HCD | ||||||
|  |  	default y | ||||||
|  |   | ||||||
|  |  config SSB_DRIVER_EXTIF | ||||||
							
								
								
									
										11
									
								
								target/linux/brcm47xx/patches-3.3/300-fork_cacheflush.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										11
									
								
								target/linux/brcm47xx/patches-3.3/300-fork_cacheflush.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,11 @@ | |||||||
|  | --- a/arch/mips/include/asm/cacheflush.h | ||||||
|  | +++ b/arch/mips/include/asm/cacheflush.h | ||||||
|  | @@ -32,7 +32,7 @@ | ||||||
|  |  extern void (*flush_cache_all)(void); | ||||||
|  |  extern void (*__flush_cache_all)(void); | ||||||
|  |  extern void (*flush_cache_mm)(struct mm_struct *mm); | ||||||
|  | -#define flush_cache_dup_mm(mm)	do { (void) (mm); } while (0) | ||||||
|  | +#define flush_cache_dup_mm(mm) flush_cache_mm(mm) | ||||||
|  |  extern void (*flush_cache_range)(struct vm_area_struct *vma, | ||||||
|  |  	unsigned long start, unsigned long end); | ||||||
|  |  extern void (*flush_cache_page)(struct vm_area_struct *vma, unsigned long page, unsigned long pfn); | ||||||
| @@ -0,0 +1,28 @@ | |||||||
|  | --- a/arch/mips/mm/c-r4k.c | ||||||
|  | +++ b/arch/mips/mm/c-r4k.c | ||||||
|  | @@ -373,7 +373,7 @@ static inline void local_r4k___flush_cac | ||||||
|  |  	} | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | -static void r4k___flush_cache_all(void) | ||||||
|  | +void r4k___flush_cache_all(void) | ||||||
|  |  { | ||||||
|  |  	r4k_on_each_cpu(local_r4k___flush_cache_all, NULL); | ||||||
|  |  } | ||||||
|  | @@ -537,7 +537,7 @@ static inline void local_r4k_flush_cache | ||||||
|  |  	} | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | -static void r4k_flush_cache_page(struct vm_area_struct *vma, | ||||||
|  | +void r4k_flush_cache_page(struct vm_area_struct *vma, | ||||||
|  |  	unsigned long addr, unsigned long pfn) | ||||||
|  |  { | ||||||
|  |  	struct flush_cache_page_args args; | ||||||
|  | @@ -1509,3 +1509,7 @@ void __cpuinit r4k_cache_init(void) | ||||||
|  |  	coherency_setup(); | ||||||
|  |  #endif | ||||||
|  |  } | ||||||
|  | + | ||||||
|  | +/* fuse package DCACHE BUG patch exports */ | ||||||
|  | +void (*fuse_flush_cache_all)(void) = r4k___flush_cache_all; | ||||||
|  | +EXPORT_SYMBOL(fuse_flush_cache_all); | ||||||
| @@ -0,0 +1,46 @@ | |||||||
|  | --- a/fs/fuse/dev.c | ||||||
|  | +++ b/fs/fuse/dev.c | ||||||
|  | @@ -651,11 +651,20 @@ static int fuse_copy_fill(struct fuse_co | ||||||
|  |  	return lock_request(cs->fc, cs->req); | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | +#ifdef DCACHE_BUG | ||||||
|  | +extern void (*fuse_flush_cache_all)(void); | ||||||
|  | +#endif | ||||||
|  | + | ||||||
|  |  /* Do as much copy to/from userspace buffer as we can */ | ||||||
|  |  static int fuse_copy_do(struct fuse_copy_state *cs, void **val, unsigned *size) | ||||||
|  |  { | ||||||
|  |  	unsigned ncpy = min(*size, cs->len); | ||||||
|  |  	if (val) { | ||||||
|  | +#ifdef DCACHE_BUG | ||||||
|  | +		// patch from mailing list, it is very important, otherwise, | ||||||
|  | +		// can't mount, or ls mount point will hang | ||||||
|  | +		fuse_flush_cache_all(); | ||||||
|  | +#endif | ||||||
|  |  		if (cs->write) | ||||||
|  |  			memcpy(cs->buf, *val, ncpy); | ||||||
|  |  		else | ||||||
|  | --- a/fs/fuse/fuse_i.h | ||||||
|  | +++ b/fs/fuse/fuse_i.h | ||||||
|  | @@ -8,6 +8,7 @@ | ||||||
|  |   | ||||||
|  |  #ifndef _FS_FUSE_I_H | ||||||
|  |  #define _FS_FUSE_I_H | ||||||
|  | +#define DCACHE_BUG | ||||||
|  |   | ||||||
|  |  #include <linux/fuse.h> | ||||||
|  |  #include <linux/fs.h> | ||||||
|  | --- a/fs/fuse/inode.c | ||||||
|  | +++ b/fs/fuse/inode.c | ||||||
|  | @@ -1210,6 +1210,10 @@ static int __init fuse_init(void) | ||||||
|  |  	printk(KERN_INFO "fuse init (API version %i.%i)\n", | ||||||
|  |  	       FUSE_KERNEL_VERSION, FUSE_KERNEL_MINOR_VERSION); | ||||||
|  |   | ||||||
|  | +#ifdef DCACHE_BUG | ||||||
|  | +	printk("fuse init DCACHE_BUG workaround enabled\n"); | ||||||
|  | +#endif | ||||||
|  | + | ||||||
|  |  	INIT_LIST_HEAD(&fuse_conn_list); | ||||||
|  |  	res = fuse_fs_init(); | ||||||
|  |  	if (res) | ||||||
							
								
								
									
										66
									
								
								target/linux/brcm47xx/patches-3.3/310-no_highpage.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										66
									
								
								target/linux/brcm47xx/patches-3.3/310-no_highpage.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,66 @@ | |||||||
|  | --- a/arch/mips/include/asm/page.h | ||||||
|  | +++ b/arch/mips/include/asm/page.h | ||||||
|  | @@ -48,6 +48,7 @@ | ||||||
|  |  #ifndef __ASSEMBLY__ | ||||||
|  |   | ||||||
|  |  #include <linux/pfn.h> | ||||||
|  | +#include <asm/cpu-features.h> | ||||||
|  |  #include <asm/io.h> | ||||||
|  |   | ||||||
|  |  extern void build_clear_page(void); | ||||||
|  | @@ -83,13 +84,16 @@ static inline void clear_user_page(void | ||||||
|  |  		flush_data_cache_page((unsigned long)addr); | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | -extern void copy_user_page(void *vto, void *vfrom, unsigned long vaddr, | ||||||
|  | -	struct page *to); | ||||||
|  | -struct vm_area_struct; | ||||||
|  | -extern void copy_user_highpage(struct page *to, struct page *from, | ||||||
|  | -	unsigned long vaddr, struct vm_area_struct *vma); | ||||||
|  | +static inline void copy_user_page(void *vto, void *vfrom, unsigned long vaddr, | ||||||
|  | +	struct page *to) | ||||||
|  | +{ | ||||||
|  | +	extern void (*flush_data_cache_page)(unsigned long addr); | ||||||
|  |   | ||||||
|  | -#define __HAVE_ARCH_COPY_USER_HIGHPAGE | ||||||
|  | +	copy_page(vto, vfrom); | ||||||
|  | +	if (!cpu_has_ic_fills_f_dc || | ||||||
|  | +	    pages_do_alias((unsigned long)vto, vaddr & PAGE_MASK)) | ||||||
|  | +		flush_data_cache_page((unsigned long)vto); | ||||||
|  | +} | ||||||
|  |   | ||||||
|  |  /* | ||||||
|  |   * These are used to make use of C type-checking.. | ||||||
|  | --- a/arch/mips/mm/init.c | ||||||
|  | +++ b/arch/mips/mm/init.c | ||||||
|  | @@ -202,30 +202,6 @@ void kunmap_coherent(void) | ||||||
|  |  	preempt_check_resched(); | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | -void copy_user_highpage(struct page *to, struct page *from, | ||||||
|  | -	unsigned long vaddr, struct vm_area_struct *vma) | ||||||
|  | -{ | ||||||
|  | -	void *vfrom, *vto; | ||||||
|  | - | ||||||
|  | -	vto = kmap_atomic(to, KM_USER1); | ||||||
|  | -	if (cpu_has_dc_aliases && cpu_use_kmap_coherent && | ||||||
|  | -	    page_mapped(from) && !Page_dcache_dirty(from)) { | ||||||
|  | -		vfrom = kmap_coherent(from, vaddr); | ||||||
|  | -		copy_page(vto, vfrom); | ||||||
|  | -		kunmap_coherent(); | ||||||
|  | -	} else { | ||||||
|  | -		vfrom = kmap_atomic(from, KM_USER0); | ||||||
|  | -		copy_page(vto, vfrom); | ||||||
|  | -		kunmap_atomic(vfrom, KM_USER0); | ||||||
|  | -	} | ||||||
|  | -	if ((!cpu_has_ic_fills_f_dc) || | ||||||
|  | -	    pages_do_alias((unsigned long)vto, vaddr & PAGE_MASK)) | ||||||
|  | -		flush_data_cache_page((unsigned long)vto); | ||||||
|  | -	kunmap_atomic(vto, KM_USER1); | ||||||
|  | -	/* Make sure this page is cleared on other CPU's too before using it */ | ||||||
|  | -	smp_wmb(); | ||||||
|  | -} | ||||||
|  | - | ||||||
|  |  void copy_to_user_page(struct vm_area_struct *vma, | ||||||
|  |  	struct page *page, unsigned long vaddr, void *dst, const void *src, | ||||||
|  |  	unsigned long len) | ||||||
							
								
								
									
										56
									
								
								target/linux/brcm47xx/patches-3.3/400-arch-bcm47xx.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										56
									
								
								target/linux/brcm47xx/patches-3.3/400-arch-bcm47xx.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,56 @@ | |||||||
|  | --- a/arch/mips/bcm47xx/nvram.c | ||||||
|  | +++ b/arch/mips/bcm47xx/nvram.c | ||||||
|  | @@ -269,3 +269,30 @@ int nvram_getenv(char *name, char *val, | ||||||
|  |  	return NVRAM_ERR_ENVNOTFOUND; | ||||||
|  |  } | ||||||
|  |  EXPORT_SYMBOL(nvram_getenv); | ||||||
|  | + | ||||||
|  | +char *nvram_get(const char *name) | ||||||
|  | +{ | ||||||
|  | +	char *var, *value, *end, *eq; | ||||||
|  | + | ||||||
|  | +	if (!name) | ||||||
|  | +		return NULL; | ||||||
|  | + | ||||||
|  | +	if (!nvram_buf[0]) | ||||||
|  | +		early_nvram_init(); | ||||||
|  | + | ||||||
|  | +	/* Look for name=value and return value */ | ||||||
|  | +	var = &nvram_buf[sizeof(struct nvram_header)]; | ||||||
|  | +	end = nvram_buf + sizeof(nvram_buf) - 2; | ||||||
|  | +	end[0] = end[1] = '\0'; | ||||||
|  | +	for (; *var; var = value + strlen(value) + 1) { | ||||||
|  | +		eq = strchr(var, '='); | ||||||
|  | +		if (!eq) | ||||||
|  | +			break; | ||||||
|  | +		value = eq + 1; | ||||||
|  | +		if ((eq - var) == strlen(name) && strncmp(var, name, (eq - var)) == 0) | ||||||
|  | +			return value; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return NULL; | ||||||
|  | +} | ||||||
|  | +EXPORT_SYMBOL(nvram_get); | ||||||
|  | --- a/arch/mips/bcm47xx/setup.c | ||||||
|  | +++ b/arch/mips/bcm47xx/setup.c | ||||||
|  | @@ -384,3 +384,20 @@ static int __init bcm47xx_register_flash | ||||||
|  |  	return -1; | ||||||
|  |  } | ||||||
|  |  fs_initcall(bcm47xx_register_flash); | ||||||
|  | + | ||||||
|  | +static int __init bcm47xx_register_gpiodev(void) | ||||||
|  | +{ | ||||||
|  | +	static struct resource res = { | ||||||
|  | +		.start = 0xFFFFFFFF, | ||||||
|  | +	}; | ||||||
|  | +	struct platform_device *pdev; | ||||||
|  | + | ||||||
|  | +	pdev = platform_device_register_simple("GPIODEV", 0, &res, 1); | ||||||
|  | +	if (!pdev) { | ||||||
|  | +		printk(KERN_ERR "bcm47xx: GPIODEV init failed\n"); | ||||||
|  | +		return -ENODEV; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	return 0; | ||||||
|  | +} | ||||||
|  | +device_initcall(bcm47xx_register_gpiodev); | ||||||
							
								
								
									
										14
									
								
								target/linux/brcm47xx/patches-3.3/610-pci_ide_fix.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										14
									
								
								target/linux/brcm47xx/patches-3.3/610-pci_ide_fix.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,14 @@ | |||||||
|  | --- a/include/linux/ide.h | ||||||
|  | +++ b/include/linux/ide.h | ||||||
|  | @@ -195,7 +195,11 @@ static inline void ide_std_init_ports(st | ||||||
|  |  	hw->io_ports.ctl_addr = ctl_addr; | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | +#if defined CONFIG_BCM47XX | ||||||
|  | +# define MAX_HWIFS	2 | ||||||
|  | +#else | ||||||
|  |  #define MAX_HWIFS	10 | ||||||
|  | +#endif | ||||||
|  |   | ||||||
|  |  /* | ||||||
|  |   * Now for the data we need to maintain per-drive:  ide_drive_t | ||||||
| @@ -0,0 +1,325 @@ | |||||||
|  | --- a/drivers/net/ethernet/broadcom/tg3.c | ||||||
|  | +++ b/drivers/net/ethernet/broadcom/tg3.c | ||||||
|  | @@ -44,6 +44,7 @@ | ||||||
|  |  #include <linux/prefetch.h> | ||||||
|  |  #include <linux/dma-mapping.h> | ||||||
|  |  #include <linux/firmware.h> | ||||||
|  | +#include <linux/ssb/ssb_driver_gige.h> | ||||||
|  |   | ||||||
|  |  #include <net/checksum.h> | ||||||
|  |  #include <net/ip.h> | ||||||
|  | @@ -530,7 +531,8 @@ static void _tw32_flush(struct tg3 *tp, | ||||||
|  |  static inline void tw32_mailbox_flush(struct tg3 *tp, u32 off, u32 val) | ||||||
|  |  { | ||||||
|  |  	tp->write32_mbox(tp, off, val); | ||||||
|  | -	if (!tg3_flag(tp, MBOX_WRITE_REORDER) && !tg3_flag(tp, ICH_WORKAROUND)) | ||||||
|  | +	if (tg3_flag(tp, FLUSH_POSTED_WRITES) || | ||||||
|  | +	    (!tg3_flag(tp, MBOX_WRITE_REORDER) && !tg3_flag(tp, ICH_WORKAROUND))) | ||||||
|  |  		tp->read32_mbox(tp, off); | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | @@ -540,7 +542,7 @@ static void tg3_write32_tx_mbox(struct t | ||||||
|  |  	writel(val, mbox); | ||||||
|  |  	if (tg3_flag(tp, TXD_MBOX_HWBUG)) | ||||||
|  |  		writel(val, mbox); | ||||||
|  | -	if (tg3_flag(tp, MBOX_WRITE_REORDER)) | ||||||
|  | +	if (tg3_flag(tp, MBOX_WRITE_REORDER) || tg3_flag(tp, FLUSH_POSTED_WRITES)) | ||||||
|  |  		readl(mbox); | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | @@ -943,7 +945,7 @@ static void tg3_switch_clocks(struct tg3 | ||||||
|  |   | ||||||
|  |  #define PHY_BUSY_LOOPS	5000 | ||||||
|  |   | ||||||
|  | -static int tg3_readphy(struct tg3 *tp, int reg, u32 *val) | ||||||
|  | +static int __tg3_readphy(struct tg3 *tp, unsigned int phy_addr, int reg, u32 *val) | ||||||
|  |  { | ||||||
|  |  	u32 frame_val; | ||||||
|  |  	unsigned int loops; | ||||||
|  | @@ -957,7 +959,7 @@ static int tg3_readphy(struct tg3 *tp, i | ||||||
|  |   | ||||||
|  |  	*val = 0x0; | ||||||
|  |   | ||||||
|  | -	frame_val  = ((tp->phy_addr << MI_COM_PHY_ADDR_SHIFT) & | ||||||
|  | +	frame_val  = ((phy_addr << MI_COM_PHY_ADDR_SHIFT) & | ||||||
|  |  		      MI_COM_PHY_ADDR_MASK); | ||||||
|  |  	frame_val |= ((reg << MI_COM_REG_ADDR_SHIFT) & | ||||||
|  |  		      MI_COM_REG_ADDR_MASK); | ||||||
|  | @@ -992,7 +994,12 @@ static int tg3_readphy(struct tg3 *tp, i | ||||||
|  |  	return ret; | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | -static int tg3_writephy(struct tg3 *tp, int reg, u32 val) | ||||||
|  | +static int tg3_readphy(struct tg3 *tp, int reg, u32 *val) | ||||||
|  | +{ | ||||||
|  | +	return __tg3_readphy(tp, tp->phy_addr, reg, val); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +static int __tg3_writephy(struct tg3 *tp, unsigned int phy_addr, int reg, u32 val) | ||||||
|  |  { | ||||||
|  |  	u32 frame_val; | ||||||
|  |  	unsigned int loops; | ||||||
|  | @@ -1008,7 +1015,7 @@ static int tg3_writephy(struct tg3 *tp, | ||||||
|  |  		udelay(80); | ||||||
|  |  	} | ||||||
|  |   | ||||||
|  | -	frame_val  = ((tp->phy_addr << MI_COM_PHY_ADDR_SHIFT) & | ||||||
|  | +	frame_val  = ((phy_addr << MI_COM_PHY_ADDR_SHIFT) & | ||||||
|  |  		      MI_COM_PHY_ADDR_MASK); | ||||||
|  |  	frame_val |= ((reg << MI_COM_REG_ADDR_SHIFT) & | ||||||
|  |  		      MI_COM_REG_ADDR_MASK); | ||||||
|  | @@ -1041,6 +1048,11 @@ static int tg3_writephy(struct tg3 *tp, | ||||||
|  |  	return ret; | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | +static int tg3_writephy(struct tg3 *tp, int reg, u32 val) | ||||||
|  | +{ | ||||||
|  | +	return __tg3_writephy(tp, tp->phy_addr, reg, val); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  |  static int tg3_phy_cl45_write(struct tg3 *tp, u32 devad, u32 addr, u32 val) | ||||||
|  |  { | ||||||
|  |  	int err; | ||||||
|  | @@ -2942,6 +2954,9 @@ static int tg3_nvram_read(struct tg3 *tp | ||||||
|  |  { | ||||||
|  |  	int ret; | ||||||
|  |   | ||||||
|  | +	if (tg3_flag(tp, IS_SSB_CORE)) | ||||||
|  | +		return -ENODEV; | ||||||
|  | + | ||||||
|  |  	if (!tg3_flag(tp, NVRAM)) | ||||||
|  |  		return tg3_nvram_read_using_eeprom(tp, offset, val); | ||||||
|  |   | ||||||
|  | @@ -3024,9 +3039,12 @@ static int tg3_halt_cpu(struct tg3 *tp, | ||||||
|  |  		return -ENODEV; | ||||||
|  |  	} | ||||||
|  |   | ||||||
|  | -	/* Clear firmware's nvram arbitration. */ | ||||||
|  | -	if (tg3_flag(tp, NVRAM)) | ||||||
|  | -		tw32(NVRAM_SWARB, SWARB_REQ_CLR0); | ||||||
|  | +	if (!tg3_flag(tp, IS_SSB_CORE)) { | ||||||
|  | +		/* Clear firmware's nvram arbitration. */ | ||||||
|  | +		if (tg3_flag(tp, NVRAM)) | ||||||
|  | +			tw32(NVRAM_SWARB, SWARB_REQ_CLR0); | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  |  	return 0; | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | @@ -3145,6 +3163,11 @@ static int tg3_load_tso_firmware(struct | ||||||
|  |  	unsigned long cpu_base, cpu_scratch_base, cpu_scratch_size; | ||||||
|  |  	int err, i; | ||||||
|  |   | ||||||
|  | +	if (tg3_flag(tp, IS_SSB_CORE)) { | ||||||
|  | +		/* We don't use firmware. */ | ||||||
|  | +		return 0; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  |  	if (tg3_flag(tp, HW_TSO_1) || | ||||||
|  |  	    tg3_flag(tp, HW_TSO_2) || | ||||||
|  |  	    tg3_flag(tp, HW_TSO_3)) | ||||||
|  | @@ -3491,8 +3514,10 @@ static int tg3_power_down_prepare(struct | ||||||
|  |  	tg3_frob_aux_power(tp, true); | ||||||
|  |   | ||||||
|  |  	/* Workaround for unstable PLL clock */ | ||||||
|  | -	if ((GET_CHIP_REV(tp->pci_chip_rev_id) == CHIPREV_5750_AX) || | ||||||
|  | -	    (GET_CHIP_REV(tp->pci_chip_rev_id) == CHIPREV_5750_BX)) { | ||||||
|  | +	if ((tp->phy_id & TG3_PHY_ID_MASK) != TG3_PHY_ID_BCM5750_2 && | ||||||
|  | +				/* !!! FIXME !!! */ | ||||||
|  | +	    ((GET_CHIP_REV(tp->pci_chip_rev_id) == CHIPREV_5750_AX) || | ||||||
|  | +	    (GET_CHIP_REV(tp->pci_chip_rev_id) == CHIPREV_5750_BX))) { | ||||||
|  |  		u32 val = tr32(0x7d00); | ||||||
|  |   | ||||||
|  |  		val &= ~((1 << 16) | (1 << 4) | (1 << 2) | (1 << 1) | 1); | ||||||
|  | @@ -4006,6 +4031,14 @@ relink: | ||||||
|  |  	if (current_link_up == 0 || (tp->phy_flags & TG3_PHYFLG_IS_LOW_POWER)) { | ||||||
|  |  		tg3_phy_copper_begin(tp); | ||||||
|  |   | ||||||
|  | +		if (tg3_flag(tp, ROBOSWITCH)) { | ||||||
|  | +			current_link_up = 1; | ||||||
|  | +			current_speed = SPEED_1000; /* FIXME */ | ||||||
|  | +			current_duplex = DUPLEX_FULL; | ||||||
|  | +			tp->link_config.active_speed = current_speed; | ||||||
|  | +			tp->link_config.active_duplex = current_duplex; | ||||||
|  | +		} | ||||||
|  | + | ||||||
|  |  		tg3_readphy(tp, MII_BMSR, &bmsr); | ||||||
|  |  		if ((!tg3_readphy(tp, MII_BMSR, &bmsr) && (bmsr & BMSR_LSTATUS)) || | ||||||
|  |  		    (tp->mac_mode & MAC_MODE_PORT_INT_LPBACK)) | ||||||
|  | @@ -7723,6 +7756,11 @@ static int tg3_chip_reset(struct tg3 *tp | ||||||
|  |  		} | ||||||
|  |  	} | ||||||
|  |   | ||||||
|  | +	if (tg3_flag(tp, IS_SSB_CORE)) { | ||||||
|  | +		/* We don't use firmware. */ | ||||||
|  | +		return 0; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  |  	if (GET_ASIC_REV(tp->pci_chip_rev_id) == ASIC_REV_5906) { | ||||||
|  |  		tw32(VCPU_STATUS, tr32(VCPU_STATUS) | VCPU_STATUS_DRV_RESET); | ||||||
|  |  		tw32(GRC_VCPU_EXT_CTRL, | ||||||
|  | @@ -7819,6 +7857,14 @@ static int tg3_chip_reset(struct tg3 *tp | ||||||
|  |  		tw32(0x5000, 0x400); | ||||||
|  |  	} | ||||||
|  |   | ||||||
|  | +	if (tg3_flag(tp, IS_SSB_CORE)) { | ||||||
|  | +		/* BCM4785: In order to avoid repercussions from using potentially | ||||||
|  | +		 * defective internal ROM, stop the Rx RISC CPU, which is not | ||||||
|  | +		 * required. */ | ||||||
|  | +		tg3_stop_fw(tp); | ||||||
|  | +		tg3_halt_cpu(tp, RX_CPU_BASE); | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  |  	tw32(GRC_MODE, tp->grc_mode); | ||||||
|  |   | ||||||
|  |  	if (tp->pci_chip_rev_id == CHIPREV_ID_5705_A0) { | ||||||
|  | @@ -9233,6 +9279,11 @@ static void tg3_timer(unsigned long __op | ||||||
|  |  	    tg3_flag(tp, 57765_CLASS)) | ||||||
|  |  		tg3_chk_missed_msi(tp); | ||||||
|  |   | ||||||
|  | +	if (tg3_flag(tp, FLUSH_POSTED_WRITES)) { | ||||||
|  | +		/* BCM4785: Flush posted writes from GbE to host memory. */ | ||||||
|  | +		tr32(HOSTCC_MODE); | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  |  	if (!tg3_flag(tp, TAGGED_STATUS)) { | ||||||
|  |  		/* All of this garbage is because when using non-tagged | ||||||
|  |  		 * IRQ status the mailbox/status_block protocol the chip | ||||||
|  | @@ -9522,6 +9573,11 @@ static int tg3_request_firmware(struct t | ||||||
|  |  		return -ENOENT; | ||||||
|  |  	} | ||||||
|  |   | ||||||
|  | +	if (tg3_flag(tp, IS_SSB_CORE)) { | ||||||
|  | +		/* We don't use firmware. */ | ||||||
|  | +		return 0; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  |  	fw_data = (void *)tp->fw->data; | ||||||
|  |   | ||||||
|  |  	/* Firmware blob starts with version numbers, followed by | ||||||
|  | @@ -10945,6 +11001,11 @@ static int tg3_test_nvram(struct tg3 *tp | ||||||
|  |  	if (tg3_flag(tp, NO_NVRAM)) | ||||||
|  |  		return 0; | ||||||
|  |   | ||||||
|  | +	if (tg3_flag(tp, IS_SSB_CORE)) { | ||||||
|  | +		/* We don't have NVRAM. */ | ||||||
|  | +		return 0; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  |  	if (tg3_nvram_read(tp, 0, &magic) != 0) | ||||||
|  |  		return -EIO; | ||||||
|  |   | ||||||
|  | @@ -11906,7 +11967,7 @@ static int tg3_ioctl(struct net_device * | ||||||
|  |  			return -EAGAIN; | ||||||
|  |   | ||||||
|  |  		spin_lock_bh(&tp->lock); | ||||||
|  | -		err = tg3_readphy(tp, data->reg_num & 0x1f, &mii_regval); | ||||||
|  | +		err = __tg3_readphy(tp, data->phy_id & 0x1f, data->reg_num & 0x1f, &mii_regval); | ||||||
|  |  		spin_unlock_bh(&tp->lock); | ||||||
|  |   | ||||||
|  |  		data->val_out = mii_regval; | ||||||
|  | @@ -11922,7 +11983,7 @@ static int tg3_ioctl(struct net_device * | ||||||
|  |  			return -EAGAIN; | ||||||
|  |   | ||||||
|  |  		spin_lock_bh(&tp->lock); | ||||||
|  | -		err = tg3_writephy(tp, data->reg_num & 0x1f, data->val_in); | ||||||
|  | +		err = __tg3_writephy(tp, data->phy_id & 0x1f, data->reg_num & 0x1f, data->val_in); | ||||||
|  |  		spin_unlock_bh(&tp->lock); | ||||||
|  |   | ||||||
|  |  		return err; | ||||||
|  | @@ -12656,6 +12717,13 @@ static void __devinit tg3_get_5720_nvram | ||||||
|  |  /* Chips other than 5700/5701 use the NVRAM for fetching info. */ | ||||||
|  |  static void __devinit tg3_nvram_init(struct tg3 *tp) | ||||||
|  |  { | ||||||
|  | +	if (tg3_flag(tp, IS_SSB_CORE)) { | ||||||
|  | +		/* No NVRAM and EEPROM on the SSB Broadcom GigE core. */ | ||||||
|  | +		tg3_flag_clear(tp, NVRAM); | ||||||
|  | +		tg3_flag_clear(tp, NVRAM_BUFFERED); | ||||||
|  | +		return; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  |  	tw32_f(GRC_EEPROM_ADDR, | ||||||
|  |  	     (EEPROM_ADDR_FSM_RESET | | ||||||
|  |  	      (EEPROM_DEFAULT_CLOCK_PERIOD << | ||||||
|  | @@ -12922,6 +12990,9 @@ static int tg3_nvram_write_block(struct | ||||||
|  |  { | ||||||
|  |  	int ret; | ||||||
|  |   | ||||||
|  | +	if (tg3_flag(tp, IS_SSB_CORE)) | ||||||
|  | +		return -ENODEV; | ||||||
|  | + | ||||||
|  |  	if (tg3_flag(tp, EEPROM_WRITE_PROT)) { | ||||||
|  |  		tw32_f(GRC_LOCAL_CTRL, tp->grc_local_ctrl & | ||||||
|  |  		       ~GRC_LCLCTRL_GPIO_OUTPUT1); | ||||||
|  | @@ -14368,6 +14439,11 @@ static int __devinit tg3_get_invariants( | ||||||
|  |  		} | ||||||
|  |  	} | ||||||
|  |   | ||||||
|  | +	if (tg3_flag(tp, FLUSH_POSTED_WRITES)) { | ||||||
|  | +		tp->write32_tx_mbox = tg3_write_flush_reg32; | ||||||
|  | +		tp->write32_rx_mbox = tg3_write_flush_reg32; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  |  	/* Get eeprom hw config before calling tg3_set_power_state(). | ||||||
|  |  	 * In particular, the TG3_FLAG_IS_NIC flag must be | ||||||
|  |  	 * determined before calling tg3_set_power_state() so that | ||||||
|  | @@ -14784,6 +14860,8 @@ static int __devinit tg3_get_device_addr | ||||||
|  |  	} | ||||||
|  |   | ||||||
|  |  	if (!is_valid_ether_addr(&dev->dev_addr[0])) { | ||||||
|  | +		if (tg3_flag(tp, IS_SSB_CORE)) | ||||||
|  | +			ssb_gige_get_macaddr(tp->pdev, &dev->dev_addr[0]); | ||||||
|  |  #ifdef CONFIG_SPARC | ||||||
|  |  		if (!tg3_get_default_macaddr_sparc(tp)) | ||||||
|  |  			return 0; | ||||||
|  | @@ -15282,6 +15360,7 @@ static char * __devinit tg3_phy_string(s | ||||||
|  |  	case TG3_PHY_ID_BCM5704:	return "5704"; | ||||||
|  |  	case TG3_PHY_ID_BCM5705:	return "5705"; | ||||||
|  |  	case TG3_PHY_ID_BCM5750:	return "5750"; | ||||||
|  | +	case TG3_PHY_ID_BCM5750_2:	return "5750-2"; | ||||||
|  |  	case TG3_PHY_ID_BCM5752:	return "5752"; | ||||||
|  |  	case TG3_PHY_ID_BCM5714:	return "5714"; | ||||||
|  |  	case TG3_PHY_ID_BCM5780:	return "5780"; | ||||||
|  | @@ -15492,6 +15571,13 @@ static int __devinit tg3_init_one(struct | ||||||
|  |  		tp->msg_enable = tg3_debug; | ||||||
|  |  	else | ||||||
|  |  		tp->msg_enable = TG3_DEF_MSG_ENABLE; | ||||||
|  | +	if (pdev_is_ssb_gige_core(pdev)) { | ||||||
|  | +		tg3_flag_set(tp, IS_SSB_CORE); | ||||||
|  | +		if (ssb_gige_must_flush_posted_writes(pdev)) | ||||||
|  | +			tg3_flag_set(tp, FLUSH_POSTED_WRITES); | ||||||
|  | +		if (ssb_gige_have_roboswitch(pdev)) | ||||||
|  | +			tg3_flag_set(tp, ROBOSWITCH); | ||||||
|  | +	} | ||||||
|  |   | ||||||
|  |  	/* The word/byte swap controls here control register access byte | ||||||
|  |  	 * swapping.  DMA data byte swapping is controlled in the GRC_MODE | ||||||
|  | --- a/drivers/net/ethernet/broadcom/tg3.h | ||||||
|  | +++ b/drivers/net/ethernet/broadcom/tg3.h | ||||||
|  | @@ -2940,6 +2940,9 @@ enum TG3_FLAGS { | ||||||
|  |  	TG3_FLAG_57765_PLUS, | ||||||
|  |  	TG3_FLAG_57765_CLASS, | ||||||
|  |  	TG3_FLAG_5717_PLUS, | ||||||
|  | +	TG3_FLAG_IS_SSB_CORE, | ||||||
|  | +	TG3_FLAG_FLUSH_POSTED_WRITES, | ||||||
|  | +	TG3_FLAG_ROBOSWITCH, | ||||||
|  |   | ||||||
|  |  	/* Add new flags before this comment and TG3_FLAG_NUMBER_OF_FLAGS */ | ||||||
|  |  	TG3_FLAG_NUMBER_OF_FLAGS,	/* Last entry in enum TG3_FLAGS */ | ||||||
|  | @@ -3089,6 +3092,7 @@ struct tg3 { | ||||||
|  |  #define TG3_PHY_ID_BCM5704		0x60008190 | ||||||
|  |  #define TG3_PHY_ID_BCM5705		0x600081a0 | ||||||
|  |  #define TG3_PHY_ID_BCM5750		0x60008180 | ||||||
|  | +#define TG3_PHY_ID_BCM5750_2		0xbc050cd0 | ||||||
|  |  #define TG3_PHY_ID_BCM5752		0x60008100 | ||||||
|  |  #define TG3_PHY_ID_BCM5714		0x60008340 | ||||||
|  |  #define TG3_PHY_ID_BCM5780		0x60008350 | ||||||
|  | @@ -3126,7 +3130,7 @@ struct tg3 { | ||||||
|  |  	 (X) == TG3_PHY_ID_BCM5906 || (X) == TG3_PHY_ID_BCM5761 || \ | ||||||
|  |  	 (X) == TG3_PHY_ID_BCM5718C || (X) == TG3_PHY_ID_BCM5718S || \ | ||||||
|  |  	 (X) == TG3_PHY_ID_BCM57765 || (X) == TG3_PHY_ID_BCM5719C || \ | ||||||
|  | -	 (X) == TG3_PHY_ID_BCM8002) | ||||||
|  | +	 (X) == TG3_PHY_ID_BCM8002 || (X) == TG3_PHY_ID_BCM5750_2) | ||||||
|  |   | ||||||
|  |  	u32				phy_flags; | ||||||
|  |  #define TG3_PHYFLG_IS_LOW_POWER		0x00000001 | ||||||
							
								
								
									
										180
									
								
								target/linux/brcm47xx/patches-3.3/812-disable_wgt634u_crap.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										180
									
								
								target/linux/brcm47xx/patches-3.3/812-disable_wgt634u_crap.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,180 @@ | |||||||
|  | --- a/arch/mips/bcm47xx/Makefile | ||||||
|  | +++ b/arch/mips/bcm47xx/Makefile | ||||||
|  | @@ -4,4 +4,3 @@ | ||||||
|  |  # | ||||||
|  |   | ||||||
|  |  obj-y 				+= gpio.o irq.o nvram.o prom.o serial.o setup.o time.o bus.o sprom.o | ||||||
|  | -obj-$(CONFIG_BCM47XX_SSB)	+= wgt634u.o | ||||||
|  | --- a/arch/mips/bcm47xx/wgt634u.c | ||||||
|  | +++ /dev/null | ||||||
|  | @@ -1,170 +0,0 @@ | ||||||
|  | -/* | ||||||
|  | - * 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) 2007 Aurelien Jarno <aurelien@aurel32.net> | ||||||
|  | - */ | ||||||
|  | - | ||||||
|  | -#include <linux/platform_device.h> | ||||||
|  | -#include <linux/module.h> | ||||||
|  | -#include <linux/leds.h> | ||||||
|  | -#include <linux/mtd/physmap.h> | ||||||
|  | -#include <linux/ssb/ssb.h> | ||||||
|  | -#include <linux/interrupt.h> | ||||||
|  | -#include <linux/reboot.h> | ||||||
|  | -#include <linux/gpio.h> | ||||||
|  | -#include <asm/mach-bcm47xx/bcm47xx.h> | ||||||
|  | - | ||||||
|  | -/* GPIO definitions for the WGT634U */ | ||||||
|  | -#define WGT634U_GPIO_LED	3 | ||||||
|  | -#define WGT634U_GPIO_RESET	2 | ||||||
|  | -#define WGT634U_GPIO_TP1	7 | ||||||
|  | -#define WGT634U_GPIO_TP2	6 | ||||||
|  | -#define WGT634U_GPIO_TP3	5 | ||||||
|  | -#define WGT634U_GPIO_TP4	4 | ||||||
|  | -#define WGT634U_GPIO_TP5	1 | ||||||
|  | - | ||||||
|  | -static struct gpio_led wgt634u_leds[] = { | ||||||
|  | -	{ | ||||||
|  | -		.name = "power", | ||||||
|  | -		.gpio = WGT634U_GPIO_LED, | ||||||
|  | -		.active_low = 1, | ||||||
|  | -		.default_trigger = "heartbeat", | ||||||
|  | -	}, | ||||||
|  | -}; | ||||||
|  | - | ||||||
|  | -static struct gpio_led_platform_data wgt634u_led_data = { | ||||||
|  | -	.num_leds =     ARRAY_SIZE(wgt634u_leds), | ||||||
|  | -	.leds =         wgt634u_leds, | ||||||
|  | -}; | ||||||
|  | - | ||||||
|  | -static struct platform_device wgt634u_gpio_leds = { | ||||||
|  | -	.name =         "leds-gpio", | ||||||
|  | -	.id =           -1, | ||||||
|  | -	.dev = { | ||||||
|  | -		.platform_data = &wgt634u_led_data, | ||||||
|  | -	} | ||||||
|  | -}; | ||||||
|  | - | ||||||
|  | - | ||||||
|  | -/* 8MiB flash. The struct mtd_partition matches original Netgear WGT634U | ||||||
|  | -   firmware. */ | ||||||
|  | -static struct mtd_partition wgt634u_partitions[] = { | ||||||
|  | -	{ | ||||||
|  | -		.name       = "cfe", | ||||||
|  | -		.offset     = 0, | ||||||
|  | -		.size       = 0x60000,		/* 384k */ | ||||||
|  | -		.mask_flags = MTD_WRITEABLE 	/* force read-only */ | ||||||
|  | -	}, | ||||||
|  | -	{ | ||||||
|  | -		.name   = "config", | ||||||
|  | -		.offset = 0x60000, | ||||||
|  | -		.size   = 0x20000		/* 128k */ | ||||||
|  | -	}, | ||||||
|  | -	{ | ||||||
|  | -		.name   = "linux", | ||||||
|  | -		.offset = 0x80000, | ||||||
|  | -		.size   = 0x140000 		/* 1280k */ | ||||||
|  | -	}, | ||||||
|  | -	{ | ||||||
|  | -		.name   = "jffs", | ||||||
|  | -		.offset = 0x1c0000, | ||||||
|  | -		.size   = 0x620000 		/* 6272k */ | ||||||
|  | -	}, | ||||||
|  | -	{ | ||||||
|  | -		.name   = "nvram", | ||||||
|  | -		.offset = 0x7e0000, | ||||||
|  | -		.size   = 0x20000		/* 128k */ | ||||||
|  | -	}, | ||||||
|  | -}; | ||||||
|  | - | ||||||
|  | -static struct physmap_flash_data wgt634u_flash_data = { | ||||||
|  | -	.parts    = wgt634u_partitions, | ||||||
|  | -	.nr_parts = ARRAY_SIZE(wgt634u_partitions) | ||||||
|  | -}; | ||||||
|  | - | ||||||
|  | -static struct resource wgt634u_flash_resource = { | ||||||
|  | -	.flags = IORESOURCE_MEM, | ||||||
|  | -}; | ||||||
|  | - | ||||||
|  | -static struct platform_device wgt634u_flash = { | ||||||
|  | -	.name          = "physmap-flash", | ||||||
|  | -	.id            = 0, | ||||||
|  | -	.dev           = { .platform_data = &wgt634u_flash_data, }, | ||||||
|  | -	.resource      = &wgt634u_flash_resource, | ||||||
|  | -	.num_resources = 1, | ||||||
|  | -}; | ||||||
|  | - | ||||||
|  | -/* Platform devices */ | ||||||
|  | -static struct platform_device *wgt634u_devices[] __initdata = { | ||||||
|  | -	&wgt634u_flash, | ||||||
|  | -	&wgt634u_gpio_leds, | ||||||
|  | -}; | ||||||
|  | - | ||||||
|  | -static irqreturn_t gpio_interrupt(int irq, void *ignored) | ||||||
|  | -{ | ||||||
|  | -	int state; | ||||||
|  | - | ||||||
|  | -	/* Interrupts are shared, check if the current one is | ||||||
|  | -	   a GPIO interrupt. */ | ||||||
|  | -	if (!ssb_chipco_irq_status(&bcm47xx_bus.ssb.chipco, | ||||||
|  | -				   SSB_CHIPCO_IRQ_GPIO)) | ||||||
|  | -		return IRQ_NONE; | ||||||
|  | - | ||||||
|  | -	state = gpio_get_value(WGT634U_GPIO_RESET); | ||||||
|  | - | ||||||
|  | -	/* Interrupt are level triggered, revert the interrupt polarity | ||||||
|  | -	   to clear the interrupt. */ | ||||||
|  | -	gpio_polarity(WGT634U_GPIO_RESET, state); | ||||||
|  | - | ||||||
|  | -	if (!state) { | ||||||
|  | -		printk(KERN_INFO "Reset button pressed"); | ||||||
|  | -		ctrl_alt_del(); | ||||||
|  | -	} | ||||||
|  | - | ||||||
|  | -	return IRQ_HANDLED; | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -static int __init wgt634u_init(void) | ||||||
|  | -{ | ||||||
|  | -	/* There is no easy way to detect that we are running on a WGT634U | ||||||
|  | -	 * machine. Use the MAC address as an heuristic. Netgear Inc. has | ||||||
|  | -	 * been allocated ranges 00:09:5b:xx:xx:xx and 00:0f:b5:xx:xx:xx. | ||||||
|  | -	 */ | ||||||
|  | -	u8 *et0mac; | ||||||
|  | - | ||||||
|  | -	if (bcm47xx_bus_type != BCM47XX_BUS_TYPE_SSB) | ||||||
|  | -		return -ENODEV; | ||||||
|  | - | ||||||
|  | -	et0mac = bcm47xx_bus.ssb.sprom.et0mac; | ||||||
|  | - | ||||||
|  | -	if (et0mac[0] == 0x00 && | ||||||
|  | -	    ((et0mac[1] == 0x09 && et0mac[2] == 0x5b) || | ||||||
|  | -	     (et0mac[1] == 0x0f && et0mac[2] == 0xb5))) { | ||||||
|  | -		struct ssb_mipscore *mcore = &bcm47xx_bus.ssb.mipscore; | ||||||
|  | - | ||||||
|  | -		printk(KERN_INFO "WGT634U machine detected.\n"); | ||||||
|  | - | ||||||
|  | -		if (!request_irq(gpio_to_irq(WGT634U_GPIO_RESET), | ||||||
|  | -				 gpio_interrupt, IRQF_SHARED, | ||||||
|  | -				 "WGT634U GPIO", &bcm47xx_bus.ssb.chipco)) { | ||||||
|  | -			gpio_direction_input(WGT634U_GPIO_RESET); | ||||||
|  | -			gpio_intmask(WGT634U_GPIO_RESET, 1); | ||||||
|  | -			ssb_chipco_irq_mask(&bcm47xx_bus.ssb.chipco, | ||||||
|  | -					    SSB_CHIPCO_IRQ_GPIO, | ||||||
|  | -					    SSB_CHIPCO_IRQ_GPIO); | ||||||
|  | -		} | ||||||
|  | - | ||||||
|  | -		wgt634u_flash_data.width = mcore->pflash.buswidth; | ||||||
|  | -		wgt634u_flash_resource.start = mcore->pflash.window; | ||||||
|  | -		wgt634u_flash_resource.end = mcore->pflash.window | ||||||
|  | -					   + mcore->pflash.window_size | ||||||
|  | -					   - 1; | ||||||
|  | -		return platform_add_devices(wgt634u_devices, | ||||||
|  | -					    ARRAY_SIZE(wgt634u_devices)); | ||||||
|  | -	} else | ||||||
|  | -		return -ENODEV; | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -module_init(wgt634u_init); | ||||||
							
								
								
									
										305
									
								
								target/linux/brcm47xx/patches-3.3/820-wgt634u-nvram-fix.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										305
									
								
								target/linux/brcm47xx/patches-3.3/820-wgt634u-nvram-fix.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,305 @@ | |||||||
|  | The Netgear wgt634u uses a different format for storing the  | ||||||
|  | configuration. This patch is needed to read out the correct  | ||||||
|  | configuration. The cfe_env.c file uses a different method way to read  | ||||||
|  | out the configuration than the in kernel cfe config reader. | ||||||
|  |  | ||||||
|  | --- a/arch/mips/bcm47xx/Makefile | ||||||
|  | +++ b/arch/mips/bcm47xx/Makefile | ||||||
|  | @@ -3,4 +3,4 @@ | ||||||
|  |  # under Linux. | ||||||
|  |  # | ||||||
|  |   | ||||||
|  | -obj-y 				+= gpio.o irq.o nvram.o prom.o serial.o setup.o time.o bus.o sprom.o | ||||||
|  | +obj-y 				+= gpio.o irq.o nvram.o prom.o serial.o setup.o time.o bus.o sprom.o cfe_env.o | ||||||
|  | --- /dev/null | ||||||
|  | +++ b/arch/mips/bcm47xx/cfe_env.c | ||||||
|  | @@ -0,0 +1,229 @@ | ||||||
|  | +/* | ||||||
|  | + * CFE environment variable access | ||||||
|  | + * | ||||||
|  | + * Copyright 2001-2003, Broadcom Corporation | ||||||
|  | + * Copyright 2006, Felix Fietkau <nbd@openwrt.org> | ||||||
|  | + *  | ||||||
|  | + * This program is free software; you can redistribute  it and/or modify it | ||||||
|  | + * under  the terms of  the GNU General  Public License as published by the | ||||||
|  | + * Free Software Foundation;  either version 2 of the  License, or (at your | ||||||
|  | + * option) any later version. | ||||||
|  | + */ | ||||||
|  | + | ||||||
|  | +#include <linux/init.h> | ||||||
|  | +#include <linux/module.h> | ||||||
|  | +#include <linux/kernel.h> | ||||||
|  | +#include <linux/string.h> | ||||||
|  | +#include <asm/io.h> | ||||||
|  | +#include <asm/uaccess.h> | ||||||
|  | + | ||||||
|  | +#define NVRAM_SIZE       (0x1ff0) | ||||||
|  | +static char _nvdata[NVRAM_SIZE]; | ||||||
|  | +static char _valuestr[256]; | ||||||
|  | + | ||||||
|  | +/* | ||||||
|  | + * TLV types.  These codes are used in the "type-length-value" | ||||||
|  | + * encoding of the items stored in the NVRAM device (flash or EEPROM) | ||||||
|  | + * | ||||||
|  | + * The layout of the flash/nvram is as follows: | ||||||
|  | + * | ||||||
|  | + * <type> <length> <data ...> <type> <length> <data ...> <type_end> | ||||||
|  | + * | ||||||
|  | + * The type code of "ENV_TLV_TYPE_END" marks the end of the list. | ||||||
|  | + * The "length" field marks the length of the data section, not | ||||||
|  | + * including the type and length fields. | ||||||
|  | + * | ||||||
|  | + * Environment variables are stored as follows: | ||||||
|  | + * | ||||||
|  | + * <type_env> <length> <flags> <name> = <value> | ||||||
|  | + * | ||||||
|  | + * If bit 0 (low bit) is set, the length is an 8-bit value. | ||||||
|  | + * If bit 0 (low bit) is clear, the length is a 16-bit value | ||||||
|  | + *  | ||||||
|  | + * Bit 7 set indicates "user" TLVs.  In this case, bit 0 still | ||||||
|  | + * indicates the size of the length field.   | ||||||
|  | + * | ||||||
|  | + * Flags are from the constants below: | ||||||
|  | + * | ||||||
|  | + */ | ||||||
|  | +#define ENV_LENGTH_16BITS	0x00	/* for low bit */ | ||||||
|  | +#define ENV_LENGTH_8BITS	0x01 | ||||||
|  | + | ||||||
|  | +#define ENV_TYPE_USER		0x80 | ||||||
|  | + | ||||||
|  | +#define ENV_CODE_SYS(n,l) (((n)<<1)|(l)) | ||||||
|  | +#define ENV_CODE_USER(n,l) ((((n)<<1)|(l)) | ENV_TYPE_USER) | ||||||
|  | + | ||||||
|  | +/* | ||||||
|  | + * The actual TLV types we support | ||||||
|  | + */ | ||||||
|  | + | ||||||
|  | +#define ENV_TLV_TYPE_END	0x00	 | ||||||
|  | +#define ENV_TLV_TYPE_ENV	ENV_CODE_SYS(0,ENV_LENGTH_8BITS) | ||||||
|  | + | ||||||
|  | +/* | ||||||
|  | + * Environment variable flags  | ||||||
|  | + */ | ||||||
|  | + | ||||||
|  | +#define ENV_FLG_NORMAL		0x00	/* normal read/write */ | ||||||
|  | +#define ENV_FLG_BUILTIN		0x01	/* builtin - not stored in flash */ | ||||||
|  | +#define ENV_FLG_READONLY	0x02	/* read-only - cannot be changed */ | ||||||
|  | + | ||||||
|  | +#define ENV_FLG_MASK		0xFF	/* mask of attributes we keep */ | ||||||
|  | +#define ENV_FLG_ADMIN		0x100	/* lets us internally override permissions */ | ||||||
|  | + | ||||||
|  | + | ||||||
|  | +/*  ********************************************************************* | ||||||
|  | +    *  _nvram_read(buffer,offset,length) | ||||||
|  | +    *   | ||||||
|  | +    *  Read data from the NVRAM device | ||||||
|  | +    *   | ||||||
|  | +    *  Input parameters:  | ||||||
|  | +    *  	   buffer - destination buffer | ||||||
|  | +    *  	   offset - offset of data to read | ||||||
|  | +    *  	   length - number of bytes to read | ||||||
|  | +    *  	    | ||||||
|  | +    *  Return value: | ||||||
|  | +    *  	   number of bytes read, or <0 if error occured | ||||||
|  | +    ********************************************************************* */ | ||||||
|  | +static int | ||||||
|  | +_nvram_read(unsigned char *nv_buf, unsigned char *buffer, int offset, int length) | ||||||
|  | +{ | ||||||
|  | +    int i; | ||||||
|  | +    if (offset > NVRAM_SIZE) | ||||||
|  | +	return -1;  | ||||||
|  | + | ||||||
|  | +    for ( i = 0; i < length; i++) { | ||||||
|  | +	buffer[i] = ((volatile unsigned char*)nv_buf)[offset + i]; | ||||||
|  | +    } | ||||||
|  | +    return length; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | + | ||||||
|  | +static char* | ||||||
|  | +_strnchr(const char *dest,int c,size_t cnt) | ||||||
|  | +{ | ||||||
|  | +	while (*dest && (cnt > 0)) { | ||||||
|  | +	if (*dest == c) return (char *) dest; | ||||||
|  | +	dest++; | ||||||
|  | +	cnt--; | ||||||
|  | +	} | ||||||
|  | +	return NULL; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | + | ||||||
|  | + | ||||||
|  | +/* | ||||||
|  | + * Core support API: Externally visible. | ||||||
|  | + */ | ||||||
|  | + | ||||||
|  | +/* | ||||||
|  | + * Get the value of an NVRAM variable | ||||||
|  | + * @param	name	name of variable to get | ||||||
|  | + * @return	value of variable or NULL if undefined | ||||||
|  | + */ | ||||||
|  | + | ||||||
|  | +char*  | ||||||
|  | +cfe_env_get(unsigned char *nv_buf, char* name) | ||||||
|  | +{ | ||||||
|  | +    int size; | ||||||
|  | +    unsigned char *buffer; | ||||||
|  | +    unsigned char *ptr; | ||||||
|  | +    unsigned char *envval; | ||||||
|  | +    unsigned int reclen; | ||||||
|  | +    unsigned int rectype; | ||||||
|  | +    int offset; | ||||||
|  | +    int flg; | ||||||
|  | +     | ||||||
|  | +	if (!strcmp(name, "nvram_type")) | ||||||
|  | +		return "cfe"; | ||||||
|  | +	 | ||||||
|  | +    size = NVRAM_SIZE; | ||||||
|  | +    buffer = &_nvdata[0]; | ||||||
|  | + | ||||||
|  | +    ptr = buffer; | ||||||
|  | +    offset = 0; | ||||||
|  | + | ||||||
|  | +    /* Read the record type and length */ | ||||||
|  | +    if (_nvram_read(nv_buf, ptr,offset,1) != 1) { | ||||||
|  | +	goto error; | ||||||
|  | +    } | ||||||
|  | +     | ||||||
|  | +    while ((*ptr != ENV_TLV_TYPE_END)  && (size > 1)) { | ||||||
|  | + | ||||||
|  | +	/* Adjust pointer for TLV type */ | ||||||
|  | +	rectype = *(ptr); | ||||||
|  | +	offset++; | ||||||
|  | +	size--; | ||||||
|  | + | ||||||
|  | +	/*  | ||||||
|  | +	 * Read the length.  It can be either 1 or 2 bytes | ||||||
|  | +	 * depending on the code  | ||||||
|  | +	 */ | ||||||
|  | +	if (rectype & ENV_LENGTH_8BITS) { | ||||||
|  | +	    /* Read the record type and length - 8 bits */ | ||||||
|  | +	    if (_nvram_read(nv_buf, ptr,offset,1) != 1) { | ||||||
|  | +		goto error; | ||||||
|  | +	    } | ||||||
|  | +	    reclen = *(ptr); | ||||||
|  | +	    size--; | ||||||
|  | +	    offset++; | ||||||
|  | +	} | ||||||
|  | +	else { | ||||||
|  | +	    /* Read the record type and length - 16 bits, MSB first */ | ||||||
|  | +	    if (_nvram_read(nv_buf, ptr,offset,2) != 2) { | ||||||
|  | +		goto error; | ||||||
|  | +	    } | ||||||
|  | +	    reclen = (((unsigned int) *(ptr)) << 8) + (unsigned int) *(ptr+1); | ||||||
|  | +	    size -= 2; | ||||||
|  | +	    offset += 2; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +	if (reclen > size) | ||||||
|  | +	    break;	/* should not happen, bad NVRAM */ | ||||||
|  | + | ||||||
|  | +	switch (rectype) { | ||||||
|  | +	    case ENV_TLV_TYPE_ENV: | ||||||
|  | +		/* Read the TLV data */ | ||||||
|  | +		if (_nvram_read(nv_buf, ptr,offset,reclen) != reclen) | ||||||
|  | +		    goto error; | ||||||
|  | +		flg = *ptr++; | ||||||
|  | +		envval = (unsigned char *) _strnchr(ptr,'=',(reclen-1)); | ||||||
|  | +		if (envval) { | ||||||
|  | +		    *envval++ = '\0'; | ||||||
|  | +		    memcpy(_valuestr,envval,(reclen-1)-(envval-ptr)); | ||||||
|  | +		    _valuestr[(reclen-1)-(envval-ptr)] = '\0'; | ||||||
|  | +#if 0			 | ||||||
|  | +		    printk(KERN_INFO "NVRAM:%s=%s\n", ptr, _valuestr); | ||||||
|  | +#endif | ||||||
|  | +		    if(!strcmp(ptr, name)){ | ||||||
|  | +			return _valuestr; | ||||||
|  | +		    } | ||||||
|  | +		    if((strlen(ptr) > 1) && !strcmp(&ptr[1], name)) | ||||||
|  | +			return _valuestr; | ||||||
|  | +		} | ||||||
|  | +		break; | ||||||
|  | +		 | ||||||
|  | +	    default:  | ||||||
|  | +		/* Unknown TLV type, skip it. */ | ||||||
|  | +		break; | ||||||
|  | +	    } | ||||||
|  | + | ||||||
|  | +	/* | ||||||
|  | +	 * Advance to next TLV  | ||||||
|  | +	 */ | ||||||
|  | +		 | ||||||
|  | +	size -= (int)reclen; | ||||||
|  | +	offset += reclen; | ||||||
|  | + | ||||||
|  | +	/* Read the next record type */ | ||||||
|  | +	ptr = buffer; | ||||||
|  | +	if (_nvram_read(nv_buf, ptr,offset,1) != 1) | ||||||
|  | +	    goto error; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  | +error: | ||||||
|  | +    return NULL; | ||||||
|  | + | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | --- a/arch/mips/bcm47xx/nvram.c | ||||||
|  | +++ b/arch/mips/bcm47xx/nvram.c | ||||||
|  | @@ -25,6 +25,8 @@ | ||||||
|  |  #include <linux/mtd/bcm47xx_nand.h> | ||||||
|  |   | ||||||
|  |  static char nvram_buf[NVRAM_SPACE]; | ||||||
|  | +static int cfe_env; | ||||||
|  | +extern char *cfe_env_get(char *nv_buf, const char *name); | ||||||
|  |   | ||||||
|  |  /* Probe for NVRAM header */ | ||||||
|  |  static void early_nvram_init_pflash(void) | ||||||
|  | @@ -58,6 +60,25 @@ static void early_nvram_init_pflash(void | ||||||
|  |  		break; | ||||||
|  |  #endif | ||||||
|  |  	} | ||||||
|  | +	cfe_env = 0; | ||||||
|  | + | ||||||
|  | +	/* XXX: hack for supporting the CFE environment stuff on WGT634U */ | ||||||
|  | +	if (lim >= 8 * 1024 * 1024) { | ||||||
|  | +		src = (u32 *) KSEG1ADDR(base + 8 * 1024 * 1024 - 0x2000); | ||||||
|  | +		dst = (u32 *) nvram_buf; | ||||||
|  | + | ||||||
|  | +		if ((*src & 0xff00ff) == 0x000001) { | ||||||
|  | +			printk("early_nvram_init: WGT634U NVRAM found.\n"); | ||||||
|  | + | ||||||
|  | +			for (i = 0; i < 0x1ff0; i++) { | ||||||
|  | +				if (*src == 0xFFFFFFFF) | ||||||
|  | +					break; | ||||||
|  | +				*dst++ = *src++; | ||||||
|  | +			} | ||||||
|  | +			cfe_env = 1; | ||||||
|  | +			return; | ||||||
|  | +		} | ||||||
|  | +	} | ||||||
|  |   | ||||||
|  |  	off = FLASH_MIN; | ||||||
|  |  	while (off <= lim) { | ||||||
|  | @@ -252,6 +273,12 @@ int nvram_getenv(char *name, char *val, | ||||||
|  |  	if (!nvram_buf[0]) | ||||||
|  |  		early_nvram_init(); | ||||||
|  |   | ||||||
|  | +	if (cfe_env) { | ||||||
|  | +		value = cfe_env_get(nvram_buf, name); | ||||||
|  | +		snprintf(val, val_len, "%s", value); | ||||||
|  | +		return 0; | ||||||
|  | +	} | ||||||
|  | + | ||||||
|  |  	/* Look for name=value and return value */ | ||||||
|  |  	var = &nvram_buf[sizeof(struct nvram_header)]; | ||||||
|  |  	end = nvram_buf + sizeof(nvram_buf) - 2; | ||||||
|  | @@ -280,6 +307,9 @@ char *nvram_get(const char *name) | ||||||
|  |  	if (!nvram_buf[0]) | ||||||
|  |  		early_nvram_init(); | ||||||
|  |   | ||||||
|  | +	if (cfe_env) | ||||||
|  | +		return cfe_env_get(nvram_buf, name); | ||||||
|  | + | ||||||
|  |  	/* Look for name=value and return value */ | ||||||
|  |  	var = &nvram_buf[sizeof(struct nvram_header)]; | ||||||
|  |  	end = nvram_buf + sizeof(nvram_buf) - 2; | ||||||
							
								
								
									
										47
									
								
								target/linux/brcm47xx/patches-3.3/830-tg3_add_pci_ids.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										47
									
								
								target/linux/brcm47xx/patches-3.3/830-tg3_add_pci_ids.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,47 @@ | |||||||
|  | commit 812bcf8f47b45a206948008144233bc47d5747ac | ||||||
|  | Author: Hauke Mehrtens <hauke@hauke-m.de> | ||||||
|  | Date:   Thu Dec 16 20:01:17 2010 +0100 | ||||||
|  |  | ||||||
|  |     Revert "tg3: Remove 5720, 5750, and 5750M" | ||||||
|  |      | ||||||
|  |     This reverts commit 67b284d476bcb3d100e946da23d6cf9acfd0465c. | ||||||
|  |  | ||||||
|  | --- a/drivers/net/ethernet/broadcom/tg3.c | ||||||
|  | +++ b/drivers/net/ethernet/broadcom/tg3.c | ||||||
|  | @@ -248,9 +248,12 @@ static DEFINE_PCI_DEVICE_TABLE(tg3_pci_t | ||||||
|  |  	{PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, PCI_DEVICE_ID_TIGON3_5901_2)}, | ||||||
|  |  	{PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, PCI_DEVICE_ID_TIGON3_5704S_2)}, | ||||||
|  |  	{PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, PCI_DEVICE_ID_TIGON3_5705F)}, | ||||||
|  | +	{PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, PCI_DEVICE_ID_TIGON3_5720)}, | ||||||
|  |  	{PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, PCI_DEVICE_ID_TIGON3_5721)}, | ||||||
|  |  	{PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, PCI_DEVICE_ID_TIGON3_5722)}, | ||||||
|  | +	{PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, PCI_DEVICE_ID_TIGON3_5750)}, | ||||||
|  |  	{PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, PCI_DEVICE_ID_TIGON3_5751)}, | ||||||
|  | +	{PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, PCI_DEVICE_ID_TIGON3_5750M)}, | ||||||
|  |  	{PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, PCI_DEVICE_ID_TIGON3_5751M)}, | ||||||
|  |  	{PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, PCI_DEVICE_ID_TIGON3_5751F)}, | ||||||
|  |  	{PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, PCI_DEVICE_ID_TIGON3_5752)}, | ||||||
|  | --- a/include/linux/pci_ids.h | ||||||
|  | +++ b/include/linux/pci_ids.h | ||||||
|  | @@ -2105,6 +2105,7 @@ | ||||||
|  |  #define PCI_DEVICE_ID_NX2_57711E	0x1650 | ||||||
|  |  #define PCI_DEVICE_ID_TIGON3_5705	0x1653 | ||||||
|  |  #define PCI_DEVICE_ID_TIGON3_5705_2	0x1654 | ||||||
|  | +#define PCI_DEVICE_ID_TIGON3_5720	0x1658 | ||||||
|  |  #define PCI_DEVICE_ID_TIGON3_5721	0x1659 | ||||||
|  |  #define PCI_DEVICE_ID_TIGON3_5722	0x165a | ||||||
|  |  #define PCI_DEVICE_ID_TIGON3_5723	0x165b | ||||||
|  | @@ -2120,11 +2121,13 @@ | ||||||
|  |  #define PCI_DEVICE_ID_TIGON3_5754M	0x1672 | ||||||
|  |  #define PCI_DEVICE_ID_TIGON3_5755M	0x1673 | ||||||
|  |  #define PCI_DEVICE_ID_TIGON3_5756	0x1674 | ||||||
|  | +#define PCI_DEVICE_ID_TIGON3_5750	0x1676 | ||||||
|  |  #define PCI_DEVICE_ID_TIGON3_5751	0x1677 | ||||||
|  |  #define PCI_DEVICE_ID_TIGON3_5715	0x1678 | ||||||
|  |  #define PCI_DEVICE_ID_TIGON3_5715S	0x1679 | ||||||
|  |  #define PCI_DEVICE_ID_TIGON3_5754	0x167a | ||||||
|  |  #define PCI_DEVICE_ID_TIGON3_5755	0x167b | ||||||
|  | +#define PCI_DEVICE_ID_TIGON3_5750M	0x167c | ||||||
|  |  #define PCI_DEVICE_ID_TIGON3_5751M	0x167d | ||||||
|  |  #define PCI_DEVICE_ID_TIGON3_5751F	0x167e | ||||||
|  |  #define PCI_DEVICE_ID_TIGON3_5787F	0x167f | ||||||
| @@ -0,0 +1,104 @@ | |||||||
|  | --- a/drivers/watchdog/bcm47xx_wdt.c | ||||||
|  | +++ b/drivers/watchdog/bcm47xx_wdt.c | ||||||
|  | @@ -31,6 +31,7 @@ | ||||||
|  |   | ||||||
|  |  #define WDT_DEFAULT_TIME	30	/* seconds */ | ||||||
|  |  #define WDT_MAX_TIME		255	/* seconds */ | ||||||
|  | +#define WDT_SHIFT		15	/* 32.768 KHz on cores with slow WDT clock */ | ||||||
|  |   | ||||||
|  |  static int wdt_time = WDT_DEFAULT_TIME; | ||||||
|  |  static int nowayout = WATCHDOG_NOWAYOUT; | ||||||
|  | @@ -50,20 +51,20 @@ static unsigned long bcm47xx_wdt_busy; | ||||||
|  |  static char expect_release; | ||||||
|  |  static struct timer_list wdt_timer; | ||||||
|  |  static atomic_t ticks; | ||||||
|  | +static int needs_sw_scale; | ||||||
|  |   | ||||||
|  | -static inline void bcm47xx_wdt_hw_start(void) | ||||||
|  | +static inline void bcm47xx_wdt_hw_start(u32 ticks) | ||||||
|  |  { | ||||||
|  | -	/* this is 2,5s on 100Mhz clock  and 2s on 133 Mhz */ | ||||||
|  |  	switch (bcm47xx_bus_type) { | ||||||
|  |  #ifdef CONFIG_BCM47XX_SSB | ||||||
|  |  	case BCM47XX_BUS_TYPE_SSB: | ||||||
|  | -		ssb_watchdog_timer_set(&bcm47xx_bus.ssb, 0xfffffff); | ||||||
|  | +		ssb_watchdog_timer_set(&bcm47xx_bus.ssb, ticks); | ||||||
|  |  		break; | ||||||
|  |  #endif | ||||||
|  |  #ifdef CONFIG_BCM47XX_BCMA | ||||||
|  |  	case BCM47XX_BUS_TYPE_BCMA: | ||||||
|  |  		bcma_chipco_watchdog_timer_set(&bcm47xx_bus.bcma.bus.drv_cc, | ||||||
|  | -					       0xfffffff); | ||||||
|  | +					       ticks); | ||||||
|  |  		break; | ||||||
|  |  #endif | ||||||
|  |  	} | ||||||
|  | @@ -88,33 +89,34 @@ static inline int bcm47xx_wdt_hw_stop(vo | ||||||
|  |  static void bcm47xx_timer_tick(unsigned long unused) | ||||||
|  |  { | ||||||
|  |  	if (!atomic_dec_and_test(&ticks)) { | ||||||
|  | -		bcm47xx_wdt_hw_start(); | ||||||
|  | +		/* This is 2,5s on 100Mhz clock and 2s on 133 Mhz */ | ||||||
|  | +		bcm47xx_wdt_hw_start(0xfffffff); | ||||||
|  |  		mod_timer(&wdt_timer, jiffies + HZ); | ||||||
|  |  	} else { | ||||||
|  | -		printk(KERN_CRIT DRV_NAME "Watchdog will fire soon!!!\n"); | ||||||
|  | +		printk(KERN_CRIT DRV_NAME ": Watchdog will fire soon!!!\n"); | ||||||
|  |  	} | ||||||
|  |  } | ||||||
|  |   | ||||||
|  | -static inline void bcm47xx_wdt_pet(void) | ||||||
|  | +static void bcm47xx_wdt_pet(void) | ||||||
|  |  { | ||||||
|  | -	atomic_set(&ticks, wdt_time); | ||||||
|  | +	if(needs_sw_scale) | ||||||
|  | +		atomic_set(&ticks, wdt_time); | ||||||
|  | +	else | ||||||
|  | +		bcm47xx_wdt_hw_start(wdt_time << WDT_SHIFT); | ||||||
|  |  } | ||||||
|  |   | ||||||
|  |  static void bcm47xx_wdt_start(void) | ||||||
|  |  { | ||||||
|  |  	bcm47xx_wdt_pet(); | ||||||
|  | -	bcm47xx_timer_tick(0); | ||||||
|  | -} | ||||||
|  | - | ||||||
|  | -static void bcm47xx_wdt_pause(void) | ||||||
|  | -{ | ||||||
|  | -	del_timer_sync(&wdt_timer); | ||||||
|  | -	bcm47xx_wdt_hw_stop(); | ||||||
|  | +	if(needs_sw_scale) | ||||||
|  | +		bcm47xx_timer_tick(0); | ||||||
|  |  } | ||||||
|  |   | ||||||
|  |  static void bcm47xx_wdt_stop(void) | ||||||
|  |  { | ||||||
|  | -	bcm47xx_wdt_pause(); | ||||||
|  | +	if(needs_sw_scale) | ||||||
|  | +		del_timer_sync(&wdt_timer); | ||||||
|  | +	bcm47xx_wdt_hw_stop(); | ||||||
|  |  } | ||||||
|  |   | ||||||
|  |  static int bcm47xx_wdt_settimeout(int new_time) | ||||||
|  | @@ -266,7 +268,20 @@ static int __init bcm47xx_wdt_init(void) | ||||||
|  |  	if (bcm47xx_wdt_hw_stop() < 0) | ||||||
|  |  		return -ENODEV; | ||||||
|  |   | ||||||
|  | -	setup_timer(&wdt_timer, bcm47xx_timer_tick, 0L); | ||||||
|  | +	/* FIXME Other cores */ | ||||||
|  | +#ifdef BCM47XX_BUS_TYPE_BCMA | ||||||
|  | +	if(bcm47xx_bus_type == BCM47XX_BUS_TYPE_BCMA && | ||||||
|  | +	   bcm47xx_bus.ssb.chip_id == 0x5354) { | ||||||
|  | +		/* Slow WDT clock, no pre-scaling */ | ||||||
|  | +		needs_sw_scale = 0; | ||||||
|  | +	} else { | ||||||
|  | +#endif | ||||||
|  | +		/* Fast WDT clock, needs software pre-scaling */ | ||||||
|  | +		needs_sw_scale = 1; | ||||||
|  | +		setup_timer(&wdt_timer, bcm47xx_timer_tick, 0L); | ||||||
|  | +#ifdef BCM47XX_BUS_TYPE_BCMA | ||||||
|  | +	} | ||||||
|  | +#endif | ||||||
|  |   | ||||||
|  |  	if (bcm47xx_wdt_settimeout(wdt_time)) { | ||||||
|  |  		bcm47xx_wdt_settimeout(WDT_DEFAULT_TIME); | ||||||
							
								
								
									
										138
									
								
								target/linux/brcm47xx/patches-3.3/920-cache-wround.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										138
									
								
								target/linux/brcm47xx/patches-3.3/920-cache-wround.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,138 @@ | |||||||
|  | --- a/arch/mips/include/asm/r4kcache.h | ||||||
|  | +++ b/arch/mips/include/asm/r4kcache.h | ||||||
|  | @@ -20,10 +20,28 @@ | ||||||
|  |  #ifdef CONFIG_BCM47XX | ||||||
|  |  #include <asm/paccess.h> | ||||||
|  |  #include <linux/ssb/ssb.h> | ||||||
|  | -#define BCM4710_DUMMY_RREG() ((void) *((u8 *) KSEG1ADDR(SSB_ENUM_BASE))) | ||||||
|  | +#define BCM4710_DUMMY_RREG() bcm4710_dummy_rreg() | ||||||
|  | + | ||||||
|  | +static inline unsigned long bcm4710_dummy_rreg(void) | ||||||
|  | +{ | ||||||
|  | +      return *(volatile unsigned long *)(KSEG1ADDR(SSB_ENUM_BASE)); | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +#define BCM4710_FILL_TLB(addr) bcm4710_fill_tlb((void *)(addr)) | ||||||
|  | + | ||||||
|  | +static inline unsigned long bcm4710_fill_tlb(void *addr) | ||||||
|  | +{ | ||||||
|  | +      return *(unsigned long *)addr; | ||||||
|  | +} | ||||||
|  | + | ||||||
|  | +#define BCM4710_PROTECTED_FILL_TLB(addr) bcm4710_protected_fill_tlb((void *)(addr)) | ||||||
|  | + | ||||||
|  | +static inline void bcm4710_protected_fill_tlb(void *addr) | ||||||
|  | +{ | ||||||
|  | +      unsigned long x; | ||||||
|  | +      get_dbe(x, (unsigned long *)addr);; | ||||||
|  | +} | ||||||
|  |   | ||||||
|  | -#define BCM4710_FILL_TLB(addr) (*(volatile unsigned long *)(addr)) | ||||||
|  | -#define BCM4710_PROTECTED_FILL_TLB(addr) ({ unsigned long x; get_dbe(x, (volatile unsigned long *)(addr)); }) | ||||||
|  |  #else | ||||||
|  |  #define BCM4710_DUMMY_RREG() | ||||||
|  |   | ||||||
|  | --- a/arch/mips/mm/tlbex.c | ||||||
|  | +++ b/arch/mips/mm/tlbex.c | ||||||
|  | @@ -914,6 +914,9 @@ build_get_pgde32(u32 **p, unsigned int t | ||||||
|  |  #endif | ||||||
|  |  	uasm_i_addu(p, ptr, tmp, ptr); | ||||||
|  |  #else | ||||||
|  | +#ifdef CONFIG_BCM47XX | ||||||
|  | +	uasm_i_nop(p); | ||||||
|  | +#endif | ||||||
|  |  	UASM_i_LA_mostly(p, ptr, pgdc); | ||||||
|  |  #endif | ||||||
|  |  	uasm_i_mfc0(p, tmp, C0_BADVADDR); /* get faulting address */ | ||||||
|  | @@ -1264,12 +1267,12 @@ static void __cpuinit build_r4000_tlb_re | ||||||
|  |  			/* No need for uasm_i_nop */ | ||||||
|  |  		} | ||||||
|  |   | ||||||
|  | -#ifdef CONFIG_BCM47XX | ||||||
|  | -		uasm_i_nop(&p); | ||||||
|  | -#endif | ||||||
|  |  #ifdef CONFIG_64BIT | ||||||
|  |  		build_get_pmde64(&p, &l, &r, K0, K1); /* get pmd in K1 */ | ||||||
|  |  #else | ||||||
|  | +# ifdef CONFIG_BCM47XX | ||||||
|  | +		uasm_i_nop(&p); | ||||||
|  | +# endif | ||||||
|  |  		build_get_pgde32(&p, K0, K1); /* get pgd in K1 */ | ||||||
|  |  #endif | ||||||
|  |   | ||||||
|  | @@ -1281,6 +1284,9 @@ static void __cpuinit build_r4000_tlb_re | ||||||
|  |  		build_update_entries(&p, K0, K1); | ||||||
|  |  		build_tlb_write_entry(&p, &l, &r, tlb_random); | ||||||
|  |  		uasm_l_leave(&l, p); | ||||||
|  | +#ifdef CONFIG_BCM47XX | ||||||
|  | +		uasm_i_nop(&p); | ||||||
|  | +#endif | ||||||
|  |  		uasm_i_eret(&p); /* return from trap */ | ||||||
|  |  	} | ||||||
|  |  #ifdef CONFIG_HUGETLB_PAGE | ||||||
|  | @@ -1797,12 +1803,12 @@ build_r4000_tlbchange_handler_head(u32 * | ||||||
|  |  { | ||||||
|  |  	struct work_registers wr = build_get_work_registers(p); | ||||||
|  |   | ||||||
|  | -#ifdef CONFIG_BCM47XX | ||||||
|  | -	uasm_i_nop(p); | ||||||
|  | -#endif | ||||||
|  |  #ifdef CONFIG_64BIT | ||||||
|  |  	build_get_pmde64(p, l, r, wr.r1, wr.r2); /* get pmd in ptr */ | ||||||
|  |  #else | ||||||
|  | +# ifdef CONFIG_BCM47XX | ||||||
|  | +	uasm_i_nop(p); | ||||||
|  | +# endif | ||||||
|  |  	build_get_pgde32(p, wr.r1, wr.r2); /* get pgd in ptr */ | ||||||
|  |  #endif | ||||||
|  |   | ||||||
|  | @@ -1841,6 +1847,9 @@ build_r4000_tlbchange_handler_tail(u32 * | ||||||
|  |  	build_tlb_write_entry(p, l, r, tlb_indexed); | ||||||
|  |  	uasm_l_leave(l, *p); | ||||||
|  |  	build_restore_work_registers(p); | ||||||
|  | +#ifdef CONFIG_BCM47XX | ||||||
|  | +	uasm_i_nop(p); | ||||||
|  | +#endif | ||||||
|  |  	uasm_i_eret(p); /* return from trap */ | ||||||
|  |   | ||||||
|  |  #ifdef CONFIG_64BIT | ||||||
|  | --- a/arch/mips/kernel/genex.S | ||||||
|  | +++ b/arch/mips/kernel/genex.S | ||||||
|  | @@ -22,6 +22,19 @@ | ||||||
|  |  #include <asm/page.h> | ||||||
|  |  #include <asm/thread_info.h> | ||||||
|  |   | ||||||
|  | +#ifdef CONFIG_BCM47XX | ||||||
|  | +# ifdef eret | ||||||
|  | +#  undef eret | ||||||
|  | +# endif | ||||||
|  | +# define eret 					\ | ||||||
|  | +	.set push;				\ | ||||||
|  | +	.set noreorder;				\ | ||||||
|  | +	 nop; 					\ | ||||||
|  | +	 nop;					\ | ||||||
|  | +	 eret;					\ | ||||||
|  | +	.set pop; | ||||||
|  | +#endif | ||||||
|  | + | ||||||
|  |  #define PANIC_PIC(msg)					\ | ||||||
|  |  		.set push;				\ | ||||||
|  |  		.set	reorder;			\ | ||||||
|  | @@ -54,7 +67,6 @@ NESTED(except_vec3_generic, 0, sp) | ||||||
|  |  	.set	noat | ||||||
|  |  #ifdef CONFIG_BCM47XX | ||||||
|  |  	nop | ||||||
|  | -	nop | ||||||
|  |  #endif | ||||||
|  |  #if R5432_CP0_INTERRUPT_WAR | ||||||
|  |  	mfc0	k0, CP0_INDEX | ||||||
|  | @@ -79,6 +91,9 @@ NESTED(except_vec3_r4000, 0, sp) | ||||||
|  |  	.set	push | ||||||
|  |  	.set	mips3 | ||||||
|  |  	.set	noat | ||||||
|  | +#ifdef CONFIG_BCM47XX | ||||||
|  | +	nop | ||||||
|  | +#endif | ||||||
|  |  	mfc0	k1, CP0_CAUSE | ||||||
|  |  	li	k0, 31<<2 | ||||||
|  |  	andi	k1, k1, 0x7c | ||||||
							
								
								
									
										46
									
								
								target/linux/brcm47xx/patches-3.3/940-bcm47xx-yenta.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										46
									
								
								target/linux/brcm47xx/patches-3.3/940-bcm47xx-yenta.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,46 @@ | |||||||
|  | --- a/drivers/pcmcia/yenta_socket.c | ||||||
|  | +++ b/drivers/pcmcia/yenta_socket.c | ||||||
|  | @@ -920,6 +920,8 @@ static unsigned int yenta_probe_irq(stru | ||||||
|  |  	 * Probe for usable interrupts using the force | ||||||
|  |  	 * register to generate bogus card status events. | ||||||
|  |  	 */ | ||||||
|  | +#ifndef CONFIG_BCM47XX | ||||||
|  | +	/* WRT54G3G does not like this */ | ||||||
|  |  	cb_writel(socket, CB_SOCKET_EVENT, -1); | ||||||
|  |  	cb_writel(socket, CB_SOCKET_MASK, CB_CSTSMASK); | ||||||
|  |  	reg = exca_readb(socket, I365_CSCINT); | ||||||
|  | @@ -935,6 +937,7 @@ static unsigned int yenta_probe_irq(stru | ||||||
|  |  	} | ||||||
|  |  	cb_writel(socket, CB_SOCKET_MASK, 0); | ||||||
|  |  	exca_writeb(socket, I365_CSCINT, reg); | ||||||
|  | +#endif | ||||||
|  |   | ||||||
|  |  	mask = probe_irq_mask(val) & 0xffff; | ||||||
|  |   | ||||||
|  | @@ -1019,6 +1022,10 @@ static void yenta_get_socket_capabilitie | ||||||
|  |  	else | ||||||
|  |  		socket->socket.irq_mask = 0; | ||||||
|  |   | ||||||
|  | +	/* irq mask probing is broken for the WRT54G3G */ | ||||||
|  | +	if (socket->socket.irq_mask == 0) | ||||||
|  | +		socket->socket.irq_mask = 0x6f8; | ||||||
|  | + | ||||||
|  |  	dev_printk(KERN_INFO, &socket->dev->dev, | ||||||
|  |  		   "ISA IRQ mask 0x%04x, PCI irq %d\n", | ||||||
|  |  		   socket->socket.irq_mask, socket->cb_irq); | ||||||
|  | @@ -1257,6 +1264,15 @@ static int __devinit yenta_probe(struct | ||||||
|  |  	dev_printk(KERN_INFO, &dev->dev, | ||||||
|  |  		   "Socket status: %08x\n", cb_readl(socket, CB_SOCKET_STATE)); | ||||||
|  |   | ||||||
|  | +	/* Generate an interrupt on card insert/remove */ | ||||||
|  | +	config_writew(socket, CB_SOCKET_MASK, CB_CSTSMASK | CB_CDMASK); | ||||||
|  | + | ||||||
|  | +	/* Set up Multifunction Routing Status Register */ | ||||||
|  | +	config_writew(socket, 0x8C, 0x1000 /* MFUNC3 to GPIO3 */ | 0x2 /* MFUNC0 to INTA */); | ||||||
|  | + | ||||||
|  | +	/* Switch interrupts to parallelized */ | ||||||
|  | +	config_writeb(socket, 0x92, 0x64); | ||||||
|  | + | ||||||
|  |  	yenta_fixup_parent_bridge(dev->subordinate); | ||||||
|  |   | ||||||
|  |  	/* Register it with the pcmcia layer.. */ | ||||||
| @@ -0,0 +1,11 @@ | |||||||
|  | --- a/drivers/ssb/driver_pcicore.c | ||||||
|  | +++ b/drivers/ssb/driver_pcicore.c | ||||||
|  | @@ -376,7 +376,7 @@ static void __devinit ssb_pcicore_init_h | ||||||
|  |  	set_io_port_base(ssb_pcicore_controller.io_map_base); | ||||||
|  |  	/* Give some time to the PCI controller to configure itself with the new | ||||||
|  |  	 * values. Not waiting at this point causes crashes of the machine. */ | ||||||
|  | -	mdelay(10); | ||||||
|  | +	mdelay(300); | ||||||
|  |  	register_pci_controller(&ssb_pcicore_controller); | ||||||
|  |  } | ||||||
|  |   | ||||||
| @@ -0,0 +1,13 @@ | |||||||
|  | --- a/arch/mips/bcm47xx/setup.c | ||||||
|  | +++ b/arch/mips/bcm47xx/setup.c | ||||||
|  | @@ -172,6 +172,10 @@ static int bcm47xx_get_invariants(struct | ||||||
|  |  	if (nvram_getenv("cardbus", buf, sizeof(buf)) >= 0) | ||||||
|  |  		iv->has_cardbus_slot = !!simple_strtoul(buf, NULL, 10); | ||||||
|  |   | ||||||
|  | +	/* Do not indicate cardbus for Netgear WNR834B V1 and V2 */ | ||||||
|  | +	if (iv->boardinfo.type == 0x0472 && iv->has_cardbus_slot) | ||||||
|  | +		iv->has_cardbus_slot = 0; | ||||||
|  | + | ||||||
|  |  	return 0; | ||||||
|  |  } | ||||||
|  |   | ||||||
							
								
								
									
										22
									
								
								target/linux/brcm47xx/patches-3.3/999-wl_exports.patch
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										22
									
								
								target/linux/brcm47xx/patches-3.3/999-wl_exports.patch
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,22 @@ | |||||||
|  | --- a/arch/mips/bcm47xx/nvram.c | ||||||
|  | +++ b/arch/mips/bcm47xx/nvram.c | ||||||
|  | @@ -24,7 +24,8 @@ | ||||||
|  |  #include <asm/mach-bcm47xx/bus.h> | ||||||
|  |  #include <linux/mtd/bcm47xx_nand.h> | ||||||
|  |   | ||||||
|  | -static char nvram_buf[NVRAM_SPACE]; | ||||||
|  | +char nvram_buf[NVRAM_SPACE]; | ||||||
|  | +EXPORT_SYMBOL(nvram_buf); | ||||||
|  |  static int cfe_env; | ||||||
|  |  extern char *cfe_env_get(char *nv_buf, const char *name); | ||||||
|  |   | ||||||
|  | --- a/arch/mips/mm/cache.c | ||||||
|  | +++ b/arch/mips/mm/cache.c | ||||||
|  | @@ -57,6 +57,7 @@ void (*_dma_cache_wback)(unsigned long s | ||||||
|  |  void (*_dma_cache_inv)(unsigned long start, unsigned long size); | ||||||
|  |   | ||||||
|  |  EXPORT_SYMBOL(_dma_cache_wback_inv); | ||||||
|  | +EXPORT_SYMBOL(_dma_cache_inv); | ||||||
|  |   | ||||||
|  |  #endif /* CONFIG_DMA_NONCOHERENT */ | ||||||
|  |   | ||||||
		Reference in New Issue
	
	Block a user
	 Hauke Mehrtens
					Hauke Mehrtens