|  | @@ -1,4501 +0,0 @@
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/ar7/clock.c linux-2.6.30.5/arch/mips/ar7/clock.c
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/ar7/clock.c	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/ar7/clock.c	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,483 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2007 Felix Fietkau <nbd@openwrt.org>
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2007 Eugene Konev <ejka@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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <linux/init.h>
 | 
	
		
			
				|  |  | -+#include <linux/types.h>
 | 
	
		
			
				|  |  | -+#include <linux/module.h>
 | 
	
		
			
				|  |  | -+#include <linux/delay.h>
 | 
	
		
			
				|  |  | -+#include <asm/addrspace.h>
 | 
	
		
			
				|  |  | -+#include <asm/io.h>
 | 
	
		
			
				|  |  | -+#include <asm/ar7/ar7.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define BOOT_PLL_SOURCE_MASK	0x3
 | 
	
		
			
				|  |  | -+#define CPU_PLL_SOURCE_SHIFT	16
 | 
	
		
			
				|  |  | -+#define BUS_PLL_SOURCE_SHIFT	14
 | 
	
		
			
				|  |  | -+#define USB_PLL_SOURCE_SHIFT	18
 | 
	
		
			
				|  |  | -+#define DSP_PLL_SOURCE_SHIFT	22
 | 
	
		
			
				|  |  | -+#define BOOT_PLL_SOURCE_AFE	0
 | 
	
		
			
				|  |  | -+#define BOOT_PLL_SOURCE_BUS	0
 | 
	
		
			
				|  |  | -+#define BOOT_PLL_SOURCE_REF	1
 | 
	
		
			
				|  |  | -+#define BOOT_PLL_SOURCE_XTAL	2
 | 
	
		
			
				|  |  | -+#define BOOT_PLL_SOURCE_CPU	3
 | 
	
		
			
				|  |  | -+#define BOOT_PLL_BYPASS		0x00000020
 | 
	
		
			
				|  |  | -+#define BOOT_PLL_ASYNC_MODE	0x02000000
 | 
	
		
			
				|  |  | -+#define BOOT_PLL_2TO1_MODE	0x00008000
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define TNETD7200_CLOCK_ID_CPU	0
 | 
	
		
			
				|  |  | -+#define TNETD7200_CLOCK_ID_DSP	1
 | 
	
		
			
				|  |  | -+#define TNETD7200_CLOCK_ID_USB	2
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define TNETD7200_DEF_CPU_CLK	211000000
 | 
	
		
			
				|  |  | -+#define TNETD7200_DEF_DSP_CLK	125000000
 | 
	
		
			
				|  |  | -+#define TNETD7200_DEF_USB_CLK	48000000
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct tnetd7300_clock {
 | 
	
		
			
				|  |  | -+	u32 ctrl;
 | 
	
		
			
				|  |  | -+#define PREDIV_MASK	0x001f0000
 | 
	
		
			
				|  |  | -+#define PREDIV_SHIFT	16
 | 
	
		
			
				|  |  | -+#define POSTDIV_MASK	0x0000001f
 | 
	
		
			
				|  |  | -+	u32 unused1[3];
 | 
	
		
			
				|  |  | -+	u32 pll;
 | 
	
		
			
				|  |  | -+#define MUL_MASK	0x0000f000
 | 
	
		
			
				|  |  | -+#define MUL_SHIFT	12
 | 
	
		
			
				|  |  | -+#define PLL_MODE_MASK	0x00000001
 | 
	
		
			
				|  |  | -+#define PLL_NDIV	0x00000800
 | 
	
		
			
				|  |  | -+#define PLL_DIV		0x00000002
 | 
	
		
			
				|  |  | -+#define PLL_STATUS	0x00000001
 | 
	
		
			
				|  |  | -+	u32 unused2[3];
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct tnetd7300_clocks {
 | 
	
		
			
				|  |  | -+	struct tnetd7300_clock bus;
 | 
	
		
			
				|  |  | -+	struct tnetd7300_clock cpu;
 | 
	
		
			
				|  |  | -+	struct tnetd7300_clock usb;
 | 
	
		
			
				|  |  | -+	struct tnetd7300_clock dsp;
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct tnetd7200_clock {
 | 
	
		
			
				|  |  | -+	u32 ctrl;
 | 
	
		
			
				|  |  | -+	u32 unused1[3];
 | 
	
		
			
				|  |  | -+#define DIVISOR_ENABLE_MASK 0x00008000
 | 
	
		
			
				|  |  | -+	u32 mul;
 | 
	
		
			
				|  |  | -+	u32 prediv;
 | 
	
		
			
				|  |  | -+	u32 postdiv;
 | 
	
		
			
				|  |  | -+	u32 postdiv2;
 | 
	
		
			
				|  |  | -+	u32 unused2[6];
 | 
	
		
			
				|  |  | -+	u32 cmd;
 | 
	
		
			
				|  |  | -+	u32 status;
 | 
	
		
			
				|  |  | -+	u32 cmden;
 | 
	
		
			
				|  |  | -+	u32 padding[15];
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct tnetd7200_clocks {
 | 
	
		
			
				|  |  | -+	struct tnetd7200_clock cpu;
 | 
	
		
			
				|  |  | -+	struct tnetd7200_clock dsp;
 | 
	
		
			
				|  |  | -+	struct tnetd7200_clock usb;
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+int ar7_cpu_clock = 150000000;
 | 
	
		
			
				|  |  | -+EXPORT_SYMBOL(ar7_cpu_clock);
 | 
	
		
			
				|  |  | -+int ar7_bus_clock = 125000000;
 | 
	
		
			
				|  |  | -+EXPORT_SYMBOL(ar7_bus_clock);
 | 
	
		
			
				|  |  | -+int ar7_dsp_clock;
 | 
	
		
			
				|  |  | -+EXPORT_SYMBOL(ar7_dsp_clock);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int gcd(int a, int b)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int c;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (a < b) {
 | 
	
		
			
				|  |  | -+		c = a;
 | 
	
		
			
				|  |  | -+		a = b;
 | 
	
		
			
				|  |  | -+		b = c;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	while ((c = (a % b))) {
 | 
	
		
			
				|  |  | -+		a = b;
 | 
	
		
			
				|  |  | -+		b = c;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	return b;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void approximate(int base, int target, int *prediv,
 | 
	
		
			
				|  |  | -+			int *postdiv, int *mul)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int i, j, k, freq, res = target;
 | 
	
		
			
				|  |  | -+	for (i = 1; i <= 16; i++)
 | 
	
		
			
				|  |  | -+		for (j = 1; j <= 32; j++)
 | 
	
		
			
				|  |  | -+			for (k = 1; k <= 32; k++) {
 | 
	
		
			
				|  |  | -+				freq = abs(base / j * i / k - target);
 | 
	
		
			
				|  |  | -+				if (freq < res) {
 | 
	
		
			
				|  |  | -+					res = freq;
 | 
	
		
			
				|  |  | -+					*mul = i;
 | 
	
		
			
				|  |  | -+					*prediv = j;
 | 
	
		
			
				|  |  | -+					*postdiv = k;
 | 
	
		
			
				|  |  | -+				}
 | 
	
		
			
				|  |  | -+			}
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void calculate(int base, int target, int *prediv, int *postdiv,
 | 
	
		
			
				|  |  | -+	int *mul)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int tmp_gcd, tmp_base, tmp_freq;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	for (*prediv = 1; *prediv <= 32; (*prediv)++) {
 | 
	
		
			
				|  |  | -+		tmp_base = base / *prediv;
 | 
	
		
			
				|  |  | -+		tmp_gcd = gcd(target, tmp_base);
 | 
	
		
			
				|  |  | -+		*mul = target / tmp_gcd;
 | 
	
		
			
				|  |  | -+		*postdiv = tmp_base / tmp_gcd;
 | 
	
		
			
				|  |  | -+		if ((*mul < 1) || (*mul >= 16))
 | 
	
		
			
				|  |  | -+			continue;
 | 
	
		
			
				|  |  | -+		if ((*postdiv > 0) & (*postdiv <= 32))
 | 
	
		
			
				|  |  | -+			break;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (base / (*prediv) * (*mul) / (*postdiv) != target) {
 | 
	
		
			
				|  |  | -+		approximate(base, target, prediv, postdiv, mul);
 | 
	
		
			
				|  |  | -+		tmp_freq = base / (*prediv) * (*mul) / (*postdiv);
 | 
	
		
			
				|  |  | -+		printk(KERN_WARNING
 | 
	
		
			
				|  |  | -+		       "Adjusted requested frequency %d to %d\n",
 | 
	
		
			
				|  |  | -+		       target, tmp_freq);
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	printk(KERN_DEBUG "Clocks: prediv: %d, postdiv: %d, mul: %d\n",
 | 
	
		
			
				|  |  | -+	       *prediv, *postdiv, *mul);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int tnetd7300_dsp_clock(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	u32 didr1, didr2;
 | 
	
		
			
				|  |  | -+	u8 rev = ar7_chip_rev();
 | 
	
		
			
				|  |  | -+	didr1 = readl((void *)KSEG1ADDR(AR7_REGS_GPIO + 0x18));
 | 
	
		
			
				|  |  | -+	didr2 = readl((void *)KSEG1ADDR(AR7_REGS_GPIO + 0x1c));
 | 
	
		
			
				|  |  | -+	if (didr2 & (1 << 23))
 | 
	
		
			
				|  |  | -+		return 0;
 | 
	
		
			
				|  |  | -+	if ((rev >= 0x23) && (rev != 0x57))
 | 
	
		
			
				|  |  | -+		return 250000000;
 | 
	
		
			
				|  |  | -+	if ((((didr2 & 0x1fff) << 10) | ((didr1 & 0xffc00000) >> 22))
 | 
	
		
			
				|  |  | -+	    > 4208000)
 | 
	
		
			
				|  |  | -+		return 250000000;
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int tnetd7300_get_clock(u32 shift, struct tnetd7300_clock *clock,
 | 
	
		
			
				|  |  | -+	u32 *bootcr, u32 bus_clock)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int product;
 | 
	
		
			
				|  |  | -+	int base_clock = AR7_REF_CLOCK;
 | 
	
		
			
				|  |  | -+	u32 ctrl = readl(&clock->ctrl);
 | 
	
		
			
				|  |  | -+	u32 pll = readl(&clock->pll);
 | 
	
		
			
				|  |  | -+	int prediv = ((ctrl & PREDIV_MASK) >> PREDIV_SHIFT) + 1;
 | 
	
		
			
				|  |  | -+	int postdiv = (ctrl & POSTDIV_MASK) + 1;
 | 
	
		
			
				|  |  | -+	int divisor = prediv * postdiv;
 | 
	
		
			
				|  |  | -+	int mul = ((pll & MUL_MASK) >> MUL_SHIFT) + 1;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	switch ((*bootcr & (BOOT_PLL_SOURCE_MASK << shift)) >> shift) {
 | 
	
		
			
				|  |  | -+	case BOOT_PLL_SOURCE_BUS:
 | 
	
		
			
				|  |  | -+		base_clock = bus_clock;
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	case BOOT_PLL_SOURCE_REF:
 | 
	
		
			
				|  |  | -+		base_clock = AR7_REF_CLOCK;
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	case BOOT_PLL_SOURCE_XTAL:
 | 
	
		
			
				|  |  | -+		base_clock = AR7_XTAL_CLOCK;
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	case BOOT_PLL_SOURCE_CPU:
 | 
	
		
			
				|  |  | -+		base_clock = ar7_cpu_clock;
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (*bootcr & BOOT_PLL_BYPASS)
 | 
	
		
			
				|  |  | -+		return base_clock / divisor;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if ((pll & PLL_MODE_MASK) == 0)
 | 
	
		
			
				|  |  | -+		return (base_clock >> (mul / 16 + 1)) / divisor;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if ((pll & (PLL_NDIV | PLL_DIV)) == (PLL_NDIV | PLL_DIV)) {
 | 
	
		
			
				|  |  | -+		product = (mul & 1) ?
 | 
	
		
			
				|  |  | -+			(base_clock * mul) >> 1 :
 | 
	
		
			
				|  |  | -+			(base_clock * (mul - 1)) >> 2;
 | 
	
		
			
				|  |  | -+		return product / divisor;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (mul == 16)
 | 
	
		
			
				|  |  | -+		return base_clock / divisor;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return base_clock * mul / divisor;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void tnetd7300_set_clock(u32 shift, struct tnetd7300_clock *clock,
 | 
	
		
			
				|  |  | -+	u32 *bootcr, u32 frequency)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int prediv, postdiv, mul;
 | 
	
		
			
				|  |  | -+	int base_clock = ar7_bus_clock;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	switch ((*bootcr & (BOOT_PLL_SOURCE_MASK << shift)) >> shift) {
 | 
	
		
			
				|  |  | -+	case BOOT_PLL_SOURCE_BUS:
 | 
	
		
			
				|  |  | -+		base_clock = ar7_bus_clock;
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	case BOOT_PLL_SOURCE_REF:
 | 
	
		
			
				|  |  | -+		base_clock = AR7_REF_CLOCK;
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	case BOOT_PLL_SOURCE_XTAL:
 | 
	
		
			
				|  |  | -+		base_clock = AR7_XTAL_CLOCK;
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	case BOOT_PLL_SOURCE_CPU:
 | 
	
		
			
				|  |  | -+		base_clock = ar7_cpu_clock;
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	calculate(base_clock, frequency, &prediv, &postdiv, &mul);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel(((prediv - 1) << PREDIV_SHIFT) | (postdiv - 1), &clock->ctrl);
 | 
	
		
			
				|  |  | -+	mdelay(1);
 | 
	
		
			
				|  |  | -+	writel(4, &clock->pll);
 | 
	
		
			
				|  |  | -+	while (readl(&clock->pll) & PLL_STATUS);
 | 
	
		
			
				|  |  | -+	writel(((mul - 1) << MUL_SHIFT) | (0xff << 3) | 0x0e, &clock->pll);
 | 
	
		
			
				|  |  | -+	mdelay(75);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void __init tnetd7300_init_clocks(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	u32 *bootcr = (u32 *)ioremap_nocache(AR7_REGS_DCL, 4);
 | 
	
		
			
				|  |  | -+	struct tnetd7300_clocks *clocks =
 | 
	
		
			
				|  |  | -+					(struct tnetd7300_clocks *)
 | 
	
		
			
				|  |  | -+					ioremap_nocache(AR7_REGS_POWER + 0x20,
 | 
	
		
			
				|  |  | -+					sizeof(struct tnetd7300_clocks));
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	ar7_bus_clock = tnetd7300_get_clock(BUS_PLL_SOURCE_SHIFT,
 | 
	
		
			
				|  |  | -+		&clocks->bus, bootcr, AR7_AFE_CLOCK);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (*bootcr & BOOT_PLL_ASYNC_MODE)
 | 
	
		
			
				|  |  | -+		ar7_cpu_clock = tnetd7300_get_clock(CPU_PLL_SOURCE_SHIFT,
 | 
	
		
			
				|  |  | -+			&clocks->cpu, bootcr, AR7_AFE_CLOCK);
 | 
	
		
			
				|  |  | -+	else
 | 
	
		
			
				|  |  | -+		ar7_cpu_clock = ar7_bus_clock;
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+	tnetd7300_set_clock(USB_PLL_SOURCE_SHIFT, &clocks->usb,
 | 
	
		
			
				|  |  | -+		bootcr, 48000000);
 | 
	
		
			
				|  |  | -+*/
 | 
	
		
			
				|  |  | -+	if (ar7_dsp_clock == 250000000)
 | 
	
		
			
				|  |  | -+		tnetd7300_set_clock(DSP_PLL_SOURCE_SHIFT, &clocks->dsp,
 | 
	
		
			
				|  |  | -+			bootcr, ar7_dsp_clock);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	iounmap(clocks);
 | 
	
		
			
				|  |  | -+	iounmap(bootcr);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int tnetd7200_get_clock(int base, struct tnetd7200_clock *clock,
 | 
	
		
			
				|  |  | -+	u32 *bootcr, u32 bus_clock)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int divisor = ((readl(&clock->prediv) & 0x1f) + 1) *
 | 
	
		
			
				|  |  | -+		((readl(&clock->postdiv) & 0x1f) + 1);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (*bootcr & BOOT_PLL_BYPASS)
 | 
	
		
			
				|  |  | -+		return base / divisor;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return base * ((readl(&clock->mul) & 0xf) + 1) / divisor;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void tnetd7200_set_clock(int base, struct tnetd7200_clock *clock,
 | 
	
		
			
				|  |  | -+	int prediv, int postdiv, int postdiv2, int mul, u32 frequency)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	printk(KERN_INFO
 | 
	
		
			
				|  |  | -+		"Clocks: base = %d, frequency = %u, prediv = %d, "
 | 
	
		
			
				|  |  | -+		"postdiv = %d, postdiv2 = %d, mul = %d\n",
 | 
	
		
			
				|  |  | -+		base, frequency, prediv, postdiv, postdiv2, mul);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel(0, &clock->ctrl);
 | 
	
		
			
				|  |  | -+	writel(DIVISOR_ENABLE_MASK | ((prediv - 1) & 0x1F), &clock->prediv);
 | 
	
		
			
				|  |  | -+	writel((mul - 1) & 0xF, &clock->mul);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	for (mul = 0; mul < 2000; mul++) /* nop */;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	while (readl(&clock->status) & 0x1) /* nop */;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel(DIVISOR_ENABLE_MASK | ((postdiv - 1) & 0x1F), &clock->postdiv);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel(readl(&clock->cmden) | 1, &clock->cmden);
 | 
	
		
			
				|  |  | -+	writel(readl(&clock->cmd) | 1, &clock->cmd);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	while (readl(&clock->status) & 0x1) /* nop */;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel(DIVISOR_ENABLE_MASK | ((postdiv2 - 1) & 0x1F), &clock->postdiv2);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel(readl(&clock->cmden) | 1, &clock->cmden);
 | 
	
		
			
				|  |  | -+	writel(readl(&clock->cmd) | 1, &clock->cmd);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	while (readl(&clock->status) & 0x1) /* nop */;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel(readl(&clock->ctrl) | 1, &clock->ctrl);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int tnetd7200_get_clock_base(int clock_id, u32 *bootcr)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	if (*bootcr & BOOT_PLL_ASYNC_MODE)
 | 
	
		
			
				|  |  | -+		/* Async */
 | 
	
		
			
				|  |  | -+		switch (clock_id) {
 | 
	
		
			
				|  |  | -+		case TNETD7200_CLOCK_ID_DSP:
 | 
	
		
			
				|  |  | -+			return AR7_REF_CLOCK;
 | 
	
		
			
				|  |  | -+		default:
 | 
	
		
			
				|  |  | -+			return AR7_AFE_CLOCK;
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+	else
 | 
	
		
			
				|  |  | -+		/* Sync */
 | 
	
		
			
				|  |  | -+		if (*bootcr & BOOT_PLL_2TO1_MODE)
 | 
	
		
			
				|  |  | -+			/* 2:1 */
 | 
	
		
			
				|  |  | -+			switch (clock_id) {
 | 
	
		
			
				|  |  | -+			case TNETD7200_CLOCK_ID_DSP:
 | 
	
		
			
				|  |  | -+				return AR7_REF_CLOCK;
 | 
	
		
			
				|  |  | -+			default:
 | 
	
		
			
				|  |  | -+				return AR7_AFE_CLOCK;
 | 
	
		
			
				|  |  | -+			}
 | 
	
		
			
				|  |  | -+		else
 | 
	
		
			
				|  |  | -+			/* 1:1 */
 | 
	
		
			
				|  |  | -+			return AR7_REF_CLOCK;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void __init tnetd7200_init_clocks(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	u32 *bootcr = (u32 *)ioremap_nocache(AR7_REGS_DCL, 4);
 | 
	
		
			
				|  |  | -+	struct tnetd7200_clocks *clocks =
 | 
	
		
			
				|  |  | -+					(struct tnetd7200_clocks *)
 | 
	
		
			
				|  |  | -+					ioremap_nocache(AR7_REGS_POWER + 0x80,
 | 
	
		
			
				|  |  | -+					sizeof(struct tnetd7200_clocks));
 | 
	
		
			
				|  |  | -+	int cpu_base, cpu_mul, cpu_prediv, cpu_postdiv;
 | 
	
		
			
				|  |  | -+	int dsp_base, dsp_mul, dsp_prediv, dsp_postdiv;
 | 
	
		
			
				|  |  | -+	int usb_base, usb_mul, usb_prediv, usb_postdiv;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+	Log from Fritz!Box 7170 Annex B:
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	CPU revision is: 00018448
 | 
	
		
			
				|  |  | -+	Clocks: Async mode
 | 
	
		
			
				|  |  | -+	Clocks: Setting DSP clock
 | 
	
		
			
				|  |  | -+	Clocks: prediv: 1, postdiv: 1, mul: 5
 | 
	
		
			
				|  |  | -+	Clocks: base = 25000000, frequency = 125000000, prediv = 1,
 | 
	
		
			
				|  |  | -+			postdiv = 2, postdiv2 = 1, mul = 10
 | 
	
		
			
				|  |  | -+	Clocks: Setting CPU clock
 | 
	
		
			
				|  |  | -+	Adjusted requested frequency 211000000 to 211968000
 | 
	
		
			
				|  |  | -+	Clocks: prediv: 1, postdiv: 1, mul: 6
 | 
	
		
			
				|  |  | -+	Clocks: base = 35328000, frequency = 211968000, prediv = 1,
 | 
	
		
			
				|  |  | -+			postdiv = 1, postdiv2 = -1, mul = 6
 | 
	
		
			
				|  |  | -+	Clocks: Setting USB clock
 | 
	
		
			
				|  |  | -+	Adjusted requested frequency 48000000 to 48076920
 | 
	
		
			
				|  |  | -+	Clocks: prediv: 13, postdiv: 1, mul: 5
 | 
	
		
			
				|  |  | -+	Clocks: base = 125000000, frequency = 48000000, prediv = 13,
 | 
	
		
			
				|  |  | -+			postdiv = 1, postdiv2 = -1, mul = 5
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	DSL didn't work if you didn't set the postdiv 2:1 postdiv2 combination,
 | 
	
		
			
				|  |  | -+	driver hung on startup.
 | 
	
		
			
				|  |  | -+	Haven't tested this on a synchronous board,
 | 
	
		
			
				|  |  | -+	neither do i know what to do with ar7_dsp_clock
 | 
	
		
			
				|  |  | -+*/
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	cpu_base = tnetd7200_get_clock_base(TNETD7200_CLOCK_ID_CPU, bootcr);
 | 
	
		
			
				|  |  | -+	dsp_base = tnetd7200_get_clock_base(TNETD7200_CLOCK_ID_DSP, bootcr);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (*bootcr & BOOT_PLL_ASYNC_MODE) {
 | 
	
		
			
				|  |  | -+		printk(KERN_INFO "Clocks: Async mode\n");
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+		printk(KERN_INFO "Clocks: Setting DSP clock\n");
 | 
	
		
			
				|  |  | -+		calculate(dsp_base, TNETD7200_DEF_DSP_CLK,
 | 
	
		
			
				|  |  | -+			&dsp_prediv, &dsp_postdiv, &dsp_mul);
 | 
	
		
			
				|  |  | -+		ar7_bus_clock =
 | 
	
		
			
				|  |  | -+			((dsp_base / dsp_prediv) * dsp_mul) / dsp_postdiv;
 | 
	
		
			
				|  |  | -+		tnetd7200_set_clock(dsp_base, &clocks->dsp,
 | 
	
		
			
				|  |  | -+			dsp_prediv, dsp_postdiv * 2, dsp_postdiv, dsp_mul * 2,
 | 
	
		
			
				|  |  | -+			ar7_bus_clock);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+		printk(KERN_INFO "Clocks: Setting CPU clock\n");
 | 
	
		
			
				|  |  | -+		calculate(cpu_base, TNETD7200_DEF_CPU_CLK, &cpu_prediv,
 | 
	
		
			
				|  |  | -+			&cpu_postdiv, &cpu_mul);
 | 
	
		
			
				|  |  | -+		ar7_cpu_clock =
 | 
	
		
			
				|  |  | -+			((cpu_base / cpu_prediv) * cpu_mul) / cpu_postdiv;
 | 
	
		
			
				|  |  | -+		tnetd7200_set_clock(cpu_base, &clocks->cpu,
 | 
	
		
			
				|  |  | -+			cpu_prediv, cpu_postdiv, -1, cpu_mul,
 | 
	
		
			
				|  |  | -+			ar7_cpu_clock);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	} else
 | 
	
		
			
				|  |  | -+		if (*bootcr & BOOT_PLL_2TO1_MODE) {
 | 
	
		
			
				|  |  | -+			printk(KERN_INFO "Clocks: Sync 2:1 mode\n");
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+			printk(KERN_INFO "Clocks: Setting CPU clock\n");
 | 
	
		
			
				|  |  | -+			calculate(cpu_base, TNETD7200_DEF_CPU_CLK, &cpu_prediv,
 | 
	
		
			
				|  |  | -+				&cpu_postdiv, &cpu_mul);
 | 
	
		
			
				|  |  | -+			ar7_cpu_clock = ((cpu_base / cpu_prediv) * cpu_mul)
 | 
	
		
			
				|  |  | -+								/ cpu_postdiv;
 | 
	
		
			
				|  |  | -+			tnetd7200_set_clock(cpu_base, &clocks->cpu,
 | 
	
		
			
				|  |  | -+				cpu_prediv, cpu_postdiv, -1, cpu_mul,
 | 
	
		
			
				|  |  | -+				ar7_cpu_clock);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+			printk(KERN_INFO "Clocks: Setting DSP clock\n");
 | 
	
		
			
				|  |  | -+			calculate(dsp_base, TNETD7200_DEF_DSP_CLK, &dsp_prediv,
 | 
	
		
			
				|  |  | -+				&dsp_postdiv, &dsp_mul);
 | 
	
		
			
				|  |  | -+			ar7_bus_clock = ar7_cpu_clock / 2;
 | 
	
		
			
				|  |  | -+			tnetd7200_set_clock(dsp_base, &clocks->dsp,
 | 
	
		
			
				|  |  | -+				dsp_prediv, dsp_postdiv * 2, dsp_postdiv,
 | 
	
		
			
				|  |  | -+				dsp_mul * 2, ar7_bus_clock);
 | 
	
		
			
				|  |  | -+		} else {
 | 
	
		
			
				|  |  | -+			printk(KERN_INFO "Clocks: Sync 1:1 mode\n");
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+			printk(KERN_INFO "Clocks: Setting DSP clock\n");
 | 
	
		
			
				|  |  | -+			calculate(dsp_base, TNETD7200_DEF_DSP_CLK, &dsp_prediv,
 | 
	
		
			
				|  |  | -+				&dsp_postdiv, &dsp_mul);
 | 
	
		
			
				|  |  | -+			ar7_bus_clock = ((dsp_base / dsp_prediv) * dsp_mul)
 | 
	
		
			
				|  |  | -+								/ dsp_postdiv;
 | 
	
		
			
				|  |  | -+			tnetd7200_set_clock(dsp_base, &clocks->dsp,
 | 
	
		
			
				|  |  | -+				dsp_prediv, dsp_postdiv * 2, dsp_postdiv,
 | 
	
		
			
				|  |  | -+				dsp_mul * 2, ar7_bus_clock);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+			ar7_cpu_clock = ar7_bus_clock;
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	printk(KERN_INFO "Clocks: Setting USB clock\n");
 | 
	
		
			
				|  |  | -+	usb_base = ar7_bus_clock;
 | 
	
		
			
				|  |  | -+	calculate(usb_base, TNETD7200_DEF_USB_CLK, &usb_prediv,
 | 
	
		
			
				|  |  | -+		&usb_postdiv, &usb_mul);
 | 
	
		
			
				|  |  | -+	tnetd7200_set_clock(usb_base, &clocks->usb,
 | 
	
		
			
				|  |  | -+		usb_prediv, usb_postdiv, -1, usb_mul,
 | 
	
		
			
				|  |  | -+		TNETD7200_DEF_USB_CLK);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	#warning FIXME
 | 
	
		
			
				|  |  | -+	ar7_dsp_clock = ar7_cpu_clock;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	iounmap(clocks);
 | 
	
		
			
				|  |  | -+	iounmap(bootcr);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+void __init ar7_init_clocks(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	switch (ar7_chip_id()) {
 | 
	
		
			
				|  |  | -+	case AR7_CHIP_7100:
 | 
	
		
			
				|  |  | -+#warning FIXME: Check if the new 7200 clock init works for 7100
 | 
	
		
			
				|  |  | -+		tnetd7200_init_clocks();
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	case AR7_CHIP_7200:
 | 
	
		
			
				|  |  | -+		tnetd7200_init_clocks();
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	case AR7_CHIP_7300:
 | 
	
		
			
				|  |  | -+		ar7_dsp_clock = tnetd7300_dsp_clock();
 | 
	
		
			
				|  |  | -+		tnetd7300_init_clocks();
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	default:
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/ar7/gpio.c linux-2.6.30.5/arch/mips/ar7/gpio.c
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/ar7/gpio.c	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/ar7/gpio.c	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,49 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2007 Felix Fietkau <nbd@openwrt.org>
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2007 Eugene Konev <ejka@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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <linux/module.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <asm/ar7/gpio.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static const char *ar7_gpio_list[AR7_GPIO_MAX];
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+int gpio_request(unsigned gpio, const char *label)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	if (gpio >= AR7_GPIO_MAX)
 | 
	
		
			
				|  |  | -+		return -EINVAL;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (ar7_gpio_list[gpio])
 | 
	
		
			
				|  |  | -+		return -EBUSY;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (label) {
 | 
	
		
			
				|  |  | -+		ar7_gpio_list[gpio] = label;
 | 
	
		
			
				|  |  | -+	} else {
 | 
	
		
			
				|  |  | -+		ar7_gpio_list[gpio] = "busy";
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+EXPORT_SYMBOL(gpio_request);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+void gpio_free(unsigned gpio)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	BUG_ON(!ar7_gpio_list[gpio]);
 | 
	
		
			
				|  |  | -+	ar7_gpio_list[gpio] = NULL;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+EXPORT_SYMBOL(gpio_free);
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/ar7/irq.c linux-2.6.30.5/arch/mips/ar7/irq.c
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/ar7/irq.c	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/ar7/irq.c	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,183 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2006,2007 Felix Fietkau <nbd@openwrt.org>
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2006,2007 Eugene Konev <ejka@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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <linux/interrupt.h>
 | 
	
		
			
				|  |  | -+#include <linux/io.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <asm/irq_cpu.h>
 | 
	
		
			
				|  |  | -+#include <asm/mipsregs.h>
 | 
	
		
			
				|  |  | -+#include <asm/ar7/ar7.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define EXCEPT_OFFSET	0x80
 | 
	
		
			
				|  |  | -+#define PACE_OFFSET	0xA0
 | 
	
		
			
				|  |  | -+#define CHNLS_OFFSET	0x200
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define REG_OFFSET(irq, reg)	((irq) / 32 * 0x4 + reg * 0x10)
 | 
	
		
			
				|  |  | -+#define SEC_REG_OFFSET(reg)	(EXCEPT_OFFSET + reg * 0x8)
 | 
	
		
			
				|  |  | -+#define SEC_SR_OFFSET		(SEC_REG_OFFSET(0))	/* 0x80 */
 | 
	
		
			
				|  |  | -+#define CR_OFFSET(irq)		(REG_OFFSET(irq, 1))	/* 0x10 */
 | 
	
		
			
				|  |  | -+#define SEC_CR_OFFSET		(SEC_REG_OFFSET(1))	/* 0x88 */
 | 
	
		
			
				|  |  | -+#define ESR_OFFSET(irq)		(REG_OFFSET(irq, 2))	/* 0x20 */
 | 
	
		
			
				|  |  | -+#define SEC_ESR_OFFSET		(SEC_REG_OFFSET(2))	/* 0x90 */
 | 
	
		
			
				|  |  | -+#define ECR_OFFSET(irq)		(REG_OFFSET(irq, 3))	/* 0x30 */
 | 
	
		
			
				|  |  | -+#define SEC_ECR_OFFSET		(SEC_REG_OFFSET(3))	/* 0x98 */
 | 
	
		
			
				|  |  | -+#define PIR_OFFSET		(0x40)
 | 
	
		
			
				|  |  | -+#define MSR_OFFSET		(0x44)
 | 
	
		
			
				|  |  | -+#define PM_OFFSET(irq)		(REG_OFFSET(irq, 5))	/* 0x50 */
 | 
	
		
			
				|  |  | -+#define TM_OFFSET(irq)		(REG_OFFSET(irq, 6))	/* 0x60 */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define REG(addr) ((u32 *)(KSEG1ADDR(AR7_REGS_IRQ) + addr))
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define CHNL_OFFSET(chnl) (CHNLS_OFFSET + (chnl * 4))
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_unmask_irq(unsigned int irq_nr);
 | 
	
		
			
				|  |  | -+static void ar7_mask_irq(unsigned int irq_nr);
 | 
	
		
			
				|  |  | -+static void ar7_ack_irq(unsigned int irq_nr);
 | 
	
		
			
				|  |  | -+static void ar7_unmask_sec_irq(unsigned int irq_nr);
 | 
	
		
			
				|  |  | -+static void ar7_mask_sec_irq(unsigned int irq_nr);
 | 
	
		
			
				|  |  | -+static void ar7_ack_sec_irq(unsigned int irq_nr);
 | 
	
		
			
				|  |  | -+static void ar7_cascade(void);
 | 
	
		
			
				|  |  | -+static void ar7_irq_init(int base);
 | 
	
		
			
				|  |  | -+static int ar7_irq_base;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct irq_chip ar7_irq_type = {
 | 
	
		
			
				|  |  | -+	.name = "AR7",
 | 
	
		
			
				|  |  | -+	.unmask = ar7_unmask_irq,
 | 
	
		
			
				|  |  | -+	.mask = ar7_mask_irq,
 | 
	
		
			
				|  |  | -+	.ack = ar7_ack_irq
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct irq_chip ar7_sec_irq_type = {
 | 
	
		
			
				|  |  | -+	.name = "AR7",
 | 
	
		
			
				|  |  | -+	.unmask = ar7_unmask_sec_irq,
 | 
	
		
			
				|  |  | -+	.mask = ar7_mask_sec_irq,
 | 
	
		
			
				|  |  | -+	.ack = ar7_ack_sec_irq,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct irqaction ar7_cascade_action = {
 | 
	
		
			
				|  |  | -+	.handler = no_action,
 | 
	
		
			
				|  |  | -+	.name = "AR7 cascade interrupt"
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_unmask_irq(unsigned int irq)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	writel(1 << ((irq - ar7_irq_base) % 32),
 | 
	
		
			
				|  |  | -+	       REG(ESR_OFFSET(irq - ar7_irq_base)));
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_mask_irq(unsigned int irq)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	writel(1 << ((irq - ar7_irq_base) % 32),
 | 
	
		
			
				|  |  | -+	       REG(ECR_OFFSET(irq - ar7_irq_base)));
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_ack_irq(unsigned int irq)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	writel(1 << ((irq - ar7_irq_base) % 32),
 | 
	
		
			
				|  |  | -+	       REG(CR_OFFSET(irq - ar7_irq_base)));
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_unmask_sec_irq(unsigned int irq)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	writel(1 << (irq - ar7_irq_base - 40), REG(SEC_ESR_OFFSET));
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_mask_sec_irq(unsigned int irq)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	writel(1 << (irq - ar7_irq_base - 40), REG(SEC_ECR_OFFSET));
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_ack_sec_irq(unsigned int irq)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	writel(1 << (irq - ar7_irq_base - 40), REG(SEC_CR_OFFSET));
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+void __init arch_init_irq(void) {
 | 
	
		
			
				|  |  | -+	mips_cpu_irq_init();
 | 
	
		
			
				|  |  | -+	ar7_irq_init(8);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void __init ar7_irq_init(int base)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int i;
 | 
	
		
			
				|  |  | -+	/*
 | 
	
		
			
				|  |  | -+	 * Disable interrupts and clear pending
 | 
	
		
			
				|  |  | -+	 */
 | 
	
		
			
				|  |  | -+	writel(0xffffffff, REG(ECR_OFFSET(0)));
 | 
	
		
			
				|  |  | -+	writel(0xff, REG(ECR_OFFSET(32)));
 | 
	
		
			
				|  |  | -+	writel(0xffffffff, REG(SEC_ECR_OFFSET));
 | 
	
		
			
				|  |  | -+	writel(0xffffffff, REG(CR_OFFSET(0)));
 | 
	
		
			
				|  |  | -+	writel(0xff, REG(CR_OFFSET(32)));
 | 
	
		
			
				|  |  | -+	writel(0xffffffff, REG(SEC_CR_OFFSET));
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	ar7_irq_base = base;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	for (i = 0; i < 40; i++) {
 | 
	
		
			
				|  |  | -+		writel(i, REG(CHNL_OFFSET(i)));
 | 
	
		
			
				|  |  | -+		/* Primary IRQ's */
 | 
	
		
			
				|  |  | -+		set_irq_chip_and_handler(base + i, &ar7_irq_type,
 | 
	
		
			
				|  |  | -+					 handle_level_irq);
 | 
	
		
			
				|  |  | -+		/* Secondary IRQ's */
 | 
	
		
			
				|  |  | -+		if (i < 32)
 | 
	
		
			
				|  |  | -+			set_irq_chip_and_handler(base + i + 40,
 | 
	
		
			
				|  |  | -+						 &ar7_sec_irq_type,
 | 
	
		
			
				|  |  | -+						 handle_level_irq);
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	setup_irq(2, &ar7_cascade_action);
 | 
	
		
			
				|  |  | -+	setup_irq(ar7_irq_base, &ar7_cascade_action);
 | 
	
		
			
				|  |  | -+	set_c0_status(IE_IRQ0);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_cascade(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	u32 status;
 | 
	
		
			
				|  |  | -+	int i, irq;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	/* Primary IRQ's */
 | 
	
		
			
				|  |  | -+	irq = readl(REG(PIR_OFFSET)) & 0x3f;
 | 
	
		
			
				|  |  | -+	if (irq) {
 | 
	
		
			
				|  |  | -+		do_IRQ(ar7_irq_base + irq);
 | 
	
		
			
				|  |  | -+		return;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	/* Secondary IRQ's are cascaded through primary '0' */
 | 
	
		
			
				|  |  | -+	writel(1, REG(CR_OFFSET(irq)));
 | 
	
		
			
				|  |  | -+	status = readl(REG(SEC_SR_OFFSET));
 | 
	
		
			
				|  |  | -+	for (i = 0; i < 32; i++) {
 | 
	
		
			
				|  |  | -+		if (status & 1) {
 | 
	
		
			
				|  |  | -+			do_IRQ(ar7_irq_base + i + 40);
 | 
	
		
			
				|  |  | -+			return;
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+		status >>= 1;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	spurious_interrupt();
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+asmlinkage void plat_irq_dispatch(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	unsigned int pending = read_c0_status() & read_c0_cause() & ST0_IM;
 | 
	
		
			
				|  |  | -+	if (pending & STATUSF_IP7)		/* cpu timer */
 | 
	
		
			
				|  |  | -+		do_IRQ(7);
 | 
	
		
			
				|  |  | -+	else if (pending & STATUSF_IP2)		/* int0 hardware line */
 | 
	
		
			
				|  |  | -+		ar7_cascade();
 | 
	
		
			
				|  |  | -+	else
 | 
	
		
			
				|  |  | -+		spurious_interrupt();
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/ar7/Makefile linux-2.6.30.5/arch/mips/ar7/Makefile
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/ar7/Makefile	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/ar7/Makefile	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,10 @@
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+obj-y := \
 | 
	
		
			
				|  |  | -+	prom.o \
 | 
	
		
			
				|  |  | -+	setup.o \
 | 
	
		
			
				|  |  | -+	memory.o \
 | 
	
		
			
				|  |  | -+	irq.o \
 | 
	
		
			
				|  |  | -+	time.o \
 | 
	
		
			
				|  |  | -+	platform.o \
 | 
	
		
			
				|  |  | -+	gpio.o \
 | 
	
		
			
				|  |  | -+	clock.o
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/ar7/memory.c linux-2.6.30.5/arch/mips/ar7/memory.c
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/ar7/memory.c	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/ar7/memory.c	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,74 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Based on arch/mips/mm/init.c
 | 
	
		
			
				|  |  | -+ * Copyright (C) 1994 - 2000 Ralf Baechle
 | 
	
		
			
				|  |  | -+ * Copyright (C) 1999, 2000 Silicon Graphics, Inc.
 | 
	
		
			
				|  |  | -+ * Kevin D. Kissell, kevink@mips.com and Carsten Langgaard, carstenl@mips.com
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2000 MIPS Technologies, Inc.  All rights reserved.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+#include <linux/bootmem.h>
 | 
	
		
			
				|  |  | -+#include <linux/init.h>
 | 
	
		
			
				|  |  | -+#include <linux/mm.h>
 | 
	
		
			
				|  |  | -+#include <linux/module.h>
 | 
	
		
			
				|  |  | -+#include <linux/pfn.h>
 | 
	
		
			
				|  |  | -+#include <linux/proc_fs.h>
 | 
	
		
			
				|  |  | -+#include <linux/string.h>
 | 
	
		
			
				|  |  | -+#include <linux/swap.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <asm/bootinfo.h>
 | 
	
		
			
				|  |  | -+#include <asm/page.h>
 | 
	
		
			
				|  |  | -+#include <asm/sections.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <asm/mips-boards/prom.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int __init memsize(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	u32 size = (64 << 20);
 | 
	
		
			
				|  |  | -+	u32 *addr = (u32 *)KSEG1ADDR(0x14000000 + size - 4);
 | 
	
		
			
				|  |  | -+	u32 *kernel_end = (u32 *)KSEG1ADDR(CPHYSADDR((u32)&_end));
 | 
	
		
			
				|  |  | -+	u32 *tmpaddr = addr;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	while (tmpaddr > kernel_end) {
 | 
	
		
			
				|  |  | -+		*tmpaddr = (u32)tmpaddr;
 | 
	
		
			
				|  |  | -+		size >>= 1;
 | 
	
		
			
				|  |  | -+		tmpaddr -= size >> 2;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	do {
 | 
	
		
			
				|  |  | -+		tmpaddr += size >> 2;
 | 
	
		
			
				|  |  | -+		if (*tmpaddr != (u32)tmpaddr)
 | 
	
		
			
				|  |  | -+			break;
 | 
	
		
			
				|  |  | -+		size <<= 1;
 | 
	
		
			
				|  |  | -+	} while (size < (64 << 20));
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel(tmpaddr, &addr);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return size;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+void __init prom_meminit(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	unsigned long pages;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	pages = memsize() >> PAGE_SHIFT;
 | 
	
		
			
				|  |  | -+	add_memory_region(PHYS_OFFSET, pages << PAGE_SHIFT,
 | 
	
		
			
				|  |  | -+			  BOOT_MEM_RAM);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+void __init prom_free_prom_memory(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/ar7/platform.c linux-2.6.30.5/arch/mips/ar7/platform.c
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/ar7/platform.c	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/ar7/platform.c	2009-08-26 20:06:50.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,550 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2006,2007 Felix Fietkau <nbd@openwrt.org>
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2006,2007 Eugene Konev <ejka@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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <linux/autoconf.h>
 | 
	
		
			
				|  |  | -+#include <linux/init.h>
 | 
	
		
			
				|  |  | -+#include <linux/types.h>
 | 
	
		
			
				|  |  | -+#include <linux/module.h>
 | 
	
		
			
				|  |  | -+#include <linux/delay.h>
 | 
	
		
			
				|  |  | -+#include <linux/dma-mapping.h>
 | 
	
		
			
				|  |  | -+#include <linux/platform_device.h>
 | 
	
		
			
				|  |  | -+#include <linux/mtd/physmap.h>
 | 
	
		
			
				|  |  | -+#include <linux/serial.h>
 | 
	
		
			
				|  |  | -+#include <linux/serial_8250.h>
 | 
	
		
			
				|  |  | -+#include <linux/ioport.h>
 | 
	
		
			
				|  |  | -+#include <linux/io.h>
 | 
	
		
			
				|  |  | -+#include <linux/version.h>
 | 
	
		
			
				|  |  | -+#include <linux/vlynq.h>
 | 
	
		
			
				|  |  | -+#include <linux/leds.h>
 | 
	
		
			
				|  |  | -+#include <linux/string.h>
 | 
	
		
			
				|  |  | -+#include <linux/phy.h>
 | 
	
		
			
				|  |  | -+#include <linux/phy_fixed.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <asm/addrspace.h>
 | 
	
		
			
				|  |  | -+#include <asm/ar7/ar7.h>
 | 
	
		
			
				|  |  | -+#include <asm/ar7/gpio.h>
 | 
	
		
			
				|  |  | -+#include <asm/ar7/prom.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct plat_vlynq_data {
 | 
	
		
			
				|  |  | -+	struct plat_vlynq_ops ops;
 | 
	
		
			
				|  |  | -+	int gpio_bit;
 | 
	
		
			
				|  |  | -+	int reset_bit;
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int vlynq_on(struct vlynq_device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int result;
 | 
	
		
			
				|  |  | -+	struct plat_vlynq_data *pdata = dev->dev.platform_data;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if ((result = gpio_request(pdata->gpio_bit, "vlynq")))
 | 
	
		
			
				|  |  | -+		goto out;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	ar7_device_reset(pdata->reset_bit);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if ((result = ar7_gpio_disable(pdata->gpio_bit)))
 | 
	
		
			
				|  |  | -+		goto out_enabled;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if ((result = ar7_gpio_enable(pdata->gpio_bit)))
 | 
	
		
			
				|  |  | -+		goto out_enabled;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if ((result = gpio_direction_output(pdata->gpio_bit, 0)))
 | 
	
		
			
				|  |  | -+		goto out_gpio_enabled;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	mdelay(50);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	gpio_set_value(pdata->gpio_bit, 1);
 | 
	
		
			
				|  |  | -+	mdelay(50);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+out_gpio_enabled:
 | 
	
		
			
				|  |  | -+	ar7_gpio_disable(pdata->gpio_bit);
 | 
	
		
			
				|  |  | -+out_enabled:
 | 
	
		
			
				|  |  | -+	ar7_device_disable(pdata->reset_bit);
 | 
	
		
			
				|  |  | -+	gpio_free(pdata->gpio_bit);
 | 
	
		
			
				|  |  | -+out:
 | 
	
		
			
				|  |  | -+	return result;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void vlynq_off(struct vlynq_device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	struct plat_vlynq_data *pdata = dev->dev.platform_data;
 | 
	
		
			
				|  |  | -+	ar7_gpio_disable(pdata->gpio_bit);
 | 
	
		
			
				|  |  | -+	gpio_free(pdata->gpio_bit);
 | 
	
		
			
				|  |  | -+	ar7_device_disable(pdata->reset_bit);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct resource physmap_flash_resource = {
 | 
	
		
			
				|  |  | -+	.name = "mem",
 | 
	
		
			
				|  |  | -+	.flags = IORESOURCE_MEM,
 | 
	
		
			
				|  |  | -+	.start = 0x10000000,
 | 
	
		
			
				|  |  | -+	.end = 0x107fffff,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct resource cpmac_low_res[] = {
 | 
	
		
			
				|  |  | -+	{
 | 
	
		
			
				|  |  | -+		.name = "regs",
 | 
	
		
			
				|  |  | -+		.flags = IORESOURCE_MEM,
 | 
	
		
			
				|  |  | -+		.start = AR7_REGS_MAC0,
 | 
	
		
			
				|  |  | -+		.end = AR7_REGS_MAC0 + 0x7ff,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+	{
 | 
	
		
			
				|  |  | -+		.name = "irq",
 | 
	
		
			
				|  |  | -+		.flags = IORESOURCE_IRQ,
 | 
	
		
			
				|  |  | -+		.start = 27,
 | 
	
		
			
				|  |  | -+		.end = 27,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct resource cpmac_high_res[] = {
 | 
	
		
			
				|  |  | -+	{
 | 
	
		
			
				|  |  | -+		.name = "regs",
 | 
	
		
			
				|  |  | -+		.flags = IORESOURCE_MEM,
 | 
	
		
			
				|  |  | -+		.start = AR7_REGS_MAC1,
 | 
	
		
			
				|  |  | -+		.end = AR7_REGS_MAC1 + 0x7ff,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+	{
 | 
	
		
			
				|  |  | -+		.name = "irq",
 | 
	
		
			
				|  |  | -+		.flags = IORESOURCE_IRQ,
 | 
	
		
			
				|  |  | -+		.start = 41,
 | 
	
		
			
				|  |  | -+		.end = 41,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct resource vlynq_low_res[] = {
 | 
	
		
			
				|  |  | -+	{
 | 
	
		
			
				|  |  | -+		.name = "regs",
 | 
	
		
			
				|  |  | -+		.flags = IORESOURCE_MEM,
 | 
	
		
			
				|  |  | -+		.start = AR7_REGS_VLYNQ0,
 | 
	
		
			
				|  |  | -+		.end = AR7_REGS_VLYNQ0 + 0xff,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+	{
 | 
	
		
			
				|  |  | -+		.name = "irq",
 | 
	
		
			
				|  |  | -+		.flags = IORESOURCE_IRQ,
 | 
	
		
			
				|  |  | -+		.start = 29,
 | 
	
		
			
				|  |  | -+		.end = 29,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+	{
 | 
	
		
			
				|  |  | -+		.name = "mem",
 | 
	
		
			
				|  |  | -+		.flags = IORESOURCE_MEM,
 | 
	
		
			
				|  |  | -+		.start = 0x04000000,
 | 
	
		
			
				|  |  | -+		.end = 0x04ffffff,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+	{
 | 
	
		
			
				|  |  | -+		.name = "devirq",
 | 
	
		
			
				|  |  | -+		.flags = IORESOURCE_IRQ,
 | 
	
		
			
				|  |  | -+		.start = 80,
 | 
	
		
			
				|  |  | -+		.end = 111,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct resource vlynq_high_res[] = {
 | 
	
		
			
				|  |  | -+	{
 | 
	
		
			
				|  |  | -+		.name = "regs",
 | 
	
		
			
				|  |  | -+		.flags = IORESOURCE_MEM,
 | 
	
		
			
				|  |  | -+		.start = AR7_REGS_VLYNQ1,
 | 
	
		
			
				|  |  | -+		.end = AR7_REGS_VLYNQ1 + 0xff,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+	{
 | 
	
		
			
				|  |  | -+		.name = "irq",
 | 
	
		
			
				|  |  | -+		.flags = IORESOURCE_IRQ,
 | 
	
		
			
				|  |  | -+		.start = 33,
 | 
	
		
			
				|  |  | -+		.end = 33,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+	{
 | 
	
		
			
				|  |  | -+		.name = "mem",
 | 
	
		
			
				|  |  | -+		.flags = IORESOURCE_MEM,
 | 
	
		
			
				|  |  | -+		.start = 0x0c000000,
 | 
	
		
			
				|  |  | -+		.end = 0x0cffffff,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+	{
 | 
	
		
			
				|  |  | -+		.name = "devirq",
 | 
	
		
			
				|  |  | -+		.flags = IORESOURCE_IRQ,
 | 
	
		
			
				|  |  | -+		.start = 112,
 | 
	
		
			
				|  |  | -+		.end = 143,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct resource usb_res[] = {
 | 
	
		
			
				|  |  | -+	{
 | 
	
		
			
				|  |  | -+		.name = "regs",
 | 
	
		
			
				|  |  | -+		.flags = IORESOURCE_MEM,
 | 
	
		
			
				|  |  | -+		.start = AR7_REGS_USB,
 | 
	
		
			
				|  |  | -+		.end = AR7_REGS_USB + 0xff,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+	{
 | 
	
		
			
				|  |  | -+		.name = "irq",
 | 
	
		
			
				|  |  | -+		.flags = IORESOURCE_IRQ,
 | 
	
		
			
				|  |  | -+		.start = 32,
 | 
	
		
			
				|  |  | -+		.end = 32,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+	{
 | 
	
		
			
				|  |  | -+		.name = "mem",
 | 
	
		
			
				|  |  | -+		.flags = IORESOURCE_MEM,
 | 
	
		
			
				|  |  | -+		.start = 0x03400000,
 | 
	
		
			
				|  |  | -+		.end = 0x034001fff,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct physmap_flash_data physmap_flash_data = {
 | 
	
		
			
				|  |  | -+	.width = 2,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/* lets assume this is suitable for both high and low cpmacs links */
 | 
	
		
			
				|  |  | -+static struct fixed_phy_status fixed_phy_status __initdata = {
 | 
	
		
			
				|  |  | -+	.link = 1,
 | 
	
		
			
				|  |  | -+	.speed = 100,
 | 
	
		
			
				|  |  | -+	.duplex = 1,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct plat_cpmac_data cpmac_low_data = {
 | 
	
		
			
				|  |  | -+	.reset_bit = 17,
 | 
	
		
			
				|  |  | -+	.power_bit = 20,
 | 
	
		
			
				|  |  | -+	.phy_mask = 0x80000000,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct plat_cpmac_data cpmac_high_data = {
 | 
	
		
			
				|  |  | -+	.reset_bit = 21,
 | 
	
		
			
				|  |  | -+	.power_bit = 22,
 | 
	
		
			
				|  |  | -+	.phy_mask = 0x7fffffff,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct plat_vlynq_data vlynq_low_data = {
 | 
	
		
			
				|  |  | -+	.ops.on = vlynq_on,
 | 
	
		
			
				|  |  | -+	.ops.off = vlynq_off,
 | 
	
		
			
				|  |  | -+	.reset_bit = 20,
 | 
	
		
			
				|  |  | -+	.gpio_bit = 18,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct plat_vlynq_data vlynq_high_data = {
 | 
	
		
			
				|  |  | -+	.ops.on = vlynq_on,
 | 
	
		
			
				|  |  | -+	.ops.off = vlynq_off,
 | 
	
		
			
				|  |  | -+	.reset_bit = 16,
 | 
	
		
			
				|  |  | -+	.gpio_bit = 19,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct platform_device physmap_flash = {
 | 
	
		
			
				|  |  | -+	.id = 0,
 | 
	
		
			
				|  |  | -+	.name = "physmap-flash",
 | 
	
		
			
				|  |  | -+	.dev.platform_data = &physmap_flash_data,
 | 
	
		
			
				|  |  | -+	.resource = &physmap_flash_resource,
 | 
	
		
			
				|  |  | -+	.num_resources = 1,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static u64 cpmac_dma_mask = DMA_32BIT_MASK;
 | 
	
		
			
				|  |  | -+static struct platform_device cpmac_low = {
 | 
	
		
			
				|  |  | -+	.id = 0,
 | 
	
		
			
				|  |  | -+	.name = "cpmac",
 | 
	
		
			
				|  |  | -+	.dev = {
 | 
	
		
			
				|  |  | -+		.dma_mask = &cpmac_dma_mask,
 | 
	
		
			
				|  |  | -+		.coherent_dma_mask = DMA_32BIT_MASK,
 | 
	
		
			
				|  |  | -+		.platform_data = &cpmac_low_data,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+	.resource = cpmac_low_res,
 | 
	
		
			
				|  |  | -+	.num_resources = ARRAY_SIZE(cpmac_low_res),
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct platform_device cpmac_high = {
 | 
	
		
			
				|  |  | -+	.id = 1,
 | 
	
		
			
				|  |  | -+	.name = "cpmac",
 | 
	
		
			
				|  |  | -+	.dev = {
 | 
	
		
			
				|  |  | -+		.dma_mask = &cpmac_dma_mask,
 | 
	
		
			
				|  |  | -+		.coherent_dma_mask = DMA_32BIT_MASK,
 | 
	
		
			
				|  |  | -+		.platform_data = &cpmac_high_data,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | -+	.resource = cpmac_high_res,
 | 
	
		
			
				|  |  | -+	.num_resources = ARRAY_SIZE(cpmac_high_res),
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct platform_device vlynq_low = {
 | 
	
		
			
				|  |  | -+	.id = 0,
 | 
	
		
			
				|  |  | -+	.name = "vlynq",
 | 
	
		
			
				|  |  | -+	.dev.platform_data = &vlynq_low_data,
 | 
	
		
			
				|  |  | -+	.resource = vlynq_low_res,
 | 
	
		
			
				|  |  | -+	.num_resources = ARRAY_SIZE(vlynq_low_res),
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct platform_device vlynq_high = {
 | 
	
		
			
				|  |  | -+	.id = 1,
 | 
	
		
			
				|  |  | -+	.name = "vlynq",
 | 
	
		
			
				|  |  | -+	.dev.platform_data = &vlynq_high_data,
 | 
	
		
			
				|  |  | -+	.resource = vlynq_high_res,
 | 
	
		
			
				|  |  | -+	.num_resources = ARRAY_SIZE(vlynq_high_res),
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/* This is proper way to define uart ports, but they are then detected
 | 
	
		
			
				|  |  | -+ * as xscale and, obviously, don't work...
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+#if !defined(CONFIG_SERIAL_8250)
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct plat_serial8250_port uart0_data = {
 | 
	
		
			
				|  |  | -+	.mapbase = AR7_REGS_UART0,
 | 
	
		
			
				|  |  | -+	.irq = AR7_IRQ_UART0,
 | 
	
		
			
				|  |  | -+	.regshift = 2,
 | 
	
		
			
				|  |  | -+	.iotype = UPIO_MEM,
 | 
	
		
			
				|  |  | -+	.flags = UPF_BOOT_AUTOCONF | UPF_IOREMAP,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct plat_serial8250_port uart1_data = {
 | 
	
		
			
				|  |  | -+	.mapbase = UR8_REGS_UART1,
 | 
	
		
			
				|  |  | -+	.irq = AR7_IRQ_UART1,
 | 
	
		
			
				|  |  | -+	.regshift = 2,
 | 
	
		
			
				|  |  | -+	.iotype = UPIO_MEM,
 | 
	
		
			
				|  |  | -+	.flags = UPF_BOOT_AUTOCONF | UPF_IOREMAP,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct plat_serial8250_port uart_data[] = {
 | 
	
		
			
				|  |  | -+	uart0_data,
 | 
	
		
			
				|  |  | -+	uart1_data,
 | 
	
		
			
				|  |  | -+	{ .flags = 0 }
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct plat_serial8250_port uart_data_single[] = {
 | 
	
		
			
				|  |  | -+	uart0_data,
 | 
	
		
			
				|  |  | -+	{ .flags = 0 }
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct platform_device uart = {
 | 
	
		
			
				|  |  | -+	.id = 0,
 | 
	
		
			
				|  |  | -+	.name = "serial8250",
 | 
	
		
			
				|  |  | -+	.dev.platform_data = uart_data_single
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+#endif
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct gpio_led default_leds[] = {
 | 
	
		
			
				|  |  | -+	{ .name = "status", .gpio = 8, .active_low = 1, },
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct gpio_led dsl502t_leds[] = {
 | 
	
		
			
				|  |  | -+	{ .name = "status", .gpio = 9, .active_low = 1, },
 | 
	
		
			
				|  |  | -+	{ .name = "ethernet", .gpio = 7, .active_low = 1, },
 | 
	
		
			
				|  |  | -+	{ .name = "usb", .gpio = 12, .active_low = 1, },
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct gpio_led dg834g_leds[] = {
 | 
	
		
			
				|  |  | -+	{ .name = "ppp", .gpio = 6, .active_low = 1, },
 | 
	
		
			
				|  |  | -+	{ .name = "status", .gpio = 7, .active_low = 1, },
 | 
	
		
			
				|  |  | -+	{ .name = "adsl", .gpio = 8, .active_low = 1, },
 | 
	
		
			
				|  |  | -+	{ .name = "wifi", .gpio = 12, .active_low = 1, },
 | 
	
		
			
				|  |  | -+	{ .name = "power", .gpio = 14, .active_low = 1, .default_trigger = "default-on", },
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct gpio_led fb_sl_leds[] = {
 | 
	
		
			
				|  |  | -+	{ .name = "1", .gpio = 7, },
 | 
	
		
			
				|  |  | -+	{ .name = "2", .gpio = 13, .active_low = 1, },
 | 
	
		
			
				|  |  | -+	{ .name = "3", .gpio = 10, .active_low = 1, },
 | 
	
		
			
				|  |  | -+	{ .name = "4", .gpio = 12, .active_low = 1, },
 | 
	
		
			
				|  |  | -+	{ .name = "5", .gpio = 9, .active_low = 1, },
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct gpio_led fb_fon_leds[] = {
 | 
	
		
			
				|  |  | -+	{ .name = "1", .gpio = 8, },
 | 
	
		
			
				|  |  | -+	{ .name = "2", .gpio = 3, .active_low = 1, },
 | 
	
		
			
				|  |  | -+	{ .name = "3", .gpio = 5, },
 | 
	
		
			
				|  |  | -+	{ .name = "4", .gpio = 4, .active_low = 1, },
 | 
	
		
			
				|  |  | -+	{ .name = "5", .gpio = 11, .active_low = 1, },
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct gpio_led_platform_data ar7_led_data;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct platform_device ar7_gpio_leds = {
 | 
	
		
			
				|  |  | -+	.name = "leds-gpio",
 | 
	
		
			
				|  |  | -+	.id = -1,
 | 
	
		
			
				|  |  | -+	.dev = {
 | 
	
		
			
				|  |  | -+		.platform_data = &ar7_led_data,
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct platform_device ar7_udc = {
 | 
	
		
			
				|  |  | -+	.id = -1,
 | 
	
		
			
				|  |  | -+	.name = "ar7_udc",
 | 
	
		
			
				|  |  | -+	.resource = usb_res,
 | 
	
		
			
				|  |  | -+	.num_resources = ARRAY_SIZE(usb_res),
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline unsigned char char2hex(char h)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	switch (h) {
 | 
	
		
			
				|  |  | -+	case '0': case '1': case '2': case '3': case '4':
 | 
	
		
			
				|  |  | -+	case '5': case '6': case '7': case '8': case '9':
 | 
	
		
			
				|  |  | -+		return h - '0';
 | 
	
		
			
				|  |  | -+	case 'A': case 'B': case 'C': case 'D': case 'E': case 'F':
 | 
	
		
			
				|  |  | -+		return h - 'A' + 10;
 | 
	
		
			
				|  |  | -+	case 'a': case 'b': case 'c': case 'd': case 'e': case 'f':
 | 
	
		
			
				|  |  | -+		return h - 'a' + 10;
 | 
	
		
			
				|  |  | -+	default:
 | 
	
		
			
				|  |  | -+		return 0;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void cpmac_get_mac(int instance, unsigned char *dev_addr)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int i;
 | 
	
		
			
				|  |  | -+	char name[5], default_mac[] = "00:00:00:12:34:56", *mac;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	mac = NULL;
 | 
	
		
			
				|  |  | -+	sprintf(name, "mac%c", 'a' + instance);
 | 
	
		
			
				|  |  | -+	mac = prom_getenv(name);
 | 
	
		
			
				|  |  | -+	if (!mac) {
 | 
	
		
			
				|  |  | -+		sprintf(name, "mac%c", 'a');
 | 
	
		
			
				|  |  | -+		mac = prom_getenv(name);
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	if (!mac)
 | 
	
		
			
				|  |  | -+		mac = default_mac;
 | 
	
		
			
				|  |  | -+	for (i = 0; i < 6; i++)
 | 
	
		
			
				|  |  | -+		dev_addr[i] = (char2hex(mac[i * 3]) << 4) +
 | 
	
		
			
				|  |  | -+			char2hex(mac[i * 3 + 1]);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void __init detect_leds(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	char *prId, *usb_prod;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	/* Default LEDs	*/
 | 
	
		
			
				|  |  | -+	ar7_led_data.num_leds = ARRAY_SIZE(default_leds);
 | 
	
		
			
				|  |  | -+	ar7_led_data.leds = default_leds;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	/* FIXME: the whole thing is unreliable */
 | 
	
		
			
				|  |  | -+	prId = prom_getenv("ProductID");
 | 
	
		
			
				|  |  | -+	usb_prod = prom_getenv("usb_prod");
 | 
	
		
			
				|  |  | -+	
 | 
	
		
			
				|  |  | -+	/* If we can't get the product id from PROM, use the default LEDs */
 | 
	
		
			
				|  |  | -+	if (!prId)
 | 
	
		
			
				|  |  | -+		return;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (strstr(prId, "Fritz_Box_FON")) {
 | 
	
		
			
				|  |  | -+		ar7_led_data.num_leds = ARRAY_SIZE(fb_fon_leds);
 | 
	
		
			
				|  |  | -+		ar7_led_data.leds = fb_fon_leds;
 | 
	
		
			
				|  |  | -+	} else if (strstr(prId, "Fritz_Box_")) {
 | 
	
		
			
				|  |  | -+		ar7_led_data.num_leds = ARRAY_SIZE(fb_sl_leds);
 | 
	
		
			
				|  |  | -+		ar7_led_data.leds = fb_sl_leds;
 | 
	
		
			
				|  |  | -+	} else if ((!strcmp(prId, "AR7RD") || !strcmp(prId, "AR7DB")) && usb_prod != NULL && strstr(usb_prod, "DSL-502T")) {
 | 
	
		
			
				|  |  | -+		ar7_led_data.num_leds = ARRAY_SIZE(dsl502t_leds);
 | 
	
		
			
				|  |  | -+		ar7_led_data.leds = dsl502t_leds;
 | 
	
		
			
				|  |  | -+	} else if (strstr(prId, "DG834")) {
 | 
	
		
			
				|  |  | -+		ar7_led_data.num_leds = ARRAY_SIZE(dg834g_leds);
 | 
	
		
			
				|  |  | -+		ar7_led_data.leds = dg834g_leds;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int __init ar7_register_devices(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int res;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#ifdef CONFIG_SERIAL_8250
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	static struct uart_port uart_port[2];
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	memset(uart_port, 0, sizeof(struct uart_port) * 2);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	uart_port[0].type = PORT_AR7;
 | 
	
		
			
				|  |  | -+	uart_port[0].line = 0;
 | 
	
		
			
				|  |  | -+	uart_port[0].irq = AR7_IRQ_UART0;
 | 
	
		
			
				|  |  | -+	uart_port[0].uartclk = ar7_bus_freq() / 2;
 | 
	
		
			
				|  |  | -+	uart_port[0].iotype = UPIO_MEM;
 | 
	
		
			
				|  |  | -+	uart_port[0].mapbase = AR7_REGS_UART0;
 | 
	
		
			
				|  |  | -+	uart_port[0].membase = ioremap(uart_port[0].mapbase, 256);
 | 
	
		
			
				|  |  | -+	uart_port[0].regshift = 2;
 | 
	
		
			
				|  |  | -+	res = early_serial_setup(&uart_port[0]);
 | 
	
		
			
				|  |  | -+	if (res)
 | 
	
		
			
				|  |  | -+		return res;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	/* Only TNETD73xx have a second serial port */
 | 
	
		
			
				|  |  | -+	if (ar7_has_second_uart()) {
 | 
	
		
			
				|  |  | -+		uart_port[1].type = PORT_AR7;
 | 
	
		
			
				|  |  | -+		uart_port[1].line = 1;
 | 
	
		
			
				|  |  | -+		uart_port[1].irq = AR7_IRQ_UART1;
 | 
	
		
			
				|  |  | -+		uart_port[1].uartclk = ar7_bus_freq() / 2;
 | 
	
		
			
				|  |  | -+		uart_port[1].iotype = UPIO_MEM;
 | 
	
		
			
				|  |  | -+		uart_port[1].mapbase = UR8_REGS_UART1;
 | 
	
		
			
				|  |  | -+		uart_port[1].membase = ioremap(uart_port[1].mapbase, 256);
 | 
	
		
			
				|  |  | -+		uart_port[1].regshift = 2;
 | 
	
		
			
				|  |  | -+		res = early_serial_setup(&uart_port[1]);
 | 
	
		
			
				|  |  | -+		if (res)
 | 
	
		
			
				|  |  | -+			return res;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#else /* !CONFIG_SERIAL_8250 */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	uart_data[0].uartclk = ar7_bus_freq() / 2;
 | 
	
		
			
				|  |  | -+	uart_data[1].uartclk = uart_data[0].uartclk;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	/* Only TNETD73xx have a second serial port */
 | 
	
		
			
				|  |  | -+	if (ar7_has_second_uart())
 | 
	
		
			
				|  |  | -+		uart.dev.platform_data = uart_data;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	res = platform_device_register(&uart);
 | 
	
		
			
				|  |  | -+	if (res)
 | 
	
		
			
				|  |  | -+		return res;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#endif /* CONFIG_SERIAL_8250 */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	res = platform_device_register(&physmap_flash);
 | 
	
		
			
				|  |  | -+	if (res)
 | 
	
		
			
				|  |  | -+		return res;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	ar7_device_disable(vlynq_low_data.reset_bit);
 | 
	
		
			
				|  |  | -+	res = platform_device_register(&vlynq_low);
 | 
	
		
			
				|  |  | -+	if (res)
 | 
	
		
			
				|  |  | -+		return res;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (ar7_has_high_vlynq()) {
 | 
	
		
			
				|  |  | -+		ar7_device_disable(vlynq_high_data.reset_bit);
 | 
	
		
			
				|  |  | -+		res = platform_device_register(&vlynq_high);
 | 
	
		
			
				|  |  | -+		if (res)
 | 
	
		
			
				|  |  | -+			return res;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (ar7_has_high_cpmac()) {
 | 
	
		
			
				|  |  | -+		res = fixed_phy_add(PHY_POLL, cpmac_high.id, &fixed_phy_status);
 | 
	
		
			
				|  |  | -+		if (res && res != -ENODEV)
 | 
	
		
			
				|  |  | -+			return res;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+		cpmac_get_mac(1, cpmac_high_data.dev_addr);
 | 
	
		
			
				|  |  | -+		res = platform_device_register(&cpmac_high);
 | 
	
		
			
				|  |  | -+		if (res)
 | 
	
		
			
				|  |  | -+			return res;
 | 
	
		
			
				|  |  | -+	} else {
 | 
	
		
			
				|  |  | -+		cpmac_low_data.phy_mask = 0xffffffff;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	res = fixed_phy_add(PHY_POLL, cpmac_low.id, &fixed_phy_status);
 | 
	
		
			
				|  |  | -+	if (res && res != -ENODEV)
 | 
	
		
			
				|  |  | -+		return res;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	cpmac_get_mac(0, cpmac_low_data.dev_addr);
 | 
	
		
			
				|  |  | -+	res = platform_device_register(&cpmac_low);
 | 
	
		
			
				|  |  | -+	if (res)
 | 
	
		
			
				|  |  | -+		return res;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	detect_leds();
 | 
	
		
			
				|  |  | -+	res = platform_device_register(&ar7_gpio_leds);
 | 
	
		
			
				|  |  | -+	if (res)
 | 
	
		
			
				|  |  | -+		return res;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	res = platform_device_register(&ar7_udc);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return res;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+arch_initcall(ar7_register_devices);
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/ar7/prom.c linux-2.6.30.5/arch/mips/ar7/prom.c
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/ar7/prom.c	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/ar7/prom.c	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,321 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Carsten Langgaard, carstenl@mips.com
 | 
	
		
			
				|  |  | -+ * Copyright (C) 1999,2000 MIPS Technologies, Inc.  All rights reserved.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ *  This program is free software; you can distribute it and/or modify it
 | 
	
		
			
				|  |  | -+ *  under the terms of the GNU General Public License (Version 2) as
 | 
	
		
			
				|  |  | -+ *  published by the Free Software Foundation.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ *  This program is distributed in the hope 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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * Putting things on the screen/serial line using YAMONs facilities.
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+#include <linux/init.h>
 | 
	
		
			
				|  |  | -+#include <linux/kernel.h>
 | 
	
		
			
				|  |  | -+#include <linux/serial_reg.h>
 | 
	
		
			
				|  |  | -+#include <linux/spinlock.h>
 | 
	
		
			
				|  |  | -+#include <linux/module.h>
 | 
	
		
			
				|  |  | -+#include <linux/string.h>
 | 
	
		
			
				|  |  | -+#include <linux/io.h>
 | 
	
		
			
				|  |  | -+#include <asm/bootinfo.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <asm/ar7/ar7.h>
 | 
	
		
			
				|  |  | -+#include <asm/ar7/prom.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define MAX_ENTRY 80
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct env_var {
 | 
	
		
			
				|  |  | -+	char *name;
 | 
	
		
			
				|  |  | -+	char *value;
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct env_var adam2_env[MAX_ENTRY] = { { 0, }, };
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+char *prom_getenv(const char *name)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int i;
 | 
	
		
			
				|  |  | -+	for (i = 0; (i < MAX_ENTRY) && adam2_env[i].name; i++)
 | 
	
		
			
				|  |  | -+		if (!strcmp(name, adam2_env[i].name))
 | 
	
		
			
				|  |  | -+			return adam2_env[i].value;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return NULL;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+EXPORT_SYMBOL(prom_getenv);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+char * __init prom_getcmdline(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return &(arcs_cmdline[0]);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void  __init ar7_init_cmdline(int argc, char *argv[])
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	char *cp;
 | 
	
		
			
				|  |  | -+	int actr;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	actr = 1; /* Always ignore argv[0] */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	cp = &(arcs_cmdline[0]);
 | 
	
		
			
				|  |  | -+	while (actr < argc) {
 | 
	
		
			
				|  |  | -+		strcpy(cp, argv[actr]);
 | 
	
		
			
				|  |  | -+		cp += strlen(argv[actr]);
 | 
	
		
			
				|  |  | -+		*cp++ = ' ';
 | 
	
		
			
				|  |  | -+		actr++;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	if (cp != &(arcs_cmdline[0])) {
 | 
	
		
			
				|  |  | -+		/* get rid of trailing space */
 | 
	
		
			
				|  |  | -+		--cp;
 | 
	
		
			
				|  |  | -+		*cp = '\0';
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct psbl_rec {
 | 
	
		
			
				|  |  | -+	u32 psbl_size;
 | 
	
		
			
				|  |  | -+	u32 env_base;
 | 
	
		
			
				|  |  | -+	u32 env_size;
 | 
	
		
			
				|  |  | -+	u32 ffs_base;
 | 
	
		
			
				|  |  | -+	u32 ffs_size;
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static __initdata char psp_env_version[] = "TIENV0.8";
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct psp_env_chunk {
 | 
	
		
			
				|  |  | -+	u8 num;
 | 
	
		
			
				|  |  | -+	u8 ctrl;
 | 
	
		
			
				|  |  | -+	u16 csum;
 | 
	
		
			
				|  |  | -+	u8 len;
 | 
	
		
			
				|  |  | -+	char data[11];
 | 
	
		
			
				|  |  | -+} __attribute__ ((packed));
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct psp_var_map_entry {
 | 
	
		
			
				|  |  | -+	u8 num;
 | 
	
		
			
				|  |  | -+	char *value;
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct psp_var_map_entry psp_var_map[] = {
 | 
	
		
			
				|  |  | -+	{ 1, "cpufrequency" },
 | 
	
		
			
				|  |  | -+	{ 2, "memsize" },
 | 
	
		
			
				|  |  | -+	{ 3, "flashsize" },
 | 
	
		
			
				|  |  | -+	{ 4, "modetty0" },
 | 
	
		
			
				|  |  | -+	{ 5, "modetty1" },
 | 
	
		
			
				|  |  | -+	{ 8, "maca" },
 | 
	
		
			
				|  |  | -+	{ 9, "macb" },
 | 
	
		
			
				|  |  | -+	{ 28, "sysfrequency" },
 | 
	
		
			
				|  |  | -+	{ 38, "mipsfrequency" },
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+Well-known variable (num is looked up in table above for matching variable name)
 | 
	
		
			
				|  |  | -+Example: cpufrequency=211968000
 | 
	
		
			
				|  |  | -++----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
 | 
	
		
			
				|  |  | -+| 01 |CTRL|CHECKSUM | 01 | _2 | _1 | _1 | _9 | _6 | _8 | _0 | _0 | _0 | \0 | FF
 | 
	
		
			
				|  |  | -++----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+Name=Value pair in a single chunk
 | 
	
		
			
				|  |  | -+Example: NAME=VALUE
 | 
	
		
			
				|  |  | -++----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
 | 
	
		
			
				|  |  | -+| 00 |CTRL|CHECKSUM | 01 | _N | _A | _M | _E | _0 | _V | _A | _L | _U | _E | \0
 | 
	
		
			
				|  |  | -++----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+Name=Value pair in 2 chunks (len is the number of chunks)
 | 
	
		
			
				|  |  | -+Example: bootloaderVersion=1.3.7.15
 | 
	
		
			
				|  |  | -++----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
 | 
	
		
			
				|  |  | -+| 00 |CTRL|CHECKSUM | 02 | _b | _o | _o | _t | _l | _o | _a | _d | _e | _r | _V
 | 
	
		
			
				|  |  | -++----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
 | 
	
		
			
				|  |  | -+| _e | _r | _s | _i | _o | _n | \0 | _1 | _. | _3 | _. | _7 | _. | _1 | _5 | \0
 | 
	
		
			
				|  |  | -++----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+Data is padded with 0xFF
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+*/
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define PSP_ENV_SIZE  4096
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static char psp_env_data[PSP_ENV_SIZE] = { 0, };
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static char * __init lookup_psp_var_map(u8 num)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int i;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	for (i = 0; i < sizeof(psp_var_map); i++)
 | 
	
		
			
				|  |  | -+		if (psp_var_map[i].num == num)
 | 
	
		
			
				|  |  | -+			return psp_var_map[i].value;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return NULL;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void __init add_adam2_var(char *name, char *value)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int i;
 | 
	
		
			
				|  |  | -+	for (i = 0; i < MAX_ENTRY; i++) {
 | 
	
		
			
				|  |  | -+		if (!adam2_env[i].name) {
 | 
	
		
			
				|  |  | -+			adam2_env[i].name = name;
 | 
	
		
			
				|  |  | -+			adam2_env[i].value = value;
 | 
	
		
			
				|  |  | -+			return;
 | 
	
		
			
				|  |  | -+		} else if (!strcmp(adam2_env[i].name, name)) {
 | 
	
		
			
				|  |  | -+			adam2_env[i].value = value;
 | 
	
		
			
				|  |  | -+			return;
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int __init parse_psp_env(void *psp_env_base)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int i, n;
 | 
	
		
			
				|  |  | -+	char *name, *value;
 | 
	
		
			
				|  |  | -+	struct psp_env_chunk *chunks = (struct psp_env_chunk *)psp_env_data;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	memcpy_fromio(chunks, psp_env_base, PSP_ENV_SIZE);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	i = 1;
 | 
	
		
			
				|  |  | -+	n = PSP_ENV_SIZE / sizeof(struct psp_env_chunk);
 | 
	
		
			
				|  |  | -+	while (i < n) {
 | 
	
		
			
				|  |  | -+		if ((chunks[i].num == 0xff) || ((i + chunks[i].len) > n))
 | 
	
		
			
				|  |  | -+			break;
 | 
	
		
			
				|  |  | -+		value = chunks[i].data;
 | 
	
		
			
				|  |  | -+		if (chunks[i].num) {
 | 
	
		
			
				|  |  | -+			name = lookup_psp_var_map(chunks[i].num);
 | 
	
		
			
				|  |  | -+		} else {
 | 
	
		
			
				|  |  | -+			name = value;
 | 
	
		
			
				|  |  | -+			value += strlen(name) + 1;
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+		if (name)
 | 
	
		
			
				|  |  | -+			add_adam2_var(name, value);
 | 
	
		
			
				|  |  | -+		i += chunks[i].len;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void __init ar7_init_env(struct env_var *env)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int i;
 | 
	
		
			
				|  |  | -+	struct psbl_rec *psbl = (struct psbl_rec *)(KSEG1ADDR(0x14000300));
 | 
	
		
			
				|  |  | -+	void *psp_env = (void *)KSEG1ADDR(psbl->env_base);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (strcmp(psp_env, psp_env_version) == 0) {
 | 
	
		
			
				|  |  | -+		parse_psp_env(psp_env);
 | 
	
		
			
				|  |  | -+	} else {
 | 
	
		
			
				|  |  | -+		for (i = 0; i < MAX_ENTRY; i++, env++)
 | 
	
		
			
				|  |  | -+			if (env->name)
 | 
	
		
			
				|  |  | -+				add_adam2_var(env->name, env->value);
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void __init console_config(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+#ifdef CONFIG_SERIAL_8250_CONSOLE
 | 
	
		
			
				|  |  | -+	char console_string[40];
 | 
	
		
			
				|  |  | -+	int baud = 0;
 | 
	
		
			
				|  |  | -+	char parity = '\0', bits = '\0', flow = '\0';
 | 
	
		
			
				|  |  | -+	char *s, *p;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (strstr(prom_getcmdline(), "console="))
 | 
	
		
			
				|  |  | -+		return;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#ifdef CONFIG_KGDB
 | 
	
		
			
				|  |  | -+	if (!strstr(prom_getcmdline(), "nokgdb")) {
 | 
	
		
			
				|  |  | -+		strcat(prom_getcmdline(), " console=kgdb");
 | 
	
		
			
				|  |  | -+		kgdb_enabled = 1;
 | 
	
		
			
				|  |  | -+		return;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+#endif
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if ((s = prom_getenv("modetty0"))) {
 | 
	
		
			
				|  |  | -+		baud = simple_strtoul(s, &p, 10);
 | 
	
		
			
				|  |  | -+		s = p;
 | 
	
		
			
				|  |  | -+		if (*s == ',') s++;
 | 
	
		
			
				|  |  | -+		if (*s) parity = *s++;
 | 
	
		
			
				|  |  | -+		if (*s == ',') s++;
 | 
	
		
			
				|  |  | -+		if (*s) bits = *s++;
 | 
	
		
			
				|  |  | -+		if (*s == ',') s++;
 | 
	
		
			
				|  |  | -+		if (*s == 'h') flow = 'r';
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (baud == 0)
 | 
	
		
			
				|  |  | -+		baud = 38400;
 | 
	
		
			
				|  |  | -+	if (parity != 'n' && parity != 'o' && parity != 'e')
 | 
	
		
			
				|  |  | -+		parity = 'n';
 | 
	
		
			
				|  |  | -+	if (bits != '7' && bits != '8')
 | 
	
		
			
				|  |  | -+		bits = '8';
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (flow == 'r')
 | 
	
		
			
				|  |  | -+		sprintf(console_string, " console=ttyS0,%d%c%c%c", baud,
 | 
	
		
			
				|  |  | -+			parity, bits, flow);
 | 
	
		
			
				|  |  | -+        else
 | 
	
		
			
				|  |  | -+		sprintf(console_string, " console=ttyS0,%d%c%c", baud, parity,
 | 
	
		
			
				|  |  | -+			bits);
 | 
	
		
			
				|  |  | -+	strcat(prom_getcmdline(), console_string);
 | 
	
		
			
				|  |  | -+#endif
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+void __init prom_init(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	ar7_init_cmdline(fw_arg0, (char **)fw_arg1);
 | 
	
		
			
				|  |  | -+	ar7_init_env((struct env_var *)fw_arg2);
 | 
	
		
			
				|  |  | -+	console_config();
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define PORT(offset) (KSEG1ADDR(AR7_REGS_UART0 + (offset * 4)))
 | 
	
		
			
				|  |  | -+static inline unsigned int serial_in(int offset)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return readb((void *)PORT(offset));
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline void serial_out(int offset, int value)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	writeb(value, (void *)PORT(offset));
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+char prom_getchar(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	while (!(serial_in(UART_LSR) & UART_LSR_DR));
 | 
	
		
			
				|  |  | -+	return serial_in(UART_RX);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+int prom_putchar(char c)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	while ((serial_in(UART_LSR) & UART_LSR_TEMT) == 0);
 | 
	
		
			
				|  |  | -+	serial_out(UART_TX, c);
 | 
	
		
			
				|  |  | -+	return 1;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/* from adm5120/prom.c */
 | 
	
		
			
				|  |  | -+void prom_printf(const char *fmt, ...)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	va_list args;
 | 
	
		
			
				|  |  | -+	int l;
 | 
	
		
			
				|  |  | -+	char *p, *buf_end;
 | 
	
		
			
				|  |  | -+	char buf[1024];
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	va_start(args, fmt);
 | 
	
		
			
				|  |  | -+	l = vsprintf(buf, fmt, args); /* hopefully i < sizeof(buf) */
 | 
	
		
			
				|  |  | -+	va_end(args);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	buf_end = buf + l;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	for (p = buf; p < buf_end; p++) {
 | 
	
		
			
				|  |  | -+		/* Crude cr/nl handling is better than none */
 | 
	
		
			
				|  |  | -+		if (*p == '\n')
 | 
	
		
			
				|  |  | -+			prom_putchar('\r');
 | 
	
		
			
				|  |  | -+		prom_putchar(*p);
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#ifdef CONFIG_KGDB
 | 
	
		
			
				|  |  | -+int putDebugChar(char c)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return prom_putchar(c);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+char getDebugChar(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+       return prom_getchar();
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+#endif
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/ar7/setup.c linux-2.6.30.5/arch/mips/ar7/setup.c
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/ar7/setup.c	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/ar7/setup.c	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,105 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Carsten Langgaard, carstenl@mips.com
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2000 MIPS Technologies, Inc.  All rights reserved.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ *  This program is free software; you can distribute it and/or modify it
 | 
	
		
			
				|  |  | -+ *  under the terms of the GNU General Public License (Version 2) as
 | 
	
		
			
				|  |  | -+ *  published by the Free Software Foundation.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ *  This program is distributed in the hope 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/version.h>
 | 
	
		
			
				|  |  | -+#include <linux/init.h>
 | 
	
		
			
				|  |  | -+#include <linux/ioport.h>
 | 
	
		
			
				|  |  | -+#include <linux/pm.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <asm/reboot.h>
 | 
	
		
			
				|  |  | -+#include <asm/time.h>
 | 
	
		
			
				|  |  | -+#include <asm/ar7/ar7.h>
 | 
	
		
			
				|  |  | -+#include <asm/ar7/prom.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_machine_restart(char *command);
 | 
	
		
			
				|  |  | -+static void ar7_machine_halt(void);
 | 
	
		
			
				|  |  | -+static void ar7_machine_power_off(void);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_machine_restart(char *command)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	u32 *softres_reg = (u32 *)ioremap(AR7_REGS_RESET +
 | 
	
		
			
				|  |  | -+					  AR7_RESET_SOFTWARE, 1);
 | 
	
		
			
				|  |  | -+	writel(1, softres_reg);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_machine_halt(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	while (1);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_machine_power_off(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	u32 *power_reg = (u32 *)ioremap(AR7_REGS_POWER, 1);
 | 
	
		
			
				|  |  | -+	u32 power_state = readl(power_reg) | (3 << 30);
 | 
	
		
			
				|  |  | -+	writel(power_state, power_reg);
 | 
	
		
			
				|  |  | -+	ar7_machine_halt();
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+const char *get_system_type(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	u16 chip_id = ar7_chip_id();
 | 
	
		
			
				|  |  | -+	switch (chip_id) {
 | 
	
		
			
				|  |  | -+	case AR7_CHIP_7300:
 | 
	
		
			
				|  |  | -+		return "TI AR7 (TNETD7300)";
 | 
	
		
			
				|  |  | -+	case AR7_CHIP_7100:
 | 
	
		
			
				|  |  | -+		return "TI AR7 (TNETD7100)";
 | 
	
		
			
				|  |  | -+	case AR7_CHIP_7200:
 | 
	
		
			
				|  |  | -+		return "TI AR7 (TNETD7200)";
 | 
	
		
			
				|  |  | -+	default:
 | 
	
		
			
				|  |  | -+		return "TI AR7 (Unknown)";
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int __init ar7_init_console(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Initializes basic routines and structures pointers, memory size (as
 | 
	
		
			
				|  |  | -+ * given by the bios and saves the command line.
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+extern void ar7_init_clocks(void);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+void __init plat_mem_setup(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	unsigned long io_base;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	_machine_restart = ar7_machine_restart;
 | 
	
		
			
				|  |  | -+	_machine_halt = ar7_machine_halt;
 | 
	
		
			
				|  |  | -+	pm_power_off = ar7_machine_power_off;
 | 
	
		
			
				|  |  | -+	panic_timeout = 3;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	io_base = (unsigned long)ioremap(AR7_REGS_BASE, 0x10000);
 | 
	
		
			
				|  |  | -+	if (!io_base) panic("Can't remap IO base!\n");
 | 
	
		
			
				|  |  | -+	set_io_port_base(io_base);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	prom_meminit();
 | 
	
		
			
				|  |  | -+	ar7_init_clocks();
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	ioport_resource.start = 0;
 | 
	
		
			
				|  |  | -+	ioport_resource.end   = ~0;
 | 
	
		
			
				|  |  | -+	iomem_resource.start  = 0;
 | 
	
		
			
				|  |  | -+	iomem_resource.end    = ~0;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	printk(KERN_INFO "%s, ID: 0x%04x, Revision: 0x%02x\n",
 | 
	
		
			
				|  |  | -+					get_system_type(),
 | 
	
		
			
				|  |  | -+		ar7_chip_id(), ar7_chip_rev());
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+console_initcall(ar7_init_console);
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/ar7/time.c linux-2.6.30.5/arch/mips/ar7/time.c
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/ar7/time.c	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/ar7/time.c	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,28 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Carsten Langgaard, carstenl@mips.com
 | 
	
		
			
				|  |  | -+ * Copyright (C) 1999,2000 MIPS Technologies, Inc.  All rights reserved.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ *  This program is free software; you can distribute it and/or modify it
 | 
	
		
			
				|  |  | -+ *  under the terms of the GNU General Public License (Version 2) as
 | 
	
		
			
				|  |  | -+ *  published by the Free Software Foundation.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ *  This program is distributed in the hope 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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * Setting up the clock on the MIPS boards.
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <linux/version.h>
 | 
	
		
			
				|  |  | -+#include <asm/time.h>
 | 
	
		
			
				|  |  | -+#include <asm/ar7/ar7.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+void __init plat_time_init(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	mips_hpt_frequency = ar7_cpu_freq() / 2;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/include/asm/ar7/ar7.h linux-2.6.30.5/arch/mips/include/asm/ar7/ar7.h
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/include/asm/ar7/ar7.h	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/include/asm/ar7/ar7.h	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,170 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2006,2007 Felix Fietkau <nbd@openwrt.org>
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2006,2007 Eugene Konev <ejka@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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#ifndef __AR7_H__
 | 
	
		
			
				|  |  | -+#define __AR7_H__
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <linux/delay.h>
 | 
	
		
			
				|  |  | -+#include <asm/addrspace.h>
 | 
	
		
			
				|  |  | -+#include <linux/io.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define AR7_REGS_BASE	0x08610000
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define AR7_REGS_MAC0	(AR7_REGS_BASE + 0x0000)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_GPIO	(AR7_REGS_BASE + 0x0900)
 | 
	
		
			
				|  |  | -+/* 0x08610A00 - 0x08610BFF (512 bytes, 128 bytes / clock) */
 | 
	
		
			
				|  |  | -+#define AR7_REGS_POWER	(AR7_REGS_BASE + 0x0a00)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_UART0	(AR7_REGS_BASE + 0x0e00)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_USB	(AR7_REGS_BASE + 0x1200)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_RESET	(AR7_REGS_BASE + 0x1600)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_VLYNQ0	(AR7_REGS_BASE + 0x1800)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_DCL	(AR7_REGS_BASE + 0x1a00)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_VLYNQ1	(AR7_REGS_BASE + 0x1c00)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_MDIO	(AR7_REGS_BASE + 0x1e00)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_IRQ	(AR7_REGS_BASE + 0x2400)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_MAC1	(AR7_REGS_BASE + 0x2800)
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define AR7_REGS_WDT	(AR7_REGS_BASE + 0x1f00)
 | 
	
		
			
				|  |  | -+#define UR8_REGS_WDT	(AR7_REGS_BASE + 0x0b00)
 | 
	
		
			
				|  |  | -+#define UR8_REGS_UART1	(AR7_REGS_BASE + 0x0f00)
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define AR7_RESET_PEREPHERIAL	0x0
 | 
	
		
			
				|  |  | -+#define AR7_RESET_SOFTWARE	0x4
 | 
	
		
			
				|  |  | -+#define AR7_RESET_STATUS	0x8
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define AR7_RESET_BIT_CPMAC_LO	17
 | 
	
		
			
				|  |  | -+#define AR7_RESET_BIT_CPMAC_HI	21
 | 
	
		
			
				|  |  | -+#define AR7_RESET_BIT_MDIO	22
 | 
	
		
			
				|  |  | -+#define AR7_RESET_BIT_EPHY	26
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/* GPIO control registers */
 | 
	
		
			
				|  |  | -+#define AR7_GPIO_INPUT	0x0
 | 
	
		
			
				|  |  | -+#define AR7_GPIO_OUTPUT	0x4
 | 
	
		
			
				|  |  | -+#define AR7_GPIO_DIR	0x8
 | 
	
		
			
				|  |  | -+#define AR7_GPIO_ENABLE	0xc
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define AR7_CHIP_7100	0x18
 | 
	
		
			
				|  |  | -+#define AR7_CHIP_7200	0x2b
 | 
	
		
			
				|  |  | -+#define AR7_CHIP_7300	0x05
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/* Interrupts */
 | 
	
		
			
				|  |  | -+#define AR7_IRQ_UART0	15
 | 
	
		
			
				|  |  | -+#define AR7_IRQ_UART1	16
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/* Clocks */
 | 
	
		
			
				|  |  | -+#define AR7_AFE_CLOCK	35328000
 | 
	
		
			
				|  |  | -+#define AR7_REF_CLOCK	25000000
 | 
	
		
			
				|  |  | -+#define AR7_XTAL_CLOCK	24000000
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct plat_cpmac_data {
 | 
	
		
			
				|  |  | -+	int reset_bit;
 | 
	
		
			
				|  |  | -+	int power_bit;
 | 
	
		
			
				|  |  | -+	u32 phy_mask;
 | 
	
		
			
				|  |  | -+	char dev_addr[6];
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct plat_dsl_data {
 | 
	
		
			
				|  |  | -+	int reset_bit_dsl;
 | 
	
		
			
				|  |  | -+	int reset_bit_sar;
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+extern int ar7_cpu_clock, ar7_bus_clock, ar7_dsp_clock;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline u16 ar7_chip_id(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return readl((void *)KSEG1ADDR(AR7_REGS_GPIO + 0x14)) & 0xffff;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline u8 ar7_chip_rev(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return (readl((void *)KSEG1ADDR(AR7_REGS_GPIO + 0x14)) >> 16) & 0xff;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int ar7_cpu_freq(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return ar7_cpu_clock;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int ar7_bus_freq(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return ar7_bus_clock;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int ar7_vbus_freq(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return ar7_bus_clock / 2;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+#define ar7_cpmac_freq ar7_vbus_freq
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int ar7_dsp_freq(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return ar7_dsp_clock;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int ar7_has_high_cpmac(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	u16 chip_id = ar7_chip_id();
 | 
	
		
			
				|  |  | -+	switch (chip_id) {
 | 
	
		
			
				|  |  | -+	case AR7_CHIP_7100:
 | 
	
		
			
				|  |  | -+	case AR7_CHIP_7200:
 | 
	
		
			
				|  |  | -+		return 0;
 | 
	
		
			
				|  |  | -+	default:
 | 
	
		
			
				|  |  | -+		return 1;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+#define ar7_has_high_vlynq ar7_has_high_cpmac
 | 
	
		
			
				|  |  | -+#define ar7_has_second_uart ar7_has_high_cpmac
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline void ar7_device_enable(u32 bit)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void *reset_reg =
 | 
	
		
			
				|  |  | -+		(void *)KSEG1ADDR(AR7_REGS_RESET + AR7_RESET_PEREPHERIAL);
 | 
	
		
			
				|  |  | -+	writel(readl(reset_reg) | (1 << bit), reset_reg);
 | 
	
		
			
				|  |  | -+	mdelay(20);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline void ar7_device_disable(u32 bit)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void *reset_reg =
 | 
	
		
			
				|  |  | -+		(void *)KSEG1ADDR(AR7_REGS_RESET + AR7_RESET_PEREPHERIAL);
 | 
	
		
			
				|  |  | -+	writel(readl(reset_reg) & ~(1 << bit), reset_reg);
 | 
	
		
			
				|  |  | -+	mdelay(20);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline void ar7_device_reset(u32 bit)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	ar7_device_disable(bit);
 | 
	
		
			
				|  |  | -+	ar7_device_enable(bit);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline void ar7_device_on(u32 bit)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void *power_reg = (void *)KSEG1ADDR(AR7_REGS_POWER);
 | 
	
		
			
				|  |  | -+	writel(readl(power_reg) | (1 << bit), power_reg);
 | 
	
		
			
				|  |  | -+	mdelay(20);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline void ar7_device_off(u32 bit)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void *power_reg = (void *)KSEG1ADDR(AR7_REGS_POWER);
 | 
	
		
			
				|  |  | -+	writel(readl(power_reg) & ~(1 << bit), power_reg);
 | 
	
		
			
				|  |  | -+	mdelay(20);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#endif /* __AR7_H__ */
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/include/asm/ar7/gpio.h linux-2.6.30.5/arch/mips/include/asm/ar7/gpio.h
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/include/asm/ar7/gpio.h	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/include/asm/ar7/gpio.h	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,109 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2007 Florian Fainelli <florian@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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#ifndef __AR7_GPIO_H__
 | 
	
		
			
				|  |  | -+#define __AR7_GPIO_H__
 | 
	
		
			
				|  |  | -+#include <asm/ar7/ar7.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define AR7_GPIO_MAX 32
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+extern int gpio_request(unsigned gpio, const char *label);
 | 
	
		
			
				|  |  | -+extern void gpio_free(unsigned gpio);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/* Common GPIO layer */
 | 
	
		
			
				|  |  | -+static inline int gpio_get_value(unsigned gpio)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void __iomem *gpio_in =
 | 
	
		
			
				|  |  | -+		(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_INPUT);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return readl(gpio_in) & (1 << gpio);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline void gpio_set_value(unsigned gpio, int value)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void __iomem *gpio_out =
 | 
	
		
			
				|  |  | -+		(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_OUTPUT);
 | 
	
		
			
				|  |  | -+	unsigned tmp;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	tmp = readl(gpio_out) & ~(1 << gpio);
 | 
	
		
			
				|  |  | -+	if (value)
 | 
	
		
			
				|  |  | -+		tmp |= 1 << gpio;
 | 
	
		
			
				|  |  | -+	writel(tmp, gpio_out);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int gpio_direction_input(unsigned gpio)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void __iomem *gpio_dir =
 | 
	
		
			
				|  |  | -+		(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_DIR);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (gpio >= AR7_GPIO_MAX)
 | 
	
		
			
				|  |  | -+		return -EINVAL;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel(readl(gpio_dir) | (1 << gpio), gpio_dir);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int gpio_direction_output(unsigned gpio, int value)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void __iomem *gpio_dir =
 | 
	
		
			
				|  |  | -+		(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_DIR);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (gpio >= AR7_GPIO_MAX)
 | 
	
		
			
				|  |  | -+		return -EINVAL;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	gpio_set_value(gpio, value);
 | 
	
		
			
				|  |  | -+	writel(readl(gpio_dir) & ~(1 << gpio), gpio_dir);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int gpio_to_irq(unsigned gpio)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return -EINVAL;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int irq_to_gpio(unsigned irq)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return -EINVAL;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/* Board specific GPIO functions */
 | 
	
		
			
				|  |  | -+static inline int ar7_gpio_enable(unsigned gpio)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void __iomem *gpio_en =
 | 
	
		
			
				|  |  | -+		(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_ENABLE);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel(readl(gpio_en) | (1 << gpio), gpio_en);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int ar7_gpio_disable(unsigned gpio)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void __iomem *gpio_en =
 | 
	
		
			
				|  |  | -+		(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_ENABLE);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel(readl(gpio_en) & ~(1 << gpio), gpio_en);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <asm-generic/gpio.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#endif
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/include/asm/ar7/irq.h linux-2.6.30.5/arch/mips/include/asm/ar7/irq.h
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/include/asm/ar7/irq.h	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/include/asm/ar7/irq.h	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,16 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * 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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * Shamelessly copied from asm-mips/mach-emma2rh/
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2003 by Ralf Baechle
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+#ifndef __ASM_AR7_IRQ_H
 | 
	
		
			
				|  |  | -+#define __ASM_AR7_IRQ_H
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define NR_IRQS	256
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include_next <irq.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#endif /* __ASM_AR7_IRQ_H */
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/include/asm/ar7/prom.h linux-2.6.30.5/arch/mips/include/asm/ar7/prom.h
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/include/asm/ar7/prom.h	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/include/asm/ar7/prom.h	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,26 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2006, 2007 Florian Fainelli <florian@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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#ifndef __PROM_H__
 | 
	
		
			
				|  |  | -+#define __PROM_H__
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+extern char *prom_getenv(const char *name);
 | 
	
		
			
				|  |  | -+extern void prom_printf(const char *fmt, ...) __attribute__((format(printf, 1, 2)));
 | 
	
		
			
				|  |  | -+extern void prom_meminit(void);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#endif /* __PROM_H__ */
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/include/asm/ar7/spaces.h linux-2.6.30.5/arch/mips/include/asm/ar7/spaces.h
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/include/asm/ar7/spaces.h	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/include/asm/ar7/spaces.h	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,32 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * 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) 1994 - 1999, 2000, 03, 04 Ralf Baechle
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2000, 2002  Maciej W. Rozycki
 | 
	
		
			
				|  |  | -+ * Copyright (C) 1990, 1999, 2000 Silicon Graphics, Inc.
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+#ifndef _ASM_AR7_SPACES_H
 | 
	
		
			
				|  |  | -+#define _ASM_AR7_SPACES_H
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define CAC_BASE		0x80000000
 | 
	
		
			
				|  |  | -+#define IO_BASE			0xa0000000
 | 
	
		
			
				|  |  | -+#define UNCAC_BASE		0xa0000000
 | 
	
		
			
				|  |  | -+#define MAP_BASE		0xc0000000
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * This handles the memory map.
 | 
	
		
			
				|  |  | -+ * We handle pages at KSEG0 for kernels with 32 bit address space.
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+#define PAGE_OFFSET		0x94000000UL
 | 
	
		
			
				|  |  | -+#define PHYS_OFFSET		0x14000000UL
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Memory above this physical address will be considered highmem.
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+#ifndef HIGHMEM_START
 | 
	
		
			
				|  |  | -+#define HIGHMEM_START		0x40000000UL
 | 
	
		
			
				|  |  | -+#endif
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#endif /* __ASM_AR7_SPACES_H */
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/include/asm/ar7/war.h linux-2.6.30.5/arch/mips/include/asm/ar7/war.h
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/include/asm/ar7/war.h	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/include/asm/ar7/war.h	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,25 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * 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) 2002, 2004, 2007 by Ralf Baechle <ralf@linux-mips.org>
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+#ifndef __ASM_MIPS_MACH_BCM947XX_WAR_H
 | 
	
		
			
				|  |  | -+#define __ASM_MIPS_MACH_BCM947XX_WAR_H
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define R4600_V1_INDEX_ICACHEOP_WAR	0
 | 
	
		
			
				|  |  | -+#define R4600_V1_HIT_CACHEOP_WAR	0
 | 
	
		
			
				|  |  | -+#define R4600_V2_HIT_CACHEOP_WAR	0
 | 
	
		
			
				|  |  | -+#define R5432_CP0_INTERRUPT_WAR		0
 | 
	
		
			
				|  |  | -+#define BCM1250_M3_WAR			0
 | 
	
		
			
				|  |  | -+#define SIBYTE_1956_WAR			0
 | 
	
		
			
				|  |  | -+#define MIPS4K_ICACHE_REFILL_WAR	0
 | 
	
		
			
				|  |  | -+#define MIPS_CACHE_SYNC_WAR		0
 | 
	
		
			
				|  |  | -+#define TX49XX_ICACHE_INDEX_INV_WAR	0
 | 
	
		
			
				|  |  | -+#define RM9000_CDEX_SMP_WAR		0
 | 
	
		
			
				|  |  | -+#define ICACHE_REFILLS_WORKAROUND_WAR	0
 | 
	
		
			
				|  |  | -+#define R10000_LLSC_WAR			0
 | 
	
		
			
				|  |  | -+#define MIPS34K_MISSED_ITLB_WAR		0
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#endif /* __ASM_MIPS_MACH_BCM947XX_WAR_H */
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/include/asm/page.h linux-2.6.30.5/arch/mips/include/asm/page.h
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/include/asm/page.h	2009-08-16 23:19:38.000000000 +0200
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/include/asm/page.h	2009-08-26 20:05:14.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -185,8 +185,10 @@
 | 
	
		
			
				|  |  | - #define VM_DATA_DEFAULT_FLAGS	(VM_READ | VM_WRITE | VM_EXEC | \
 | 
	
		
			
				|  |  | - 				 VM_MAYREAD | VM_MAYWRITE | VM_MAYEXEC)
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | --#define UNCAC_ADDR(addr)	((addr) - PAGE_OFFSET + UNCAC_BASE)
 | 
	
		
			
				|  |  | --#define CAC_ADDR(addr)		((addr) - UNCAC_BASE + PAGE_OFFSET)
 | 
	
		
			
				|  |  | -+#define UNCAC_ADDR(addr)	((addr) - PAGE_OFFSET + UNCAC_BASE +	\
 | 
	
		
			
				|  |  | -+				 PHYS_OFFSET)
 | 
	
		
			
				|  |  | -+#define CAC_ADDR(addr)		((addr) - UNCAC_BASE + PAGE_OFFSET -	\
 | 
	
		
			
				|  |  | -+				 PHYS_OFFSET)
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - #include <asm-generic/memory_model.h>
 | 
	
		
			
				|  |  | - #include <asm-generic/page.h>
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/Kconfig linux-2.6.30.5/arch/mips/Kconfig
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/Kconfig	2009-08-16 23:19:38.000000000 +0200
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/Kconfig	2009-08-27 21:44:10.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -19,6 +19,23 @@
 | 
	
		
			
				|  |  | - 	prompt "System type"
 | 
	
		
			
				|  |  | - 	default SGI_IP22
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | -+config AR7
 | 
	
		
			
				|  |  | -+	bool "Texas Instruments AR7"
 | 
	
		
			
				|  |  | -+	select BOOT_ELF32
 | 
	
		
			
				|  |  | -+	select DMA_NONCOHERENT
 | 
	
		
			
				|  |  | -+	select CEVT_R4K
 | 
	
		
			
				|  |  | -+	select CSRC_R4K
 | 
	
		
			
				|  |  | -+	select IRQ_CPU
 | 
	
		
			
				|  |  | -+	select SWAP_IO_SPACE
 | 
	
		
			
				|  |  | -+	select SYS_HAS_CPU_MIPS32_R1
 | 
	
		
			
				|  |  | -+	select SYS_HAS_EARLY_PRINTK
 | 
	
		
			
				|  |  | -+	select SYS_SUPPORTS_32BIT_KERNEL
 | 
	
		
			
				|  |  | -+	select SYS_SUPPORTS_KGDB
 | 
	
		
			
				|  |  | -+	select SYS_SUPPORTS_LITTLE_ENDIAN
 | 
	
		
			
				|  |  | -+	select SYS_SUPPORTS_BIG_ENDIAN
 | 
	
		
			
				|  |  | -+	select GENERIC_GPIO
 | 
	
		
			
				|  |  | -+	select GENERIC_HARDIRQS_NO__DO_IRQ
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | - config MACH_ALCHEMY
 | 
	
		
			
				|  |  | - 	bool "Alchemy processor based machines"
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/kernel/traps.c linux-2.6.30.5/arch/mips/kernel/traps.c
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/kernel/traps.c	2009-08-16 23:19:38.000000000 +0200
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/kernel/traps.c	2009-08-26 20:05:14.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -1256,9 +1256,22 @@
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - 	exception_handlers[n] = handler;
 | 
	
		
			
				|  |  | - 	if (n == 0 && cpu_has_divec) {
 | 
	
		
			
				|  |  | --		*(u32 *)(ebase + 0x200) = 0x08000000 |
 | 
	
		
			
				|  |  | --					  (0x03ffffff & (handler >> 2));
 | 
	
		
			
				|  |  | --		local_flush_icache_range(ebase + 0x200, ebase + 0x204);
 | 
	
		
			
				|  |  | -+		if ((handler ^ (ebase + 4)) & 0xfc000000) {
 | 
	
		
			
				|  |  | -+			/* lui k0, 0x0000 */
 | 
	
		
			
				|  |  | -+			*(u32 *)(ebase + 0x200) = 0x3c1a0000 | (handler >> 16);
 | 
	
		
			
				|  |  | -+			/* ori k0, 0x0000 */
 | 
	
		
			
				|  |  | -+			*(u32 *)(ebase + 0x204) =
 | 
	
		
			
				|  |  | -+					0x375a0000 | (handler & 0xffff);
 | 
	
		
			
				|  |  | -+			/* jr k0 */
 | 
	
		
			
				|  |  | -+			*(u32 *)(ebase + 0x208) = 0x03400008;
 | 
	
		
			
				|  |  | -+			/* nop */
 | 
	
		
			
				|  |  | -+			*(u32 *)(ebase + 0x20C) = 0x00000000;
 | 
	
		
			
				|  |  | -+			flush_icache_range(ebase + 0x200, ebase + 0x210);
 | 
	
		
			
				|  |  | -+		} else {
 | 
	
		
			
				|  |  | -+			*(u32 *)(ebase + 0x200) =
 | 
	
		
			
				|  |  | -+				0x08000000 | (0x03ffffff & (handler >> 2));
 | 
	
		
			
				|  |  | -+			flush_icache_range(ebase + 0x200, ebase + 0x204);
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | - 	}
 | 
	
		
			
				|  |  | - 	return (void *)old_handler;
 | 
	
		
			
				|  |  | - }
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/arch/mips/Makefile linux-2.6.30.5/arch/mips/Makefile
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/arch/mips/Makefile	2009-08-16 23:19:38.000000000 +0200
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/arch/mips/Makefile	2009-08-26 20:05:14.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -174,6 +174,13 @@
 | 
	
		
			
				|  |  | - #
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - #
 | 
	
		
			
				|  |  | -+# Texas Instruments AR7
 | 
	
		
			
				|  |  | -+#
 | 
	
		
			
				|  |  | -+core-$(CONFIG_AR7)		+= arch/mips/ar7/
 | 
	
		
			
				|  |  | -+cflags-$(CONFIG_AR7)		+= -Iinclude/asm-mips/ar7
 | 
	
		
			
				|  |  | -+load-$(CONFIG_AR7)		+= 0xffffffff94100000
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#
 | 
	
		
			
				|  |  | - # Acer PICA 61, Mips Magnum 4000 and Olivetti M700.
 | 
	
		
			
				|  |  | - #
 | 
	
		
			
				|  |  | - core-$(CONFIG_MACH_JAZZ)	+= arch/mips/jazz/
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/drivers/char/ar7_gpio.c linux-2.6.30.5/drivers/char/ar7_gpio.c
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/drivers/char/ar7_gpio.c	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/drivers/char/ar7_gpio.c	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,158 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2007 Nicolas Thill <nico@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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <linux/device.h>
 | 
	
		
			
				|  |  | -+#include <linux/fs.h>
 | 
	
		
			
				|  |  | -+#include <linux/module.h>
 | 
	
		
			
				|  |  | -+#include <linux/errno.h>
 | 
	
		
			
				|  |  | -+#include <linux/kernel.h>
 | 
	
		
			
				|  |  | -+#include <linux/init.h>
 | 
	
		
			
				|  |  | -+#include <linux/platform_device.h>
 | 
	
		
			
				|  |  | -+#include <linux/uaccess.h>
 | 
	
		
			
				|  |  | -+#include <linux/io.h>
 | 
	
		
			
				|  |  | -+#include <linux/types.h>
 | 
	
		
			
				|  |  | -+#include <linux/cdev.h>
 | 
	
		
			
				|  |  | -+#include <gpio.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define DRVNAME "ar7_gpio"
 | 
	
		
			
				|  |  | -+#define LONGNAME "TI AR7 GPIOs Driver"
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+MODULE_AUTHOR("Nicolas Thill <nico@openwrt.org>");
 | 
	
		
			
				|  |  | -+MODULE_DESCRIPTION(LONGNAME);
 | 
	
		
			
				|  |  | -+MODULE_LICENSE("GPL");
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int ar7_gpio_major;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static ssize_t ar7_gpio_write(struct file *file, const char __user *buf,
 | 
	
		
			
				|  |  | -+	size_t len, loff_t *ppos)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int pin = iminor(file->f_dentry->d_inode);
 | 
	
		
			
				|  |  | -+	size_t i;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	for (i = 0; i < len; ++i) {
 | 
	
		
			
				|  |  | -+		char c;
 | 
	
		
			
				|  |  | -+		if (get_user(c, buf + i))
 | 
	
		
			
				|  |  | -+			return -EFAULT;
 | 
	
		
			
				|  |  | -+		switch (c) {
 | 
	
		
			
				|  |  | -+		case '0':
 | 
	
		
			
				|  |  | -+			gpio_set_value(pin, 0);
 | 
	
		
			
				|  |  | -+			break;
 | 
	
		
			
				|  |  | -+		case '1':
 | 
	
		
			
				|  |  | -+			gpio_set_value(pin, 1);
 | 
	
		
			
				|  |  | -+			break;
 | 
	
		
			
				|  |  | -+		case 'd':
 | 
	
		
			
				|  |  | -+		case 'D':
 | 
	
		
			
				|  |  | -+			ar7_gpio_disable(pin);
 | 
	
		
			
				|  |  | -+			break;
 | 
	
		
			
				|  |  | -+		case 'e':
 | 
	
		
			
				|  |  | -+		case 'E':
 | 
	
		
			
				|  |  | -+			ar7_gpio_enable(pin);
 | 
	
		
			
				|  |  | -+			break;
 | 
	
		
			
				|  |  | -+		case 'i':
 | 
	
		
			
				|  |  | -+		case 'I':
 | 
	
		
			
				|  |  | -+		case '<':
 | 
	
		
			
				|  |  | -+			gpio_direction_input(pin);
 | 
	
		
			
				|  |  | -+			break;
 | 
	
		
			
				|  |  | -+		case 'o':
 | 
	
		
			
				|  |  | -+		case 'O':
 | 
	
		
			
				|  |  | -+		case '>':
 | 
	
		
			
				|  |  | -+			gpio_direction_output(pin, 0);
 | 
	
		
			
				|  |  | -+			break;
 | 
	
		
			
				|  |  | -+		default:
 | 
	
		
			
				|  |  | -+			return -EINVAL;
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return len;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static ssize_t ar7_gpio_read(struct file *file, char __user *buf,
 | 
	
		
			
				|  |  | -+	size_t len, loff_t *ppos)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int pin = iminor(file->f_dentry->d_inode);
 | 
	
		
			
				|  |  | -+	int value;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	value = gpio_get_value(pin);
 | 
	
		
			
				|  |  | -+	if (put_user(value ? '1' : '0', buf))
 | 
	
		
			
				|  |  | -+		return -EFAULT;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 1;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int ar7_gpio_open(struct inode *inode, struct file *file)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int m = iminor(inode);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (m >= AR7_GPIO_MAX)
 | 
	
		
			
				|  |  | -+		return -EINVAL;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return nonseekable_open(inode, file);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int ar7_gpio_release(struct inode *inode, struct file *file)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static const struct file_operations ar7_gpio_fops = {
 | 
	
		
			
				|  |  | -+	.owner   = THIS_MODULE,
 | 
	
		
			
				|  |  | -+	.write   = ar7_gpio_write,
 | 
	
		
			
				|  |  | -+	.read    = ar7_gpio_read,
 | 
	
		
			
				|  |  | -+	.open    = ar7_gpio_open,
 | 
	
		
			
				|  |  | -+	.release = ar7_gpio_release,
 | 
	
		
			
				|  |  | -+	.llseek  = no_llseek,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct platform_device *ar7_gpio_device;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int __init ar7_gpio_init(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int rc;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	ar7_gpio_device = platform_device_alloc(DRVNAME, -1);
 | 
	
		
			
				|  |  | -+	if (!ar7_gpio_device)
 | 
	
		
			
				|  |  | -+		return -ENOMEM;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	rc = platform_device_add(ar7_gpio_device);
 | 
	
		
			
				|  |  | -+	if (rc < 0)
 | 
	
		
			
				|  |  | -+		goto out_put;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	rc = register_chrdev(ar7_gpio_major, DRVNAME, &ar7_gpio_fops);
 | 
	
		
			
				|  |  | -+	if (rc < 0)
 | 
	
		
			
				|  |  | -+		goto out_put;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	ar7_gpio_major = rc;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	rc = 0;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	goto out;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+out_put:
 | 
	
		
			
				|  |  | -+	platform_device_put(ar7_gpio_device);
 | 
	
		
			
				|  |  | -+out:
 | 
	
		
			
				|  |  | -+	return rc;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void __exit ar7_gpio_exit(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	unregister_chrdev(ar7_gpio_major, DRVNAME);
 | 
	
		
			
				|  |  | -+	platform_device_unregister(ar7_gpio_device);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+module_init(ar7_gpio_init);
 | 
	
		
			
				|  |  | -+module_exit(ar7_gpio_exit);
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/drivers/char/Kconfig linux-2.6.30.5/drivers/char/Kconfig
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/drivers/char/Kconfig	2009-08-16 23:19:38.000000000 +0200
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/drivers/char/Kconfig	2009-08-26 20:05:23.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -974,6 +974,15 @@
 | 
	
		
			
				|  |  | - 	  To compile this driver as a module, choose M here: the
 | 
	
		
			
				|  |  | - 	  module will be called mwave.
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | -+config AR7_GPIO
 | 
	
		
			
				|  |  | -+	tristate "TI AR7 GPIO Support"
 | 
	
		
			
				|  |  | -+	depends on AR7
 | 
	
		
			
				|  |  | -+	help
 | 
	
		
			
				|  |  | -+	  Give userspace access to the GPIO pins on the Texas Instruments AR7 
 | 
	
		
			
				|  |  | -+	  processors.
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	  If compiled as a module, it will be called ar7_gpio.
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | - config SCx200_GPIO
 | 
	
		
			
				|  |  | - 	tristate "NatSemi SCx200 GPIO Support"
 | 
	
		
			
				|  |  | - 	depends on SCx200
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/drivers/char/Makefile linux-2.6.30.5/drivers/char/Makefile
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/drivers/char/Makefile	2009-08-16 23:19:38.000000000 +0200
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/drivers/char/Makefile	2009-08-26 20:05:23.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -90,6 +90,7 @@
 | 
	
		
			
				|  |  | - obj-$(CONFIG_PPDEV)		+= ppdev.o
 | 
	
		
			
				|  |  | - obj-$(CONFIG_NWBUTTON)		+= nwbutton.o
 | 
	
		
			
				|  |  | - obj-$(CONFIG_NWFLASH)		+= nwflash.o
 | 
	
		
			
				|  |  | -+obj-$(CONFIG_AR7_GPIO)		+= ar7_gpio.o
 | 
	
		
			
				|  |  | - obj-$(CONFIG_SCx200_GPIO)	+= scx200_gpio.o
 | 
	
		
			
				|  |  | - obj-$(CONFIG_PC8736x_GPIO)	+= pc8736x_gpio.o
 | 
	
		
			
				|  |  | - obj-$(CONFIG_NSC_GPIO)		+= nsc_gpio.o
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/drivers/char/watchdog/ar7_wdt.c linux-2.6.30.5/drivers/char/watchdog/ar7_wdt.c
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/drivers/char/watchdog/ar7_wdt.c	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/drivers/char/watchdog/ar7_wdt.c	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,349 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * drivers/watchdog/ar7_wdt.c
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2007 Nicolas Thill <nico@openwrt.org>
 | 
	
		
			
				|  |  | -+ * Copyright (c) 2005 Enrik Berkhan <Enrik.Berkhan@akk.org>
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * Some code taken from:
 | 
	
		
			
				|  |  | -+ * National Semiconductor SCx200 Watchdog support
 | 
	
		
			
				|  |  | -+ * Copyright (c) 2001,2002 Christer Weinigel <wingel@nano-system.com>
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <linux/module.h>
 | 
	
		
			
				|  |  | -+#include <linux/moduleparam.h>
 | 
	
		
			
				|  |  | -+#include <linux/errno.h>
 | 
	
		
			
				|  |  | -+#include <linux/init.h>
 | 
	
		
			
				|  |  | -+#include <linux/miscdevice.h>
 | 
	
		
			
				|  |  | -+#include <linux/watchdog.h>
 | 
	
		
			
				|  |  | -+#include <linux/notifier.h>
 | 
	
		
			
				|  |  | -+#include <linux/reboot.h>
 | 
	
		
			
				|  |  | -+#include <linux/fs.h>
 | 
	
		
			
				|  |  | -+#include <linux/ioport.h>
 | 
	
		
			
				|  |  | -+#include <linux/io.h>
 | 
	
		
			
				|  |  | -+#include <linux/uaccess.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <asm/addrspace.h>
 | 
	
		
			
				|  |  | -+#include <asm/ar7/ar7.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define DRVNAME "ar7_wdt"
 | 
	
		
			
				|  |  | -+#define LONGNAME "TI AR7 Watchdog Timer"
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+MODULE_AUTHOR("Nicolas Thill <nico@openwrt.org>");
 | 
	
		
			
				|  |  | -+MODULE_DESCRIPTION(LONGNAME);
 | 
	
		
			
				|  |  | -+MODULE_LICENSE("GPL");
 | 
	
		
			
				|  |  | -+MODULE_ALIAS_MISCDEV(WATCHDOG_MINOR);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int margin = 60;
 | 
	
		
			
				|  |  | -+module_param(margin, int, 0);
 | 
	
		
			
				|  |  | -+MODULE_PARM_DESC(margin, "Watchdog margin in seconds");
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int nowayout = WATCHDOG_NOWAYOUT;
 | 
	
		
			
				|  |  | -+module_param(nowayout, int, 0);
 | 
	
		
			
				|  |  | -+MODULE_PARM_DESC(nowayout, "Disable watchdog shutdown on close");
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define READ_REG(x) readl((void __iomem *)&(x))
 | 
	
		
			
				|  |  | -+#define WRITE_REG(x, v) writel((v), (void __iomem *)&(x))
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct ar7_wdt {
 | 
	
		
			
				|  |  | -+	u32 kick_lock;
 | 
	
		
			
				|  |  | -+	u32 kick;
 | 
	
		
			
				|  |  | -+	u32 change_lock;
 | 
	
		
			
				|  |  | -+	u32 change;
 | 
	
		
			
				|  |  | -+	u32 disable_lock;
 | 
	
		
			
				|  |  | -+	u32 disable;
 | 
	
		
			
				|  |  | -+	u32 prescale_lock;
 | 
	
		
			
				|  |  | -+	u32 prescale;
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct semaphore open_semaphore;
 | 
	
		
			
				|  |  | -+static unsigned expect_close;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/* XXX currently fixed, allows max margin ~68.72 secs */
 | 
	
		
			
				|  |  | -+#define prescale_value 0xffff
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/* Offset of the WDT registers */
 | 
	
		
			
				|  |  | -+static unsigned long ar7_regs_wdt;
 | 
	
		
			
				|  |  | -+/* Pointer to the remapped WDT IO space */
 | 
	
		
			
				|  |  | -+static struct ar7_wdt *ar7_wdt;
 | 
	
		
			
				|  |  | -+static void ar7_wdt_get_regs(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	u16 chip_id = ar7_chip_id();
 | 
	
		
			
				|  |  | -+	switch (chip_id) {
 | 
	
		
			
				|  |  | -+	case AR7_CHIP_7100:
 | 
	
		
			
				|  |  | -+	case AR7_CHIP_7200:
 | 
	
		
			
				|  |  | -+		ar7_regs_wdt = AR7_REGS_WDT;
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	default:
 | 
	
		
			
				|  |  | -+		ar7_regs_wdt = UR8_REGS_WDT;
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_wdt_kick(u32 value)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	WRITE_REG(ar7_wdt->kick_lock, 0x5555);
 | 
	
		
			
				|  |  | -+	if ((READ_REG(ar7_wdt->kick_lock) & 3) == 1) {
 | 
	
		
			
				|  |  | -+		WRITE_REG(ar7_wdt->kick_lock, 0xaaaa);
 | 
	
		
			
				|  |  | -+		if ((READ_REG(ar7_wdt->kick_lock) & 3) == 3) {
 | 
	
		
			
				|  |  | -+			WRITE_REG(ar7_wdt->kick, value);
 | 
	
		
			
				|  |  | -+			return;
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	printk(KERN_ERR DRVNAME ": failed to unlock WDT kick reg\n");
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_wdt_prescale(u32 value)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	WRITE_REG(ar7_wdt->prescale_lock, 0x5a5a);
 | 
	
		
			
				|  |  | -+	if ((READ_REG(ar7_wdt->prescale_lock) & 3) == 1) {
 | 
	
		
			
				|  |  | -+		WRITE_REG(ar7_wdt->prescale_lock, 0xa5a5);
 | 
	
		
			
				|  |  | -+		if ((READ_REG(ar7_wdt->prescale_lock) & 3) == 3) {
 | 
	
		
			
				|  |  | -+			WRITE_REG(ar7_wdt->prescale, value);
 | 
	
		
			
				|  |  | -+			return;
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	printk(KERN_ERR DRVNAME ": failed to unlock WDT prescale reg\n");
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_wdt_change(u32 value)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	WRITE_REG(ar7_wdt->change_lock, 0x6666);
 | 
	
		
			
				|  |  | -+	if ((READ_REG(ar7_wdt->change_lock) & 3) == 1) {
 | 
	
		
			
				|  |  | -+		WRITE_REG(ar7_wdt->change_lock, 0xbbbb);
 | 
	
		
			
				|  |  | -+		if ((READ_REG(ar7_wdt->change_lock) & 3) == 3) {
 | 
	
		
			
				|  |  | -+			WRITE_REG(ar7_wdt->change, value);
 | 
	
		
			
				|  |  | -+			return;
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	printk(KERN_ERR DRVNAME ": failed to unlock WDT change reg\n");
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_wdt_disable(u32 value)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	WRITE_REG(ar7_wdt->disable_lock, 0x7777);
 | 
	
		
			
				|  |  | -+	if ((READ_REG(ar7_wdt->disable_lock) & 3) == 1) {
 | 
	
		
			
				|  |  | -+		WRITE_REG(ar7_wdt->disable_lock, 0xcccc);
 | 
	
		
			
				|  |  | -+		if ((READ_REG(ar7_wdt->disable_lock) & 3) == 2) {
 | 
	
		
			
				|  |  | -+			WRITE_REG(ar7_wdt->disable_lock, 0xdddd);
 | 
	
		
			
				|  |  | -+			if ((READ_REG(ar7_wdt->disable_lock) & 3) == 3) {
 | 
	
		
			
				|  |  | -+				WRITE_REG(ar7_wdt->disable, value);
 | 
	
		
			
				|  |  | -+				return;
 | 
	
		
			
				|  |  | -+			}
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	printk(KERN_ERR DRVNAME ": failed to unlock WDT disable reg\n");
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_wdt_update_margin(int new_margin)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	u32 change;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	change = new_margin * (ar7_vbus_freq() / prescale_value);
 | 
	
		
			
				|  |  | -+	if (change < 1) change = 1;
 | 
	
		
			
				|  |  | -+	if (change > 0xffff) change = 0xffff;
 | 
	
		
			
				|  |  | -+	ar7_wdt_change(change);
 | 
	
		
			
				|  |  | -+	margin = change * prescale_value / ar7_vbus_freq();
 | 
	
		
			
				|  |  | -+	printk(KERN_INFO DRVNAME
 | 
	
		
			
				|  |  | -+	       ": timer margin %d seconds (prescale %d, change %d, freq %d)\n",
 | 
	
		
			
				|  |  | -+	       margin, prescale_value, change, ar7_vbus_freq());
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_wdt_enable_wdt(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	printk(KERN_DEBUG DRVNAME ": enabling watchdog timer\n");
 | 
	
		
			
				|  |  | -+	ar7_wdt_disable(1);
 | 
	
		
			
				|  |  | -+	ar7_wdt_kick(1);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void ar7_wdt_disable_wdt(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	printk(KERN_DEBUG DRVNAME ": disabling watchdog timer\n");
 | 
	
		
			
				|  |  | -+	ar7_wdt_disable(0);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int ar7_wdt_open(struct inode *inode, struct file *file)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	/* only allow one at a time */
 | 
	
		
			
				|  |  | -+	if (down_trylock(&open_semaphore))
 | 
	
		
			
				|  |  | -+		return -EBUSY;
 | 
	
		
			
				|  |  | -+	ar7_wdt_enable_wdt();
 | 
	
		
			
				|  |  | -+	expect_close = 0;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return nonseekable_open(inode, file);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int ar7_wdt_release(struct inode *inode, struct file *file)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	if (!expect_close)
 | 
	
		
			
				|  |  | -+		printk(KERN_WARNING DRVNAME
 | 
	
		
			
				|  |  | -+		": watchdog device closed unexpectedly,"
 | 
	
		
			
				|  |  | -+		"will not disable the watchdog timer\n");
 | 
	
		
			
				|  |  | -+	else if (!nowayout)
 | 
	
		
			
				|  |  | -+		ar7_wdt_disable_wdt();
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	up(&open_semaphore);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int ar7_wdt_notify_sys(struct notifier_block *this,
 | 
	
		
			
				|  |  | -+			      unsigned long code, void *unused)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	if (code == SYS_HALT || code == SYS_POWER_OFF)
 | 
	
		
			
				|  |  | -+		if (!nowayout)
 | 
	
		
			
				|  |  | -+			ar7_wdt_disable_wdt();
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return NOTIFY_DONE;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct notifier_block ar7_wdt_notifier = {
 | 
	
		
			
				|  |  | -+	.notifier_call = ar7_wdt_notify_sys
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static ssize_t ar7_wdt_write(struct file *file, const char *data,
 | 
	
		
			
				|  |  | -+			     size_t len, loff_t *ppos)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	/* check for a magic close character */
 | 
	
		
			
				|  |  | -+	if (len) {
 | 
	
		
			
				|  |  | -+		size_t i;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+		ar7_wdt_kick(1);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+		expect_close = 0;
 | 
	
		
			
				|  |  | -+		for (i = 0; i < len; ++i) {
 | 
	
		
			
				|  |  | -+			char c;
 | 
	
		
			
				|  |  | -+			if (get_user(c, data+i))
 | 
	
		
			
				|  |  | -+				return -EFAULT;
 | 
	
		
			
				|  |  | -+			if (c == 'V')
 | 
	
		
			
				|  |  | -+				expect_close = 1;
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	return len;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int ar7_wdt_ioctl(struct inode *inode, struct file *file,
 | 
	
		
			
				|  |  | -+			 unsigned int cmd, unsigned long arg)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	static struct watchdog_info ident = {
 | 
	
		
			
				|  |  | -+		.identity = LONGNAME,
 | 
	
		
			
				|  |  | -+		.firmware_version = 1,
 | 
	
		
			
				|  |  | -+		.options = (WDIOF_SETTIMEOUT | WDIOF_MAGICCLOSE | WDIOF_KEEPALIVEPING),
 | 
	
		
			
				|  |  | -+	};
 | 
	
		
			
				|  |  | -+	int new_margin;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	switch (cmd) {
 | 
	
		
			
				|  |  | -+	default:
 | 
	
		
			
				|  |  | -+		return -ENOTTY;
 | 
	
		
			
				|  |  | -+	case WDIOC_GETSUPPORT:
 | 
	
		
			
				|  |  | -+		if (copy_to_user((struct watchdog_info *)arg, &ident,
 | 
	
		
			
				|  |  | -+				sizeof(ident)))
 | 
	
		
			
				|  |  | -+			return -EFAULT;
 | 
	
		
			
				|  |  | -+		return 0;
 | 
	
		
			
				|  |  | -+	case WDIOC_GETSTATUS:
 | 
	
		
			
				|  |  | -+	case WDIOC_GETBOOTSTATUS:
 | 
	
		
			
				|  |  | -+		if (put_user(0, (int *)arg))
 | 
	
		
			
				|  |  | -+			return -EFAULT;
 | 
	
		
			
				|  |  | -+		return 0;
 | 
	
		
			
				|  |  | -+	case WDIOC_KEEPALIVE:
 | 
	
		
			
				|  |  | -+		ar7_wdt_kick(1);
 | 
	
		
			
				|  |  | -+		return 0;
 | 
	
		
			
				|  |  | -+	case WDIOC_SETTIMEOUT:
 | 
	
		
			
				|  |  | -+		if (get_user(new_margin, (int *)arg))
 | 
	
		
			
				|  |  | -+			return -EFAULT;
 | 
	
		
			
				|  |  | -+		if (new_margin < 1)
 | 
	
		
			
				|  |  | -+			return -EINVAL;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+		ar7_wdt_update_margin(new_margin);
 | 
	
		
			
				|  |  | -+		ar7_wdt_kick(1);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	case WDIOC_GETTIMEOUT:
 | 
	
		
			
				|  |  | -+		if (put_user(margin, (int *)arg))
 | 
	
		
			
				|  |  | -+			return -EFAULT;
 | 
	
		
			
				|  |  | -+		return 0;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct file_operations ar7_wdt_fops = {
 | 
	
		
			
				|  |  | -+	.owner		= THIS_MODULE,
 | 
	
		
			
				|  |  | -+	.write		= ar7_wdt_write,
 | 
	
		
			
				|  |  | -+	.ioctl		= ar7_wdt_ioctl,
 | 
	
		
			
				|  |  | -+	.open		= ar7_wdt_open,
 | 
	
		
			
				|  |  | -+	.release	= ar7_wdt_release,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct miscdevice ar7_wdt_miscdev = {
 | 
	
		
			
				|  |  | -+	.minor		= WATCHDOG_MINOR,
 | 
	
		
			
				|  |  | -+	.name		= "watchdog",
 | 
	
		
			
				|  |  | -+	.fops		= &ar7_wdt_fops,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int __init ar7_wdt_init(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int rc;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	ar7_wdt_get_regs();
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (!request_mem_region(ar7_regs_wdt, sizeof(struct ar7_wdt),
 | 
	
		
			
				|  |  | -+							LONGNAME)) {
 | 
	
		
			
				|  |  | -+		printk(KERN_WARNING DRVNAME ": watchdog I/O region busy\n");
 | 
	
		
			
				|  |  | -+		return -EBUSY;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	ar7_wdt = (struct ar7_wdt *)
 | 
	
		
			
				|  |  | -+			ioremap(ar7_regs_wdt, sizeof(struct ar7_wdt));
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	ar7_wdt_disable_wdt();
 | 
	
		
			
				|  |  | -+	ar7_wdt_prescale(prescale_value);
 | 
	
		
			
				|  |  | -+	ar7_wdt_update_margin(margin);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	sema_init(&open_semaphore, 1);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	rc = register_reboot_notifier(&ar7_wdt_notifier);
 | 
	
		
			
				|  |  | -+	if (rc) {
 | 
	
		
			
				|  |  | -+		printk(KERN_ERR DRVNAME
 | 
	
		
			
				|  |  | -+			": unable to register reboot notifier\n");
 | 
	
		
			
				|  |  | -+		goto out_alloc;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	rc = misc_register(&ar7_wdt_miscdev);
 | 
	
		
			
				|  |  | -+	if (rc) {
 | 
	
		
			
				|  |  | -+		printk(KERN_ERR DRVNAME ": unable to register misc device\n");
 | 
	
		
			
				|  |  | -+		goto out_register;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	goto out;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+out_register:
 | 
	
		
			
				|  |  | -+	unregister_reboot_notifier(&ar7_wdt_notifier);
 | 
	
		
			
				|  |  | -+out_alloc:
 | 
	
		
			
				|  |  | -+	iounmap(ar7_wdt);
 | 
	
		
			
				|  |  | -+	release_mem_region(ar7_regs_wdt, sizeof(struct ar7_wdt));
 | 
	
		
			
				|  |  | -+out:
 | 
	
		
			
				|  |  | -+	return rc;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void __exit ar7_wdt_cleanup(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	misc_deregister(&ar7_wdt_miscdev);
 | 
	
		
			
				|  |  | -+	unregister_reboot_notifier(&ar7_wdt_notifier);
 | 
	
		
			
				|  |  | -+	iounmap(ar7_wdt);
 | 
	
		
			
				|  |  | -+	release_mem_region(ar7_regs_wdt, sizeof(struct ar7_wdt));
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+module_init(ar7_wdt_init);
 | 
	
		
			
				|  |  | -+module_exit(ar7_wdt_cleanup);
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/drivers/Kconfig linux-2.6.30.5/drivers/Kconfig
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/drivers/Kconfig	2009-08-16 23:19:38.000000000 +0200
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/drivers/Kconfig	2009-08-26 20:05:30.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -104,6 +104,8 @@
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - source "drivers/uio/Kconfig"
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | -+source "drivers/vlynq/Kconfig"
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | - source "drivers/xen/Kconfig"
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - source "drivers/staging/Kconfig"
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/drivers/Makefile linux-2.6.30.5/drivers/Makefile
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/drivers/Makefile	2009-08-16 23:19:38.000000000 +0200
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/drivers/Makefile	2009-08-26 20:05:30.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -103,6 +103,7 @@
 | 
	
		
			
				|  |  | - obj-$(CONFIG_HID)		+= hid/
 | 
	
		
			
				|  |  | - obj-$(CONFIG_PPC_PS3)		+= ps3/
 | 
	
		
			
				|  |  | - obj-$(CONFIG_OF)		+= of/
 | 
	
		
			
				|  |  | -+obj-$(CONFIG_VLYNQ)		+= vlynq/
 | 
	
		
			
				|  |  | - obj-$(CONFIG_SSB)		+= ssb/
 | 
	
		
			
				|  |  | - obj-$(CONFIG_VIRTIO)		+= virtio/
 | 
	
		
			
				|  |  | - obj-$(CONFIG_STAGING)		+= staging/
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/drivers/mtd/maps/physmap.c linux-2.6.30.5/drivers/mtd/maps/physmap.c
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/drivers/mtd/maps/physmap.c	2009-08-16 23:19:38.000000000 +0200
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/drivers/mtd/maps/physmap.c	2009-08-26 20:05:19.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -80,7 +80,7 @@
 | 
	
		
			
				|  |  | - 					"map_rom",
 | 
	
		
			
				|  |  | - 					NULL };
 | 
	
		
			
				|  |  | - #ifdef CONFIG_MTD_PARTITIONS
 | 
	
		
			
				|  |  | --static const char *part_probe_types[] = { "cmdlinepart", "RedBoot", NULL };
 | 
	
		
			
				|  |  | -+static const char *part_probe_types[] = { "cmdlinepart", "RedBoot", "ar7part", NULL };
 | 
	
		
			
				|  |  | - #endif
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - static int physmap_flash_probe(struct platform_device *dev)
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/drivers/net/cpmac.c linux-2.6.30.5/drivers/net/cpmac.c
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/drivers/net/cpmac.c	2009-08-16 23:19:38.000000000 +0200
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/drivers/net/cpmac.c	2009-08-26 22:00:29.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -615,13 +615,13 @@
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - 		dev_kfree_skb_irq(desc->skb);
 | 
	
		
			
				|  |  | - 		desc->skb = NULL;
 | 
	
		
			
				|  |  | --		if (netif_subqueue_stopped(dev, queue))
 | 
	
		
			
				|  |  | -+		if (__netif_subqueue_stopped(dev, queue))
 | 
	
		
			
				|  |  | - 			netif_wake_subqueue(dev, queue);
 | 
	
		
			
				|  |  | - 	} else {
 | 
	
		
			
				|  |  | - 		if (netif_msg_tx_err(priv) && net_ratelimit())
 | 
	
		
			
				|  |  | - 			printk(KERN_WARNING
 | 
	
		
			
				|  |  | - 			       "%s: end_xmit: spurious interrupt\n", dev->name);
 | 
	
		
			
				|  |  | --		if (netif_subqueue_stopped(dev, queue))
 | 
	
		
			
				|  |  | -+		if (__netif_subqueue_stopped(dev, queue))
 | 
	
		
			
				|  |  | - 			netif_wake_subqueue(dev, queue);
 | 
	
		
			
				|  |  | - 	}
 | 
	
		
			
				|  |  | - }
 | 
	
		
			
				|  |  | -@@ -731,7 +731,6 @@
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - static void cpmac_hw_error(struct work_struct *work)
 | 
	
		
			
				|  |  | - {
 | 
	
		
			
				|  |  | --	int i;
 | 
	
		
			
				|  |  | - 	struct cpmac_priv *priv =
 | 
	
		
			
				|  |  | - 		container_of(work, struct cpmac_priv, reset_work);
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | -@@ -818,7 +817,6 @@
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - static void cpmac_tx_timeout(struct net_device *dev)
 | 
	
		
			
				|  |  | - {
 | 
	
		
			
				|  |  | --	int i;
 | 
	
		
			
				|  |  | - 	struct cpmac_priv *priv = netdev_priv(dev);
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - 	spin_lock(&priv->lock);
 | 
	
		
			
				|  |  | -@@ -1097,15 +1095,18 @@
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - static int __devinit cpmac_probe(struct platform_device *pdev)
 | 
	
		
			
				|  |  | - {
 | 
	
		
			
				|  |  | --	int rc, phy_id, i;
 | 
	
		
			
				|  |  | --	char *mdio_bus_id = "0";
 | 
	
		
			
				|  |  | -+	int rc, phy_id;
 | 
	
		
			
				|  |  | -+	char mdio_bus_id[BUS_ID_SIZE];
 | 
	
		
			
				|  |  | - 	struct resource *mem;
 | 
	
		
			
				|  |  | - 	struct cpmac_priv *priv;
 | 
	
		
			
				|  |  | - 	struct net_device *dev;
 | 
	
		
			
				|  |  | - 	struct plat_cpmac_data *pdata;
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - 	pdata = pdev->dev.platform_data;
 | 
	
		
			
				|  |  | -+	strncpy(mdio_bus_id, "0", BUS_ID_SIZE);
 | 
	
		
			
				|  |  | -+	phy_id = pdev->id;
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | -+	/*
 | 
	
		
			
				|  |  | - 	for (phy_id = 0; phy_id < PHY_MAX_ADDR; phy_id++) {
 | 
	
		
			
				|  |  | - 		if (!(pdata->phy_mask & (1 << phy_id)))
 | 
	
		
			
				|  |  | - 			continue;
 | 
	
		
			
				|  |  | -@@ -1116,15 +1117,17 @@
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - 	if (phy_id == PHY_MAX_ADDR) {
 | 
	
		
			
				|  |  | - 		if (external_switch || dumb_switch) {
 | 
	
		
			
				|  |  | --			mdio_bus_id = 0; /* fixed phys bus */
 | 
	
		
			
				|  |  | -+			strncpy(mdio_bus_id, "0", BUS_ID_SIZE);
 | 
	
		
			
				|  |  | - 			phy_id = pdev->id;
 | 
	
		
			
				|  |  | - 		} else {
 | 
	
		
			
				|  |  | - 			dev_err(&pdev->dev, "no PHY present\n");
 | 
	
		
			
				|  |  | - 			return -ENODEV;
 | 
	
		
			
				|  |  | - 		}
 | 
	
		
			
				|  |  | - 	}
 | 
	
		
			
				|  |  | -+	*/
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - 	dev = alloc_etherdev_mq(sizeof(*priv), CPMAC_QUEUES);
 | 
	
		
			
				|  |  | -+	//~ dev = alloc_etherdev(sizeof(*priv));
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - 	if (!dev) {
 | 
	
		
			
				|  |  | - 		printk(KERN_ERR "cpmac: Unable to allocate net_device\n");
 | 
	
		
			
				|  |  | -@@ -1161,8 +1164,11 @@
 | 
	
		
			
				|  |  | - 	priv->msg_enable = netif_msg_init(debug_level, 0xff);
 | 
	
		
			
				|  |  | - 	memcpy(dev->dev_addr, pdata->dev_addr, sizeof(dev->dev_addr));
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | --	priv->phy = phy_connect(dev, dev_name(&cpmac_mii->phy_map[phy_id]->dev),
 | 
	
		
			
				|  |  | -+ 	snprintf(priv->phy_name, BUS_ID_SIZE, PHY_ID_FMT, mdio_bus_id, phy_id);
 | 
	
		
			
				|  |  | -+	//priv->phy = phy_connect(dev, dev_name(&cpmac_mii->phy_map[phy_id]->dev),
 | 
	
		
			
				|  |  | -+ 	priv->phy = phy_connect(dev, priv->phy_name,
 | 
	
		
			
				|  |  | - 				&cpmac_adjust_link, 0, PHY_INTERFACE_MODE_MII);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | - 	if (IS_ERR(priv->phy)) {
 | 
	
		
			
				|  |  | - 		if (netif_msg_drv(priv))
 | 
	
		
			
				|  |  | - 			printk(KERN_ERR "%s: Could not attach to PHY\n",
 | 
	
		
			
				|  |  | -@@ -1249,7 +1255,7 @@
 | 
	
		
			
				|  |  | - 	}
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - 	cpmac_mii->phy_mask = ~(mask | 0x80000000);
 | 
	
		
			
				|  |  | --	snprintf(cpmac_mii->id, MII_BUS_ID_SIZE, "0");
 | 
	
		
			
				|  |  | -+	snprintf(cpmac_mii->id, MII_BUS_ID_SIZE, "1");
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - 	res = mdiobus_register(cpmac_mii);
 | 
	
		
			
				|  |  | - 	if (res)
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/drivers/net/Kconfig linux-2.6.30.5/drivers/net/Kconfig
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/drivers/net/Kconfig	2009-08-16 23:19:38.000000000 +0200
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/drivers/net/Kconfig	2009-08-26 20:06:44.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -1760,7 +1760,7 @@
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - config CPMAC
 | 
	
		
			
				|  |  | - 	tristate "TI AR7 CPMAC Ethernet support (EXPERIMENTAL)"
 | 
	
		
			
				|  |  | --	depends on NET_ETHERNET && EXPERIMENTAL && AR7 && BROKEN
 | 
	
		
			
				|  |  | -+	depends on NET_ETHERNET && EXPERIMENTAL && AR7
 | 
	
		
			
				|  |  | - 	select PHYLIB
 | 
	
		
			
				|  |  | - 	help
 | 
	
		
			
				|  |  | - 	  TI AR7 CPMAC Ethernet support
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/drivers/serial/8250.c linux-2.6.30.5/drivers/serial/8250.c
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/drivers/serial/8250.c	2009-08-16 23:19:38.000000000 +0200
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/drivers/serial/8250.c	2009-08-26 20:06:59.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -287,6 +287,13 @@
 | 
	
		
			
				|  |  | - 		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
 | 
	
		
			
				|  |  | - 		.flags		= UART_CAP_FIFO,
 | 
	
		
			
				|  |  | - 	},
 | 
	
		
			
				|  |  | -+	[PORT_AR7] = {
 | 
	
		
			
				|  |  | -+		.name		= "TI-AR7",
 | 
	
		
			
				|  |  | -+		.fifo_size	= 16,
 | 
	
		
			
				|  |  | -+		.tx_loadsz	= 16,
 | 
	
		
			
				|  |  | -+		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_00,
 | 
	
		
			
				|  |  | -+		.flags		= UART_CAP_FIFO | UART_CAP_AFE,
 | 
	
		
			
				|  |  | -+	},
 | 
	
		
			
				|  |  | - };
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - #if defined (CONFIG_SERIAL_8250_AU1X00)
 | 
	
		
			
				|  |  | -@@ -2702,7 +2709,11 @@
 | 
	
		
			
				|  |  | - {
 | 
	
		
			
				|  |  | - 	struct uart_8250_port *up = (struct uart_8250_port *)port;
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | -+#ifdef CONFIG_AR7
 | 
	
		
			
				|  |  | -+	wait_for_xmitr(up, BOTH_EMPTY);
 | 
	
		
			
				|  |  | -+#else
 | 
	
		
			
				|  |  | - 	wait_for_xmitr(up, UART_LSR_THRE);
 | 
	
		
			
				|  |  | -+#endif
 | 
	
		
			
				|  |  | - 	serial_out(up, UART_TX, ch);
 | 
	
		
			
				|  |  | - }
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/drivers/vlynq/Kconfig linux-2.6.30.5/drivers/vlynq/Kconfig
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/drivers/vlynq/Kconfig	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/drivers/vlynq/Kconfig	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,13 @@
 | 
	
		
			
				|  |  | -+menu "TI VLYNQ"
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+config VLYNQ
 | 
	
		
			
				|  |  | -+	bool "TI VLYNQ bus support"
 | 
	
		
			
				|  |  | -+	depends on AR7 && EXPERIMENTAL
 | 
	
		
			
				|  |  | -+	help
 | 
	
		
			
				|  |  | -+	  Support for the TI VLYNQ bus
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	  The module will be called vlynq
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	  If unsure, say N
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+endmenu
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/drivers/vlynq/Makefile linux-2.6.30.5/drivers/vlynq/Makefile
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/drivers/vlynq/Makefile	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/drivers/vlynq/Makefile	2009-08-26 20:05:03.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,5 @@
 | 
	
		
			
				|  |  | -+#
 | 
	
		
			
				|  |  | -+# Makefile for kernel vlynq drivers
 | 
	
		
			
				|  |  | -+#
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+obj-$(CONFIG_VLYNQ) += vlynq.o
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/drivers/vlynq/vlynq.c linux-2.6.30.5/drivers/vlynq/vlynq.c
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/drivers/vlynq/vlynq.c	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/drivers/vlynq/vlynq.c	2009-08-26 20:06:33.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,813 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2006, 2007 Eugene Konev <ejka@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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * Parts of the VLYNQ specification can be found here:
 | 
	
		
			
				|  |  | -+ * http://www.ti.com/litv/pdf/sprue36a
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <linux/init.h>
 | 
	
		
			
				|  |  | -+#include <linux/types.h>
 | 
	
		
			
				|  |  | -+#include <linux/kernel.h>
 | 
	
		
			
				|  |  | -+#include <linux/string.h>
 | 
	
		
			
				|  |  | -+#include <linux/device.h>
 | 
	
		
			
				|  |  | -+#include <linux/module.h>
 | 
	
		
			
				|  |  | -+#include <linux/errno.h>
 | 
	
		
			
				|  |  | -+#include <linux/platform_device.h>
 | 
	
		
			
				|  |  | -+#include <linux/interrupt.h>
 | 
	
		
			
				|  |  | -+#include <linux/delay.h>
 | 
	
		
			
				|  |  | -+#include <linux/io.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <linux/vlynq.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define VLYNQ_CTRL_PM_ENABLE		0x80000000
 | 
	
		
			
				|  |  | -+#define VLYNQ_CTRL_CLOCK_INT		0x00008000
 | 
	
		
			
				|  |  | -+#define VLYNQ_CTRL_CLOCK_DIV(x)		(((x) & 7) << 16)
 | 
	
		
			
				|  |  | -+#define VLYNQ_CTRL_INT_LOCAL		0x00004000
 | 
	
		
			
				|  |  | -+#define VLYNQ_CTRL_INT_ENABLE		0x00002000
 | 
	
		
			
				|  |  | -+#define VLYNQ_CTRL_INT_VECTOR(x)	(((x) & 0x1f) << 8)
 | 
	
		
			
				|  |  | -+#define VLYNQ_CTRL_INT2CFG		0x00000080
 | 
	
		
			
				|  |  | -+#define VLYNQ_CTRL_RESET		0x00000001
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define VLYNQ_CTRL_CLOCK_MASK          (0x7 << 16)
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define VLYNQ_INT_OFFSET		0x00000014
 | 
	
		
			
				|  |  | -+#define VLYNQ_REMOTE_OFFSET		0x00000080
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define VLYNQ_STATUS_LINK		0x00000001
 | 
	
		
			
				|  |  | -+#define VLYNQ_STATUS_LERROR		0x00000080
 | 
	
		
			
				|  |  | -+#define VLYNQ_STATUS_RERROR		0x00000100
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define VINT_ENABLE			0x00000100
 | 
	
		
			
				|  |  | -+#define VINT_TYPE_EDGE			0x00000080
 | 
	
		
			
				|  |  | -+#define VINT_LEVEL_LOW			0x00000040
 | 
	
		
			
				|  |  | -+#define VINT_VECTOR(x)			((x) & 0x1f)
 | 
	
		
			
				|  |  | -+#define VINT_OFFSET(irq)		(8 * ((irq) % 4))
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define VLYNQ_AUTONEGO_V2		0x00010000
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct vlynq_regs {
 | 
	
		
			
				|  |  | -+	u32 revision;
 | 
	
		
			
				|  |  | -+	u32 control;
 | 
	
		
			
				|  |  | -+	u32 status;
 | 
	
		
			
				|  |  | -+	u32 int_prio;
 | 
	
		
			
				|  |  | -+	u32 int_status;
 | 
	
		
			
				|  |  | -+	u32 int_pending;
 | 
	
		
			
				|  |  | -+	u32 int_ptr;
 | 
	
		
			
				|  |  | -+	u32 tx_offset;
 | 
	
		
			
				|  |  | -+	struct vlynq_mapping rx_mapping[4];
 | 
	
		
			
				|  |  | -+	u32 chip;
 | 
	
		
			
				|  |  | -+	u32 autonego;
 | 
	
		
			
				|  |  | -+	u32 unused[6];
 | 
	
		
			
				|  |  | -+	u32 int_device[8];
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#ifdef CONFIG_VLYNQ_DEBUG
 | 
	
		
			
				|  |  | -+static void vlynq_dump_regs(struct vlynq_device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int i;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	printk(KERN_DEBUG "VLYNQ local=%p remote=%p\n",
 | 
	
		
			
				|  |  | -+			dev->local, dev->remote);
 | 
	
		
			
				|  |  | -+	for (i = 0; i < 32; i++) {
 | 
	
		
			
				|  |  | -+		printk(KERN_DEBUG "VLYNQ: local %d: %08x\n",
 | 
	
		
			
				|  |  | -+			i + 1, ((u32 *)dev->local)[i]);
 | 
	
		
			
				|  |  | -+		printk(KERN_DEBUG "VLYNQ: remote %d: %08x\n",
 | 
	
		
			
				|  |  | -+			i + 1, ((u32 *)dev->remote)[i]);
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void vlynq_dump_mem(u32 *base, int count)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int i;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	for (i = 0; i < (count + 3) / 4; i++) {
 | 
	
		
			
				|  |  | -+		if (i % 4 == 0)
 | 
	
		
			
				|  |  | -+			printk(KERN_DEBUG "\nMEM[0x%04x]:", i * 4);
 | 
	
		
			
				|  |  | -+		printk(KERN_DEBUG " 0x%08x", *(base + i));
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	printk(KERN_DEBUG "\n");
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+#endif
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/* Check the VLYNQ link status with a given device */
 | 
	
		
			
				|  |  | -+static int vlynq_linked(struct vlynq_device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int i;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	for (i = 0; i < 100; i++)
 | 
	
		
			
				|  |  | -+		if (readl(&dev->local->status) & VLYNQ_STATUS_LINK)
 | 
	
		
			
				|  |  | -+			return 1;
 | 
	
		
			
				|  |  | -+		else
 | 
	
		
			
				|  |  | -+			cpu_relax();
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void vlynq_reset(struct vlynq_device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	writel(readl(&dev->local->control) | VLYNQ_CTRL_RESET,
 | 
	
		
			
				|  |  | -+			&dev->local->control);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	/* Wait for the devices to finish resetting */
 | 
	
		
			
				|  |  | -+	msleep(5);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	/* Remove reset bit */
 | 
	
		
			
				|  |  | -+	writel(readl(&dev->local->control) & ~VLYNQ_CTRL_RESET,
 | 
	
		
			
				|  |  | -+			&dev->local->control);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	/* Give some time for the devices to settle */
 | 
	
		
			
				|  |  | -+	msleep(5);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void vlynq_irq_unmask(unsigned int irq)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	u32 val;
 | 
	
		
			
				|  |  | -+	struct vlynq_device *dev = get_irq_chip_data(irq);
 | 
	
		
			
				|  |  | -+	int virq;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	BUG_ON(!dev);
 | 
	
		
			
				|  |  | -+	virq = irq - dev->irq_start;
 | 
	
		
			
				|  |  | -+	val = readl(&dev->remote->int_device[virq >> 2]);
 | 
	
		
			
				|  |  | -+	val |= (VINT_ENABLE | virq) << VINT_OFFSET(virq);
 | 
	
		
			
				|  |  | -+	writel(val, &dev->remote->int_device[virq >> 2]);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void vlynq_irq_mask(unsigned int irq)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	u32 val;
 | 
	
		
			
				|  |  | -+	struct vlynq_device *dev = get_irq_chip_data(irq);
 | 
	
		
			
				|  |  | -+	int virq;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	BUG_ON(!dev);
 | 
	
		
			
				|  |  | -+	virq = irq - dev->irq_start;
 | 
	
		
			
				|  |  | -+	val = readl(&dev->remote->int_device[virq >> 2]);
 | 
	
		
			
				|  |  | -+	val &= ~(VINT_ENABLE << VINT_OFFSET(virq));
 | 
	
		
			
				|  |  | -+	writel(val, &dev->remote->int_device[virq >> 2]);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int vlynq_irq_type(unsigned int irq, unsigned int flow_type)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	u32 val;
 | 
	
		
			
				|  |  | -+	struct vlynq_device *dev = get_irq_chip_data(irq);
 | 
	
		
			
				|  |  | -+	int virq;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	BUG_ON(!dev);
 | 
	
		
			
				|  |  | -+	virq = irq - dev->irq_start;
 | 
	
		
			
				|  |  | -+	val = readl(&dev->remote->int_device[virq >> 2]);
 | 
	
		
			
				|  |  | -+	switch (flow_type & IRQ_TYPE_SENSE_MASK) {
 | 
	
		
			
				|  |  | -+	case IRQ_TYPE_EDGE_RISING:
 | 
	
		
			
				|  |  | -+	case IRQ_TYPE_EDGE_FALLING:
 | 
	
		
			
				|  |  | -+	case IRQ_TYPE_EDGE_BOTH:
 | 
	
		
			
				|  |  | -+		val |= VINT_TYPE_EDGE << VINT_OFFSET(virq);
 | 
	
		
			
				|  |  | -+		val &= ~(VINT_LEVEL_LOW << VINT_OFFSET(virq));
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	case IRQ_TYPE_LEVEL_HIGH:
 | 
	
		
			
				|  |  | -+		val &= ~(VINT_TYPE_EDGE << VINT_OFFSET(virq));
 | 
	
		
			
				|  |  | -+		val &= ~(VINT_LEVEL_LOW << VINT_OFFSET(virq));
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	case IRQ_TYPE_LEVEL_LOW:
 | 
	
		
			
				|  |  | -+		val &= ~(VINT_TYPE_EDGE << VINT_OFFSET(virq));
 | 
	
		
			
				|  |  | -+		val |= VINT_LEVEL_LOW << VINT_OFFSET(virq);
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	default:
 | 
	
		
			
				|  |  | -+		return -EINVAL;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	writel(val, &dev->remote->int_device[virq >> 2]);
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void vlynq_local_ack(unsigned int irq)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	struct vlynq_device *dev = get_irq_chip_data(irq);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	u32 status = readl(&dev->local->status);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	pr_debug("%s: local status: 0x%08x\n",
 | 
	
		
			
				|  |  | -+		       dev_name(&dev->dev), status);
 | 
	
		
			
				|  |  | -+	writel(status, &dev->local->status);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void vlynq_remote_ack(unsigned int irq)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	struct vlynq_device *dev = get_irq_chip_data(irq);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	u32 status = readl(&dev->remote->status);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	pr_debug("%s: remote status: 0x%08x\n",
 | 
	
		
			
				|  |  | -+		       dev_name(&dev->dev), status);
 | 
	
		
			
				|  |  | -+	writel(status, &dev->remote->status);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static irqreturn_t vlynq_irq(int irq, void *dev_id)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	struct vlynq_device *dev = dev_id;
 | 
	
		
			
				|  |  | -+	u32 status;
 | 
	
		
			
				|  |  | -+	int virq = 0;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	status = readl(&dev->local->int_status);
 | 
	
		
			
				|  |  | -+	writel(status, &dev->local->int_status);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (unlikely(!status))
 | 
	
		
			
				|  |  | -+		spurious_interrupt();
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	while (status) {
 | 
	
		
			
				|  |  | -+		if (status & 1)
 | 
	
		
			
				|  |  | -+			do_IRQ(dev->irq_start + virq);
 | 
	
		
			
				|  |  | -+		status >>= 1;
 | 
	
		
			
				|  |  | -+		virq++;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return IRQ_HANDLED;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct irq_chip vlynq_irq_chip = {
 | 
	
		
			
				|  |  | -+	.name = "vlynq",
 | 
	
		
			
				|  |  | -+	.unmask = vlynq_irq_unmask,
 | 
	
		
			
				|  |  | -+	.mask = vlynq_irq_mask,
 | 
	
		
			
				|  |  | -+	.set_type = vlynq_irq_type,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct irq_chip vlynq_local_chip = {
 | 
	
		
			
				|  |  | -+	.name = "vlynq local error",
 | 
	
		
			
				|  |  | -+	.unmask = vlynq_irq_unmask,
 | 
	
		
			
				|  |  | -+	.mask = vlynq_irq_mask,
 | 
	
		
			
				|  |  | -+	.ack = vlynq_local_ack,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct irq_chip vlynq_remote_chip = {
 | 
	
		
			
				|  |  | -+	.name = "vlynq local error",
 | 
	
		
			
				|  |  | -+	.unmask = vlynq_irq_unmask,
 | 
	
		
			
				|  |  | -+	.mask = vlynq_irq_mask,
 | 
	
		
			
				|  |  | -+	.ack = vlynq_remote_ack,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int vlynq_setup_irq(struct vlynq_device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	u32 val;
 | 
	
		
			
				|  |  | -+	int i, virq;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (dev->local_irq == dev->remote_irq) {
 | 
	
		
			
				|  |  | -+		printk(KERN_ERR
 | 
	
		
			
				|  |  | -+		       "%s: local vlynq irq should be different from remote\n",
 | 
	
		
			
				|  |  | -+		       dev_name(&dev->dev));
 | 
	
		
			
				|  |  | -+		return -EINVAL;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	/* Clear local and remote error bits */
 | 
	
		
			
				|  |  | -+	writel(readl(&dev->local->status), &dev->local->status);
 | 
	
		
			
				|  |  | -+	writel(readl(&dev->remote->status), &dev->remote->status);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	/* Now setup interrupts */
 | 
	
		
			
				|  |  | -+	val = VLYNQ_CTRL_INT_VECTOR(dev->local_irq);
 | 
	
		
			
				|  |  | -+	val |= VLYNQ_CTRL_INT_ENABLE | VLYNQ_CTRL_INT_LOCAL |
 | 
	
		
			
				|  |  | -+		VLYNQ_CTRL_INT2CFG;
 | 
	
		
			
				|  |  | -+	val |= readl(&dev->local->control);
 | 
	
		
			
				|  |  | -+	writel(VLYNQ_INT_OFFSET, &dev->local->int_ptr);
 | 
	
		
			
				|  |  | -+	writel(val, &dev->local->control);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	val = VLYNQ_CTRL_INT_VECTOR(dev->remote_irq);
 | 
	
		
			
				|  |  | -+	val |= VLYNQ_CTRL_INT_ENABLE;
 | 
	
		
			
				|  |  | -+	val |= readl(&dev->remote->control);
 | 
	
		
			
				|  |  | -+	writel(VLYNQ_INT_OFFSET, &dev->remote->int_ptr);
 | 
	
		
			
				|  |  | -+	writel(val, &dev->remote->int_ptr);
 | 
	
		
			
				|  |  | -+	writel(val, &dev->remote->control);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	for (i = dev->irq_start; i <= dev->irq_end; i++) {
 | 
	
		
			
				|  |  | -+		virq = i - dev->irq_start;
 | 
	
		
			
				|  |  | -+		if (virq == dev->local_irq) {
 | 
	
		
			
				|  |  | -+			set_irq_chip_and_handler(i, &vlynq_local_chip,
 | 
	
		
			
				|  |  | -+						 handle_level_irq);
 | 
	
		
			
				|  |  | -+			set_irq_chip_data(i, dev);
 | 
	
		
			
				|  |  | -+		} else if (virq == dev->remote_irq) {
 | 
	
		
			
				|  |  | -+			set_irq_chip_and_handler(i, &vlynq_remote_chip,
 | 
	
		
			
				|  |  | -+						 handle_level_irq);
 | 
	
		
			
				|  |  | -+			set_irq_chip_data(i, dev);
 | 
	
		
			
				|  |  | -+		} else {
 | 
	
		
			
				|  |  | -+			set_irq_chip_and_handler(i, &vlynq_irq_chip,
 | 
	
		
			
				|  |  | -+						 handle_simple_irq);
 | 
	
		
			
				|  |  | -+			set_irq_chip_data(i, dev);
 | 
	
		
			
				|  |  | -+			writel(0, &dev->remote->int_device[virq >> 2]);
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (request_irq(dev->irq, vlynq_irq, IRQF_SHARED, "vlynq", dev)) {
 | 
	
		
			
				|  |  | -+		printk(KERN_ERR "%s: request_irq failed\n",
 | 
	
		
			
				|  |  | -+					dev_name(&dev->dev));
 | 
	
		
			
				|  |  | -+		return -EAGAIN;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void vlynq_device_release(struct device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	struct vlynq_device *vdev = to_vlynq_device(dev);
 | 
	
		
			
				|  |  | -+	kfree(vdev);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int vlynq_device_match(struct device *dev,
 | 
	
		
			
				|  |  | -+			      struct device_driver *drv)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	struct vlynq_device *vdev = to_vlynq_device(dev);
 | 
	
		
			
				|  |  | -+	struct vlynq_driver *vdrv = to_vlynq_driver(drv);
 | 
	
		
			
				|  |  | -+	struct vlynq_device_id *ids = vdrv->id_table;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	while (ids->id) {
 | 
	
		
			
				|  |  | -+		if (ids->id == vdev->dev_id) {
 | 
	
		
			
				|  |  | -+			vdev->divisor = ids->divisor;
 | 
	
		
			
				|  |  | -+			vlynq_set_drvdata(vdev, ids);
 | 
	
		
			
				|  |  | -+			printk(KERN_INFO "Driver found for VLYNQ "
 | 
	
		
			
				|  |  | -+				"device: %08x\n", vdev->dev_id);
 | 
	
		
			
				|  |  | -+			return 1;
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+		printk(KERN_DEBUG "Not using the %08x VLYNQ device's driver"
 | 
	
		
			
				|  |  | -+			" for VLYNQ device: %08x\n", ids->id, vdev->dev_id);
 | 
	
		
			
				|  |  | -+		ids++;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int vlynq_device_probe(struct device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	struct vlynq_device *vdev = to_vlynq_device(dev);
 | 
	
		
			
				|  |  | -+	struct vlynq_driver *drv = to_vlynq_driver(dev->driver);
 | 
	
		
			
				|  |  | -+	struct vlynq_device_id *id = vlynq_get_drvdata(vdev);
 | 
	
		
			
				|  |  | -+	int result = -ENODEV;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (drv->probe)
 | 
	
		
			
				|  |  | -+		result = drv->probe(vdev, id);
 | 
	
		
			
				|  |  | -+	if (result)
 | 
	
		
			
				|  |  | -+		put_device(dev);
 | 
	
		
			
				|  |  | -+	return result;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int vlynq_device_remove(struct device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	struct vlynq_driver *drv = to_vlynq_driver(dev->driver);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (drv->remove)
 | 
	
		
			
				|  |  | -+		drv->remove(to_vlynq_device(dev));
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+int __vlynq_register_driver(struct vlynq_driver *driver, struct module *owner)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	driver->driver.name = driver->name;
 | 
	
		
			
				|  |  | -+	driver->driver.bus = &vlynq_bus_type;
 | 
	
		
			
				|  |  | -+	return driver_register(&driver->driver);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+EXPORT_SYMBOL(__vlynq_register_driver);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+void vlynq_unregister_driver(struct vlynq_driver *driver)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	driver_unregister(&driver->driver);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+EXPORT_SYMBOL(vlynq_unregister_driver);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * A VLYNQ remote device can clock the VLYNQ bus master
 | 
	
		
			
				|  |  | -+ * using a dedicated clock line. In that case, both the
 | 
	
		
			
				|  |  | -+ * remove device and the bus master should have the same
 | 
	
		
			
				|  |  | -+ * serial clock dividers configured. Iterate through the
 | 
	
		
			
				|  |  | -+ * 8 possible dividers until we actually link with the
 | 
	
		
			
				|  |  | -+ * device.
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+static int __vlynq_try_remote(struct vlynq_device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int i;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	vlynq_reset(dev);
 | 
	
		
			
				|  |  | -+	for (i = dev->dev_id ? vlynq_rdiv2 : vlynq_rdiv8; dev->dev_id ?
 | 
	
		
			
				|  |  | -+			i <= vlynq_rdiv8 : i >= vlynq_rdiv2;
 | 
	
		
			
				|  |  | -+		dev->dev_id ? i++ : i--) {
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+		if (!vlynq_linked(dev))
 | 
	
		
			
				|  |  | -+			break;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+		writel((readl(&dev->remote->control) &
 | 
	
		
			
				|  |  | -+				~VLYNQ_CTRL_CLOCK_MASK) |
 | 
	
		
			
				|  |  | -+				VLYNQ_CTRL_CLOCK_INT |
 | 
	
		
			
				|  |  | -+				VLYNQ_CTRL_CLOCK_DIV(i - vlynq_rdiv1),
 | 
	
		
			
				|  |  | -+				&dev->remote->control);
 | 
	
		
			
				|  |  | -+		writel((readl(&dev->local->control)
 | 
	
		
			
				|  |  | -+				& ~(VLYNQ_CTRL_CLOCK_INT |
 | 
	
		
			
				|  |  | -+				VLYNQ_CTRL_CLOCK_MASK)) |
 | 
	
		
			
				|  |  | -+				VLYNQ_CTRL_CLOCK_DIV(i - vlynq_rdiv1),
 | 
	
		
			
				|  |  | -+				&dev->local->control);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+		if (vlynq_linked(dev)) {
 | 
	
		
			
				|  |  | -+			printk(KERN_DEBUG
 | 
	
		
			
				|  |  | -+				"%s: using remote clock divisor %d\n",
 | 
	
		
			
				|  |  | -+				dev_name(&dev->dev), i - vlynq_rdiv1 + 1);
 | 
	
		
			
				|  |  | -+			dev->divisor = i;
 | 
	
		
			
				|  |  | -+			return 0;
 | 
	
		
			
				|  |  | -+		} else {
 | 
	
		
			
				|  |  | -+			vlynq_reset(dev);
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return -ENODEV;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * A VLYNQ remote device can be clocked by the VLYNQ bus
 | 
	
		
			
				|  |  | -+ * master using a dedicated clock line. In that case, only
 | 
	
		
			
				|  |  | -+ * the bus master configures the serial clock divider.
 | 
	
		
			
				|  |  | -+ * Iterate through the 8 possible dividers until we
 | 
	
		
			
				|  |  | -+ * actually get a link with the device.
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+static int __vlynq_try_local(struct vlynq_device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int i;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	vlynq_reset(dev);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	for (i = dev->dev_id ? vlynq_ldiv2 : vlynq_ldiv8; dev->dev_id ?
 | 
	
		
			
				|  |  | -+			i <= vlynq_ldiv8 : i >= vlynq_ldiv2;
 | 
	
		
			
				|  |  | -+		dev->dev_id ? i++ : i--) {
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+		writel((readl(&dev->local->control) &
 | 
	
		
			
				|  |  | -+				~VLYNQ_CTRL_CLOCK_MASK) |
 | 
	
		
			
				|  |  | -+				VLYNQ_CTRL_CLOCK_INT |
 | 
	
		
			
				|  |  | -+				VLYNQ_CTRL_CLOCK_DIV(i - vlynq_ldiv1),
 | 
	
		
			
				|  |  | -+				&dev->local->control);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+		if (vlynq_linked(dev)) {
 | 
	
		
			
				|  |  | -+			printk(KERN_DEBUG
 | 
	
		
			
				|  |  | -+				"%s: using local clock divisor %d\n",
 | 
	
		
			
				|  |  | -+				dev_name(&dev->dev), i - vlynq_ldiv1 + 1);
 | 
	
		
			
				|  |  | -+			dev->divisor = i;
 | 
	
		
			
				|  |  | -+			return 0;
 | 
	
		
			
				|  |  | -+		} else {
 | 
	
		
			
				|  |  | -+			vlynq_reset(dev);
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return -ENODEV;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * When using external clocking method, serial clock
 | 
	
		
			
				|  |  | -+ * is supplied by an external oscillator, therefore we
 | 
	
		
			
				|  |  | -+ * should mask the local clock bit in the clock control
 | 
	
		
			
				|  |  | -+ * register for both the bus master and the remote device.
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+static int __vlynq_try_external(struct vlynq_device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	vlynq_reset(dev);
 | 
	
		
			
				|  |  | -+	if (!vlynq_linked(dev))
 | 
	
		
			
				|  |  | -+		return -ENODEV;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel((readl(&dev->remote->control) &
 | 
	
		
			
				|  |  | -+			~VLYNQ_CTRL_CLOCK_INT),
 | 
	
		
			
				|  |  | -+			&dev->remote->control);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel((readl(&dev->local->control) &
 | 
	
		
			
				|  |  | -+			~VLYNQ_CTRL_CLOCK_INT),
 | 
	
		
			
				|  |  | -+			&dev->local->control);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (vlynq_linked(dev)) {
 | 
	
		
			
				|  |  | -+		printk(KERN_DEBUG "%s: using external clock\n",
 | 
	
		
			
				|  |  | -+			dev_name(&dev->dev));
 | 
	
		
			
				|  |  | -+			dev->divisor = vlynq_div_external;
 | 
	
		
			
				|  |  | -+		return 0;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return -ENODEV;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int __vlynq_enable_device(struct vlynq_device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int result;
 | 
	
		
			
				|  |  | -+	struct plat_vlynq_ops *ops = dev->dev.platform_data;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	result = ops->on(dev);
 | 
	
		
			
				|  |  | -+	if (result)
 | 
	
		
			
				|  |  | -+		return result;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	switch (dev->divisor) {
 | 
	
		
			
				|  |  | -+	case vlynq_div_external:
 | 
	
		
			
				|  |  | -+	case vlynq_div_auto:
 | 
	
		
			
				|  |  | -+		/* When the device is brought from reset it should have clock
 | 
	
		
			
				|  |  | -+		 * generation negotiated by hardware.
 | 
	
		
			
				|  |  | -+		 * Check which device is generating clocks and perform setup
 | 
	
		
			
				|  |  | -+		 * accordingly */
 | 
	
		
			
				|  |  | -+		if (vlynq_linked(dev) && readl(&dev->remote->control) &
 | 
	
		
			
				|  |  | -+		   VLYNQ_CTRL_CLOCK_INT) {
 | 
	
		
			
				|  |  | -+			if (!__vlynq_try_remote(dev) ||
 | 
	
		
			
				|  |  | -+				!__vlynq_try_local(dev)  ||
 | 
	
		
			
				|  |  | -+				!__vlynq_try_external(dev))
 | 
	
		
			
				|  |  | -+				return 0;
 | 
	
		
			
				|  |  | -+		} else {
 | 
	
		
			
				|  |  | -+			if (!__vlynq_try_external(dev) ||
 | 
	
		
			
				|  |  | -+				!__vlynq_try_local(dev)    ||
 | 
	
		
			
				|  |  | -+				!__vlynq_try_remote(dev))
 | 
	
		
			
				|  |  | -+				return 0;
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	case vlynq_ldiv1:
 | 
	
		
			
				|  |  | -+	case vlynq_ldiv2:
 | 
	
		
			
				|  |  | -+	case vlynq_ldiv3:
 | 
	
		
			
				|  |  | -+	case vlynq_ldiv4:
 | 
	
		
			
				|  |  | -+	case vlynq_ldiv5:
 | 
	
		
			
				|  |  | -+	case vlynq_ldiv6:
 | 
	
		
			
				|  |  | -+	case vlynq_ldiv7:
 | 
	
		
			
				|  |  | -+	case vlynq_ldiv8:
 | 
	
		
			
				|  |  | -+		writel(VLYNQ_CTRL_CLOCK_INT |
 | 
	
		
			
				|  |  | -+			VLYNQ_CTRL_CLOCK_DIV(dev->divisor -
 | 
	
		
			
				|  |  | -+			vlynq_ldiv1), &dev->local->control);
 | 
	
		
			
				|  |  | -+		writel(0, &dev->remote->control);
 | 
	
		
			
				|  |  | -+		if (vlynq_linked(dev)) {
 | 
	
		
			
				|  |  | -+			printk(KERN_DEBUG
 | 
	
		
			
				|  |  | -+				"%s: using local clock divisor %d\n",
 | 
	
		
			
				|  |  | -+				dev_name(&dev->dev),
 | 
	
		
			
				|  |  | -+				dev->divisor - vlynq_ldiv1 + 1);
 | 
	
		
			
				|  |  | -+			return 0;
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	case vlynq_rdiv1:
 | 
	
		
			
				|  |  | -+	case vlynq_rdiv2:
 | 
	
		
			
				|  |  | -+	case vlynq_rdiv3:
 | 
	
		
			
				|  |  | -+	case vlynq_rdiv4:
 | 
	
		
			
				|  |  | -+	case vlynq_rdiv5:
 | 
	
		
			
				|  |  | -+	case vlynq_rdiv6:
 | 
	
		
			
				|  |  | -+	case vlynq_rdiv7:
 | 
	
		
			
				|  |  | -+	case vlynq_rdiv8:
 | 
	
		
			
				|  |  | -+		writel(0, &dev->local->control);
 | 
	
		
			
				|  |  | -+		writel(VLYNQ_CTRL_CLOCK_INT |
 | 
	
		
			
				|  |  | -+			VLYNQ_CTRL_CLOCK_DIV(dev->divisor -
 | 
	
		
			
				|  |  | -+			vlynq_rdiv1), &dev->remote->control);
 | 
	
		
			
				|  |  | -+		if (vlynq_linked(dev)) {
 | 
	
		
			
				|  |  | -+			printk(KERN_DEBUG
 | 
	
		
			
				|  |  | -+				"%s: using remote clock divisor %d\n",
 | 
	
		
			
				|  |  | -+				dev_name(&dev->dev),
 | 
	
		
			
				|  |  | -+				dev->divisor - vlynq_rdiv1 + 1);
 | 
	
		
			
				|  |  | -+			return 0;
 | 
	
		
			
				|  |  | -+		}
 | 
	
		
			
				|  |  | -+		break;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	ops->off(dev);
 | 
	
		
			
				|  |  | -+	return -ENODEV;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+int vlynq_enable_device(struct vlynq_device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	struct plat_vlynq_ops *ops = dev->dev.platform_data;
 | 
	
		
			
				|  |  | -+	int result = -ENODEV;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	result = __vlynq_enable_device(dev);
 | 
	
		
			
				|  |  | -+	if (result)
 | 
	
		
			
				|  |  | -+		return result;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	result = vlynq_setup_irq(dev);
 | 
	
		
			
				|  |  | -+	if (result)
 | 
	
		
			
				|  |  | -+		ops->off(dev);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	dev->enabled = !result;
 | 
	
		
			
				|  |  | -+	return result;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+EXPORT_SYMBOL(vlynq_enable_device);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+void vlynq_disable_device(struct vlynq_device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	struct plat_vlynq_ops *ops = dev->dev.platform_data;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	dev->enabled = 0;
 | 
	
		
			
				|  |  | -+	free_irq(dev->irq, dev);
 | 
	
		
			
				|  |  | -+	ops->off(dev);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+EXPORT_SYMBOL(vlynq_disable_device);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+int vlynq_set_local_mapping(struct vlynq_device *dev, u32 tx_offset,
 | 
	
		
			
				|  |  | -+			    struct vlynq_mapping *mapping)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int i;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (!dev->enabled)
 | 
	
		
			
				|  |  | -+		return -ENXIO;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel(tx_offset, &dev->local->tx_offset);
 | 
	
		
			
				|  |  | -+	for (i = 0; i < 4; i++) {
 | 
	
		
			
				|  |  | -+		writel(mapping[i].offset, &dev->local->rx_mapping[i].offset);
 | 
	
		
			
				|  |  | -+		writel(mapping[i].size, &dev->local->rx_mapping[i].size);
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+EXPORT_SYMBOL(vlynq_set_local_mapping);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+int vlynq_set_remote_mapping(struct vlynq_device *dev, u32 tx_offset,
 | 
	
		
			
				|  |  | -+			     struct vlynq_mapping *mapping)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int i;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (!dev->enabled)
 | 
	
		
			
				|  |  | -+		return -ENXIO;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel(tx_offset, &dev->remote->tx_offset);
 | 
	
		
			
				|  |  | -+	for (i = 0; i < 4; i++) {
 | 
	
		
			
				|  |  | -+		writel(mapping[i].offset, &dev->remote->rx_mapping[i].offset);
 | 
	
		
			
				|  |  | -+		writel(mapping[i].size, &dev->remote->rx_mapping[i].size);
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+EXPORT_SYMBOL(vlynq_set_remote_mapping);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+int vlynq_set_local_irq(struct vlynq_device *dev, int virq)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int irq = dev->irq_start + virq;
 | 
	
		
			
				|  |  | -+	if (dev->enabled)
 | 
	
		
			
				|  |  | -+		return -EBUSY;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if ((irq < dev->irq_start) || (irq > dev->irq_end))
 | 
	
		
			
				|  |  | -+		return -EINVAL;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (virq == dev->remote_irq)
 | 
	
		
			
				|  |  | -+		return -EINVAL;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	dev->local_irq = virq;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+EXPORT_SYMBOL(vlynq_set_local_irq);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+int vlynq_set_remote_irq(struct vlynq_device *dev, int virq)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int irq = dev->irq_start + virq;
 | 
	
		
			
				|  |  | -+	if (dev->enabled)
 | 
	
		
			
				|  |  | -+		return -EBUSY;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if ((irq < dev->irq_start) || (irq > dev->irq_end))
 | 
	
		
			
				|  |  | -+		return -EINVAL;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (virq == dev->local_irq)
 | 
	
		
			
				|  |  | -+		return -EINVAL;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	dev->remote_irq = virq;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+EXPORT_SYMBOL(vlynq_set_remote_irq);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int vlynq_probe(struct platform_device *pdev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	struct vlynq_device *dev;
 | 
	
		
			
				|  |  | -+	struct resource *regs_res, *mem_res, *irq_res;
 | 
	
		
			
				|  |  | -+	int len, result;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	regs_res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "regs");
 | 
	
		
			
				|  |  | -+	if (!regs_res)
 | 
	
		
			
				|  |  | -+		return -ENODEV;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	mem_res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mem");
 | 
	
		
			
				|  |  | -+	if (!mem_res)
 | 
	
		
			
				|  |  | -+		return -ENODEV;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	irq_res = platform_get_resource_byname(pdev, IORESOURCE_IRQ, "devirq");
 | 
	
		
			
				|  |  | -+	if (!irq_res)
 | 
	
		
			
				|  |  | -+		return -ENODEV;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
 | 
	
		
			
				|  |  | -+	if (!dev) {
 | 
	
		
			
				|  |  | -+		printk(KERN_ERR
 | 
	
		
			
				|  |  | -+		       "vlynq: failed to allocate device structure\n");
 | 
	
		
			
				|  |  | -+		return -ENOMEM;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	dev->id = pdev->id;
 | 
	
		
			
				|  |  | -+	dev->dev.bus = &vlynq_bus_type;
 | 
	
		
			
				|  |  | -+	dev->dev.parent = &pdev->dev;
 | 
	
		
			
				|  |  | -+	dev_set_name(&dev->dev, "vlynq%d", dev->id);
 | 
	
		
			
				|  |  | -+	dev->dev.platform_data = pdev->dev.platform_data;
 | 
	
		
			
				|  |  | -+	dev->dev.release = vlynq_device_release;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	dev->regs_start = regs_res->start;
 | 
	
		
			
				|  |  | -+	dev->regs_end = regs_res->end;
 | 
	
		
			
				|  |  | -+	dev->mem_start = mem_res->start;
 | 
	
		
			
				|  |  | -+	dev->mem_end = mem_res->end;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	len = regs_res->end - regs_res->start;
 | 
	
		
			
				|  |  | -+	if (!request_mem_region(regs_res->start, len, dev_name(&dev->dev))) {
 | 
	
		
			
				|  |  | -+		printk(KERN_ERR "%s: Can't request vlynq registers\n",
 | 
	
		
			
				|  |  | -+		       dev_name(&dev->dev));
 | 
	
		
			
				|  |  | -+		result = -ENXIO;
 | 
	
		
			
				|  |  | -+		goto fail_request;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	dev->local = ioremap(regs_res->start, len);
 | 
	
		
			
				|  |  | -+	if (!dev->local) {
 | 
	
		
			
				|  |  | -+		printk(KERN_ERR "%s: Can't remap vlynq registers\n",
 | 
	
		
			
				|  |  | -+		       dev_name(&dev->dev));
 | 
	
		
			
				|  |  | -+		result = -ENXIO;
 | 
	
		
			
				|  |  | -+		goto fail_remap;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	dev->remote = (struct vlynq_regs *)((void *)dev->local +
 | 
	
		
			
				|  |  | -+					    VLYNQ_REMOTE_OFFSET);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	dev->irq = platform_get_irq_byname(pdev, "irq");
 | 
	
		
			
				|  |  | -+	dev->irq_start = irq_res->start;
 | 
	
		
			
				|  |  | -+	dev->irq_end = irq_res->end;
 | 
	
		
			
				|  |  | -+	dev->local_irq = dev->irq_end - dev->irq_start;
 | 
	
		
			
				|  |  | -+	dev->remote_irq = dev->local_irq - 1;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (device_register(&dev->dev))
 | 
	
		
			
				|  |  | -+		goto fail_register;
 | 
	
		
			
				|  |  | -+	platform_set_drvdata(pdev, dev);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	printk(KERN_INFO "%s: regs 0x%p, irq %d, mem 0x%p\n",
 | 
	
		
			
				|  |  | -+	       dev_name(&dev->dev), (void *)dev->regs_start, dev->irq,
 | 
	
		
			
				|  |  | -+	       (void *)dev->mem_start);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	dev->dev_id = 0;
 | 
	
		
			
				|  |  | -+	dev->divisor = vlynq_div_auto;
 | 
	
		
			
				|  |  | -+	result = __vlynq_enable_device(dev);
 | 
	
		
			
				|  |  | -+	if (result == 0) {
 | 
	
		
			
				|  |  | -+		dev->dev_id = readl(&dev->remote->chip);
 | 
	
		
			
				|  |  | -+		((struct plat_vlynq_ops *)(dev->dev.platform_data))->off(dev);
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+	if (dev->dev_id)
 | 
	
		
			
				|  |  | -+		printk(KERN_INFO "Found a VLYNQ device: %08x\n", dev->dev_id);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+fail_register:
 | 
	
		
			
				|  |  | -+	iounmap(dev->local);
 | 
	
		
			
				|  |  | -+fail_remap:
 | 
	
		
			
				|  |  | -+fail_request:
 | 
	
		
			
				|  |  | -+	release_mem_region(regs_res->start, len);
 | 
	
		
			
				|  |  | -+	kfree(dev);
 | 
	
		
			
				|  |  | -+	return result;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int vlynq_remove(struct platform_device *pdev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	struct vlynq_device *dev = platform_get_drvdata(pdev);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	device_unregister(&dev->dev);
 | 
	
		
			
				|  |  | -+	iounmap(dev->local);
 | 
	
		
			
				|  |  | -+	release_mem_region(dev->regs_start, dev->regs_end - dev->regs_start);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	kfree(dev);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static struct platform_driver vlynq_platform_driver = {
 | 
	
		
			
				|  |  | -+	.driver.name = "vlynq",
 | 
	
		
			
				|  |  | -+	.probe = vlynq_probe,
 | 
	
		
			
				|  |  | -+	.remove = __devexit_p(vlynq_remove),
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct bus_type vlynq_bus_type = {
 | 
	
		
			
				|  |  | -+	.name = "vlynq",
 | 
	
		
			
				|  |  | -+	.match = vlynq_device_match,
 | 
	
		
			
				|  |  | -+	.probe = vlynq_device_probe,
 | 
	
		
			
				|  |  | -+	.remove = vlynq_device_remove,
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+EXPORT_SYMBOL(vlynq_bus_type);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static int __devinit vlynq_init(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int res = 0;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	res = bus_register(&vlynq_bus_type);
 | 
	
		
			
				|  |  | -+	if (res)
 | 
	
		
			
				|  |  | -+		goto fail_bus;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	res = platform_driver_register(&vlynq_platform_driver);
 | 
	
		
			
				|  |  | -+	if (res)
 | 
	
		
			
				|  |  | -+		goto fail_platform;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+fail_platform:
 | 
	
		
			
				|  |  | -+	bus_unregister(&vlynq_bus_type);
 | 
	
		
			
				|  |  | -+fail_bus:
 | 
	
		
			
				|  |  | -+	return res;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static void __devexit vlynq_exit(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	platform_driver_unregister(&vlynq_platform_driver);
 | 
	
		
			
				|  |  | -+	bus_unregister(&vlynq_bus_type);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+module_init(vlynq_init);
 | 
	
		
			
				|  |  | -+module_exit(vlynq_exit);
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/drivers/watchdog/ar7_wdt.c linux-2.6.30.5/drivers/watchdog/ar7_wdt.c
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/drivers/watchdog/ar7_wdt.c	2009-08-16 23:19:38.000000000 +0200
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/drivers/watchdog/ar7_wdt.c	2009-08-26 20:06:40.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -298,14 +298,28 @@
 | 
	
		
			
				|  |  | - 	.fops		= &ar7_wdt_fops,
 | 
	
		
			
				|  |  | - };
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | -+#define AR7_WDT_HARDWARE_ENABLE 0x10
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | - static int __init ar7_wdt_init(void)
 | 
	
		
			
				|  |  | - {
 | 
	
		
			
				|  |  | - 	int rc;
 | 
	
		
			
				|  |  | -+	u32 *bootcr;
 | 
	
		
			
				|  |  | -+	u32 bootcr_value;
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - 	spin_lock_init(&wdt_lock);
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - 	ar7_wdt_get_regs();
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | -+	/* arch/mips/ar7/clocks.c is the only other thing that reads this */
 | 
	
		
			
				|  |  | -+	bootcr = (u32 *)ioremap_nocache(AR7_REGS_DCL, 4);
 | 
	
		
			
				|  |  | -+	bootcr_value = *bootcr;
 | 
	
		
			
				|  |  | -+	iounmap(bootcr);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (!(bootcr_value & AR7_WDT_HARDWARE_ENABLE)) { 
 | 
	
		
			
				|  |  | -+		printk(KERN_INFO DRVNAME ": watchdog disabled in hardware (bootcr=%#x)\n", bootcr_value);
 | 
	
		
			
				|  |  | -+		return -ENODEV; 
 | 
	
		
			
				|  |  | -+        } 
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | - 	if (!request_mem_region(ar7_regs_wdt, sizeof(struct ar7_wdt),
 | 
	
		
			
				|  |  | - 							LONGNAME)) {
 | 
	
		
			
				|  |  | - 		printk(KERN_WARNING DRVNAME ": watchdog I/O region busy\n");
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/include/asm-mips/ar7/ar7.h linux-2.6.30.5/include/asm-mips/ar7/ar7.h
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/include/asm-mips/ar7/ar7.h	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/include/asm-mips/ar7/ar7.h	2009-08-26 20:05:02.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,170 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2006,2007 Felix Fietkau <nbd@openwrt.org>
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2006,2007 Eugene Konev <ejka@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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#ifndef __AR7_H__
 | 
	
		
			
				|  |  | -+#define __AR7_H__
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <linux/delay.h>
 | 
	
		
			
				|  |  | -+#include <asm/addrspace.h>
 | 
	
		
			
				|  |  | -+#include <linux/io.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define AR7_REGS_BASE	0x08610000
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define AR7_REGS_MAC0	(AR7_REGS_BASE + 0x0000)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_GPIO	(AR7_REGS_BASE + 0x0900)
 | 
	
		
			
				|  |  | -+/* 0x08610A00 - 0x08610BFF (512 bytes, 128 bytes / clock) */
 | 
	
		
			
				|  |  | -+#define AR7_REGS_POWER	(AR7_REGS_BASE + 0x0a00)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_UART0	(AR7_REGS_BASE + 0x0e00)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_USB	(AR7_REGS_BASE + 0x1200)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_RESET	(AR7_REGS_BASE + 0x1600)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_VLYNQ0	(AR7_REGS_BASE + 0x1800)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_DCL	(AR7_REGS_BASE + 0x1a00)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_VLYNQ1	(AR7_REGS_BASE + 0x1c00)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_MDIO	(AR7_REGS_BASE + 0x1e00)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_IRQ	(AR7_REGS_BASE + 0x2400)
 | 
	
		
			
				|  |  | -+#define AR7_REGS_MAC1	(AR7_REGS_BASE + 0x2800)
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define AR7_REGS_WDT	(AR7_REGS_BASE + 0x1f00)
 | 
	
		
			
				|  |  | -+#define UR8_REGS_WDT	(AR7_REGS_BASE + 0x0b00)
 | 
	
		
			
				|  |  | -+#define UR8_REGS_UART1	(AR7_REGS_BASE + 0x0f00)
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define AR7_RESET_PEREPHERIAL	0x0
 | 
	
		
			
				|  |  | -+#define AR7_RESET_SOFTWARE	0x4
 | 
	
		
			
				|  |  | -+#define AR7_RESET_STATUS	0x8
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define AR7_RESET_BIT_CPMAC_LO	17
 | 
	
		
			
				|  |  | -+#define AR7_RESET_BIT_CPMAC_HI	21
 | 
	
		
			
				|  |  | -+#define AR7_RESET_BIT_MDIO	22
 | 
	
		
			
				|  |  | -+#define AR7_RESET_BIT_EPHY	26
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/* GPIO control registers */
 | 
	
		
			
				|  |  | -+#define AR7_GPIO_INPUT	0x0
 | 
	
		
			
				|  |  | -+#define AR7_GPIO_OUTPUT	0x4
 | 
	
		
			
				|  |  | -+#define AR7_GPIO_DIR	0x8
 | 
	
		
			
				|  |  | -+#define AR7_GPIO_ENABLE	0xc
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define AR7_CHIP_7100	0x18
 | 
	
		
			
				|  |  | -+#define AR7_CHIP_7200	0x2b
 | 
	
		
			
				|  |  | -+#define AR7_CHIP_7300	0x05
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/* Interrupts */
 | 
	
		
			
				|  |  | -+#define AR7_IRQ_UART0	15
 | 
	
		
			
				|  |  | -+#define AR7_IRQ_UART1	16
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/* Clocks */
 | 
	
		
			
				|  |  | -+#define AR7_AFE_CLOCK	35328000
 | 
	
		
			
				|  |  | -+#define AR7_REF_CLOCK	25000000
 | 
	
		
			
				|  |  | -+#define AR7_XTAL_CLOCK	24000000
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct plat_cpmac_data {
 | 
	
		
			
				|  |  | -+	int reset_bit;
 | 
	
		
			
				|  |  | -+	int power_bit;
 | 
	
		
			
				|  |  | -+	u32 phy_mask;
 | 
	
		
			
				|  |  | -+	char dev_addr[6];
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct plat_dsl_data {
 | 
	
		
			
				|  |  | -+	int reset_bit_dsl;
 | 
	
		
			
				|  |  | -+	int reset_bit_sar;
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+extern int ar7_cpu_clock, ar7_bus_clock, ar7_dsp_clock;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline u16 ar7_chip_id(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return readl((void *)KSEG1ADDR(AR7_REGS_GPIO + 0x14)) & 0xffff;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline u8 ar7_chip_rev(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return (readl((void *)KSEG1ADDR(AR7_REGS_GPIO + 0x14)) >> 16) & 0xff;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int ar7_cpu_freq(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return ar7_cpu_clock;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int ar7_bus_freq(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return ar7_bus_clock;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int ar7_vbus_freq(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return ar7_bus_clock / 2;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+#define ar7_cpmac_freq ar7_vbus_freq
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int ar7_dsp_freq(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return ar7_dsp_clock;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int ar7_has_high_cpmac(void)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	u16 chip_id = ar7_chip_id();
 | 
	
		
			
				|  |  | -+	switch (chip_id) {
 | 
	
		
			
				|  |  | -+	case AR7_CHIP_7100:
 | 
	
		
			
				|  |  | -+	case AR7_CHIP_7200:
 | 
	
		
			
				|  |  | -+		return 0;
 | 
	
		
			
				|  |  | -+	default:
 | 
	
		
			
				|  |  | -+		return 1;
 | 
	
		
			
				|  |  | -+	}
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+#define ar7_has_high_vlynq ar7_has_high_cpmac
 | 
	
		
			
				|  |  | -+#define ar7_has_second_uart ar7_has_high_cpmac
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline void ar7_device_enable(u32 bit)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void *reset_reg =
 | 
	
		
			
				|  |  | -+		(void *)KSEG1ADDR(AR7_REGS_RESET + AR7_RESET_PEREPHERIAL);
 | 
	
		
			
				|  |  | -+	writel(readl(reset_reg) | (1 << bit), reset_reg);
 | 
	
		
			
				|  |  | -+	mdelay(20);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline void ar7_device_disable(u32 bit)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void *reset_reg =
 | 
	
		
			
				|  |  | -+		(void *)KSEG1ADDR(AR7_REGS_RESET + AR7_RESET_PEREPHERIAL);
 | 
	
		
			
				|  |  | -+	writel(readl(reset_reg) & ~(1 << bit), reset_reg);
 | 
	
		
			
				|  |  | -+	mdelay(20);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline void ar7_device_reset(u32 bit)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	ar7_device_disable(bit);
 | 
	
		
			
				|  |  | -+	ar7_device_enable(bit);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline void ar7_device_on(u32 bit)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void *power_reg = (void *)KSEG1ADDR(AR7_REGS_POWER);
 | 
	
		
			
				|  |  | -+	writel(readl(power_reg) | (1 << bit), power_reg);
 | 
	
		
			
				|  |  | -+	mdelay(20);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline void ar7_device_off(u32 bit)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void *power_reg = (void *)KSEG1ADDR(AR7_REGS_POWER);
 | 
	
		
			
				|  |  | -+	writel(readl(power_reg) & ~(1 << bit), power_reg);
 | 
	
		
			
				|  |  | -+	mdelay(20);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#endif /* __AR7_H__ */
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/include/asm-mips/ar7/gpio.h linux-2.6.30.5/include/asm-mips/ar7/gpio.h
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/include/asm-mips/ar7/gpio.h	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/include/asm-mips/ar7/gpio.h	2009-08-26 20:05:02.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,109 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2007 Florian Fainelli <florian@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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#ifndef __AR7_GPIO_H__
 | 
	
		
			
				|  |  | -+#define __AR7_GPIO_H__
 | 
	
		
			
				|  |  | -+#include <asm/ar7/ar7.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define AR7_GPIO_MAX 32
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+extern int gpio_request(unsigned gpio, const char *label);
 | 
	
		
			
				|  |  | -+extern void gpio_free(unsigned gpio);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/* Common GPIO layer */
 | 
	
		
			
				|  |  | -+static inline int gpio_get_value(unsigned gpio)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void __iomem *gpio_in =
 | 
	
		
			
				|  |  | -+		(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_INPUT);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return readl(gpio_in) & (1 << gpio);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline void gpio_set_value(unsigned gpio, int value)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void __iomem *gpio_out =
 | 
	
		
			
				|  |  | -+		(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_OUTPUT);
 | 
	
		
			
				|  |  | -+	unsigned tmp;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	tmp = readl(gpio_out) & ~(1 << gpio);
 | 
	
		
			
				|  |  | -+	if (value)
 | 
	
		
			
				|  |  | -+		tmp |= 1 << gpio;
 | 
	
		
			
				|  |  | -+	writel(tmp, gpio_out);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int gpio_direction_input(unsigned gpio)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void __iomem *gpio_dir =
 | 
	
		
			
				|  |  | -+		(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_DIR);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (gpio >= AR7_GPIO_MAX)
 | 
	
		
			
				|  |  | -+		return -EINVAL;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel(readl(gpio_dir) | (1 << gpio), gpio_dir);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int gpio_direction_output(unsigned gpio, int value)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void __iomem *gpio_dir =
 | 
	
		
			
				|  |  | -+		(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_DIR);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	if (gpio >= AR7_GPIO_MAX)
 | 
	
		
			
				|  |  | -+		return -EINVAL;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	gpio_set_value(gpio, value);
 | 
	
		
			
				|  |  | -+	writel(readl(gpio_dir) & ~(1 << gpio), gpio_dir);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int gpio_to_irq(unsigned gpio)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return -EINVAL;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int irq_to_gpio(unsigned irq)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return -EINVAL;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/* Board specific GPIO functions */
 | 
	
		
			
				|  |  | -+static inline int ar7_gpio_enable(unsigned gpio)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void __iomem *gpio_en =
 | 
	
		
			
				|  |  | -+		(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_ENABLE);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel(readl(gpio_en) | (1 << gpio), gpio_en);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int ar7_gpio_disable(unsigned gpio)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	void __iomem *gpio_en =
 | 
	
		
			
				|  |  | -+		(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_ENABLE);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	writel(readl(gpio_en) & ~(1 << gpio), gpio_en);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return 0;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <asm-generic/gpio.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#endif
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/include/asm-mips/ar7/irq.h linux-2.6.30.5/include/asm-mips/ar7/irq.h
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/include/asm-mips/ar7/irq.h	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/include/asm-mips/ar7/irq.h	2009-08-26 20:05:02.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,16 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * 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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * Shamelessly copied from asm-mips/mach-emma2rh/
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2003 by Ralf Baechle
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+#ifndef __ASM_AR7_IRQ_H
 | 
	
		
			
				|  |  | -+#define __ASM_AR7_IRQ_H
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define NR_IRQS	256
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include_next <irq.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#endif /* __ASM_AR7_IRQ_H */
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/include/asm-mips/ar7/prom.h linux-2.6.30.5/include/asm-mips/ar7/prom.h
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/include/asm-mips/ar7/prom.h	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/include/asm-mips/ar7/prom.h	2009-08-26 20:05:02.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,26 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2006, 2007 Florian Fainelli <florian@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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#ifndef __PROM_H__
 | 
	
		
			
				|  |  | -+#define __PROM_H__
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+extern char *prom_getenv(const char *name);
 | 
	
		
			
				|  |  | -+extern void prom_printf(const char *fmt, ...) __attribute__((format(printf, 1, 2)));
 | 
	
		
			
				|  |  | -+extern void prom_meminit(void);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#endif /* __PROM_H__ */
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/include/asm-mips/ar7/spaces.h linux-2.6.30.5/include/asm-mips/ar7/spaces.h
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/include/asm-mips/ar7/spaces.h	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/include/asm-mips/ar7/spaces.h	2009-08-26 20:05:02.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,32 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * 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) 1994 - 1999, 2000, 03, 04 Ralf Baechle
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2000, 2002  Maciej W. Rozycki
 | 
	
		
			
				|  |  | -+ * Copyright (C) 1990, 1999, 2000 Silicon Graphics, Inc.
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+#ifndef _ASM_AR7_SPACES_H
 | 
	
		
			
				|  |  | -+#define _ASM_AR7_SPACES_H
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define CAC_BASE		0x80000000
 | 
	
		
			
				|  |  | -+#define IO_BASE			0xa0000000
 | 
	
		
			
				|  |  | -+#define UNCAC_BASE		0xa0000000
 | 
	
		
			
				|  |  | -+#define MAP_BASE		0xc0000000
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * This handles the memory map.
 | 
	
		
			
				|  |  | -+ * We handle pages at KSEG0 for kernels with 32 bit address space.
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+#define PAGE_OFFSET		0x94000000UL
 | 
	
		
			
				|  |  | -+#define PHYS_OFFSET		0x14000000UL
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Memory above this physical address will be considered highmem.
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+#ifndef HIGHMEM_START
 | 
	
		
			
				|  |  | -+#define HIGHMEM_START		0x40000000UL
 | 
	
		
			
				|  |  | -+#endif
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#endif /* __ASM_AR7_SPACES_H */
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/include/asm-mips/ar7/war.h linux-2.6.30.5/include/asm-mips/ar7/war.h
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/include/asm-mips/ar7/war.h	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/include/asm-mips/ar7/war.h	2009-08-26 20:05:02.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,25 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * 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) 2002, 2004, 2007 by Ralf Baechle <ralf@linux-mips.org>
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+#ifndef __ASM_MIPS_MACH_BCM947XX_WAR_H
 | 
	
		
			
				|  |  | -+#define __ASM_MIPS_MACH_BCM947XX_WAR_H
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define R4600_V1_INDEX_ICACHEOP_WAR	0
 | 
	
		
			
				|  |  | -+#define R4600_V1_HIT_CACHEOP_WAR	0
 | 
	
		
			
				|  |  | -+#define R4600_V2_HIT_CACHEOP_WAR	0
 | 
	
		
			
				|  |  | -+#define R5432_CP0_INTERRUPT_WAR		0
 | 
	
		
			
				|  |  | -+#define BCM1250_M3_WAR			0
 | 
	
		
			
				|  |  | -+#define SIBYTE_1956_WAR			0
 | 
	
		
			
				|  |  | -+#define MIPS4K_ICACHE_REFILL_WAR	0
 | 
	
		
			
				|  |  | -+#define MIPS_CACHE_SYNC_WAR		0
 | 
	
		
			
				|  |  | -+#define TX49XX_ICACHE_INDEX_INV_WAR	0
 | 
	
		
			
				|  |  | -+#define RM9000_CDEX_SMP_WAR		0
 | 
	
		
			
				|  |  | -+#define ICACHE_REFILLS_WORKAROUND_WAR	0
 | 
	
		
			
				|  |  | -+#define R10000_LLSC_WAR			0
 | 
	
		
			
				|  |  | -+#define MIPS34K_MISSED_ITLB_WAR		0
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#endif /* __ASM_MIPS_MACH_BCM947XX_WAR_H */
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/include/linux/serial_core.h linux-2.6.30.5/include/linux/serial_core.h
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/include/linux/serial_core.h	2009-08-16 23:19:38.000000000 +0200
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/include/linux/serial_core.h	2009-08-26 20:06:59.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -41,6 +41,7 @@
 | 
	
		
			
				|  |  | - #define PORT_XSCALE	15
 | 
	
		
			
				|  |  | - #define PORT_RM9000	16	/* PMC-Sierra RM9xxx internal UART */
 | 
	
		
			
				|  |  | - #define PORT_OCTEON	17	/* Cavium OCTEON internal UART */
 | 
	
		
			
				|  |  | -+#define PORT_AR7	18	/* TI AR7 internal UART */
 | 
	
		
			
				|  |  | - #define PORT_MAX_8250	17	/* max port ID */
 | 
	
		
			
				|  |  | - 
 | 
	
		
			
				|  |  | - /*
 | 
	
		
			
				|  |  | -diff -Nur linux-2.6.30.5.orig/include/linux/vlynq.h linux-2.6.30.5/include/linux/vlynq.h
 | 
	
		
			
				|  |  | ---- linux-2.6.30.5.orig/include/linux/vlynq.h	1970-01-01 01:00:00.000000000 +0100
 | 
	
		
			
				|  |  | -+++ linux-2.6.30.5/include/linux/vlynq.h	2009-08-26 20:05:02.000000000 +0200
 | 
	
		
			
				|  |  | -@@ -0,0 +1,161 @@
 | 
	
		
			
				|  |  | -+/*
 | 
	
		
			
				|  |  | -+ * Copyright (C) 2006, 2007 Eugene Konev <ejka@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.
 | 
	
		
			
				|  |  | -+ *
 | 
	
		
			
				|  |  | -+ * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 | 
	
		
			
				|  |  | -+ */
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#ifndef __VLYNQ_H__
 | 
	
		
			
				|  |  | -+#define __VLYNQ_H__
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#include <linux/device.h>
 | 
	
		
			
				|  |  | -+#include <linux/module.h>
 | 
	
		
			
				|  |  | -+#include <linux/types.h>
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#define VLYNQ_NUM_IRQS 32
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct vlynq_mapping {
 | 
	
		
			
				|  |  | -+	u32 size;
 | 
	
		
			
				|  |  | -+	u32 offset;
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+enum vlynq_divisor {
 | 
	
		
			
				|  |  | -+	vlynq_div_auto = 0,
 | 
	
		
			
				|  |  | -+	vlynq_ldiv1,
 | 
	
		
			
				|  |  | -+	vlynq_ldiv2,
 | 
	
		
			
				|  |  | -+	vlynq_ldiv3,
 | 
	
		
			
				|  |  | -+	vlynq_ldiv4,
 | 
	
		
			
				|  |  | -+	vlynq_ldiv5,
 | 
	
		
			
				|  |  | -+	vlynq_ldiv6,
 | 
	
		
			
				|  |  | -+	vlynq_ldiv7,
 | 
	
		
			
				|  |  | -+	vlynq_ldiv8,
 | 
	
		
			
				|  |  | -+	vlynq_rdiv1,
 | 
	
		
			
				|  |  | -+	vlynq_rdiv2,
 | 
	
		
			
				|  |  | -+	vlynq_rdiv3,
 | 
	
		
			
				|  |  | -+	vlynq_rdiv4,
 | 
	
		
			
				|  |  | -+	vlynq_rdiv5,
 | 
	
		
			
				|  |  | -+	vlynq_rdiv6,
 | 
	
		
			
				|  |  | -+	vlynq_rdiv7,
 | 
	
		
			
				|  |  | -+	vlynq_rdiv8,
 | 
	
		
			
				|  |  | -+	vlynq_div_external
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct vlynq_device_id {
 | 
	
		
			
				|  |  | -+	u32 id;
 | 
	
		
			
				|  |  | -+	enum vlynq_divisor divisor;
 | 
	
		
			
				|  |  | -+	unsigned long driver_data;
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct vlynq_regs;
 | 
	
		
			
				|  |  | -+struct vlynq_device {
 | 
	
		
			
				|  |  | -+	u32 id, dev_id;
 | 
	
		
			
				|  |  | -+	int local_irq;
 | 
	
		
			
				|  |  | -+	int remote_irq;
 | 
	
		
			
				|  |  | -+	enum vlynq_divisor divisor;
 | 
	
		
			
				|  |  | -+	u32 regs_start, regs_end;
 | 
	
		
			
				|  |  | -+	u32 mem_start, mem_end;
 | 
	
		
			
				|  |  | -+	u32 irq_start, irq_end;
 | 
	
		
			
				|  |  | -+	int irq;
 | 
	
		
			
				|  |  | -+	int enabled;
 | 
	
		
			
				|  |  | -+	struct vlynq_regs *local;
 | 
	
		
			
				|  |  | -+	struct vlynq_regs *remote;
 | 
	
		
			
				|  |  | -+	struct device dev;
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct vlynq_driver {
 | 
	
		
			
				|  |  | -+	char *name;
 | 
	
		
			
				|  |  | -+	struct vlynq_device_id *id_table;
 | 
	
		
			
				|  |  | -+	int (*probe)(struct vlynq_device *dev, struct vlynq_device_id *id);
 | 
	
		
			
				|  |  | -+	void (*remove)(struct vlynq_device *dev);
 | 
	
		
			
				|  |  | -+	struct device_driver driver;
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+struct plat_vlynq_ops {
 | 
	
		
			
				|  |  | -+	int (*on)(struct vlynq_device *dev);
 | 
	
		
			
				|  |  | -+	void (*off)(struct vlynq_device *dev);
 | 
	
		
			
				|  |  | -+};
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline struct vlynq_driver *to_vlynq_driver(struct device_driver *drv)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return container_of(drv, struct vlynq_driver, driver);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline struct vlynq_device *to_vlynq_device(struct device *device)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return container_of(device, struct vlynq_device, dev);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+extern struct bus_type vlynq_bus_type;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+extern int __vlynq_register_driver(struct vlynq_driver *driver,
 | 
	
		
			
				|  |  | -+				   struct module *owner);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int vlynq_register_driver(struct vlynq_driver *driver)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return __vlynq_register_driver(driver, THIS_MODULE);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline void *vlynq_get_drvdata(struct vlynq_device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return dev_get_drvdata(&dev->dev);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline void vlynq_set_drvdata(struct vlynq_device *dev, void *data)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	dev_set_drvdata(&dev->dev, data);
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline u32 vlynq_mem_start(struct vlynq_device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return dev->mem_start;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline u32 vlynq_mem_end(struct vlynq_device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return dev->mem_end;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline u32 vlynq_mem_len(struct vlynq_device *dev)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	return dev->mem_end - dev->mem_start + 1;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int vlynq_virq_to_irq(struct vlynq_device *dev, int virq)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	int irq = dev->irq_start + virq;
 | 
	
		
			
				|  |  | -+	if ((irq < dev->irq_start) || (irq > dev->irq_end))
 | 
	
		
			
				|  |  | -+		return -EINVAL;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return irq;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+static inline int vlynq_irq_to_virq(struct vlynq_device *dev, int irq)
 | 
	
		
			
				|  |  | -+{
 | 
	
		
			
				|  |  | -+	if ((irq < dev->irq_start) || (irq > dev->irq_end))
 | 
	
		
			
				|  |  | -+		return -EINVAL;
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+	return irq - dev->irq_start;
 | 
	
		
			
				|  |  | -+}
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+extern void vlynq_unregister_driver(struct vlynq_driver *driver);
 | 
	
		
			
				|  |  | -+extern int vlynq_enable_device(struct vlynq_device *dev);
 | 
	
		
			
				|  |  | -+extern void vlynq_disable_device(struct vlynq_device *dev);
 | 
	
		
			
				|  |  | -+extern int vlynq_set_local_mapping(struct vlynq_device *dev, u32 tx_offset,
 | 
	
		
			
				|  |  | -+				   struct vlynq_mapping *mapping);
 | 
	
		
			
				|  |  | -+extern int vlynq_set_remote_mapping(struct vlynq_device *dev, u32 tx_offset,
 | 
	
		
			
				|  |  | -+				    struct vlynq_mapping *mapping);
 | 
	
		
			
				|  |  | -+extern int vlynq_set_local_irq(struct vlynq_device *dev, int virq);
 | 
	
		
			
				|  |  | -+extern int vlynq_set_remote_irq(struct vlynq_device *dev, int virq);
 | 
	
		
			
				|  |  | -+
 | 
	
		
			
				|  |  | -+#endif /* __VLYNQ_H__ */
 |