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