53d3521dc6dc03fc8bc179f50b786ccb4c5bfff9
[openwrt/svn-archive/archive.git] / target / linux / mcs814x / files-3.3 / arch / arm / mach-mcs814x / common.c
1 /*
2 * arch/arm/mach-mcs814x/common.c
3 *
4 * Core functions for Moschip MCS814x SoCs
5 *
6 * This file is licensed under the terms of the GNU General Public
7 * License version 2. This program is licensed "as is" without any
8 * warranty of any kind, whether express or implied.
9 */
10
11 #include <linux/kernel.h>
12 #include <linux/init.h>
13 #include <linux/io.h>
14 #include <linux/gpio.h>
15 #include <linux/of.h>
16 #include <linux/of_address.h>
17
18 #include <asm/setup.h>
19 #include <asm/mach-types.h>
20 #include <asm/mach/arch.h>
21 #include <mach/mcs814x.h>
22 #include <mach/cpu.h>
23 #include <asm/pgtable.h>
24 #include <asm/mach/map.h>
25
26 void __iomem *mcs814x_sysdbg_base;
27
28 static struct map_desc mcs814x_io_desc[] __initdata = {
29 {
30 .virtual = MCS814X_IO_BASE,
31 .pfn = __phys_to_pfn(MCS814X_IO_START),
32 .length = MCS814X_IO_SIZE,
33 .type = MT_DEVICE
34 },
35 };
36
37 struct cpu_mode {
38 const char *name;
39 int gpio_start;
40 int gpio_end;
41 };
42
43 static const struct cpu_mode cpu_modes[] = {
44 {
45 .name = "I2S",
46 .gpio_start = 4,
47 .gpio_end = 8,
48 },
49 {
50 .name = "UART",
51 .gpio_start = 4,
52 .gpio_end = 9,
53 },
54 {
55 .name = "External MII",
56 .gpio_start = 0,
57 .gpio_end = 16,
58 },
59 {
60 .name = "Normal",
61 .gpio_start = -1,
62 .gpio_end = -1,
63 },
64 };
65
66 static void mcs814x_eth_hardware_filter_set(u8 value)
67 {
68 u32 reg;
69
70 reg = __raw_readl(MCS814X_VIRT_BASE + MCS814X_DBGLED);
71 if (value)
72 reg |= 0x80;
73 else
74 reg &= ~0x80;
75 __raw_writel(reg, MCS814X_VIRT_BASE + MCS814X_DBGLED);
76 }
77
78 static void mcs814x_eth_led_cfg_set(u8 cfg)
79 {
80 u32 reg;
81
82 reg = __raw_readl(mcs814x_sysdbg_base + SYSDBG_BS2);
83 reg &= ~LED_CFG_MASK;
84 reg |= cfg;
85 __raw_writel(reg, mcs814x_sysdbg_base + SYSDBG_BS2);
86 }
87
88 static void mcs814x_eth_buffer_shifting_set(u8 value)
89 {
90 u8 reg;
91
92 reg = __raw_readb(mcs814x_sysdbg_base + SYSDBG_SYSCTL_MAC);
93 if (value)
94 reg |= BUF_SHIFT_BIT;
95 else
96 reg &= ~BUF_SHIFT_BIT;
97 __raw_writeb(reg, mcs814x_sysdbg_base + SYSDBG_SYSCTL_MAC);
98 }
99
100 static struct of_device_id mcs814x_eth_ids[] __initdata = {
101 { .compatible = "moschip,nuport-mac", },
102 { /* sentinel */ },
103 };
104
105 /* Configure platform specific knobs based on ethernet device node
106 * properties */
107 static void mcs814x_eth_init(void)
108 {
109 struct device_node *np;
110 const unsigned int *intspec;
111
112 np = of_find_matching_node(NULL, mcs814x_eth_ids);
113 if (!np)
114 return;
115
116 /* hardware filter must always be enabled */
117 mcs814x_eth_hardware_filter_set(1);
118
119 intspec = of_get_property(np, "nuport-mac,buffer-shifting", NULL);
120 if (!intspec)
121 mcs814x_eth_buffer_shifting_set(0);
122 else
123 mcs814x_eth_buffer_shifting_set(1);
124
125 intspec = of_get_property(np, "nuport-mac,link-activity", NULL);
126 if (intspec)
127 mcs814x_eth_led_cfg_set(be32_to_cpup(intspec));
128
129 of_node_put(np);
130 }
131
132 void __init mcs814x_init_machine(void)
133 {
134 u32 bs2, cpu_mode;
135 int gpio;
136
137 bs2 = __raw_readl(mcs814x_sysdbg_base + SYSDBG_BS2);
138 cpu_mode = (bs2 >> CPU_MODE_SHIFT) & CPU_MODE_MASK;
139
140 pr_info("CPU mode: %s\n", cpu_modes[cpu_mode].name);
141
142 /* request the gpios since the pins are muxed for functionnality */
143 for (gpio = cpu_modes[cpu_mode].gpio_start;
144 gpio == cpu_modes[cpu_mode].gpio_end; gpio++) {
145 if (gpio != -1)
146 gpio_request(gpio, cpu_modes[cpu_mode].name);
147 }
148
149 mcs814x_eth_init();
150 }
151
152 void __init mcs814x_map_io(void)
153 {
154 iotable_init(mcs814x_io_desc, ARRAY_SIZE(mcs814x_io_desc));
155
156 mcs814x_sysdbg_base = ioremap(MCS814X_IO_START + MCS814X_SYSDBG,
157 MCS814X_SYSDBG_SIZE);
158 if (!mcs814x_sysdbg_base)
159 panic("unable to remap sysdbg base");
160 }
161
162 void mcs814x_restart(char mode, const char *cmd)
163 {
164 __raw_writel(~(1 << 31), mcs814x_sysdbg_base);
165 }