Matteo Croce
15 years ago
parent
e8ce2f14d5
commit
312dcf3e9a
@ -0,0 +1,154 @@ |
|||||||
|
CONFIG_32BIT=y |
||||||
|
# CONFIG_64BIT is not set |
||||||
|
CONFIG_ADM6996_PHY=y |
||||||
|
# CONFIG_ALCHEMY_GPIO_INDIRECT is not set |
||||||
|
CONFIG_AR231X_ETHERNET=y |
||||||
|
# CONFIG_AR7 is not set |
||||||
|
CONFIG_AR8216_PHY=y |
||||||
|
# CONFIG_ARCH_HAS_ILOG2_U32 is not set |
||||||
|
# CONFIG_ARCH_HAS_ILOG2_U64 is not set |
||||||
|
CONFIG_ARCH_HIBERNATION_POSSIBLE=y |
||||||
|
CONFIG_ARCH_POPULATES_NODE_MAP=y |
||||||
|
# CONFIG_ARCH_SUPPORTS_MSI is not set |
||||||
|
CONFIG_ARCH_SUPPORTS_OPROFILE=y |
||||||
|
CONFIG_ARCH_SUSPEND_POSSIBLE=y |
||||||
|
CONFIG_ATHEROS_AR2315=y |
||||||
|
CONFIG_ATHEROS_AR2315_PCI=y |
||||||
|
CONFIG_ATHEROS_AR231X=y |
||||||
|
CONFIG_ATHEROS_AR5312=y |
||||||
|
CONFIG_ATHEROS_WDT=y |
||||||
|
# CONFIG_BCM47XX is not set |
||||||
|
# CONFIG_BCM63XX is not set |
||||||
|
CONFIG_BITREVERSE=y |
||||||
|
# CONFIG_CAVIUM_OCTEON_REFERENCE_BOARD is not set |
||||||
|
# CONFIG_CAVIUM_OCTEON_SIMULATOR is not set |
||||||
|
CONFIG_CEVT_R4K=y |
||||||
|
CONFIG_CEVT_R4K_LIB=y |
||||||
|
CONFIG_CFG80211_DEFAULT_PS_VALUE=0 |
||||||
|
CONFIG_CMDLINE="console=ttyS0,9600 rootfstype=squashfs,jffs2" |
||||||
|
CONFIG_CPU_BIG_ENDIAN=y |
||||||
|
# CONFIG_CPU_CAVIUM_OCTEON is not set |
||||||
|
CONFIG_CPU_HAS_PREFETCH=y |
||||||
|
CONFIG_CPU_HAS_SYNC=y |
||||||
|
# CONFIG_CPU_LITTLE_ENDIAN is not set |
||||||
|
# CONFIG_CPU_LOONGSON2E is not set |
||||||
|
CONFIG_CPU_MIPS32=y |
||||||
|
CONFIG_CPU_MIPS32_R1=y |
||||||
|
# CONFIG_CPU_MIPS32_R2 is not set |
||||||
|
# CONFIG_CPU_MIPS64_R1 is not set |
||||||
|
# CONFIG_CPU_MIPS64_R2 is not set |
||||||
|
CONFIG_CPU_MIPSR1=y |
||||||
|
# CONFIG_CPU_NEVADA is not set |
||||||
|
# CONFIG_CPU_R10000 is not set |
||||||
|
# CONFIG_CPU_R3000 is not set |
||||||
|
# CONFIG_CPU_R4300 is not set |
||||||
|
# CONFIG_CPU_R4X00 is not set |
||||||
|
# CONFIG_CPU_R5000 is not set |
||||||
|
# CONFIG_CPU_R5432 is not set |
||||||
|
# CONFIG_CPU_R5500 is not set |
||||||
|
# CONFIG_CPU_R6000 is not set |
||||||
|
# CONFIG_CPU_R8000 is not set |
||||||
|
# CONFIG_CPU_RM7000 is not set |
||||||
|
# CONFIG_CPU_RM9000 is not set |
||||||
|
# CONFIG_CPU_SB1 is not set |
||||||
|
CONFIG_CPU_SUPPORTS_32BIT_KERNEL=y |
||||||
|
CONFIG_CPU_SUPPORTS_HIGHMEM=y |
||||||
|
# CONFIG_CPU_TX39XX is not set |
||||||
|
# CONFIG_CPU_TX49XX is not set |
||||||
|
# CONFIG_CPU_VR41XX is not set |
||||||
|
CONFIG_CSRC_R4K=y |
||||||
|
CONFIG_CSRC_R4K_LIB=y |
||||||
|
CONFIG_DECOMPRESS_LZMA=y |
||||||
|
CONFIG_DEVPORT=y |
||||||
|
# CONFIG_DM9000 is not set |
||||||
|
CONFIG_DMA_NEED_PCI_MAP_STATE=y |
||||||
|
CONFIG_DMA_NONCOHERENT=y |
||||||
|
# CONFIG_FSNOTIFY is not set |
||||||
|
CONFIG_GENERIC_CLOCKEVENTS=y |
||||||
|
CONFIG_GENERIC_CLOCKEVENTS_BUILD=y |
||||||
|
CONFIG_GENERIC_CMOS_UPDATE=y |
||||||
|
CONFIG_GENERIC_FIND_LAST_BIT=y |
||||||
|
CONFIG_GENERIC_FIND_NEXT_BIT=y |
||||||
|
CONFIG_GENERIC_GPIO=y |
||||||
|
CONFIG_GENERIC_HARDIRQS_NO__DO_IRQ=y |
||||||
|
CONFIG_GPIO_DEVICE=y |
||||||
|
CONFIG_HARDWARE_WATCHPOINTS=y |
||||||
|
CONFIG_HAS_DMA=y |
||||||
|
CONFIG_HAS_IOMEM=y |
||||||
|
CONFIG_HAS_IOPORT=y |
||||||
|
CONFIG_HAVE_ARCH_KGDB=y |
||||||
|
CONFIG_HAVE_GENERIC_DMA_COHERENT=y |
||||||
|
CONFIG_HAVE_IDE=y |
||||||
|
CONFIG_HAVE_OPROFILE=y |
||||||
|
CONFIG_HW_HAS_PCI=y |
||||||
|
CONFIG_HW_RANDOM=y |
||||||
|
CONFIG_INITRAMFS_SOURCE="" |
||||||
|
CONFIG_IP175C_PHY=y |
||||||
|
CONFIG_IRQ_CPU=y |
||||||
|
# CONFIG_ISDN is not set |
||||||
|
# CONFIG_LEDS_GPIO is not set |
||||||
|
# CONFIG_MACH_ALCHEMY is not set |
||||||
|
# CONFIG_MACH_DECSTATION is not set |
||||||
|
# CONFIG_MACH_JAZZ is not set |
||||||
|
# CONFIG_MACH_LOONGSON is not set |
||||||
|
# CONFIG_MACH_TX39XX is not set |
||||||
|
# CONFIG_MACH_TX49XX is not set |
||||||
|
# CONFIG_MACH_VR41XX is not set |
||||||
|
# CONFIG_MIKROTIK_RB532 is not set |
||||||
|
CONFIG_MIPS=y |
||||||
|
# CONFIG_MIPS_COBALT is not set |
||||||
|
CONFIG_MIPS_L1_CACHE_SHIFT=5 |
||||||
|
# CONFIG_MIPS_MACHINE is not set |
||||||
|
# CONFIG_MIPS_MALTA is not set |
||||||
|
CONFIG_MIPS_MT_DISABLED=y |
||||||
|
# CONFIG_MIPS_MT_SMP is not set |
||||||
|
# CONFIG_MIPS_MT_SMTC is not set |
||||||
|
# CONFIG_MIPS_SIM is not set |
||||||
|
CONFIG_MTD_AR2315=y |
||||||
|
CONFIG_MTD_CFI_ADV_OPTIONS=y |
||||||
|
# CONFIG_MTD_CFI_GEOMETRY is not set |
||||||
|
# CONFIG_MTD_CFI_INTELEXT is not set |
||||||
|
CONFIG_MTD_MYLOADER_PARTS=y |
||||||
|
CONFIG_MTD_PHYSMAP=y |
||||||
|
CONFIG_MTD_REDBOOT_DIRECTORY_BLOCK=-3 |
||||||
|
CONFIG_MTD_REDBOOT_PARTS=y |
||||||
|
CONFIG_MVSWITCH_PHY=y |
||||||
|
# CONFIG_NET_PCI is not set |
||||||
|
# CONFIG_NO_IOPORT is not set |
||||||
|
# CONFIG_NXP_STB220 is not set |
||||||
|
# CONFIG_NXP_STB225 is not set |
||||||
|
CONFIG_PAGEFLAGS_EXTENDED=y |
||||||
|
CONFIG_PCI_DOMAINS=y |
||||||
|
CONFIG_PHYLIB=y |
||||||
|
# CONFIG_PMC_MSP is not set |
||||||
|
# CONFIG_PMC_YOSEMITE is not set |
||||||
|
# CONFIG_PNX8550_JBS is not set |
||||||
|
# CONFIG_PNX8550_STB810 is not set |
||||||
|
# CONFIG_PROBE_INITRD_HEADER is not set |
||||||
|
CONFIG_SCHED_OMIT_FRAME_POINTER=y |
||||||
|
# CONFIG_SCSI_DMA is not set |
||||||
|
# CONFIG_SERIAL_8250_EXTENDED is not set |
||||||
|
CONFIG_SERIAL_8250_NR_UARTS=1 |
||||||
|
CONFIG_SERIAL_8250_RUNTIME_UARTS=1 |
||||||
|
# CONFIG_SGI_IP22 is not set |
||||||
|
# CONFIG_SGI_IP27 is not set |
||||||
|
# CONFIG_SGI_IP28 is not set |
||||||
|
# CONFIG_SGI_IP32 is not set |
||||||
|
# CONFIG_SIBYTE_BIGSUR is not set |
||||||
|
# CONFIG_SIBYTE_CARMEL is not set |
||||||
|
# CONFIG_SIBYTE_CRHINE is not set |
||||||
|
# CONFIG_SIBYTE_CRHONE is not set |
||||||
|
# CONFIG_SIBYTE_LITTLESUR is not set |
||||||
|
# CONFIG_SIBYTE_RHONE is not set |
||||||
|
# CONFIG_SIBYTE_SENTOSA is not set |
||||||
|
# CONFIG_SIBYTE_SWARM is not set |
||||||
|
CONFIG_SWCONFIG=y |
||||||
|
CONFIG_SYS_HAS_CPU_MIPS32_R1=y |
||||||
|
CONFIG_SYS_SUPPORTS_32BIT_KERNEL=y |
||||||
|
CONFIG_SYS_SUPPORTS_ARBIT_HZ=y |
||||||
|
CONFIG_SYS_SUPPORTS_BIG_ENDIAN=y |
||||||
|
CONFIG_TRAD_SIGNALS=y |
||||||
|
# CONFIG_TREE_PREEMPT_RCU is not set |
||||||
|
CONFIG_TREE_RCU=y |
||||||
|
CONFIG_USB_SUPPORT=y |
||||||
|
CONFIG_ZONE_DMA_FLAG=0 |
||||||
@ -0,0 +1,41 @@ |
|||||||
|
Fix the usage of get_c0_compare_int: override cp0_compare_irq if the returned
|
||||||
|
value is in the MIPS CPU IRQ range to ensure that c0_compare_int_usable()
|
||||||
|
still works.
|
||||||
|
|
||||||
|
Signed-off-by: Felix Fietkau <nbd@openwrt.org>
|
||||||
|
|
||||||
|
Index: linux-2.6.32.7/arch/mips/kernel/cevt-r4k.c
|
||||||
|
===================================================================
|
||||||
|
--- linux-2.6.32.7.orig/arch/mips/kernel/cevt-r4k.c 2010-01-29 00:06:20.000000000 +0100
|
||||||
|
+++ linux-2.6.32.7/arch/mips/kernel/cevt-r4k.c 2010-02-03 16:59:28.310430064 +0100
|
||||||
|
@@ -168,20 +168,23 @@
|
||||||
|
struct clock_event_device *cd;
|
||||||
|
unsigned int irq;
|
||||||
|
|
||||||
|
- if (!cpu_has_counter || !mips_hpt_frequency)
|
||||||
|
- return -ENXIO;
|
||||||
|
-
|
||||||
|
- if (!c0_compare_int_usable())
|
||||||
|
- return -ENXIO;
|
||||||
|
-
|
||||||
|
/*
|
||||||
|
* With vectored interrupts things are getting platform specific.
|
||||||
|
* get_c0_compare_int is a hook to allow a platform to return the
|
||||||
|
* interrupt number of it's liking.
|
||||||
|
*/
|
||||||
|
irq = MIPS_CPU_IRQ_BASE + cp0_compare_irq;
|
||||||
|
- if (get_c0_compare_int)
|
||||||
|
+ if (get_c0_compare_int) {
|
||||||
|
irq = get_c0_compare_int();
|
||||||
|
+ if ((irq >= MIPS_CPU_IRQ_BASE) && (irq < MIPS_CPU_IRQ_BASE + 8))
|
||||||
|
+ cp0_compare_irq = irq - MIPS_CPU_IRQ_BASE;
|
||||||
|
+ }
|
||||||
|
+
|
||||||
|
+ if (!cpu_has_counter || !mips_hpt_frequency)
|
||||||
|
+ return -ENXIO;
|
||||||
|
+
|
||||||
|
+ if (!c0_compare_int_usable())
|
||||||
|
+ return -ENXIO;
|
||||||
|
|
||||||
|
cd = &per_cpu(mips_clockevent_device, cpu);
|
||||||
|
|
||||||
@ -0,0 +1,58 @@ |
|||||||
|
Index: linux-2.6.32.7/arch/mips/kernel/cevt-r4k.c
|
||||||
|
===================================================================
|
||||||
|
--- linux-2.6.32.7.orig/arch/mips/kernel/cevt-r4k.c 2010-02-03 16:59:28.310430064 +0100
|
||||||
|
+++ linux-2.6.32.7/arch/mips/kernel/cevt-r4k.c 2010-02-03 16:59:54.578430015 +0100
|
||||||
|
@@ -16,6 +16,22 @@
|
||||||
|
#include <asm/cevt-r4k.h>
|
||||||
|
|
||||||
|
/*
|
||||||
|
+ * Compare interrupt can be routed and latched outside the core,
|
||||||
|
+ * so a single execution hazard barrier may not be enough to give
|
||||||
|
+ * it time to clear as seen in the Cause register. 4 time the
|
||||||
|
+ * pipeline depth seems reasonably conservative, and empirically
|
||||||
|
+ * works better in configurations with high CPU/bus clock ratios.
|
||||||
|
+ */
|
||||||
|
+
|
||||||
|
+#define compare_change_hazard() \
|
||||||
|
+ do { \
|
||||||
|
+ irq_disable_hazard(); \
|
||||||
|
+ irq_disable_hazard(); \
|
||||||
|
+ irq_disable_hazard(); \
|
||||||
|
+ irq_disable_hazard(); \
|
||||||
|
+ } while (0)
|
||||||
|
+
|
||||||
|
+/*
|
||||||
|
* The SMTC Kernel for the 34K, 1004K, et. al. replaces several
|
||||||
|
* of these routines with SMTC-specific variants.
|
||||||
|
*/
|
||||||
|
@@ -31,6 +47,7 @@
|
||||||
|
cnt = read_c0_count();
|
||||||
|
cnt += delta;
|
||||||
|
write_c0_compare(cnt);
|
||||||
|
+ compare_change_hazard();
|
||||||
|
res = ((int)(read_c0_count() - cnt) > 0) ? -ETIME : 0;
|
||||||
|
return res;
|
||||||
|
}
|
||||||
|
@@ -100,22 +117,6 @@
|
||||||
|
return (read_c0_cause() >> cp0_compare_irq) & 0x100;
|
||||||
|
}
|
||||||
|
|
||||||
|
-/*
|
||||||
|
- * Compare interrupt can be routed and latched outside the core,
|
||||||
|
- * so a single execution hazard barrier may not be enough to give
|
||||||
|
- * it time to clear as seen in the Cause register. 4 time the
|
||||||
|
- * pipeline depth seems reasonably conservative, and empirically
|
||||||
|
- * works better in configurations with high CPU/bus clock ratios.
|
||||||
|
- */
|
||||||
|
-
|
||||||
|
-#define compare_change_hazard() \
|
||||||
|
- do { \
|
||||||
|
- irq_disable_hazard(); \
|
||||||
|
- irq_disable_hazard(); \
|
||||||
|
- irq_disable_hazard(); \
|
||||||
|
- irq_disable_hazard(); \
|
||||||
|
- } while (0)
|
||||||
|
-
|
||||||
|
int c0_compare_int_usable(void)
|
||||||
|
{
|
||||||
|
unsigned int delta;
|
||||||
File diff suppressed because it is too large
Load Diff
@ -0,0 +1,305 @@ |
|||||||
|
Index: linux-2.6.32.7/arch/mips/ar231x/Makefile
|
||||||
|
===================================================================
|
||||||
|
--- linux-2.6.32.7.orig/arch/mips/ar231x/Makefile 2010-02-03 17:00:08.814429898 +0100
|
||||||
|
+++ linux-2.6.32.7/arch/mips/ar231x/Makefile 2010-02-03 17:00:21.031428952 +0100
|
||||||
|
@@ -11,3 +11,4 @@
|
||||||
|
obj-y += board.o prom.o devices.o
|
||||||
|
obj-$(CONFIG_ATHEROS_AR5312) += ar5312.o
|
||||||
|
obj-$(CONFIG_ATHEROS_AR2315) += ar2315.o
|
||||||
|
+obj-$(CONFIG_ATHEROS_AR2315_PCI) += pci.o
|
||||||
|
Index: linux-2.6.32.7/arch/mips/ar231x/pci.c
|
||||||
|
===================================================================
|
||||||
|
--- /dev/null 1970-01-01 00:00:00.000000000 +0000
|
||||||
|
+++ linux-2.6.32.7/arch/mips/ar231x/pci.c 2010-02-03 17:00:21.031428952 +0100
|
||||||
|
@@ -0,0 +1,230 @@
|
||||||
|
+/*
|
||||||
|
+ * 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., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
||||||
|
+ */
|
||||||
|
+
|
||||||
|
+#include <linux/types.h>
|
||||||
|
+#include <linux/pci.h>
|
||||||
|
+#include <linux/kernel.h>
|
||||||
|
+#include <linux/init.h>
|
||||||
|
+#include <linux/mm.h>
|
||||||
|
+#include <linux/spinlock.h>
|
||||||
|
+#include <linux/delay.h>
|
||||||
|
+#include <linux/irq.h>
|
||||||
|
+#include <asm/bootinfo.h>
|
||||||
|
+#include <asm/paccess.h>
|
||||||
|
+#include <asm/irq_cpu.h>
|
||||||
|
+#include <asm/io.h>
|
||||||
|
+#include <ar231x_platform.h>
|
||||||
|
+#include <ar231x.h>
|
||||||
|
+#include <ar2315_regs.h>
|
||||||
|
+#include "devices.h"
|
||||||
|
+
|
||||||
|
+#define AR531X_MEM_BASE 0x80800000UL
|
||||||
|
+#define AR531X_MEM_SIZE 0x00ffffffUL
|
||||||
|
+#define AR531X_IO_SIZE 0x00007fffUL
|
||||||
|
+
|
||||||
|
+static unsigned long configspace;
|
||||||
|
+
|
||||||
|
+static int config_access(int devfn, int where, int size, u32 *ptr, bool write)
|
||||||
|
+{
|
||||||
|
+ unsigned long flags;
|
||||||
|
+ int func = PCI_FUNC(devfn);
|
||||||
|
+ int dev = PCI_SLOT(devfn);
|
||||||
|
+ u32 value = 0;
|
||||||
|
+ int err = 0;
|
||||||
|
+ u32 addr;
|
||||||
|
+
|
||||||
|
+ if (((dev != 0) && (dev != 3)) || (func > 2))
|
||||||
|
+ return PCIBIOS_DEVICE_NOT_FOUND;
|
||||||
|
+
|
||||||
|
+ /* Select Configuration access */
|
||||||
|
+ local_irq_save(flags);
|
||||||
|
+ ar231x_mask_reg(AR2315_PCI_MISC_CONFIG, 0, AR2315_PCIMISC_CFG_SEL);
|
||||||
|
+ mb();
|
||||||
|
+
|
||||||
|
+ addr = (u32) configspace + (1 << (13 + dev)) + (func << 8) + where;
|
||||||
|
+ if (size == 1)
|
||||||
|
+ addr ^= 0x3;
|
||||||
|
+ else if (size == 2)
|
||||||
|
+ addr ^= 0x2;
|
||||||
|
+
|
||||||
|
+ if (write) {
|
||||||
|
+ value = *ptr;
|
||||||
|
+ if (size == 1)
|
||||||
|
+ err = put_dbe(value, (u8 *) addr);
|
||||||
|
+ else if (size == 2)
|
||||||
|
+ err = put_dbe(value, (u16 *) addr);
|
||||||
|
+ else if (size == 4)
|
||||||
|
+ err = put_dbe(value, (u32 *) addr);
|
||||||
|
+ } else {
|
||||||
|
+ if (size == 1)
|
||||||
|
+ err = get_dbe(value, (u8 *) addr);
|
||||||
|
+ else if (size == 2)
|
||||||
|
+ err = get_dbe(value, (u16 *) addr);
|
||||||
|
+ else if (size == 4)
|
||||||
|
+ err = get_dbe(value, (u32 *) addr);
|
||||||
|
+ if (err)
|
||||||
|
+ *ptr = 0xffffffff;
|
||||||
|
+ else
|
||||||
|
+ *ptr = value;
|
||||||
|
+ }
|
||||||
|
+
|
||||||
|
+ /* Select Memory access */
|
||||||
|
+ ar231x_mask_reg(AR2315_PCI_MISC_CONFIG, AR2315_PCIMISC_CFG_SEL, 0);
|
||||||
|
+ local_irq_restore(flags);
|
||||||
|
+
|
||||||
|
+ return (err ? PCIBIOS_DEVICE_NOT_FOUND : PCIBIOS_SUCCESSFUL);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static int ar231x_pci_read(struct pci_bus *bus, unsigned int devfn, int where, int size, u32 * value)
|
||||||
|
+{
|
||||||
|
+ return config_access(devfn, where, size, value, 0);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static int ar231x_pci_write(struct pci_bus *bus, unsigned int devfn, int where, int size, u32 value)
|
||||||
|
+{
|
||||||
|
+ return config_access(devfn, where, size, &value, 1);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+struct pci_ops ar231x_pci_ops = {
|
||||||
|
+ .read = ar231x_pci_read,
|
||||||
|
+ .write = ar231x_pci_write,
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+static struct resource ar231x_mem_resource = {
|
||||||
|
+ .name = "AR531x PCI MEM",
|
||||||
|
+ .start = AR531X_MEM_BASE,
|
||||||
|
+ .end = AR531X_MEM_BASE + AR531X_MEM_SIZE - AR531X_IO_SIZE - 1 + 0x4000000,
|
||||||
|
+ .flags = IORESOURCE_MEM,
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+static struct resource ar231x_io_resource = {
|
||||||
|
+ .name = "AR531x PCI I/O",
|
||||||
|
+ .start = AR531X_MEM_BASE + AR531X_MEM_SIZE - AR531X_IO_SIZE,
|
||||||
|
+ .end = AR531X_MEM_BASE + AR531X_MEM_SIZE - 1,
|
||||||
|
+ .flags = IORESOURCE_IO,
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+struct pci_controller ar231x_pci_controller = {
|
||||||
|
+ .pci_ops = &ar231x_pci_ops,
|
||||||
|
+ .mem_resource = &ar231x_mem_resource,
|
||||||
|
+ .io_resource = &ar231x_io_resource,
|
||||||
|
+ .mem_offset = 0x00000000UL,
|
||||||
|
+ .io_offset = 0x00000000UL,
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+int pcibios_map_irq(const struct pci_dev *dev, u8 slot, u8 pin)
|
||||||
|
+{
|
||||||
|
+ return AR2315_IRQ_LCBUS_PCI;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+int pcibios_plat_dev_init(struct pci_dev *dev)
|
||||||
|
+{
|
||||||
|
+ pci_write_config_byte(dev, PCI_INTERRUPT_LINE, 5);
|
||||||
|
+ pci_write_config_word(dev, 0x40, 0);
|
||||||
|
+
|
||||||
|
+ /* Clear any pending Abort or external Interrupts
|
||||||
|
+ * and enable interrupt processing */
|
||||||
|
+ ar231x_mask_reg(AR2315_PCI_INTEN_REG, AR2315_PCI_INT_ENABLE, 0);
|
||||||
|
+ ar231x_write_reg(AR2315_PCI_INT_STATUS, (AR2315_PCI_ABORT_INT | AR2315_PCI_EXT_INT));
|
||||||
|
+ ar231x_write_reg(AR2315_PCI_INT_MASK, (AR2315_PCI_ABORT_INT | AR2315_PCI_EXT_INT));
|
||||||
|
+ ar231x_mask_reg(AR2315_PCI_INTEN_REG, 0, AR2315_PCI_INT_ENABLE);
|
||||||
|
+
|
||||||
|
+ return 0;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static void
|
||||||
|
+ar2315_pci_fixup(struct pci_dev *dev)
|
||||||
|
+{
|
||||||
|
+ unsigned int devfn = dev->devfn;
|
||||||
|
+
|
||||||
|
+ if (dev->bus->number != 0)
|
||||||
|
+ return;
|
||||||
|
+
|
||||||
|
+ /* Only fix up the PCI host settings */
|
||||||
|
+ if ((PCI_SLOT(devfn) != 3) || (PCI_FUNC(devfn) != 0))
|
||||||
|
+ return;
|
||||||
|
+
|
||||||
|
+ /* Fix up MBARs */
|
||||||
|
+ pci_write_config_dword(dev, PCI_BASE_ADDRESS_0, HOST_PCI_MBAR0);
|
||||||
|
+ pci_write_config_dword(dev, PCI_BASE_ADDRESS_1, HOST_PCI_MBAR1);
|
||||||
|
+ pci_write_config_dword(dev, PCI_BASE_ADDRESS_2, HOST_PCI_MBAR2);
|
||||||
|
+ pci_write_config_dword(dev, PCI_COMMAND,
|
||||||
|
+ PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER | PCI_COMMAND_SPECIAL |
|
||||||
|
+ PCI_COMMAND_INVALIDATE | PCI_COMMAND_PARITY | PCI_COMMAND_SERR |
|
||||||
|
+ PCI_COMMAND_FAST_BACK);
|
||||||
|
+}
|
||||||
|
+DECLARE_PCI_FIXUP_HEADER(PCI_ANY_ID, PCI_ANY_ID, ar2315_pci_fixup);
|
||||||
|
+
|
||||||
|
+static int __init
|
||||||
|
+ar2315_pci_init(void)
|
||||||
|
+{
|
||||||
|
+ u32 reg;
|
||||||
|
+
|
||||||
|
+ if (ar231x_devtype != DEV_TYPE_AR2315)
|
||||||
|
+ return -ENODEV;
|
||||||
|
+
|
||||||
|
+ configspace = (unsigned long) ioremap_nocache(0x80000000, 1*1024*1024); /* Remap PCI config space */
|
||||||
|
+ ar231x_pci_controller.io_map_base =
|
||||||
|
+ (unsigned long) ioremap_nocache(AR531X_MEM_BASE + AR531X_MEM_SIZE, AR531X_IO_SIZE);
|
||||||
|
+ set_io_port_base(ar231x_pci_controller.io_map_base); /* PCI I/O space */
|
||||||
|
+
|
||||||
|
+ reg = ar231x_mask_reg(AR2315_RESET, 0, AR2315_RESET_PCIDMA);
|
||||||
|
+ msleep(10);
|
||||||
|
+
|
||||||
|
+ reg &= ~AR2315_RESET_PCIDMA;
|
||||||
|
+ ar231x_write_reg(AR2315_RESET, reg);
|
||||||
|
+ msleep(10);
|
||||||
|
+
|
||||||
|
+ ar231x_mask_reg(AR2315_ENDIAN_CTL, 0,
|
||||||
|
+ AR2315_CONFIG_PCIAHB | AR2315_CONFIG_PCIAHB_BRIDGE);
|
||||||
|
+
|
||||||
|
+ ar231x_write_reg(AR2315_PCICLK, AR2315_PCICLK_PLLC_CLKM |
|
||||||
|
+ (AR2315_PCICLK_IN_FREQ_DIV_6 << AR2315_PCICLK_DIV_S));
|
||||||
|
+ ar231x_mask_reg(AR2315_AHB_ARB_CTL, 0, AR2315_ARB_PCI);
|
||||||
|
+ ar231x_mask_reg(AR2315_IF_CTL, AR2315_IF_PCI_CLK_MASK | AR2315_IF_MASK,
|
||||||
|
+ AR2315_IF_PCI | AR2315_IF_PCI_HOST | AR2315_IF_PCI_INTR |
|
||||||
|
+ (AR2315_IF_PCI_CLK_OUTPUT_CLK << AR2315_IF_PCI_CLK_SHIFT));
|
||||||
|
+
|
||||||
|
+ /* Reset the PCI bus by setting bits 5-4 in PCI_MCFG */
|
||||||
|
+ ar231x_mask_reg(AR2315_PCI_MISC_CONFIG, AR2315_PCIMISC_RST_MODE,
|
||||||
|
+ AR2315_PCIRST_LOW);
|
||||||
|
+ msleep(100);
|
||||||
|
+
|
||||||
|
+ /* Bring the PCI out of reset */
|
||||||
|
+ ar231x_mask_reg(AR2315_PCI_MISC_CONFIG, AR2315_PCIMISC_RST_MODE,
|
||||||
|
+ AR2315_PCIRST_HIGH | AR2315_PCICACHE_DIS | 0x8);
|
||||||
|
+
|
||||||
|
+ ar231x_write_reg(AR2315_PCI_UNCACHE_CFG,
|
||||||
|
+ 0x1E | /* 1GB uncached */
|
||||||
|
+ (1 << 5) | /* Enable uncached */
|
||||||
|
+ (0x2 << 30) /* Base: 0x80000000 */
|
||||||
|
+ );
|
||||||
|
+ ar231x_read_reg(AR2315_PCI_UNCACHE_CFG);
|
||||||
|
+
|
||||||
|
+ msleep(500);
|
||||||
|
+
|
||||||
|
+ /* dirty hack - anyone with a datasheet that knows the memory map ? */
|
||||||
|
+ ioport_resource.start = 0x10000000;
|
||||||
|
+ ioport_resource.end = 0xffffffff;
|
||||||
|
+ iomem_resource.start = 0x10000000;
|
||||||
|
+ iomem_resource.end = 0xffffffff;
|
||||||
|
+
|
||||||
|
+ register_pci_controller(&ar231x_pci_controller);
|
||||||
|
+
|
||||||
|
+ return 0;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+arch_initcall(ar2315_pci_init);
|
||||||
|
Index: linux-2.6.32.7/arch/mips/ar231x/Kconfig
|
||||||
|
===================================================================
|
||||||
|
--- linux-2.6.32.7.orig/arch/mips/ar231x/Kconfig 2010-02-03 17:00:08.814429898 +0100
|
||||||
|
+++ linux-2.6.32.7/arch/mips/ar231x/Kconfig 2010-02-03 17:00:21.031428952 +0100
|
||||||
|
@@ -15,3 +15,13 @@
|
||||||
|
select SYS_SUPPORTS_BIG_ENDIAN
|
||||||
|
select GENERIC_GPIO
|
||||||
|
default y
|
||||||
|
+
|
||||||
|
+config ATHEROS_AR2315_PCI
|
||||||
|
+ bool "PCI support"
|
||||||
|
+ depends on ATHEROS_AR2315
|
||||||
|
+ select HW_HAS_PCI
|
||||||
|
+ select PCI
|
||||||
|
+ select USB_ARCH_HAS_HCD
|
||||||
|
+ select USB_ARCH_HAS_OHCI
|
||||||
|
+ select USB_ARCH_HAS_EHCI
|
||||||
|
+ default y
|
||||||
|
Index: linux-2.6.32.7/arch/mips/ar231x/ar2315.c
|
||||||
|
===================================================================
|
||||||
|
--- linux-2.6.32.7.orig/arch/mips/ar231x/ar2315.c 2010-02-03 17:00:08.818431986 +0100
|
||||||
|
+++ linux-2.6.32.7/arch/mips/ar231x/ar2315.c 2010-02-03 17:00:21.031428952 +0100
|
||||||
|
@@ -63,6 +63,27 @@
|
||||||
|
do_IRQ(AR531X_GPIO_IRQ_BASE + bit);
|
||||||
|
}
|
||||||
|
|
||||||
|
+#ifdef CONFIG_ATHEROS_AR2315_PCI
|
||||||
|
+static inline void pci_abort_irq(void)
|
||||||
|
+{
|
||||||
|
+ ar231x_write_reg(AR2315_PCI_INT_STATUS, AR2315_PCI_ABORT_INT);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static inline void pci_ack_irq(void)
|
||||||
|
+{
|
||||||
|
+ ar231x_write_reg(AR2315_PCI_INT_STATUS, AR2315_PCI_EXT_INT);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+void ar2315_pci_irq(int irq)
|
||||||
|
+{
|
||||||
|
+ if (ar231x_read_reg(AR2315_PCI_INT_STATUS) == AR2315_PCI_ABORT_INT)
|
||||||
|
+ pci_abort_irq();
|
||||||
|
+ else {
|
||||||
|
+ do_IRQ(irq);
|
||||||
|
+ pci_ack_irq();
|
||||||
|
+ }
|
||||||
|
+}
|
||||||
|
+#endif /* CONFIG_ATHEROS_AR2315_PCI */
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Called when an interrupt is received, this function
|
||||||
|
@@ -81,6 +102,10 @@
|
||||||
|
do_IRQ(AR2315_IRQ_WLAN0_INTRS);
|
||||||
|
else if (pending & CAUSEF_IP4)
|
||||||
|
do_IRQ(AR2315_IRQ_ENET0_INTRS);
|
||||||
|
+#ifdef CONFIG_ATHEROS_AR2315_PCI
|
||||||
|
+ else if (pending & CAUSEF_IP5)
|
||||||
|
+ ar2315_pci_irq(AR2315_IRQ_LCBUS_PCI);
|
||||||
|
+#endif
|
||||||
|
else if (pending & CAUSEF_IP2) {
|
||||||
|
unsigned int misc_intr = ar231x_read_reg(AR2315_ISR) & ar231x_read_reg(AR2315_IMR);
|
||||||
|
|
||||||
File diff suppressed because it is too large
Load Diff
@ -0,0 +1,667 @@ |
|||||||
|
Index: linux-2.6.32.7/drivers/mtd/devices/Kconfig
|
||||||
|
===================================================================
|
||||||
|
--- linux-2.6.32.7.orig/drivers/mtd/devices/Kconfig 2010-01-29 00:06:20.000000000 +0100
|
||||||
|
+++ linux-2.6.32.7/drivers/mtd/devices/Kconfig 2010-02-03 17:01:08.858429535 +0100
|
||||||
|
@@ -114,6 +114,10 @@
|
||||||
|
Set up your spi devices with the right board-specific platform data,
|
||||||
|
if you want to specify device partitioning.
|
||||||
|
|
||||||
|
+config MTD_AR2315
|
||||||
|
+ tristate "Atheros AR2315+ SPI Flash support"
|
||||||
|
+ depends on ATHEROS_AR2315
|
||||||
|
+
|
||||||
|
config MTD_SLRAM
|
||||||
|
tristate "Uncached system RAM"
|
||||||
|
help
|
||||||
|
Index: linux-2.6.32.7/drivers/mtd/devices/Makefile
|
||||||
|
===================================================================
|
||||||
|
--- linux-2.6.32.7.orig/drivers/mtd/devices/Makefile 2010-01-29 00:06:20.000000000 +0100
|
||||||
|
+++ linux-2.6.32.7/drivers/mtd/devices/Makefile 2010-02-03 17:01:30.282430590 +0100
|
||||||
|
@@ -17,3 +17,4 @@
|
||||||
|
obj-$(CONFIG_MTD_DATAFLASH) += mtd_dataflash.o
|
||||||
|
obj-$(CONFIG_MTD_M25P80) += m25p80.o
|
||||||
|
obj-$(CONFIG_MTD_SST25L) += sst25l.o
|
||||||
|
+obj-$(CONFIG_MTD_AR2315) += ar2315.o
|
||||||
|
Index: linux-2.6.32.7/drivers/mtd/devices/ar2315.c
|
||||||
|
===================================================================
|
||||||
|
--- /dev/null 1970-01-01 00:00:00.000000000 +0000
|
||||||
|
+++ linux-2.6.32.7/drivers/mtd/devices/ar2315.c 2010-02-03 17:01:08.858429535 +0100
|
||||||
|
@@ -0,0 +1,517 @@
|
||||||
|
+
|
||||||
|
+/*
|
||||||
|
+ * MTD driver for the SPI Flash Memory support on Atheros AR2315
|
||||||
|
+ *
|
||||||
|
+ * Copyright (c) 2005-2006 Atheros Communications Inc.
|
||||||
|
+ * Copyright (C) 2006-2007 FON Technology, SL.
|
||||||
|
+ * Copyright (C) 2006-2007 Imre Kaloz <kaloz@openwrt.org>
|
||||||
|
+ * Copyright (C) 2006-2009 Felix Fietkau <nbd@openwrt.org>
|
||||||
|
+ *
|
||||||
|
+ * This code is free software; you can redistribute it and/or modify
|
||||||
|
+ * it under the terms of the GNU General Public License version 2 as
|
||||||
|
+ * published by the Free Software Foundation.
|
||||||
|
+ *
|
||||||
|
+ */
|
||||||
|
+
|
||||||
|
+#include <linux/kernel.h>
|
||||||
|
+#include <linux/module.h>
|
||||||
|
+#include <linux/types.h>
|
||||||
|
+#include <linux/version.h>
|
||||||
|
+#include <linux/errno.h>
|
||||||
|
+#include <linux/slab.h>
|
||||||
|
+#include <linux/mtd/mtd.h>
|
||||||
|
+#include <linux/mtd/partitions.h>
|
||||||
|
+#include <linux/platform_device.h>
|
||||||
|
+#include <linux/sched.h>
|
||||||
|
+#include <linux/root_dev.h>
|
||||||
|
+#include <linux/delay.h>
|
||||||
|
+#include <asm/delay.h>
|
||||||
|
+#include <asm/io.h>
|
||||||
|
+
|
||||||
|
+#include <ar2315_spiflash.h>
|
||||||
|
+#include <ar231x_platform.h>
|
||||||
|
+#include <ar231x.h>
|
||||||
|
+
|
||||||
|
+
|
||||||
|
+#define SPIFLASH "spiflash: "
|
||||||
|
+#define busy_wait(_priv, _condition, _wait) do { \
|
||||||
|
+ while (_condition) { \
|
||||||
|
+ spin_unlock_bh(&_priv->lock); \
|
||||||
|
+ if (_wait > 1) \
|
||||||
|
+ msleep(_wait); \
|
||||||
|
+ else if ((_wait == 1) && need_resched()) \
|
||||||
|
+ schedule(); \
|
||||||
|
+ else \
|
||||||
|
+ udelay(1); \
|
||||||
|
+ spin_lock_bh(&_priv->lock); \
|
||||||
|
+ } \
|
||||||
|
+} while (0)
|
||||||
|
+
|
||||||
|
+enum {
|
||||||
|
+ FLASH_NONE,
|
||||||
|
+ FLASH_1MB,
|
||||||
|
+ FLASH_2MB,
|
||||||
|
+ FLASH_4MB,
|
||||||
|
+ FLASH_8MB,
|
||||||
|
+ FLASH_16MB,
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+/* Flash configuration table */
|
||||||
|
+struct flashconfig {
|
||||||
|
+ u32 byte_cnt;
|
||||||
|
+ u32 sector_cnt;
|
||||||
|
+ u32 sector_size;
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+const struct flashconfig flashconfig_tbl[] = {
|
||||||
|
+ [FLASH_NONE] = { 0, 0, 0},
|
||||||
|
+ [FLASH_1MB] = { STM_1MB_BYTE_COUNT, STM_1MB_SECTOR_COUNT, STM_1MB_SECTOR_SIZE},
|
||||||
|
+ [FLASH_2MB] = { STM_2MB_BYTE_COUNT, STM_2MB_SECTOR_COUNT, STM_2MB_SECTOR_SIZE},
|
||||||
|
+ [FLASH_4MB] = { STM_4MB_BYTE_COUNT, STM_4MB_SECTOR_COUNT, STM_4MB_SECTOR_SIZE},
|
||||||
|
+ [FLASH_8MB] = { STM_8MB_BYTE_COUNT, STM_8MB_SECTOR_COUNT, STM_8MB_SECTOR_SIZE},
|
||||||
|
+ [FLASH_16MB] = { STM_16MB_BYTE_COUNT, STM_16MB_SECTOR_COUNT, STM_16MB_SECTOR_SIZE}
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+/* Mapping of generic opcodes to STM serial flash opcodes */
|
||||||
|
+enum {
|
||||||
|
+ SPI_WRITE_ENABLE,
|
||||||
|
+ SPI_WRITE_DISABLE,
|
||||||
|
+ SPI_RD_STATUS,
|
||||||
|
+ SPI_WR_STATUS,
|
||||||
|
+ SPI_RD_DATA,
|
||||||
|
+ SPI_FAST_RD_DATA,
|
||||||
|
+ SPI_PAGE_PROGRAM,
|
||||||
|
+ SPI_SECTOR_ERASE,
|
||||||
|
+ SPI_BULK_ERASE,
|
||||||
|
+ SPI_DEEP_PWRDOWN,
|
||||||
|
+ SPI_RD_SIG,
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+struct opcodes {
|
||||||
|
+ __u16 code;
|
||||||
|
+ __s8 tx_cnt;
|
||||||
|
+ __s8 rx_cnt;
|
||||||
|
+};
|
||||||
|
+const struct opcodes stm_opcodes[] = {
|
||||||
|
+ [SPI_WRITE_ENABLE] = {STM_OP_WR_ENABLE, 1, 0},
|
||||||
|
+ [SPI_WRITE_DISABLE] = {STM_OP_WR_DISABLE, 1, 0},
|
||||||
|
+ [SPI_RD_STATUS] = {STM_OP_RD_STATUS, 1, 1},
|
||||||
|
+ [SPI_WR_STATUS] = {STM_OP_WR_STATUS, 1, 0},
|
||||||
|
+ [SPI_RD_DATA] = {STM_OP_RD_DATA, 4, 4},
|
||||||
|
+ [SPI_FAST_RD_DATA] = {STM_OP_FAST_RD_DATA, 5, 0},
|
||||||
|
+ [SPI_PAGE_PROGRAM] = {STM_OP_PAGE_PGRM, 8, 0},
|
||||||
|
+ [SPI_SECTOR_ERASE] = {STM_OP_SECTOR_ERASE, 4, 0},
|
||||||
|
+ [SPI_BULK_ERASE] = {STM_OP_BULK_ERASE, 1, 0},
|
||||||
|
+ [SPI_DEEP_PWRDOWN] = {STM_OP_DEEP_PWRDOWN, 1, 0},
|
||||||
|
+ [SPI_RD_SIG] = {STM_OP_RD_SIG, 4, 1},
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+/* Driver private data structure */
|
||||||
|
+struct spiflash_priv {
|
||||||
|
+ struct mtd_info mtd;
|
||||||
|
+ void *readaddr; /* memory mapped data for read */
|
||||||
|
+ void *mmraddr; /* memory mapped register space */
|
||||||
|
+ wait_queue_head_t wq;
|
||||||
|
+ spinlock_t lock;
|
||||||
|
+ int state;
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+#define to_spiflash(_mtd) container_of(_mtd, struct spiflash_priv, mtd)
|
||||||
|
+
|
||||||
|
+enum {
|
||||||
|
+ FL_READY,
|
||||||
|
+ FL_READING,
|
||||||
|
+ FL_ERASING,
|
||||||
|
+ FL_WRITING
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+/***************************************************************************************************/
|
||||||
|
+
|
||||||
|
+static u32
|
||||||
|
+spiflash_read_reg(struct spiflash_priv *priv, int reg)
|
||||||
|
+{
|
||||||
|
+ return ar231x_read_reg((u32) priv->mmraddr + reg);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static void
|
||||||
|
+spiflash_write_reg(struct spiflash_priv *priv, int reg, u32 data)
|
||||||
|
+{
|
||||||
|
+ ar231x_write_reg((u32) priv->mmraddr + reg, data);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static u32
|
||||||
|
+spiflash_wait_busy(struct spiflash_priv *priv)
|
||||||
|
+{
|
||||||
|
+ u32 reg;
|
||||||
|
+
|
||||||
|
+ busy_wait(priv, (reg = spiflash_read_reg(priv, SPI_FLASH_CTL)) &
|
||||||
|
+ SPI_CTL_BUSY, 0);
|
||||||
|
+ return reg;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static u32
|
||||||
|
+spiflash_sendcmd (struct spiflash_priv *priv, int opcode, u32 addr)
|
||||||
|
+{
|
||||||
|
+ const struct opcodes *op;
|
||||||
|
+ u32 reg, mask;
|
||||||
|
+
|
||||||
|
+ op = &stm_opcodes[opcode];
|
||||||
|
+ reg = spiflash_wait_busy(priv);
|
||||||
|
+ spiflash_write_reg(priv, SPI_FLASH_OPCODE,
|
||||||
|
+ ((u32) op->code) | (addr << 8));
|
||||||
|
+
|
||||||
|
+ reg &= ~SPI_CTL_TX_RX_CNT_MASK;
|
||||||
|
+ reg |= SPI_CTL_START | op->tx_cnt | (op->rx_cnt << 4);
|
||||||
|
+
|
||||||
|
+ spiflash_write_reg(priv, SPI_FLASH_CTL, reg);
|
||||||
|
+ spiflash_wait_busy(priv);
|
||||||
|
+
|
||||||
|
+ if (!op->rx_cnt)
|
||||||
|
+ return 0;
|
||||||
|
+
|
||||||
|
+ reg = spiflash_read_reg(priv, SPI_FLASH_DATA);
|
||||||
|
+
|
||||||
|
+ switch (op->rx_cnt) {
|
||||||
|
+ case 1:
|
||||||
|
+ mask = 0x000000ff;
|
||||||
|
+ break;
|
||||||
|
+ case 2:
|
||||||
|
+ mask = 0x0000ffff;
|
||||||
|
+ break;
|
||||||
|
+ case 3:
|
||||||
|
+ mask = 0x00ffffff;
|
||||||
|
+ break;
|
||||||
|
+ default:
|
||||||
|
+ mask = 0xffffffff;
|
||||||
|
+ break;
|
||||||
|
+ }
|
||||||
|
+ reg &= mask;
|
||||||
|
+
|
||||||
|
+ return reg;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+
|
||||||
|
+/*
|
||||||
|
+ * Probe SPI flash device
|
||||||
|
+ * Function returns 0 for failure.
|
||||||
|
+ * and flashconfig_tbl array index for success.
|
||||||
|
+ */
|
||||||
|
+static int
|
||||||
|
+spiflash_probe_chip (struct spiflash_priv *priv)
|
||||||
|
+{
|
||||||
|
+ u32 sig;
|
||||||
|
+ int flash_size;
|
||||||
|
+
|
||||||
|
+ /* Read the signature on the flash device */
|
||||||
|
+ spin_lock_bh(&priv->lock);
|
||||||
|
+ sig = spiflash_sendcmd(priv, SPI_RD_SIG, 0);
|
||||||
|
+ spin_unlock_bh(&priv->lock);
|
||||||
|
+
|
||||||
|
+ switch (sig) {
|
||||||
|
+ case STM_8MBIT_SIGNATURE:
|
||||||
|
+ flash_size = FLASH_1MB;
|
||||||
|
+ break;
|
||||||
|
+ case STM_16MBIT_SIGNATURE:
|
||||||
|
+ flash_size = FLASH_2MB;
|
||||||
|
+ break;
|
||||||
|
+ case STM_32MBIT_SIGNATURE:
|
||||||
|
+ flash_size = FLASH_4MB;
|
||||||
|
+ break;
|
||||||
|
+ case STM_64MBIT_SIGNATURE:
|
||||||
|
+ flash_size = FLASH_8MB;
|
||||||
|
+ break;
|
||||||
|
+ case STM_128MBIT_SIGNATURE:
|
||||||
|
+ flash_size = FLASH_16MB;
|
||||||
|
+ break;
|
||||||
|
+ default:
|
||||||
|
+ printk (KERN_WARNING SPIFLASH "Read of flash device signature failed!\n");
|
||||||
|
+ return 0;
|
||||||
|
+ }
|
||||||
|
+
|
||||||
|
+ return flash_size;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+
|
||||||
|
+/* wait until the flash chip is ready and grab a lock */
|
||||||
|
+static int spiflash_wait_ready(struct spiflash_priv *priv, int state)
|
||||||
|
+{
|
||||||
|
+ DECLARE_WAITQUEUE(wait, current);
|
||||||
|
+
|
||||||
|
+retry:
|
||||||
|
+ spin_lock_bh(&priv->lock);
|
||||||
|
+ if (priv->state != FL_READY) {
|
||||||
|
+ set_current_state(TASK_UNINTERRUPTIBLE);
|
||||||
|
+ add_wait_queue(&priv->wq, &wait);
|
||||||
|
+ spin_unlock_bh(&priv->lock);
|
||||||
|
+ schedule();
|
||||||
|
+ remove_wait_queue(&priv->wq, &wait);
|
||||||
|
+
|
||||||
|
+ if(signal_pending(current))
|
||||||
|
+ return 0;
|
||||||
|
+
|
||||||
|
+ goto retry;
|
||||||
|
+ }
|
||||||
|
+ priv->state = state;
|
||||||
|
+
|
||||||
|
+ return 1;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static inline void spiflash_done(struct spiflash_priv *priv)
|
||||||
|
+{
|
||||||
|
+ priv->state = FL_READY;
|
||||||
|
+ spin_unlock_bh(&priv->lock);
|
||||||
|
+ wake_up(&priv->wq);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static void
|
||||||
|
+spiflash_wait_complete(struct spiflash_priv *priv, unsigned int timeout)
|
||||||
|
+{
|
||||||
|
+ busy_wait(priv, spiflash_sendcmd(priv, SPI_RD_STATUS, 0) &
|
||||||
|
+ SPI_STATUS_WIP, timeout);
|
||||||
|
+ spiflash_done(priv);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+
|
||||||
|
+
|
||||||
|
+static int
|
||||||
|
+spiflash_erase (struct mtd_info *mtd, struct erase_info *instr)
|
||||||
|
+{
|
||||||
|
+ struct spiflash_priv *priv = to_spiflash(mtd);
|
||||||
|
+ const struct opcodes *op;
|
||||||
|
+ u32 temp, reg;
|
||||||
|
+
|
||||||
|
+ if (instr->addr + instr->len > mtd->size)
|
||||||
|
+ return -EINVAL;
|
||||||
|
+
|
||||||
|
+ if (!spiflash_wait_ready(priv, FL_ERASING))
|
||||||
|
+ return -EINTR;
|
||||||
|
+
|
||||||
|
+ spiflash_sendcmd(priv, SPI_WRITE_ENABLE, 0);
|
||||||
|
+ reg = spiflash_wait_busy(priv);
|
||||||
|
+
|
||||||
|
+ op = &stm_opcodes[SPI_SECTOR_ERASE];
|
||||||
|
+ temp = ((u32)instr->addr << 8) | (u32)(op->code);
|
||||||
|
+ spiflash_write_reg(priv, SPI_FLASH_OPCODE, temp);
|
||||||
|
+
|
||||||
|
+ reg &= ~SPI_CTL_TX_RX_CNT_MASK;
|
||||||
|
+ reg |= op->tx_cnt | SPI_CTL_START;
|
||||||
|
+ spiflash_write_reg(priv, SPI_FLASH_CTL, reg);
|
||||||
|
+
|
||||||
|
+ spiflash_wait_complete(priv, 20);
|
||||||
|
+
|
||||||
|
+ instr->state = MTD_ERASE_DONE;
|
||||||
|
+ mtd_erase_callback(instr);
|
||||||
|
+
|
||||||
|
+ return 0;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static int
|
||||||
|
+spiflash_read (struct mtd_info *mtd, loff_t from, size_t len, size_t *retlen, u_char *buf)
|
||||||
|
+{
|
||||||
|
+ struct spiflash_priv *priv = to_spiflash(mtd);
|
||||||
|
+ u8 *read_addr;
|
||||||
|
+
|
||||||
|
+ if (!len)
|
||||||
|
+ return 0;
|
||||||
|
+
|
||||||
|
+ if (from + len > mtd->size)
|
||||||
|
+ return -EINVAL;
|
||||||
|
+
|
||||||
|
+ *retlen = len;
|
||||||
|
+
|
||||||
|
+ if (!spiflash_wait_ready(priv, FL_READING))
|
||||||
|
+ return -EINTR;
|
||||||
|
+
|
||||||
|
+ read_addr = (u8 *)(priv->readaddr + from);
|
||||||
|
+ memcpy_fromio(buf, read_addr, len);
|
||||||
|
+ spiflash_done(priv);
|
||||||
|
+
|
||||||
|
+ return 0;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static int
|
||||||
|
+spiflash_write (struct mtd_info *mtd, loff_t to, size_t len, size_t *retlen, const u8 *buf)
|
||||||
|
+{
|
||||||
|
+ struct spiflash_priv *priv = to_spiflash(mtd);
|
||||||
|
+ u32 opcode, bytes_left;
|
||||||
|
+
|
||||||
|
+ *retlen = 0;
|
||||||
|
+
|
||||||
|
+ if (!len)
|
||||||
|
+ return 0;
|
||||||
|
+
|
||||||
|
+ if (to + len > mtd->size)
|
||||||
|
+ return -EINVAL;
|
||||||
|
+
|
||||||
|
+ bytes_left = len;
|
||||||
|
+
|
||||||
|
+ do {
|
||||||
|
+ u32 read_len, reg, page_offset, spi_data = 0;
|
||||||
|
+
|
||||||
|
+ read_len = min(bytes_left, sizeof(u32));
|
||||||
|
+
|
||||||
|
+ /* 32-bit writes cannot span across a page boundary
|
||||||
|
+ * (256 bytes). This types of writes require two page
|
||||||
|
+ * program operations to handle it correctly. The STM part
|
||||||
|
+ * will write the overflow data to the beginning of the
|
||||||
|
+ * current page as opposed to the subsequent page.
|
||||||
|
+ */
|
||||||
|
+ page_offset = (to & (STM_PAGE_SIZE - 1)) + read_len;
|
||||||
|
+
|
||||||
|
+ if (page_offset > STM_PAGE_SIZE)
|
||||||
|
+ read_len -= (page_offset - STM_PAGE_SIZE);
|
||||||
|
+
|
||||||
|
+ if (!spiflash_wait_ready(priv, FL_WRITING))
|
||||||
|
+ return -EINTR;
|
||||||
|
+
|
||||||
|
+ spiflash_sendcmd(priv, SPI_WRITE_ENABLE, 0);
|
||||||
|
+ spi_data = 0;
|
||||||
|
+ switch (read_len) {
|
||||||
|
+ case 4:
|
||||||
|
+ spi_data |= buf[3] << 24;
|
||||||
|
+ /* fall through */
|
||||||
|
+ case 3:
|
||||||
|
+ spi_data |= buf[2] << 16;
|
||||||
|
+ /* fall through */
|
||||||
|
+ case 2:
|
||||||
|
+ spi_data |= buf[1] << 8;
|
||||||
|
+ /* fall through */
|
||||||
|
+ case 1:
|
||||||
|
+ spi_data |= buf[0] & 0xff;
|
||||||
|
+ break;
|
||||||
|
+ default:
|
||||||
|
+ break;
|
||||||
|
+ }
|
||||||
|
+
|
||||||
|
+ spiflash_write_reg(priv, SPI_FLASH_DATA, spi_data);
|
||||||
|
+ opcode = stm_opcodes[SPI_PAGE_PROGRAM].code |
|
||||||
|
+ (to & 0x00ffffff) << 8;
|
||||||
|
+ spiflash_write_reg(priv, SPI_FLASH_OPCODE, opcode);
|
||||||
|
+
|
||||||
|
+ reg = spiflash_read_reg(priv, SPI_FLASH_CTL);
|
||||||
|
+ reg &= ~SPI_CTL_TX_RX_CNT_MASK;
|
||||||
|
+ reg |= (read_len + 4) | SPI_CTL_START;
|
||||||
|
+ spiflash_write_reg(priv, SPI_FLASH_CTL, reg);
|
||||||
|
+
|
||||||
|
+ spiflash_wait_complete(priv, 1);
|
||||||
|
+
|
||||||
|
+ bytes_left -= read_len;
|
||||||
|
+ to += read_len;
|
||||||
|
+ buf += read_len;
|
||||||
|
+
|
||||||
|
+ *retlen += read_len;
|
||||||
|
+ } while (bytes_left != 0);
|
||||||
|
+
|
||||||
|
+ return 0;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+
|
||||||
|
+#ifdef CONFIG_MTD_PARTITIONS
|
||||||
|
+static const char *part_probe_types[] = { "cmdlinepart", "RedBoot", "MyLoader", NULL };
|
||||||
|
+#endif
|
||||||
|
+
|
||||||
|
+
|
||||||
|
+static int
|
||||||
|
+spiflash_probe(struct platform_device *pdev)
|
||||||
|
+{
|
||||||
|
+ struct spiflash_priv *priv;
|
||||||
|
+ struct mtd_partition *parts;
|
||||||
|
+ struct mtd_info *mtd;
|
||||||
|
+ int index, num_parts;
|
||||||
|
+ int result = 0;
|
||||||
|
+
|
||||||
|
+ priv = kzalloc(sizeof(struct spiflash_priv), GFP_KERNEL);
|
||||||
|
+ spin_lock_init(&priv->lock);
|
||||||
|
+ init_waitqueue_head(&priv->wq);
|
||||||
|
+ priv->state = FL_READY;
|
||||||
|
+ mtd = &priv->mtd;
|
||||||
|
+
|
||||||
|
+ priv->mmraddr = ioremap_nocache(SPI_FLASH_MMR, SPI_FLASH_MMR_SIZE);
|
||||||
|
+ if (!priv->mmraddr) {
|
||||||
|
+ printk(KERN_WARNING SPIFLASH "Failed to map flash device\n");
|
||||||
|
+ goto error;
|
||||||
|
+ }
|
||||||
|
+
|
||||||
|
+ index = spiflash_probe_chip(priv);
|
||||||
|
+ if (!index) {
|
||||||
|
+ printk (KERN_WARNING SPIFLASH "Found no serial flash device\n");
|
||||||
|
+ goto error;
|
||||||
|
+ }
|
||||||
|
+
|
||||||
|
+ priv->readaddr = ioremap_nocache(SPI_FLASH_READ, flashconfig_tbl[index].byte_cnt);
|
||||||
|
+ if (!priv->readaddr) {
|
||||||
|
+ printk (KERN_WARNING SPIFLASH "Failed to map flash device\n");
|
||||||
|
+ goto error;
|
||||||
|
+ }
|
||||||
|
+
|
||||||
|
+ platform_set_drvdata(pdev, priv);
|
||||||
|
+ mtd->name = "spiflash";
|
||||||
|
+ mtd->type = MTD_NORFLASH;
|
||||||
|
+ mtd->flags = (MTD_CAP_NORFLASH|MTD_WRITEABLE);
|
||||||
|
+ mtd->size = flashconfig_tbl[index].byte_cnt;
|
||||||
|
+ mtd->erasesize = flashconfig_tbl[index].sector_size;
|
||||||
|
+ mtd->writesize = 1;
|
||||||
|
+ mtd->numeraseregions = 0;
|
||||||
|
+ mtd->eraseregions = NULL;
|
||||||
|
+ mtd->erase = spiflash_erase;
|
||||||
|
+ mtd->read = spiflash_read;
|
||||||
|
+ mtd->write = spiflash_write;
|
||||||
|
+ mtd->owner = THIS_MODULE;
|
||||||
|
+
|
||||||
|
+#ifdef CONFIG_MTD_PARTITIONS
|
||||||
|
+ /* parse redboot partitions */
|
||||||
|
+ num_parts = parse_mtd_partitions(mtd, part_probe_types, &parts, 0);
|
||||||
|
+ if (!num_parts)
|
||||||
|
+ goto error;
|
||||||
|
+
|
||||||
|
+ result = add_mtd_partitions(mtd, parts, num_parts);
|
||||||
|
+#endif
|
||||||
|
+
|
||||||
|
+ return result;
|
||||||
|
+
|
||||||
|
+error:
|
||||||
|
+ if (priv->mmraddr)
|
||||||
|
+ iounmap(priv->mmraddr);
|
||||||
|
+ kfree(priv);
|
||||||
|
+ return -ENXIO;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static int
|
||||||
|
+spiflash_remove (struct platform_device *pdev)
|
||||||
|
+{
|
||||||
|
+ struct spiflash_priv *priv = platform_get_drvdata(pdev);
|
||||||
|
+ struct mtd_info *mtd = &priv->mtd;
|
||||||
|
+
|
||||||
|
+ del_mtd_partitions(mtd);
|
||||||
|
+ iounmap(priv->mmraddr);
|
||||||
|
+ iounmap(priv->readaddr);
|
||||||
|
+ kfree(priv);
|
||||||
|
+
|
||||||
|
+ return 0;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+struct platform_driver spiflash_driver = {
|
||||||
|
+ .driver.name = "spiflash",
|
||||||
|
+ .probe = spiflash_probe,
|
||||||
|
+ .remove = spiflash_remove,
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+int __init
|
||||||
|
+spiflash_init (void)
|
||||||
|
+{
|
||||||
|
+ return platform_driver_register(&spiflash_driver);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+void __exit
|
||||||
|
+spiflash_exit (void)
|
||||||
|
+{
|
||||||
|
+ return platform_driver_unregister(&spiflash_driver);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+module_init (spiflash_init);
|
||||||
|
+module_exit (spiflash_exit);
|
||||||
|
+
|
||||||
|
+MODULE_LICENSE("GPL");
|
||||||
|
+MODULE_AUTHOR("OpenWrt.org, Atheros Communications Inc");
|
||||||
|
+MODULE_DESCRIPTION("MTD driver for SPI Flash on Atheros SOC");
|
||||||
|
+
|
||||||
|
Index: linux-2.6.32.7/arch/mips/include/asm/mach-ar231x/ar2315_spiflash.h
|
||||||
|
===================================================================
|
||||||
|
--- /dev/null 1970-01-01 00:00:00.000000000 +0000
|
||||||
|
+++ linux-2.6.32.7/arch/mips/include/asm/mach-ar231x/ar2315_spiflash.h 2010-02-03 17:01:08.858429535 +0100
|
||||||
|
@@ -0,0 +1,116 @@
|
||||||
|
+/*
|
||||||
|
+ * SPI Flash Memory support header file.
|
||||||
|
+ *
|
||||||
|
+ * Copyright (c) 2005, Atheros Communications Inc.
|
||||||
|
+ * Copyright (C) 2006 FON Technology, SL.
|
||||||
|
+ * Copyright (C) 2006 Imre Kaloz <kaloz@openwrt.org>
|
||||||
|
+ * Copyright (C) 2006-2009 Felix Fietkau <nbd@openwrt.org>
|
||||||
|
+ *
|
||||||
|
+ * This code is free software; you can redistribute it and/or modify
|
||||||
|
+ * it under the terms of the GNU General Public License version 2 as
|
||||||
|
+ * published by the Free Software Foundation.
|
||||||
|
+ *
|
||||||
|
+ */
|
||||||
|
+#ifndef __AR2315_SPIFLASH_H
|
||||||
|
+#define __AR2315_SPIFLASH_H
|
||||||
|
+
|
||||||
|
+#define STM_PAGE_SIZE 256
|
||||||
|
+
|
||||||
|
+#define SFI_WRITE_BUFFER_SIZE 4
|
||||||
|
+#define SFI_FLASH_ADDR_MASK 0x00ffffff
|
||||||
|
+
|
||||||
|
+#define STM_8MBIT_SIGNATURE 0x13
|
||||||
|
+#define STM_M25P80_BYTE_COUNT 1048576
|
||||||
|
+#define STM_M25P80_SECTOR_COUNT 16
|
||||||
|
+#define STM_M25P80_SECTOR_SIZE 0x10000
|
||||||
|
+
|
||||||
|
+#define STM_16MBIT_SIGNATURE 0x14
|
||||||
|
+#define STM_M25P16_BYTE_COUNT 2097152
|
||||||
|
+#define STM_M25P16_SECTOR_COUNT 32
|
||||||
|
+#define STM_M25P16_SECTOR_SIZE 0x10000
|
||||||
|
+
|
||||||
|
+#define STM_32MBIT_SIGNATURE 0x15
|
||||||
|
+#define STM_M25P32_BYTE_COUNT 4194304
|
||||||
|
+#define STM_M25P32_SECTOR_COUNT 64
|
||||||
|
+#define STM_M25P32_SECTOR_SIZE 0x10000
|
||||||
|
+
|
||||||
|
+#define STM_64MBIT_SIGNATURE 0x16
|
||||||
|
+#define STM_M25P64_BYTE_COUNT 8388608
|
||||||
|
+#define STM_M25P64_SECTOR_COUNT 128
|
||||||
|
+#define STM_M25P64_SECTOR_SIZE 0x10000
|
||||||
|
+
|
||||||
|
+#define STM_128MBIT_SIGNATURE 0x17
|
||||||
|
+#define STM_M25P128_BYTE_COUNT 16777216
|
||||||
|
+#define STM_M25P128_SECTOR_COUNT 256
|
||||||
|
+#define STM_M25P128_SECTOR_SIZE 0x10000
|
||||||
|
+
|
||||||
|
+#define STM_1MB_BYTE_COUNT STM_M25P80_BYTE_COUNT
|
||||||
|
+#define STM_1MB_SECTOR_COUNT STM_M25P80_SECTOR_COUNT
|
||||||
|
+#define STM_1MB_SECTOR_SIZE STM_M25P80_SECTOR_SIZE
|
||||||
|
+#define STM_2MB_BYTE_COUNT STM_M25P16_BYTE_COUNT
|
||||||
|
+#define STM_2MB_SECTOR_COUNT STM_M25P16_SECTOR_COUNT
|
||||||
|
+#define STM_2MB_SECTOR_SIZE STM_M25P16_SECTOR_SIZE
|
||||||
|
+#define STM_4MB_BYTE_COUNT STM_M25P32_BYTE_COUNT
|
||||||
|
+#define STM_4MB_SECTOR_COUNT STM_M25P32_SECTOR_COUNT
|
||||||
|
+#define STM_4MB_SECTOR_SIZE STM_M25P32_SECTOR_SIZE
|
||||||
|
+#define STM_8MB_BYTE_COUNT STM_M25P64_BYTE_COUNT
|
||||||
|
+#define STM_8MB_SECTOR_COUNT STM_M25P64_SECTOR_COUNT
|
||||||
|
+#define STM_8MB_SECTOR_SIZE STM_M25P64_SECTOR_SIZE
|
||||||
|
+#define STM_16MB_BYTE_COUNT STM_M25P128_BYTE_COUNT
|
||||||
|
+#define STM_16MB_SECTOR_COUNT STM_M25P128_SECTOR_COUNT
|
||||||
|
+#define STM_16MB_SECTOR_SIZE STM_M25P128_SECTOR_SIZE
|
||||||
|
+
|
||||||
|
+/*
|
||||||
|
+ * ST Microelectronics Opcodes for Serial Flash
|
||||||
|
+ */
|
||||||
|
+
|
||||||
|
+#define STM_OP_WR_ENABLE 0x06 /* Write Enable */
|
||||||
|
+#define STM_OP_WR_DISABLE 0x04 /* Write Disable */
|
||||||
|
+#define STM_OP_RD_STATUS 0x05 /* Read Status */
|
||||||
|
+#define STM_OP_WR_STATUS 0x01 /* Write Status */
|
||||||
|
+#define STM_OP_RD_DATA 0x03 /* Read Data */
|
||||||
|
+#define STM_OP_FAST_RD_DATA 0x0b /* Fast Read Data */
|
||||||
|
+#define STM_OP_PAGE_PGRM 0x02 /* Page Program */
|
||||||
|
+#define STM_OP_SECTOR_ERASE 0xd8 /* Sector Erase */
|
||||||
|
+#define STM_OP_BULK_ERASE 0xc7 /* Bulk Erase */
|
||||||
|
+#define STM_OP_DEEP_PWRDOWN 0xb9 /* Deep Power-Down Mode */
|
||||||
|
+#define STM_OP_RD_SIG 0xab /* Read Electronic Signature */
|
||||||
|
+
|
||||||
|
+#define STM_STATUS_WIP 0x01 /* Write-In-Progress */
|
||||||
|
+#define STM_STATUS_WEL 0x02 /* Write Enable Latch */
|
||||||
|
+#define STM_STATUS_BP0 0x04 /* Block Protect 0 */
|
||||||
|
+#define STM_STATUS_BP1 0x08 /* Block Protect 1 */
|
||||||
|
+#define STM_STATUS_BP2 0x10 /* Block Protect 2 */
|
||||||
|
+#define STM_STATUS_SRWD 0x80 /* Status Register Write Disable */
|
||||||
|
+
|
||||||
|
+/*
|
||||||
|
+ * SPI Flash Interface Registers
|
||||||
|
+ */
|
||||||
|
+#define AR531XPLUS_SPI_READ 0x08000000
|
||||||
|
+#define AR531XPLUS_SPI_MMR 0x11300000
|
||||||
|
+#define AR531XPLUS_SPI_MMR_SIZE 12
|
||||||
|
+
|
||||||
|
+#define AR531XPLUS_SPI_CTL 0x00
|
||||||
|
+#define AR531XPLUS_SPI_OPCODE 0x04
|
||||||
|
+#define AR531XPLUS_SPI_DATA 0x08
|
||||||
|
+
|
||||||
|
+#define SPI_FLASH_READ AR531XPLUS_SPI_READ
|
||||||
|
+#define SPI_FLASH_MMR AR531XPLUS_SPI_MMR
|
||||||
|
+#define SPI_FLASH_MMR_SIZE AR531XPLUS_SPI_MMR_SIZE
|
||||||
|
+#define SPI_FLASH_CTL AR531XPLUS_SPI_CTL
|
||||||
|
+#define SPI_FLASH_OPCODE AR531XPLUS_SPI_OPCODE
|
||||||
|
+#define SPI_FLASH_DATA AR531XPLUS_SPI_DATA
|
||||||
|
+
|
||||||
|
+#define SPI_CTL_START 0x00000100
|
||||||
|
+#define SPI_CTL_BUSY 0x00010000
|
||||||
|
+#define SPI_CTL_TXCNT_MASK 0x0000000f
|
||||||
|
+#define SPI_CTL_RXCNT_MASK 0x000000f0
|
||||||
|
+#define SPI_CTL_TX_RX_CNT_MASK 0x000000ff
|
||||||
|
+#define SPI_CTL_SIZE_MASK 0x00060000
|
||||||
|
+
|
||||||
|
+#define SPI_CTL_CLK_SEL_MASK 0x03000000
|
||||||
|
+#define SPI_OPCODE_MASK 0x000000ff
|
||||||
|
+
|
||||||
|
+#define SPI_STATUS_WIP STM_STATUS_WIP
|
||||||
|
+
|
||||||
|
+#endif
|
||||||
@ -0,0 +1,234 @@ |
|||||||
|
Index: linux-2.6.32.7/drivers/watchdog/ar2315-wtd.c
|
||||||
|
===================================================================
|
||||||
|
--- /dev/null 1970-01-01 00:00:00.000000000 +0000
|
||||||
|
+++ linux-2.6.32.7/drivers/watchdog/ar2315-wtd.c 2010-02-03 17:01:46.074429108 +0100
|
||||||
|
@@ -0,0 +1,200 @@
|
||||||
|
+/*
|
||||||
|
+ * 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||||||
|
+ *
|
||||||
|
+ * Copyright (C) 2008 John Crispin <blogic@openwrt.org>
|
||||||
|
+ * Based on EP93xx and ifxmips wdt driver
|
||||||
|
+ */
|
||||||
|
+
|
||||||
|
+#include <linux/interrupt.h>
|
||||||
|
+#include <linux/module.h>
|
||||||
|
+#include <linux/moduleparam.h>
|
||||||
|
+#include <linux/types.h>
|
||||||
|
+#include <linux/miscdevice.h>
|
||||||
|
+#include <linux/watchdog.h>
|
||||||
|
+#include <linux/fs.h>
|
||||||
|
+#include <linux/ioport.h>
|
||||||
|
+#include <linux/notifier.h>
|
||||||
|
+#include <linux/reboot.h>
|
||||||
|
+#include <linux/init.h>
|
||||||
|
+#include <linux/platform_device.h>
|
||||||
|
+
|
||||||
|
+#include <asm/io.h>
|
||||||
|
+#include <asm/uaccess.h>
|
||||||
|
+#include <asm/system.h>
|
||||||
|
+#include <asm/addrspace.h>
|
||||||
|
+#include <ar231x_platform.h>
|
||||||
|
+#include <ar2315_regs.h>
|
||||||
|
+#include <ar231x.h>
|
||||||
|
+
|
||||||
|
+#define CLOCK_RATE 40000000
|
||||||
|
+#define HEARTBEAT(x) (x < 1 || x > 90)?(20):(x)
|
||||||
|
+
|
||||||
|
+static int wdt_timeout = 20;
|
||||||
|
+static int started = 0;
|
||||||
|
+static int in_use = 0;
|
||||||
|
+
|
||||||
|
+static void
|
||||||
|
+ar2315_wdt_enable(void)
|
||||||
|
+{
|
||||||
|
+ ar231x_write_reg(AR2315_WD, wdt_timeout * CLOCK_RATE);
|
||||||
|
+ ar231x_write_reg(AR2315_ISR, 0x80);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static ssize_t
|
||||||
|
+ar2315_wdt_write(struct file *file, const char __user *data, size_t len, loff_t *ppos)
|
||||||
|
+{
|
||||||
|
+ if(len)
|
||||||
|
+ ar2315_wdt_enable();
|
||||||
|
+ return len;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static int
|
||||||
|
+ar2315_wdt_open(struct inode *inode, struct file *file)
|
||||||
|
+{
|
||||||
|
+ if(in_use)
|
||||||
|
+ return -EBUSY;
|
||||||
|
+ ar2315_wdt_enable();
|
||||||
|
+ in_use = started = 1;
|
||||||
|
+ return nonseekable_open(inode, file);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static int
|
||||||
|
+ar2315_wdt_release(struct inode *inode, struct file *file)
|
||||||
|
+{
|
||||||
|
+ in_use = 0;
|
||||||
|
+ return 0;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static irqreturn_t
|
||||||
|
+ar2315_wdt_interrupt(int irq, void *dev_id)
|
||||||
|
+{
|
||||||
|
+ if(started)
|
||||||
|
+ {
|
||||||
|
+ printk(KERN_CRIT "watchdog expired, rebooting system\n");
|
||||||
|
+ emergency_restart();
|
||||||
|
+ } else {
|
||||||
|
+ ar231x_write_reg(AR2315_WDC, 0);
|
||||||
|
+ ar231x_write_reg(AR2315_WD, 0);
|
||||||
|
+ ar231x_write_reg(AR2315_ISR, 0x80);
|
||||||
|
+ }
|
||||||
|
+ return IRQ_HANDLED;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static struct watchdog_info ident = {
|
||||||
|
+ .options = WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING,
|
||||||
|
+ .identity = "ar2315 Watchdog",
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+static int
|
||||||
|
+ar2315_wdt_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
|
||||||
|
+{
|
||||||
|
+ int new_wdt_timeout;
|
||||||
|
+ int ret = -ENOIOCTLCMD;
|
||||||
|
+
|
||||||
|
+ switch(cmd)
|
||||||
|
+ {
|
||||||
|
+ case WDIOC_GETSUPPORT:
|
||||||
|
+ ret = copy_to_user((struct watchdog_info __user *)arg, &ident, sizeof(ident)) ? -EFAULT : 0;
|
||||||
|
+ break;
|
||||||
|
+
|
||||||
|
+ case WDIOC_KEEPALIVE:
|
||||||
|
+ ar2315_wdt_enable();
|
||||||
|
+ ret = 0;
|
||||||
|
+ break;
|
||||||
|
+
|
||||||
|
+ case WDIOC_SETTIMEOUT:
|
||||||
|
+ if((ret = get_user(new_wdt_timeout, (int __user *)arg)))
|
||||||
|
+ break;
|
||||||
|
+ wdt_timeout = HEARTBEAT(new_wdt_timeout);
|
||||||
|
+ ar2315_wdt_enable();
|
||||||
|
+ break;
|
||||||
|
+
|
||||||
|
+ case WDIOC_GETTIMEOUT:
|
||||||
|
+ ret = put_user(wdt_timeout, (int __user *)arg);
|
||||||
|
+ break;
|
||||||
|
+ }
|
||||||
|
+ return ret;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static struct file_operations ar2315_wdt_fops = {
|
||||||
|
+ .owner = THIS_MODULE,
|
||||||
|
+ .llseek = no_llseek,
|
||||||
|
+ .write = ar2315_wdt_write,
|
||||||
|
+ .ioctl = ar2315_wdt_ioctl,
|
||||||
|
+ .open = ar2315_wdt_open,
|
||||||
|
+ .release = ar2315_wdt_release,
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+static struct miscdevice ar2315_wdt_miscdev = {
|
||||||
|
+ .minor = WATCHDOG_MINOR,
|
||||||
|
+ .name = "watchdog",
|
||||||
|
+ .fops = &ar2315_wdt_fops,
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+static int
|
||||||
|
+ar2315_wdt_probe(struct platform_device *dev)
|
||||||
|
+{
|
||||||
|
+ int ret = 0;
|
||||||
|
+
|
||||||
|
+ ar2315_wdt_enable();
|
||||||
|
+ ret = request_irq(AR531X_MISC_IRQ_WATCHDOG, ar2315_wdt_interrupt, IRQF_DISABLED, "ar2315_wdt", NULL);
|
||||||
|
+ if(ret)
|
||||||
|
+ {
|
||||||
|
+ printk(KERN_ERR "ar2315wdt: failed to register inetrrupt\n");
|
||||||
|
+ goto out;
|
||||||
|
+ }
|
||||||
|
+
|
||||||
|
+ ret = misc_register(&ar2315_wdt_miscdev);
|
||||||
|
+ if(ret)
|
||||||
|
+ printk(KERN_ERR "ar2315wdt: failed to register miscdev\n");
|
||||||
|
+
|
||||||
|
+out:
|
||||||
|
+ return ret;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static int
|
||||||
|
+ar2315_wdt_remove(struct platform_device *dev)
|
||||||
|
+{
|
||||||
|
+ misc_deregister(&ar2315_wdt_miscdev);
|
||||||
|
+ free_irq(AR531X_MISC_IRQ_WATCHDOG, NULL);
|
||||||
|
+ return 0;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static struct platform_driver ar2315_wdt_driver = {
|
||||||
|
+ .probe = ar2315_wdt_probe,
|
||||||
|
+ .remove = ar2315_wdt_remove,
|
||||||
|
+ .driver = {
|
||||||
|
+ .name = "ar2315_wdt",
|
||||||
|
+ .owner = THIS_MODULE,
|
||||||
|
+ },
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+static int __init
|
||||||
|
+init_ar2315_wdt(void)
|
||||||
|
+{
|
||||||
|
+ int ret = platform_driver_register(&ar2315_wdt_driver);
|
||||||
|
+ if(ret)
|
||||||
|
+ printk(KERN_INFO "ar2315_wdt: error registering platfom driver!");
|
||||||
|
+ return ret;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static void __exit
|
||||||
|
+exit_ar2315_wdt(void)
|
||||||
|
+{
|
||||||
|
+ platform_driver_unregister(&ar2315_wdt_driver);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+module_init(init_ar2315_wdt);
|
||||||
|
+module_exit(exit_ar2315_wdt);
|
||||||
|
Index: linux-2.6.32.7/drivers/watchdog/Kconfig
|
||||||
|
===================================================================
|
||||||
|
--- linux-2.6.32.7.orig/drivers/watchdog/Kconfig 2010-01-29 00:06:20.000000000 +0100
|
||||||
|
+++ linux-2.6.32.7/drivers/watchdog/Kconfig 2010-02-03 17:01:46.078429135 +0100
|
||||||
|
@@ -850,6 +850,12 @@
|
||||||
|
help
|
||||||
|
Hardware driver for the built-in watchdog timer on TXx9 MIPS SoCs.
|
||||||
|
|
||||||
|
+config ATHEROS_WDT
|
||||||
|
+ tristate "Atheros wisoc Watchdog Timer"
|
||||||
|
+ depends on ATHEROS_AR231X
|
||||||
|
+ help
|
||||||
|
+ Hardware driver for the Atheros wisoc Watchdog Timer.
|
||||||
|
+
|
||||||
|
# PARISC Architecture
|
||||||
|
|
||||||
|
# POWERPC Architecture
|
||||||
|
Index: linux-2.6.32.7/drivers/watchdog/Makefile
|
||||||
|
===================================================================
|
||||||
|
--- linux-2.6.32.7.orig/drivers/watchdog/Makefile 2010-01-29 00:06:20.000000000 +0100
|
||||||
|
+++ linux-2.6.32.7/drivers/watchdog/Makefile 2010-02-03 17:01:46.078429135 +0100
|
||||||
|
@@ -113,6 +113,7 @@
|
||||||
|
obj-$(CONFIG_SIBYTE_WDOG) += sb_wdog.o
|
||||||
|
obj-$(CONFIG_AR7_WDT) += ar7_wdt.o
|
||||||
|
obj-$(CONFIG_TXX9_WDT) += txx9wdt.o
|
||||||
|
+obj-$(CONFIG_ATHEROS_WDT) += ar2315-wtd.o
|
||||||
|
|
||||||
|
# PARISC Architecture
|
||||||
|
|
||||||
@ -0,0 +1,56 @@ |
|||||||
|
Index: linux-2.6.32.7/drivers/mtd/redboot.c
|
||||||
|
===================================================================
|
||||||
|
--- linux-2.6.32.7.orig/drivers/mtd/redboot.c 2010-02-03 16:57:31.582429139 +0100
|
||||||
|
+++ linux-2.6.32.7/drivers/mtd/redboot.c 2010-02-03 17:01:57.067429178 +0100
|
||||||
|
@@ -60,31 +60,32 @@
|
||||||
|
static char nullstring[] = "unallocated";
|
||||||
|
#endif
|
||||||
|
|
||||||
|
+ buf = vmalloc(master->erasesize);
|
||||||
|
+ if (!buf)
|
||||||
|
+ return -ENOMEM;
|
||||||
|
+
|
||||||
|
+ restart:
|
||||||
|
if ( directory < 0 ) {
|
||||||
|
offset = master->size + directory * master->erasesize;
|
||||||
|
- while (master->block_isbad &&
|
||||||
|
+ while (master->block_isbad &&
|
||||||
|
master->block_isbad(master, offset)) {
|
||||||
|
if (!offset) {
|
||||||
|
nogood:
|
||||||
|
printk(KERN_NOTICE "Failed to find a non-bad block to check for RedBoot partition table\n");
|
||||||
|
+ vfree(buf);
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
offset -= master->erasesize;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
offset = directory * master->erasesize;
|
||||||
|
- while (master->block_isbad &&
|
||||||
|
+ while (master->block_isbad &&
|
||||||
|
master->block_isbad(master, offset)) {
|
||||||
|
offset += master->erasesize;
|
||||||
|
if (offset == master->size)
|
||||||
|
goto nogood;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
- buf = vmalloc(master->erasesize);
|
||||||
|
-
|
||||||
|
- if (!buf)
|
||||||
|
- return -ENOMEM;
|
||||||
|
-
|
||||||
|
printk(KERN_NOTICE "Searching for RedBoot partition table in %s at offset 0x%lx\n",
|
||||||
|
master->name, offset);
|
||||||
|
|
||||||
|
@@ -156,6 +157,11 @@
|
||||||
|
}
|
||||||
|
if (i == numslots) {
|
||||||
|
/* Didn't find it */
|
||||||
|
+ if (offset + master->erasesize < master->size) {
|
||||||
|
+ /* not at the end of the flash yet, maybe next block :) */
|
||||||
|
+ directory++;
|
||||||
|
+ goto restart;
|
||||||
|
+ }
|
||||||
|
printk(KERN_NOTICE "No RedBoot partition table detected in %s\n",
|
||||||
|
master->name);
|
||||||
|
ret = 0;
|
||||||
@ -0,0 +1,74 @@ |
|||||||
|
Index: linux-2.6.32.7/drivers/net/ar231x.c
|
||||||
|
===================================================================
|
||||||
|
--- linux-2.6.32.7.orig/drivers/net/ar231x.c 2010-02-03 17:00:35.874430230 +0100
|
||||||
|
+++ linux-2.6.32.7/drivers/net/ar231x.c 2010-02-03 17:02:28.998430523 +0100
|
||||||
|
@@ -735,6 +735,7 @@
|
||||||
|
for (i = 0; i < nr_bufs; i++) {
|
||||||
|
struct sk_buff *skb;
|
||||||
|
ar231x_descr_t *rd;
|
||||||
|
+ int offset = RX_OFFSET;
|
||||||
|
|
||||||
|
if (sp->rx_skb[idx])
|
||||||
|
break;
|
||||||
|
@@ -750,7 +751,9 @@
|
||||||
|
* Make sure IP header starts on a fresh cache line.
|
||||||
|
*/
|
||||||
|
skb->dev = dev;
|
||||||
|
- skb_reserve(skb, RX_OFFSET);
|
||||||
|
+ if (sp->phy_dev)
|
||||||
|
+ offset += sp->phy_dev->pkt_align;
|
||||||
|
+ skb_reserve(skb, offset);
|
||||||
|
sp->rx_skb[idx] = skb;
|
||||||
|
|
||||||
|
rd = (ar231x_descr_t *) & sp->rx_ring[idx];
|
||||||
|
@@ -824,20 +827,23 @@
|
||||||
|
/* alloc new buffer. */
|
||||||
|
skb_new = netdev_alloc_skb(dev, AR2313_BUFSIZE + RX_OFFSET);
|
||||||
|
if (skb_new != NULL) {
|
||||||
|
+ int offset;
|
||||||
|
|
||||||
|
skb = sp->rx_skb[idx];
|
||||||
|
/* set skb */
|
||||||
|
skb_put(skb,
|
||||||
|
((status >> DMA_RX_LEN_SHIFT) & 0x3fff) - CRC_LEN);
|
||||||
|
-
|
||||||
|
dev->stats.rx_bytes += skb->len;
|
||||||
|
- skb->protocol = eth_type_trans(skb, dev);
|
||||||
|
- /* pass the packet to upper layers */
|
||||||
|
- netif_rx(skb);
|
||||||
|
|
||||||
|
+ /* pass the packet to upper layers */
|
||||||
|
+ sp->rx(skb);
|
||||||
|
skb_new->dev = dev;
|
||||||
|
+
|
||||||
|
/* 16 bit align */
|
||||||
|
- skb_reserve(skb_new, RX_OFFSET);
|
||||||
|
+ offset = RX_OFFSET;
|
||||||
|
+ if (sp->phy_dev)
|
||||||
|
+ offset += sp->phy_dev->pkt_align;
|
||||||
|
+ skb_reserve(skb_new, offset);
|
||||||
|
/* reset descriptor's curr_addr */
|
||||||
|
rxdesc->addr = virt_to_phys(skb_new->data);
|
||||||
|
|
||||||
|
@@ -1239,6 +1245,8 @@
|
||||||
|
return PTR_ERR(phydev);
|
||||||
|
}
|
||||||
|
|
||||||
|
+ sp->rx = phydev->netif_rx;
|
||||||
|
+
|
||||||
|
/* mask with MAC supported features */
|
||||||
|
phydev->supported &= (SUPPORTED_10baseT_Half
|
||||||
|
| SUPPORTED_10baseT_Full
|
||||||
|
Index: linux-2.6.32.7/drivers/net/ar231x.h
|
||||||
|
===================================================================
|
||||||
|
--- linux-2.6.32.7.orig/drivers/net/ar231x.h 2010-02-03 17:00:35.874430230 +0100
|
||||||
|
+++ linux-2.6.32.7/drivers/net/ar231x.h 2010-02-03 17:02:28.998430523 +0100
|
||||||
|
@@ -221,6 +221,8 @@
|
||||||
|
*/
|
||||||
|
struct ar231x_private {
|
||||||
|
struct net_device *dev;
|
||||||
|
+ int (*rx)(struct sk_buff *skb);
|
||||||
|
+
|
||||||
|
int version;
|
||||||
|
u32 mb[2];
|
||||||
|
|
||||||
@ -0,0 +1,178 @@ |
|||||||
|
Index: linux-2.6.32.7/arch/mips/ar231x/Makefile
|
||||||
|
===================================================================
|
||||||
|
--- linux-2.6.32.7.orig/arch/mips/ar231x/Makefile 2010-02-03 17:00:21.031428952 +0100
|
||||||
|
+++ linux-2.6.32.7/arch/mips/ar231x/Makefile 2010-02-03 17:02:36.795429223 +0100
|
||||||
|
@@ -8,7 +8,7 @@
|
||||||
|
# Copyright (C) 2006-2009 Felix Fietkau <nbd@openwrt.org>
|
||||||
|
#
|
||||||
|
|
||||||
|
-obj-y += board.o prom.o devices.o
|
||||||
|
+obj-y += board.o prom.o devices.o reset.o
|
||||||
|
obj-$(CONFIG_ATHEROS_AR5312) += ar5312.o
|
||||||
|
obj-$(CONFIG_ATHEROS_AR2315) += ar2315.o
|
||||||
|
obj-$(CONFIG_ATHEROS_AR2315_PCI) += pci.o
|
||||||
|
Index: linux-2.6.32.7/arch/mips/ar231x/reset.c
|
||||||
|
===================================================================
|
||||||
|
--- /dev/null 1970-01-01 00:00:00.000000000 +0000
|
||||||
|
+++ linux-2.6.32.7/arch/mips/ar231x/reset.c 2010-02-03 17:02:36.795429223 +0100
|
||||||
|
@@ -0,0 +1,160 @@
|
||||||
|
+#include <linux/init.h>
|
||||||
|
+#include <linux/module.h>
|
||||||
|
+#include <linux/timer.h>
|
||||||
|
+#include <linux/interrupt.h>
|
||||||
|
+#include <linux/kobject.h>
|
||||||
|
+#include <linux/workqueue.h>
|
||||||
|
+#include <linux/skbuff.h>
|
||||||
|
+#include <linux/netlink.h>
|
||||||
|
+#include <net/sock.h>
|
||||||
|
+#include <asm/uaccess.h>
|
||||||
|
+#include <ar231x_platform.h>
|
||||||
|
+#include <ar231x.h>
|
||||||
|
+#include <gpio.h>
|
||||||
|
+#include "devices.h"
|
||||||
|
+
|
||||||
|
+#define AR531X_RESET_GPIO_IRQ (AR531X_GPIO_IRQ(ar231x_board.config->resetConfigGpio))
|
||||||
|
+
|
||||||
|
+struct event_t {
|
||||||
|
+ struct work_struct wq;
|
||||||
|
+ int set;
|
||||||
|
+ unsigned long jiffies;
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+static struct timer_list rst_button_timer;
|
||||||
|
+static unsigned long seen;
|
||||||
|
+
|
||||||
|
+extern struct sock *uevent_sock;
|
||||||
|
+extern u64 uevent_next_seqnum(void);
|
||||||
|
+
|
||||||
|
+static int no_release_workaround = 1;
|
||||||
|
+module_param(no_release_workaround, int, 0);
|
||||||
|
+
|
||||||
|
+static inline void
|
||||||
|
+add_msg(struct sk_buff *skb, char *msg)
|
||||||
|
+{
|
||||||
|
+ char *scratch;
|
||||||
|
+ scratch = skb_put(skb, strlen(msg) + 1);
|
||||||
|
+ sprintf(scratch, msg);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static void
|
||||||
|
+hotplug_button(struct work_struct *wq)
|
||||||
|
+{
|
||||||
|
+ struct sk_buff *skb;
|
||||||
|
+ struct event_t *event;
|
||||||
|
+ size_t len;
|
||||||
|
+ char *scratch, *s;
|
||||||
|
+ char buf[128];
|
||||||
|
+
|
||||||
|
+ event = container_of(wq, struct event_t, wq);
|
||||||
|
+ if (!uevent_sock)
|
||||||
|
+ goto done;
|
||||||
|
+
|
||||||
|
+ /* allocate message with the maximum possible size */
|
||||||
|
+ s = event->set ? "pressed" : "released";
|
||||||
|
+ len = strlen(s) + 2;
|
||||||
|
+ skb = alloc_skb(NLMSG_GOODSIZE, GFP_KERNEL);
|
||||||
|
+ if (!skb)
|
||||||
|
+ goto done;
|
||||||
|
+
|
||||||
|
+ /* add header */
|
||||||
|
+ scratch = skb_put(skb, len);
|
||||||
|
+ sprintf(scratch, "%s@",s);
|
||||||
|
+
|
||||||
|
+ /* copy keys to our continuous event payload buffer */
|
||||||
|
+ add_msg(skb, "HOME=/");
|
||||||
|
+ add_msg(skb, "PATH=/sbin:/bin:/usr/sbin:/usr/bin");
|
||||||
|
+ add_msg(skb, "SUBSYSTEM=button");
|
||||||
|
+ add_msg(skb, "BUTTON=reset");
|
||||||
|
+ add_msg(skb, (event->set ? "ACTION=pressed" : "ACTION=released"));
|
||||||
|
+ sprintf(buf, "SEEN=%ld", (event->jiffies - seen)/HZ);
|
||||||
|
+ add_msg(skb, buf);
|
||||||
|
+ snprintf(buf, 128, "SEQNUM=%llu", uevent_next_seqnum());
|
||||||
|
+ add_msg(skb, buf);
|
||||||
|
+
|
||||||
|
+ NETLINK_CB(skb).dst_group = 1;
|
||||||
|
+ netlink_broadcast(uevent_sock, skb, 0, 1, GFP_KERNEL);
|
||||||
|
+
|
||||||
|
+done:
|
||||||
|
+ kfree(event);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static void
|
||||||
|
+reset_button_poll(unsigned long unused)
|
||||||
|
+{
|
||||||
|
+ struct event_t *event;
|
||||||
|
+ int gpio = ~0;
|
||||||
|
+
|
||||||
|
+ if(!no_release_workaround)
|
||||||
|
+ return;
|
||||||
|
+
|
||||||
|
+ gpio = ar231x_gpiodev->get();
|
||||||
|
+ gpio &= (1 << (AR531X_RESET_GPIO_IRQ - AR531X_GPIO_IRQ_BASE));
|
||||||
|
+ if(gpio) {
|
||||||
|
+ rst_button_timer.expires = jiffies + (HZ / 4);
|
||||||
|
+ add_timer(&rst_button_timer);
|
||||||
|
+ return;
|
||||||
|
+ }
|
||||||
|
+
|
||||||
|
+ event = (struct event_t *) kzalloc(sizeof(struct event_t), GFP_ATOMIC);
|
||||||
|
+ if (!event)
|
||||||
|
+ return;
|
||||||
|
+
|
||||||
|
+ event->set = 0;
|
||||||
|
+ event->jiffies = jiffies;
|
||||||
|
+ INIT_WORK(&event->wq, hotplug_button);
|
||||||
|
+ schedule_work(&event->wq);
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static irqreturn_t
|
||||||
|
+button_handler(int irq, void *dev_id)
|
||||||
|
+{
|
||||||
|
+ static int pressed = 0;
|
||||||
|
+ struct event_t *event;
|
||||||
|
+ u32 gpio = ~0;
|
||||||
|
+
|
||||||
|
+ event = (struct event_t *) kzalloc(sizeof(struct event_t), GFP_ATOMIC);
|
||||||
|
+ if (!event)
|
||||||
|
+ return IRQ_NONE;
|
||||||
|
+
|
||||||
|
+ pressed = !pressed;
|
||||||
|
+
|
||||||
|
+ gpio = ar231x_gpiodev->get() & (1 << (irq - AR531X_GPIO_IRQ_BASE));
|
||||||
|
+
|
||||||
|
+ event->set = gpio;
|
||||||
|
+ if(!event->set)
|
||||||
|
+ no_release_workaround = 0;
|
||||||
|
+
|
||||||
|
+ event->jiffies = jiffies;
|
||||||
|
+
|
||||||
|
+ INIT_WORK(&event->wq, hotplug_button);
|
||||||
|
+ schedule_work(&event->wq);
|
||||||
|
+
|
||||||
|
+ seen = jiffies;
|
||||||
|
+ if(event->set && no_release_workaround)
|
||||||
|
+ mod_timer(&rst_button_timer, jiffies + (HZ / 4));
|
||||||
|
+
|
||||||
|
+ return IRQ_HANDLED;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+
|
||||||
|
+static int __init
|
||||||
|
+ar231x_init_reset(void)
|
||||||
|
+{
|
||||||
|
+ seen = jiffies;
|
||||||
|
+
|
||||||
|
+ if (ar231x_board.config->resetConfigGpio == 0xffff)
|
||||||
|
+ return -ENODEV;
|
||||||
|
+
|
||||||
|
+ init_timer(&rst_button_timer);
|
||||||
|
+ rst_button_timer.function = reset_button_poll;
|
||||||
|
+ rst_button_timer.expires = jiffies + HZ / 50;
|
||||||
|
+ add_timer(&rst_button_timer);
|
||||||
|
+
|
||||||
|
+ request_irq(AR531X_RESET_GPIO_IRQ, &button_handler, IRQF_SAMPLE_RANDOM, "ar231x_reset", NULL);
|
||||||
|
+
|
||||||
|
+ return 0;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+module_init(ar231x_init_reset);
|
||||||
@ -0,0 +1,71 @@ |
|||||||
|
Index: linux-2.6.32.7/drivers/net/ar231x.c
|
||||||
|
===================================================================
|
||||||
|
--- linux-2.6.32.7.orig/drivers/net/ar231x.c 2010-02-03 17:02:28.998430523 +0100
|
||||||
|
+++ linux-2.6.32.7/drivers/net/ar231x.c 2010-02-03 17:03:01.346429245 +0100
|
||||||
|
@@ -148,6 +148,7 @@
|
||||||
|
static int ar231x_mdiobus_reset(struct mii_bus *bus);
|
||||||
|
static int ar231x_mdiobus_probe (struct net_device *dev);
|
||||||
|
static void ar231x_adjust_link(struct net_device *dev);
|
||||||
|
+static bool no_phy = false;
|
||||||
|
|
||||||
|
#ifndef ERR
|
||||||
|
#define ERR(fmt, args...) printk("%s: " fmt, __func__, ##args)
|
||||||
|
@@ -278,6 +279,21 @@
|
||||||
|
|
||||||
|
mdiobus_register(sp->mii_bus);
|
||||||
|
|
||||||
|
+ /* Workaround for Micrel switch, which is only available on
|
||||||
|
+ * one PHY and cannot be configured through MDIO */
|
||||||
|
+ if (!no_phy) {
|
||||||
|
+ u32 phy_id = 0;
|
||||||
|
+ get_phy_id(sp->mii_bus, 1, &phy_id);
|
||||||
|
+ if (phy_id == 0x00221450)
|
||||||
|
+ no_phy = true;
|
||||||
|
+ }
|
||||||
|
+ if (no_phy) {
|
||||||
|
+ sp->link = 1;
|
||||||
|
+ netif_carrier_on(dev);
|
||||||
|
+ return 0;
|
||||||
|
+ }
|
||||||
|
+ no_phy = true;
|
||||||
|
+
|
||||||
|
if (ar231x_mdiobus_probe(dev) != 0) {
|
||||||
|
printk(KERN_ERR "%s: mdiobus_probe failed\n", dev->name);
|
||||||
|
rx_tasklet_cleanup(dev);
|
||||||
|
@@ -334,8 +350,10 @@
|
||||||
|
rx_tasklet_cleanup(dev);
|
||||||
|
ar231x_init_cleanup(dev);
|
||||||
|
unregister_netdev(dev);
|
||||||
|
- mdiobus_unregister(sp->mii_bus);
|
||||||
|
- mdiobus_free(sp->mii_bus);
|
||||||
|
+ if (sp->mii_bus) {
|
||||||
|
+ mdiobus_unregister(sp->mii_bus);
|
||||||
|
+ mdiobus_free(sp->mii_bus);
|
||||||
|
+ }
|
||||||
|
kfree(dev);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
@@ -836,7 +854,12 @@
|
||||||
|
dev->stats.rx_bytes += skb->len;
|
||||||
|
|
||||||
|
/* pass the packet to upper layers */
|
||||||
|
- sp->rx(skb);
|
||||||
|
+ if (sp->rx) {
|
||||||
|
+ sp->rx(skb);
|
||||||
|
+ } else {
|
||||||
|
+ skb->protocol = eth_type_trans(skb, skb->dev);
|
||||||
|
+ netif_rx(skb);
|
||||||
|
+ }
|
||||||
|
skb_new->dev = dev;
|
||||||
|
|
||||||
|
/* 16 bit align */
|
||||||
|
@@ -1123,6 +1146,9 @@
|
||||||
|
struct ar231x_private *sp = netdev_priv(dev);
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
+ if (!sp->phy_dev)
|
||||||
|
+ return -ENODEV;
|
||||||
|
+
|
||||||
|
switch (cmd) {
|
||||||
|
|
||||||
|
case SIOCETHTOOL:
|
||||||
Loading…
Reference in new issue