1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#include <linux/module.h>
17#include <linux/init.h>
18#include <linux/kernel.h>
19#include <linux/platform_data/sa11x0-serial.h>
20#include <linux/platform_device.h>
21#include <linux/delay.h>
22#include <linux/tty.h>
23#include <linux/mtd/mtd.h>
24#include <linux/mtd/partitions.h>
25#include <linux/errno.h>
26#include <linux/gpio.h>
27#include <linux/leds.h>
28
29#include <mach/hardware.h>
30#include <asm/mach-types.h>
31#include <asm/setup.h>
32#include <mach/irqs.h>
33
34#include <asm/mach/arch.h>
35#include <asm/mach/flash.h>
36#include <asm/mach/map.h>
37#include <asm/hardware/sa1111.h>
38
39#include <mach/badge4.h>
40
41#include "generic.h"
42
43static struct resource sa1111_resources[] = {
44 [0] = DEFINE_RES_MEM(BADGE4_SA1111_BASE, 0x2000),
45 [1] = DEFINE_RES_IRQ(BADGE4_IRQ_GPIO_SA1111),
46};
47
48static int badge4_sa1111_enable(void *data, unsigned devid)
49{
50 if (devid == SA1111_DEVID_USB)
51 badge4_set_5V(BADGE4_5V_USB, 1);
52 return 0;
53}
54
55static void badge4_sa1111_disable(void *data, unsigned devid)
56{
57 if (devid == SA1111_DEVID_USB)
58 badge4_set_5V(BADGE4_5V_USB, 0);
59}
60
61static struct sa1111_platform_data sa1111_info = {
62 .disable_devs = SA1111_DEVID_PS2_MSE,
63 .enable = badge4_sa1111_enable,
64 .disable = badge4_sa1111_disable,
65};
66
67static u64 sa1111_dmamask = 0xffffffffUL;
68
69static struct platform_device sa1111_device = {
70 .name = "sa1111",
71 .id = 0,
72 .dev = {
73 .dma_mask = &sa1111_dmamask,
74 .coherent_dma_mask = 0xffffffff,
75 .platform_data = &sa1111_info,
76 },
77 .num_resources = ARRAY_SIZE(sa1111_resources),
78 .resource = sa1111_resources,
79};
80
81
82struct gpio_led badge4_gpio_leds[] = {
83 {
84 .name = "badge4:red",
85 .default_trigger = "heartbeat",
86 .gpio = 7,
87 },
88 {
89 .name = "badge4:green",
90 .default_trigger = "cpu0",
91 .gpio = 9,
92 },
93};
94
95static struct gpio_led_platform_data badge4_gpio_led_info = {
96 .leds = badge4_gpio_leds,
97 .num_leds = ARRAY_SIZE(badge4_gpio_leds),
98};
99
100static struct platform_device badge4_leds = {
101 .name = "leds-gpio",
102 .id = -1,
103 .dev = {
104 .platform_data = &badge4_gpio_led_info,
105 }
106};
107
108static struct platform_device *devices[] __initdata = {
109 &sa1111_device,
110 &badge4_leds,
111};
112
113static int __init badge4_sa1111_init(void)
114{
115
116
117
118
119 sa1110_mb_disable();
120
121
122
123
124 return platform_add_devices(devices, ARRAY_SIZE(devices));
125}
126
127
128
129
130
131
132
133
134
135
136
137
138
139static struct mtd_partition badge4_partitions[] = {
140 {
141 .name = "BLOB boot loader",
142 .offset = 0,
143 .size = 0x0000A000
144 }, {
145 .name = "params",
146 .offset = MTDPART_OFS_APPEND,
147 .size = 0x00006000
148 }, {
149 .name = "root",
150 .offset = MTDPART_OFS_APPEND,
151 .size = MTDPART_SIZ_FULL
152 }
153};
154
155static struct flash_platform_data badge4_flash_data = {
156 .map_name = "cfi_probe",
157 .parts = badge4_partitions,
158 .nr_parts = ARRAY_SIZE(badge4_partitions),
159};
160
161static struct resource badge4_flash_resource =
162 DEFINE_RES_MEM(SA1100_CS0_PHYS, SZ_64M);
163
164static int five_v_on __initdata = 0;
165
166static int __init five_v_on_setup(char *ignore)
167{
168 five_v_on = 1;
169 return 1;
170}
171__setup("five_v_on", five_v_on_setup);
172
173
174static int __init badge4_init(void)
175{
176 int ret;
177
178 if (!machine_is_badge4())
179 return -ENODEV;
180
181
182 GPCR = (BADGE4_GPIO_LGP2 | BADGE4_GPIO_LGP3 |
183 BADGE4_GPIO_LGP4 | BADGE4_GPIO_LGP5 |
184 BADGE4_GPIO_LGP6 | BADGE4_GPIO_LGP7 |
185 BADGE4_GPIO_LGP8 | BADGE4_GPIO_LGP9 |
186 BADGE4_GPIO_GPA_VID | BADGE4_GPIO_GPB_VID |
187 BADGE4_GPIO_GPC_VID);
188 GPDR &= ~BADGE4_GPIO_INT_VID;
189 GPDR |= (BADGE4_GPIO_LGP2 | BADGE4_GPIO_LGP3 |
190 BADGE4_GPIO_LGP4 | BADGE4_GPIO_LGP5 |
191 BADGE4_GPIO_LGP6 | BADGE4_GPIO_LGP7 |
192 BADGE4_GPIO_LGP8 | BADGE4_GPIO_LGP9 |
193 BADGE4_GPIO_GPA_VID | BADGE4_GPIO_GPB_VID |
194 BADGE4_GPIO_GPC_VID);
195
196
197 GPCR = (BADGE4_GPIO_SDSDA | BADGE4_GPIO_SDSCL);
198 GPDR |= (BADGE4_GPIO_SDSDA | BADGE4_GPIO_SDSCL);
199
200
201 GPCR = (BADGE4_GPIO_UART_HS1 | BADGE4_GPIO_UART_HS2);
202 GPDR |= (BADGE4_GPIO_UART_HS1 | BADGE4_GPIO_UART_HS2);
203
204
205 GPCR = BADGE4_GPIO_MUXSEL0;
206 GPDR |= BADGE4_GPIO_MUXSEL0;
207
208
209 GPDR &= ~(BADGE4_GPIO_TESTPT_J5 | BADGE4_GPIO_TESTPT_J6);
210 GPCR = BADGE4_GPIO_TESTPT_J7;
211 GPDR |= BADGE4_GPIO_TESTPT_J7;
212
213
214 GPCR = BADGE4_GPIO_PCMEN5V;
215 GPDR |= BADGE4_GPIO_PCMEN5V;
216
217
218
219 printk(KERN_DEBUG __FILE__ ": SDRAM CPLD typ1=%d typ0=%d\n",
220 !!(GPLR & BADGE4_GPIO_SDTYP1),
221 !!(GPLR & BADGE4_GPIO_SDTYP0));
222
223
224
225
226
227
228
229 PGSR = 0;
230 PWER = 0;
231 PCFR = 0;
232 PSDR = 0;
233
234 PWER |= PWER_GPIO26;
235 PWER |= PWER_RTC;
236
237
238 PGSR |= BADGE4_GPIO_SA1111_NRST;
239
240 PGSR |= (GPLR & (BADGE4_GPIO_SDTYP0|BADGE4_GPIO_SDTYP1));
241
242
243
244 ret = badge4_sa1111_init();
245 if (ret < 0)
246 printk(KERN_ERR
247 "%s: SA-1111 initialization failed (%d)\n",
248 __func__, ret);
249
250
251
252 badge4_set_5V(BADGE4_5V_INITIALLY, five_v_on);
253
254 sa11x0_register_mtd(&badge4_flash_data, &badge4_flash_resource, 1);
255
256 return 0;
257}
258
259arch_initcall(badge4_init);
260
261
262static unsigned badge4_5V_bitmap = 0;
263
264void badge4_set_5V(unsigned subsystem, int on)
265{
266 unsigned long flags;
267 unsigned old_5V_bitmap;
268
269 local_irq_save(flags);
270
271 old_5V_bitmap = badge4_5V_bitmap;
272
273 if (on) {
274 badge4_5V_bitmap |= subsystem;
275 } else {
276 badge4_5V_bitmap &= ~subsystem;
277 }
278
279
280 if ((!old_5V_bitmap) && (badge4_5V_bitmap)) {
281
282 printk(KERN_INFO "%s: enabling 5V supply rail\n", __func__);
283 GPSR = BADGE4_GPIO_PCMEN5V;
284 } else if ((old_5V_bitmap) && (!badge4_5V_bitmap)) {
285
286 printk(KERN_INFO "%s: disabling 5V supply rail\n", __func__);
287 GPCR = BADGE4_GPIO_PCMEN5V;
288 }
289
290 local_irq_restore(flags);
291}
292EXPORT_SYMBOL(badge4_set_5V);
293
294
295static struct map_desc badge4_io_desc[] __initdata = {
296 {
297 .virtual = 0xf1000000,
298 .pfn = __phys_to_pfn(0x08000000),
299 .length = 0x00100000,
300 .type = MT_DEVICE
301 }, {
302 .virtual = 0xf2000000,
303 .pfn = __phys_to_pfn(0x10000000),
304 .length = 0x00100000,
305 .type = MT_DEVICE
306 }
307};
308
309static void
310badge4_uart_pm(struct uart_port *port, u_int state, u_int oldstate)
311{
312 if (!state) {
313 Ser1SDCR0 |= SDCR0_UART;
314 }
315}
316
317static struct sa1100_port_fns badge4_port_fns __initdata = {
318
319
320 .pm = badge4_uart_pm,
321};
322
323static void __init badge4_map_io(void)
324{
325 sa1100_map_io();
326 iotable_init(badge4_io_desc, ARRAY_SIZE(badge4_io_desc));
327
328 sa1100_register_uart_fns(&badge4_port_fns);
329 sa1100_register_uart(0, 3);
330 sa1100_register_uart(1, 1);
331}
332
333MACHINE_START(BADGE4, "Hewlett-Packard Laboratories BadgePAD 4")
334 .atag_offset = 0x100,
335 .map_io = badge4_map_io,
336 .nr_irqs = SA1100_NR_IRQS,
337 .init_irq = sa1100_init_irq,
338 .init_late = sa11x0_init_late,
339 .init_time = sa1100_timer_init,
340#ifdef CONFIG_SA1111
341 .dma_zone_size = SZ_1M,
342#endif
343 .restart = sa11x0_restart,
344MACHINE_END
345