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