1
2
3
4
5
6
7
8
9#include <linux/platform_device.h>
10#include <linux/module.h>
11#include <linux/leds.h>
12#include <linux/mtd/physmap.h>
13#include <linux/ssb/ssb.h>
14#include <linux/interrupt.h>
15#include <linux/reboot.h>
16#include <linux/gpio.h>
17#include <asm/mach-bcm47xx/bcm47xx.h>
18
19
20#define WGT634U_GPIO_LED 3
21#define WGT634U_GPIO_RESET 2
22#define WGT634U_GPIO_TP1 7
23#define WGT634U_GPIO_TP2 6
24#define WGT634U_GPIO_TP3 5
25#define WGT634U_GPIO_TP4 4
26#define WGT634U_GPIO_TP5 1
27
28static struct gpio_led wgt634u_leds[] = {
29 {
30 .name = "power",
31 .gpio = WGT634U_GPIO_LED,
32 .active_low = 1,
33 .default_trigger = "heartbeat",
34 },
35};
36
37static struct gpio_led_platform_data wgt634u_led_data = {
38 .num_leds = ARRAY_SIZE(wgt634u_leds),
39 .leds = wgt634u_leds,
40};
41
42static struct platform_device wgt634u_gpio_leds = {
43 .name = "leds-gpio",
44 .id = -1,
45 .dev = {
46 .platform_data = &wgt634u_led_data,
47 }
48};
49
50
51
52
53static struct mtd_partition wgt634u_partitions[] = {
54 {
55 .name = "cfe",
56 .offset = 0,
57 .size = 0x60000,
58 .mask_flags = MTD_WRITEABLE
59 },
60 {
61 .name = "config",
62 .offset = 0x60000,
63 .size = 0x20000
64 },
65 {
66 .name = "linux",
67 .offset = 0x80000,
68 .size = 0x140000
69 },
70 {
71 .name = "jffs",
72 .offset = 0x1c0000,
73 .size = 0x620000
74 },
75 {
76 .name = "nvram",
77 .offset = 0x7e0000,
78 .size = 0x20000
79 },
80};
81
82static struct physmap_flash_data wgt634u_flash_data = {
83 .parts = wgt634u_partitions,
84 .nr_parts = ARRAY_SIZE(wgt634u_partitions)
85};
86
87static struct resource wgt634u_flash_resource = {
88 .flags = IORESOURCE_MEM,
89};
90
91static struct platform_device wgt634u_flash = {
92 .name = "physmap-flash",
93 .id = 0,
94 .dev = { .platform_data = &wgt634u_flash_data, },
95 .resource = &wgt634u_flash_resource,
96 .num_resources = 1,
97};
98
99
100static struct platform_device *wgt634u_devices[] __initdata = {
101 &wgt634u_flash,
102 &wgt634u_gpio_leds,
103};
104
105static irqreturn_t gpio_interrupt(int irq, void *ignored)
106{
107 int state;
108
109
110
111 if (!ssb_chipco_irq_status(&bcm47xx_bus.ssb.chipco,
112 SSB_CHIPCO_IRQ_GPIO))
113 return IRQ_NONE;
114
115 state = gpio_get_value(WGT634U_GPIO_RESET);
116
117
118
119 gpio_polarity(WGT634U_GPIO_RESET, state);
120
121 if (!state) {
122 printk(KERN_INFO "Reset button pressed");
123 ctrl_alt_del();
124 }
125
126 return IRQ_HANDLED;
127}
128
129static int __init wgt634u_init(void)
130{
131
132
133
134
135 u8 *et0mac;
136
137 if (bcm47xx_bus_type != BCM47XX_BUS_TYPE_SSB)
138 return -ENODEV;
139
140 et0mac = bcm47xx_bus.ssb.sprom.et0mac;
141
142 if (et0mac[0] == 0x00 &&
143 ((et0mac[1] == 0x09 && et0mac[2] == 0x5b) ||
144 (et0mac[1] == 0x0f && et0mac[2] == 0xb5))) {
145 struct ssb_mipscore *mcore = &bcm47xx_bus.ssb.mipscore;
146
147 printk(KERN_INFO "WGT634U machine detected.\n");
148
149 if (!request_irq(gpio_to_irq(WGT634U_GPIO_RESET),
150 gpio_interrupt, IRQF_SHARED,
151 "WGT634U GPIO", &bcm47xx_bus.ssb.chipco)) {
152 gpio_direction_input(WGT634U_GPIO_RESET);
153 gpio_intmask(WGT634U_GPIO_RESET, 1);
154 ssb_chipco_irq_mask(&bcm47xx_bus.ssb.chipco,
155 SSB_CHIPCO_IRQ_GPIO,
156 SSB_CHIPCO_IRQ_GPIO);
157 }
158
159 wgt634u_flash_data.width = mcore->flash_buswidth;
160 wgt634u_flash_resource.start = mcore->flash_window;
161 wgt634u_flash_resource.end = mcore->flash_window
162 + mcore->flash_window_size
163 - 1;
164 return platform_add_devices(wgt634u_devices,
165 ARRAY_SIZE(wgt634u_devices));
166 } else
167 return -ENODEV;
168}
169
170module_init(wgt634u_init);
171