fix (really this time) laguna UART config
[openwrt/openwrt.git] / target / linux / cns3xxx / patches-3.3 / 300-laguna_support.patch
1 --- /dev/null
2 +++ b/arch/arm/mach-cns3xxx/laguna.c
3 @@ -0,0 +1,936 @@
4 +/*
5 + * Gateworks Corporation Laguna Platform
6 + *
7 + * Copyright 2000 Deep Blue Solutions Ltd
8 + * Copyright 2008 ARM Limited
9 + * Copyright 2008 Cavium Networks
10 + * Scott Shu
11 + * Copyright 2010 MontaVista Software, LLC.
12 + * Anton Vorontsov <avorontsov@mvista.com>
13 + * Copyright 2011 Gateworks Corporation
14 + * Chris Lang <clang@gateworks.com>
15 + * Copyright 2012 Gateworks Corporation
16 + * Tim Harvey <tharvey@gateworks.com>
17 + *
18 + * This file is free software; you can redistribute it and/or modify
19 + * it under the terms of the GNU General Public License, Version 2, as
20 + * published by the Free Software Foundation.
21 + */
22 +
23 +#include <linux/init.h>
24 +#include <linux/kernel.h>
25 +#include <linux/compiler.h>
26 +#include <linux/io.h>
27 +#include <linux/gpio.h>
28 +#include <linux/dma-mapping.h>
29 +#include <linux/serial_core.h>
30 +#include <linux/serial_8250.h>
31 +#include <linux/platform_device.h>
32 +#include <linux/mtd/mtd.h>
33 +#include <linux/mtd/physmap.h>
34 +#include <linux/mtd/partitions.h>
35 +#include <linux/leds.h>
36 +#include <linux/i2c.h>
37 +#include <linux/i2c/at24.h>
38 +#include <linux/i2c/pca953x.h>
39 +#include <linux/spi/spi.h>
40 +#include <linux/spi/flash.h>
41 +#include <linux/if_ether.h>
42 +#include <asm/setup.h>
43 +#include <asm/mach-types.h>
44 +#include <asm/mach/arch.h>
45 +#include <asm/mach/map.h>
46 +#include <asm/mach/time.h>
47 +#include <mach/cns3xxx.h>
48 +#include <mach/irqs.h>
49 +#include <mach/platform.h>
50 +#include <mach/pm.h>
51 +#include <asm/hardware/gic.h>
52 +#include "core.h"
53 +#include "devices.h"
54 +
55 +#define ARRAY_AND_SIZE(x) (x), ARRAY_SIZE(x)
56 +
57 +// Config 1 Bitmap
58 +#define ETH0_LOAD BIT(0)
59 +#define ETH1_LOAD BIT(1)
60 +#define ETH2_LOAD BIT(2)
61 +#define SATA0_LOAD BIT(3)
62 +#define SATA1_LOAD BIT(4)
63 +#define PCM_LOAD BIT(5)
64 +#define I2S_LOAD BIT(6)
65 +#define SPI0_LOAD BIT(7)
66 +#define SPI1_LOAD BIT(8)
67 +#define PCIE0_LOAD BIT(9)
68 +#define PCIE1_LOAD BIT(10)
69 +#define USB0_LOAD BIT(11)
70 +#define USB1_LOAD BIT(12)
71 +#define USB1_ROUTE BIT(13)
72 +#define SD_LOAD BIT(14)
73 +#define UART0_LOAD BIT(15)
74 +#define UART1_LOAD BIT(16)
75 +#define UART2_LOAD BIT(17)
76 +#define MPCI0_LOAD BIT(18)
77 +#define MPCI1_LOAD BIT(19)
78 +#define MPCI2_LOAD BIT(20)
79 +#define MPCI3_LOAD BIT(21)
80 +#define FP_BUT_LOAD BIT(22)
81 +#define FP_BUT_HEADER_LOAD BIT(23)
82 +#define FP_LED_LOAD BIT(24)
83 +#define FP_LED_HEADER_LOAD BIT(25)
84 +#define FP_TAMPER_LOAD BIT(26)
85 +#define HEADER_33V_LOAD BIT(27)
86 +#define SATA_POWER_LOAD BIT(28)
87 +#define FP_POWER_LOAD BIT(29)
88 +#define GPIO_HEADER_LOAD BIT(30)
89 +#define GSP_BAT_LOAD BIT(31)
90 +
91 +// Config 2 Bitmap
92 +#define FAN_LOAD BIT(0)
93 +#define SPI_FLASH_LOAD BIT(1)
94 +#define NOR_FLASH_LOAD BIT(2)
95 +#define GPS_LOAD BIT(3)
96 +#define SUPPLY_5V_LOAD BIT(6)
97 +#define SUPPLY_33V_LOAD BIT(7)
98 +
99 +struct laguna_board_info {
100 + char model[16];
101 + u32 config_bitmap;
102 + u32 config2_bitmap;
103 + u8 nor_flash_size;
104 + u8 spi_flash_size;
105 +};
106 +
107 +static struct laguna_board_info laguna_info __initdata;
108 +
109 +/*
110 + * NOR Flash
111 + */
112 +static struct mtd_partition laguna_nor_partitions[] = {
113 + {
114 + .name = "uboot",
115 + .size = SZ_256K,
116 + .offset = 0,
117 + .mask_flags = MTD_WRITEABLE,
118 + }, {
119 + .name = "params",
120 + .size = SZ_128K,
121 + .offset = SZ_256K,
122 + }, {
123 + .name = "kernel",
124 + .size = SZ_2M,
125 + .offset = SZ_256K + SZ_128K,
126 + }, {
127 + .name = "rootfs",
128 + .size = SZ_16M - SZ_256K - SZ_128K - SZ_2M,
129 + .offset = SZ_256K + SZ_128K + SZ_2M,
130 + },
131 +};
132 +
133 +static struct physmap_flash_data laguna_nor_pdata = {
134 + .width = 2,
135 + .parts = laguna_nor_partitions,
136 + .nr_parts = ARRAY_SIZE(laguna_nor_partitions),
137 +};
138 +
139 +static struct resource laguna_nor_res = {
140 + .start = CNS3XXX_FLASH_BASE,
141 + .end = CNS3XXX_FLASH_BASE + SZ_128M - 1,
142 + .flags = IORESOURCE_MEM | IORESOURCE_MEM_32BIT,
143 +};
144 +
145 +static struct platform_device laguna_nor_pdev = {
146 + .name = "physmap-flash",
147 + .id = 0,
148 + .resource = &laguna_nor_res,
149 + .num_resources = 1,
150 + .dev = {
151 + .platform_data = &laguna_nor_pdata,
152 + },
153 +};
154 +
155 +/*
156 + * SPI
157 + */
158 +static struct mtd_partition laguna_spi_partitions[] = {
159 + {
160 + .name = "uboot",
161 + .size = SZ_256K,
162 + .offset = 0,
163 + .mask_flags = MTD_WRITEABLE,
164 + }, {
165 + .name = "params",
166 + .size = SZ_256K,
167 + .offset = SZ_256K,
168 + }, {
169 + .name = "kernel",
170 + .size = SZ_1M + SZ_512K,
171 + .offset = SZ_512K,
172 + }, {
173 + .name = "rootfs",
174 + .size = SZ_16M - SZ_2M,
175 + .offset = SZ_2M,
176 + },
177 +};
178 +
179 +static struct flash_platform_data laguna_spi_pdata = {
180 + .parts = laguna_spi_partitions,
181 + .nr_parts = ARRAY_SIZE(laguna_spi_partitions),
182 +};
183 +
184 +static struct spi_board_info __initdata laguna_spi_devices[] = {
185 + {
186 + .modalias = "m25p80",
187 + .platform_data = &laguna_spi_pdata,
188 + .max_speed_hz = 50000000,
189 + .bus_num = 1,
190 + .chip_select = 0,
191 + },
192 +};
193 +
194 +static struct platform_device laguna_spi_controller = {
195 + .name = "cns3xxx_spi",
196 +};
197 +
198 +/*
199 + * LED's
200 + */
201 +static struct gpio_led laguna_gpio_leds[] = {
202 + {
203 + .name = "user1", /* Green Led */
204 + .gpio = 115,
205 + .active_low = 1,
206 + },{
207 + .name = "user2", /* Red Led */
208 + .gpio = 114,
209 + .active_low = 1,
210 + },{
211 + .name = "pwr1", /* Green Led */
212 + .gpio = 116,
213 + .active_low = 1,
214 + },{
215 + .name = "pwr2", /* Yellow Led */
216 + .gpio = 117,
217 + .active_low = 1,
218 + },{
219 + .name = "txd1", /* Green Led */
220 + .gpio = 118,
221 + .active_low = 1,
222 + },{
223 + .name = "txd2", /* Yellow Led */
224 + .gpio = 119,
225 + .active_low = 1,
226 + },{
227 + .name = "rxd1", /* Green Led */
228 + .gpio = 120,
229 + .active_low = 1,
230 + },{
231 + .name = "rxd2", /* Yellow Led */
232 + .gpio = 121,
233 + .active_low = 1,
234 + },{
235 + .name = "ser1", /* Green Led */
236 + .gpio = 122,
237 + .active_low = 1,
238 + },{
239 + .name = "ser2", /* Yellow Led */
240 + .gpio = 123,
241 + .active_low = 1,
242 + },{
243 + .name = "enet1", /* Green Led */
244 + .gpio = 124,
245 + .active_low = 1,
246 + },{
247 + .name = "enet2", /* Yellow Led */
248 + .gpio = 125,
249 + .active_low = 1,
250 + },{
251 + .name = "sig1_1", /* Green Led */
252 + .gpio = 126,
253 + .active_low = 1,
254 + },{
255 + .name = "sig1_2", /* Yellow Led */
256 + .gpio = 127,
257 + .active_low = 1,
258 + },{
259 + .name = "sig2_1", /* Green Led */
260 + .gpio = 128,
261 + .active_low = 1,
262 + },{
263 + .name = "sig2_2", /* Yellow Led */
264 + .gpio = 129,
265 + .active_low = 1,
266 + },{
267 + .name = "sig3_1", /* Green Led */
268 + .gpio = 130,
269 + .active_low = 1,
270 + },{
271 + .name = "sig3_2", /* Yellow Led */
272 + .gpio = 131,
273 + .active_low = 1,
274 + },{
275 + .name = "net1", /*Green Led */
276 + .gpio = 109,
277 + .active_low = 1,
278 + },{
279 + .name = "net2", /* Red Led */
280 + .gpio = 110,
281 + .active_low = 1,
282 + },{
283 + .name = "mod1", /* Green Led */
284 + .gpio = 111,
285 + .active_low = 1,
286 + },{
287 + .name = "mod2", /* Red Led */
288 + .gpio = 112,
289 + .active_low = 1,
290 + },
291 +};
292 +
293 +static struct gpio_led_platform_data laguna_gpio_leds_data = {
294 + .num_leds = 22,
295 + .leds = laguna_gpio_leds,
296 +};
297 +
298 +static struct platform_device laguna_gpio_leds_device = {
299 + .name = "leds-gpio",
300 + .id = -1,
301 + .dev.platform_data = &laguna_gpio_leds_data,
302 +};
303 +
304 +/*
305 + * Ethernet
306 + */
307 +static struct cns3xxx_plat_info laguna_net_data = {
308 + .ports = 0,
309 + .phy = {
310 + 0,
311 + 1,
312 + 2,
313 + },
314 +};
315 +
316 +static struct platform_device laguna_net_device = {
317 + .name = "cns3xxx_eth",
318 + .id = 0,
319 + .dev.platform_data = &laguna_net_data,
320 +};
321 +
322 +/*
323 + * UART
324 + */
325 +static void __init laguna_early_serial_setup(void)
326 +{
327 +#ifdef CONFIG_SERIAL_8250_CONSOLE
328 + static struct uart_port laguna_serial_port = {
329 + .membase = (void __iomem *)CNS3XXX_UART0_BASE_VIRT,
330 + .mapbase = CNS3XXX_UART0_BASE,
331 + .irq = IRQ_CNS3XXX_UART0,
332 + .iotype = UPIO_MEM,
333 + .flags = UPF_BOOT_AUTOCONF | UPF_FIXED_TYPE,
334 + .regshift = 2,
335 + .uartclk = 24000000,
336 + .line = 0,
337 + .type = PORT_16550A,
338 + .fifosize = 16,
339 + };
340 +
341 + early_serial_setup(&laguna_serial_port);
342 +#endif
343 +}
344 +
345 +static struct resource laguna_uart_resources[] = {
346 + {
347 + .start = CNS3XXX_UART0_BASE,
348 + .end = CNS3XXX_UART0_BASE + SZ_4K - 1,
349 + .flags = IORESOURCE_MEM
350 + },{
351 + .start = CNS3XXX_UART2_BASE,
352 + .end = CNS3XXX_UART2_BASE + SZ_4K - 1,
353 + .flags = IORESOURCE_MEM
354 + },{
355 + .start = CNS3XXX_UART2_BASE,
356 + .end = CNS3XXX_UART2_BASE + SZ_4K - 1,
357 + .flags = IORESOURCE_MEM
358 + },
359 +};
360 +
361 +static struct plat_serial8250_port laguna_uart_data[] = {
362 + {
363 + .membase = (char*) (CNS3XXX_UART0_BASE_VIRT),
364 + .mapbase = (CNS3XXX_UART0_BASE),
365 + .irq = IRQ_CNS3XXX_UART0,
366 + .iotype = UPIO_MEM,
367 + .flags = UPF_BOOT_AUTOCONF | UPF_FIXED_TYPE | UPF_NO_TXEN_TEST,
368 + .regshift = 2,
369 + .uartclk = 24000000,
370 + .type = PORT_16550A,
371 + },{
372 + .membase = (char*) (CNS3XXX_UART1_BASE_VIRT),
373 + .mapbase = (CNS3XXX_UART1_BASE),
374 + .irq = IRQ_CNS3XXX_UART1,
375 + .iotype = UPIO_MEM,
376 + .flags = UPF_BOOT_AUTOCONF | UPF_FIXED_TYPE | UPF_NO_TXEN_TEST,
377 + .regshift = 2,
378 + .uartclk = 24000000,
379 + .type = PORT_16550A,
380 + },{
381 + .membase = (char*) (CNS3XXX_UART2_BASE_VIRT),
382 + .mapbase = (CNS3XXX_UART2_BASE),
383 + .irq = IRQ_CNS3XXX_UART2,
384 + .iotype = UPIO_MEM,
385 + .flags = UPF_BOOT_AUTOCONF | UPF_FIXED_TYPE | UPF_NO_TXEN_TEST,
386 + .regshift = 2,
387 + .uartclk = 24000000,
388 + .type = PORT_16550A,
389 + },
390 + { },
391 +};
392 +
393 +static struct platform_device laguna_uart = {
394 + .name = "serial8250",
395 + .id = PLAT8250_DEV_PLATFORM,
396 + .dev.platform_data = laguna_uart_data,
397 + .num_resources = 3,
398 + .resource = laguna_uart_resources
399 +};
400 +
401 +/*
402 + * USB
403 + */
404 +static struct resource cns3xxx_usb_ehci_resources[] = {
405 + [0] = {
406 + .start = CNS3XXX_USB_BASE,
407 + .end = CNS3XXX_USB_BASE + SZ_16M - 1,
408 + .flags = IORESOURCE_MEM,
409 + },
410 + [1] = {
411 + .start = IRQ_CNS3XXX_USB_EHCI,
412 + .flags = IORESOURCE_IRQ,
413 + },
414 +};
415 +
416 +static u64 cns3xxx_usb_ehci_dma_mask = DMA_BIT_MASK(32);
417 +
418 +static struct platform_device cns3xxx_usb_ehci_device = {
419 + .name = "cns3xxx-ehci",
420 + .num_resources = ARRAY_SIZE(cns3xxx_usb_ehci_resources),
421 + .resource = cns3xxx_usb_ehci_resources,
422 + .dev = {
423 + .dma_mask = &cns3xxx_usb_ehci_dma_mask,
424 + .coherent_dma_mask = DMA_BIT_MASK(32),
425 + },
426 +};
427 +
428 +static struct resource cns3xxx_usb_ohci_resources[] = {
429 + [0] = {
430 + .start = CNS3XXX_USB_OHCI_BASE,
431 + .end = CNS3XXX_USB_OHCI_BASE + SZ_16M - 1,
432 + .flags = IORESOURCE_MEM,
433 + },
434 + [1] = {
435 + .start = IRQ_CNS3XXX_USB_OHCI,
436 + .flags = IORESOURCE_IRQ,
437 + },
438 +};
439 +
440 +static u64 cns3xxx_usb_ohci_dma_mask = DMA_BIT_MASK(32);
441 +
442 +static struct platform_device cns3xxx_usb_ohci_device = {
443 + .name = "cns3xxx-ohci",
444 + .num_resources = ARRAY_SIZE(cns3xxx_usb_ohci_resources),
445 + .resource = cns3xxx_usb_ohci_resources,
446 + .dev = {
447 + .dma_mask = &cns3xxx_usb_ohci_dma_mask,
448 + .coherent_dma_mask = DMA_BIT_MASK(32),
449 + },
450 +};
451 +
452 +static struct resource cns3xxx_usb_otg_resources[] = {
453 + [0] = {
454 + .start = CNS3XXX_USBOTG_BASE,
455 + .end = CNS3XXX_USBOTG_BASE + SZ_16M - 1,
456 + .flags = IORESOURCE_MEM,
457 + },
458 + [1] = {
459 + .start = IRQ_CNS3XXX_USB_OTG,
460 + .flags = IORESOURCE_IRQ,
461 + },
462 +};
463 +
464 +static u64 cns3xxx_usb_otg_dma_mask = DMA_BIT_MASK(32);
465 +
466 +static struct platform_device cns3xxx_usb_otg_device = {
467 + .name = "dwc_otg",
468 + .num_resources = ARRAY_SIZE(cns3xxx_usb_otg_resources),
469 + .resource = cns3xxx_usb_otg_resources,
470 + .dev = {
471 + .dma_mask = &cns3xxx_usb_otg_dma_mask,
472 + .coherent_dma_mask = DMA_BIT_MASK(32),
473 + },
474 +};
475 +
476 +/*
477 + * I2C
478 + */
479 +static struct resource laguna_i2c_resource[] = {
480 + {
481 + .start = CNS3XXX_SSP_BASE + 0x20,
482 + .end = 0x7100003f,
483 + .flags = IORESOURCE_MEM,
484 + },{
485 + .start = IRQ_CNS3XXX_I2C,
486 + .flags = IORESOURCE_IRQ,
487 + },
488 +};
489 +
490 +static struct platform_device laguna_i2c_controller = {
491 + .name = "cns3xxx-i2c",
492 + .num_resources = 2,
493 + .resource = laguna_i2c_resource,
494 +};
495 +
496 +static struct memory_accessor *at24_mem_acc;
497 +
498 +static void at24_setup(struct memory_accessor *mem_acc, void *context)
499 +{
500 + char buf[16];
501 +
502 + at24_mem_acc = mem_acc;
503 +
504 + /* Read MAC addresses */
505 + if (at24_mem_acc->read(at24_mem_acc, buf, 0x100, 6) == 6)
506 + memcpy(&laguna_net_data.hwaddr[0], buf, ETH_ALEN);
507 + if (at24_mem_acc->read(at24_mem_acc, buf, 0x106, 6) == 6)
508 + memcpy(&laguna_net_data.hwaddr[1], buf, ETH_ALEN);
509 + if (at24_mem_acc->read(at24_mem_acc, buf, 0x10C, 6) == 6)
510 + memcpy(&laguna_net_data.hwaddr[2], buf, ETH_ALEN);
511 + if (at24_mem_acc->read(at24_mem_acc, buf, 0x112, 6) == 6)
512 + memcpy(&laguna_net_data.hwaddr[3], buf, ETH_ALEN);
513 +
514 + /* Read out Model Information */
515 + if (at24_mem_acc->read(at24_mem_acc, buf, 0x130, 16) == 16)
516 + memcpy(&laguna_info.model, buf, 16);
517 + if (at24_mem_acc->read(at24_mem_acc, buf, 0x140, 1) == 1)
518 + memcpy(&laguna_info.nor_flash_size, buf, 1);
519 + if (at24_mem_acc->read(at24_mem_acc, buf, 0x141, 1) == 1)
520 + memcpy(&laguna_info.spi_flash_size, buf, 1);
521 + if (at24_mem_acc->read(at24_mem_acc, buf, 0x142, 4) == 4)
522 + memcpy(&laguna_info.config_bitmap, buf, 4);
523 + if (at24_mem_acc->read(at24_mem_acc, buf, 0x146, 4) == 4)
524 + memcpy(&laguna_info.config2_bitmap, buf, 4);
525 +};
526 +
527 +static struct at24_platform_data laguna_eeprom_info = {
528 + .byte_len = 1024,
529 + .page_size = 16,
530 + .flags = AT24_FLAG_READONLY,
531 + .setup = at24_setup,
532 +};
533 +
534 +static struct pca953x_platform_data laguna_pca_data = {
535 + .gpio_base = 100,
536 + .irq_base = -1,
537 +};
538 +
539 +static struct pca953x_platform_data laguna_pca2_data = {
540 + .gpio_base = 116,
541 + .irq_base = -1,
542 +};
543 +
544 +static struct i2c_board_info __initdata laguna_i2c_devices[] = {
545 + {
546 + I2C_BOARD_INFO("pca9555", 0x23),
547 + .platform_data = &laguna_pca_data,
548 + },{
549 + I2C_BOARD_INFO("pca9555", 0x27),
550 + .platform_data = &laguna_pca2_data,
551 + },{
552 + I2C_BOARD_INFO("gsp", 0x29),
553 + },{
554 + I2C_BOARD_INFO ("24c08",0x50),
555 + .platform_data = &laguna_eeprom_info,
556 + },{
557 + I2C_BOARD_INFO("ds1672", 0x68),
558 + },
559 +};
560 +
561 +/*
562 + * Watchdog
563 + */
564 +
565 +static struct resource laguna_watchdog_resources[] = {
566 + [0] = {
567 + .start = CNS3XXX_TC11MP_TWD_BASE + 0x100, // CPU0 watchdog
568 + .end = CNS3XXX_TC11MP_TWD_BASE + SZ_4K - 1,
569 + .flags = IORESOURCE_MEM,
570 + },
571 + [1] = {
572 + .start = IRQ_LOCALWDOG,
573 + .end = IRQ_LOCALWDOG,
574 + .flags = IORESOURCE_IRQ,
575 + }
576 +};
577 +
578 +static struct platform_device laguna_watchdog = {
579 + .name = "mpcore_wdt",
580 + .id = -1,
581 + .num_resources = ARRAY_SIZE(laguna_watchdog_resources),
582 + .resource = laguna_watchdog_resources,
583 +};
584 +
585 +/*
586 + * GPIO
587 + */
588 +static struct platform_device laguna_gpio_dev = {
589 + .name = "GPIODEV",
590 + .id = -1,
591 +};
592 +
593 +static struct gpio laguna_gpio_gw2391[] = {
594 + { 0, GPIOF_IN , "*GPS_PPS" },
595 + { 1, GPIOF_IN , "*GSC_IRQ#" },
596 + { 2, GPIOF_IN , "*USB_FAULT#" },
597 + { 5, GPIOF_OUT_INIT_LOW , "*USB0_PCI_SEL" },
598 + { 6, GPIOF_OUT_INIT_HIGH, "*USB_VBUS_EN" },
599 + { 7, GPIOF_OUT_INIT_LOW , "*USB1_PCI_SEL" },
600 + { 8, GPIOF_OUT_INIT_HIGH, "*PERST#" },
601 + { 9, GPIOF_OUT_INIT_LOW , "*FP_SER_EN#" },
602 + { 100, GPIOF_IN , "*USER_PB#" },
603 + { 103, GPIOF_OUT_INIT_HIGH, "*V5_EN" },
604 + { 108, GPIOF_IN , "DIO0" },
605 + { 109, GPIOF_IN , "DIO1" },
606 + { 110, GPIOF_IN , "DIO2" },
607 + { 111, GPIOF_IN , "DIO3" },
608 + { 112, GPIOF_IN , "DIO4" },
609 +};
610 +
611 +static struct gpio laguna_gpio_gw2388[] = {
612 + { 0, GPIOF_IN , "*GPS_PPS" },
613 + { 1, GPIOF_IN , "*GSC_IRQ#" },
614 + { 3, GPIOF_IN , "*USB_FAULT#" },
615 + { 6, GPIOF_OUT_INIT_HIGH, "*USB_VBUS_EN" },
616 + { 7, GPIOF_OUT_INIT_LOW , "*GSM_SEL0" },
617 + { 8, GPIOF_OUT_INIT_LOW , "*GSM_SEL1" },
618 + { 9, GPIOF_OUT_INIT_LOW , "*FP_SER_EN" },
619 + { 100, GPIOF_OUT_INIT_HIGH, "*USER_PB#" },
620 + { 108, GPIOF_IN , "DIO0" },
621 + { 109, GPIOF_IN , "DIO1" },
622 + { 110, GPIOF_IN , "DIO2" },
623 + { 111, GPIOF_IN , "DIO3" },
624 + { 112, GPIOF_IN , "DIO4" },
625 +};
626 +
627 +static struct gpio laguna_gpio_gw2387[] = {
628 + { 0, GPIOF_IN , "*GPS_PPS" },
629 + { 1, GPIOF_IN , "*GSC_IRQ#" },
630 + { 2, GPIOF_IN , "*USB_FAULT#" },
631 + { 5, GPIOF_OUT_INIT_LOW , "*USB_PCI_SEL" },
632 + { 6, GPIOF_OUT_INIT_HIGH, "*USB_VBUS_EN" },
633 + { 7, GPIOF_OUT_INIT_LOW , "*GSM_SEL0" },
634 + { 8, GPIOF_OUT_INIT_LOW , "*GSM_SEL1" },
635 + { 9, GPIOF_OUT_INIT_LOW , "*FP_SER_EN" },
636 + { 100, GPIOF_IN , "*USER_PB#" },
637 + { 103, GPIOF_OUT_INIT_HIGH, "*V5_EN" },
638 + { 108, GPIOF_IN , "DIO0" },
639 + { 109, GPIOF_IN , "DIO1" },
640 + { 110, GPIOF_IN , "DIO2" },
641 + { 111, GPIOF_IN , "DIO3" },
642 + { 112, GPIOF_IN , "DIO4" },
643 + { 113, GPIOF_IN , "DIO5" },
644 +};
645 +
646 +static struct gpio laguna_gpio_gw2384[] = {
647 + { 0, GPIOF_IN , "*GSC_IRQ#" },
648 + { 1, GPIOF_OUT_INIT_HIGH, "*USB_HST_VBUS_EN" },
649 + { 2, GPIOF_IN , "*USB_HST_FAULT#" },
650 + { 5, GPIOF_IN , "*USB_OTG_FAULT#" },
651 + { 6, GPIOF_OUT_INIT_LOW , "*USB_HST_PCI_SEL" },
652 + { 7, GPIOF_OUT_INIT_LOW , "*GSM_SEL0" },
653 + { 8, GPIOF_OUT_INIT_LOW , "*GSM_SEL1" },
654 + { 9, GPIOF_OUT_INIT_LOW , "*FP_SER_EN" },
655 + { 12, GPIOF_OUT_INIT_LOW , "J10_DIOLED0" },
656 + { 13, GPIOF_OUT_INIT_HIGH, "*I2CMUX_RST#" },
657 + { 14, GPIOF_OUT_INIT_LOW , "J10_DIOLED1" },
658 + { 15, GPIOF_OUT_INIT_LOW , "J10_DIOLED2" },
659 + { 100, GPIOF_IN , "*USER_PB#" },
660 + { 103, GPIOF_OUT_INIT_HIGH, "V5_EN" },
661 + { 108, GPIOF_IN , "J9_DIOGSC0" },
662 +};
663 +
664 +static struct gpio laguna_gpio_gw2383[] = {
665 + { 0, GPIOF_IN , "*GPS_PPS" },
666 + { 1, GPIOF_IN , "*GSC_IRQ#" },
667 + { 2, GPIOF_OUT_INIT_HIGH, "*PCIE_RST#" },
668 + { 3, GPIOF_IN , "GPIO0" },
669 + { 8, GPIOF_IN , "GPIO1" },
670 + { 100, GPIOF_IN , "DIO0" },
671 + { 101, GPIOF_IN , "DIO1" },
672 +};
673 +
674 +static struct gpio laguna_gpio_gw2382[] = {
675 + { 0, GPIOF_IN , "*GPS_PPS" },
676 + { 1, GPIOF_IN , "*GSC_IRQ#" },
677 + { 2, GPIOF_OUT_INIT_HIGH, "*PCIE_RST#" },
678 + { 3, GPIOF_IN , "GPIO0" },
679 + { 4, GPIOF_IN , "GPIO1" },
680 + { 9, GPIOF_OUT_INIT_HIGH, "*USB_VBUS_EN" },
681 + { 10, GPIOF_OUT_INIT_HIGH, "*USB_PCI_SEL#" },
682 + { 100, GPIOF_IN , "DIO0" },
683 + { 101, GPIOF_IN , "DIO1" },
684 +};
685 +
686 +static struct gpio laguna_gpio_gw2380[] = {
687 + { 0, GPIOF_IN , "*GPS_PPS" },
688 + { 1, GPIOF_IN , "*GSC_IRQ#" },
689 + { 3, GPIOF_IN , "GPIO0" },
690 + { 8, GPIOF_IN , "GPIO1" },
691 + { 100, GPIOF_IN , "DIO0" },
692 + { 101, GPIOF_IN , "DIO1" },
693 + { 102, GPIOF_IN , "DIO2" },
694 + { 103, GPIOF_IN , "DIO3" },
695 +};
696 +
697 +/*
698 + * Initialization
699 + */
700 +static void __init laguna_init(void)
701 +{
702 + cns3xxx_l2x0_init();
703 +
704 + platform_device_register(&laguna_watchdog);
705 +
706 + platform_device_register(&laguna_i2c_controller);
707 +
708 + i2c_register_board_info(0, ARRAY_AND_SIZE(laguna_i2c_devices));
709 +
710 + pm_power_off = cns3xxx_power_off;
711 +}
712 +
713 +static struct map_desc laguna_io_desc[] __initdata = {
714 + {
715 + .virtual = CNS3XXX_UART0_BASE_VIRT,
716 + .pfn = __phys_to_pfn(CNS3XXX_UART0_BASE),
717 + .length = SZ_4K,
718 + .type = MT_DEVICE,
719 + },{
720 + .virtual = CNS3XXX_UART1_BASE_VIRT,
721 + .pfn = __phys_to_pfn(CNS3XXX_UART1_BASE),
722 + .length = SZ_4K,
723 + .type = MT_DEVICE,
724 + },{
725 + .virtual = CNS3XXX_UART2_BASE_VIRT,
726 + .pfn = __phys_to_pfn(CNS3XXX_UART2_BASE),
727 + .length = SZ_4K,
728 + .type = MT_DEVICE,
729 + },
730 +};
731 +
732 +static void __init laguna_map_io(void)
733 +{
734 + cns3xxx_common_init();
735 + cns3xxx_pcie_iotable_init(0x3);
736 + iotable_init(ARRAY_AND_SIZE(laguna_io_desc));
737 + laguna_early_serial_setup();
738 +}
739 +
740 +static int laguna_register_gpio(struct gpio *array, size_t num)
741 +{
742 + int i, err, ret;
743 +
744 + ret = 0;
745 + for (i = 0; i < num; i++, array++) {
746 + const char *label = array->label;
747 + if (label[0] == '*')
748 + label++;
749 + err = gpio_request_one(array->gpio, array->flags, label);
750 + if (err)
751 + ret = err;
752 + else {
753 + err = gpio_export(array->gpio, array->label[0] != '*');
754 + }
755 + }
756 + return ret;
757 +}
758 +
759 +static int __init laguna_model_setup(void)
760 +{
761 + u32 __iomem *mem;
762 + u32 reg;
763 + u8 pcie_bitmap = 0;
764 +
765 + printk("Running on Gateworks Laguna %s\n", laguna_info.model);
766 +
767 + if (strncmp(laguna_info.model, "GW", 2) == 0) {
768 + if (laguna_info.config_bitmap & ETH0_LOAD)
769 + laguna_net_data.ports |= BIT(0);
770 + if (laguna_info.config_bitmap & ETH1_LOAD)
771 + laguna_net_data.ports |= BIT(1);
772 + if (laguna_info.config_bitmap & ETH2_LOAD)
773 + laguna_net_data.ports |= BIT(2);
774 + if (laguna_net_data.ports)
775 + platform_device_register(&laguna_net_device);
776 +
777 + if ((laguna_info.config_bitmap & SATA0_LOAD) ||
778 + (laguna_info.config_bitmap & SATA1_LOAD))
779 + cns3xxx_ahci_init();
780 +
781 + if (laguna_info.config_bitmap & (PCIE0_LOAD))
782 + pcie_bitmap |= 0x1;
783 +
784 + if (laguna_info.config_bitmap & (PCIE1_LOAD))
785 + pcie_bitmap |= 0x2;
786 +
787 + cns3xxx_pcie_init(pcie_bitmap);
788 +
789 + if (laguna_info.config_bitmap & (USB0_LOAD)) {
790 + cns3xxx_pwr_power_up(1 << PM_PLL_HM_PD_CTRL_REG_OFFSET_PLL_USB);
791 +
792 + /* DRVVBUS pins share with GPIOA */
793 + mem = (void __iomem *)(CNS3XXX_MISC_BASE_VIRT + 0x0014);
794 + reg = __raw_readl(mem);
795 + reg |= 0x8;
796 + __raw_writel(reg, mem);
797 +
798 + /* Enable OTG */
799 + mem = (void __iomem *)(CNS3XXX_MISC_BASE_VIRT + 0x0808);
800 + reg = __raw_readl(mem);
801 + reg &= ~(1 << 10);
802 + __raw_writel(reg, mem);
803 +
804 + platform_device_register(&cns3xxx_usb_otg_device);
805 + }
806 +
807 + if (laguna_info.config_bitmap & (USB1_LOAD)) {
808 + platform_device_register(&cns3xxx_usb_ehci_device);
809 + platform_device_register(&cns3xxx_usb_ohci_device);
810 + }
811 +
812 + if (laguna_info.config_bitmap & (SD_LOAD))
813 + cns3xxx_sdhci_init();
814 +
815 + if (laguna_info.config_bitmap & (UART0_LOAD))
816 + laguna_uart.num_resources = 1;
817 + if (laguna_info.config_bitmap & (UART1_LOAD))
818 + laguna_uart.num_resources = 2;
819 + if (laguna_info.config_bitmap & (UART2_LOAD))
820 + laguna_uart.num_resources = 3;
821 + platform_device_register(&laguna_uart);
822 +
823 + if (laguna_info.config2_bitmap & (NOR_FLASH_LOAD)) {
824 + switch (laguna_info.nor_flash_size) {
825 + case 1:
826 + laguna_nor_partitions[3].size = SZ_8M - SZ_256K - SZ_128K - SZ_2M;
827 + laguna_nor_res.end = CNS3XXX_FLASH_BASE + SZ_8M - 1;
828 + break;
829 + case 2:
830 + laguna_nor_partitions[3].size = SZ_16M - SZ_256K - SZ_128K - SZ_2M;
831 + laguna_nor_res.end = CNS3XXX_FLASH_BASE + SZ_16M - 1;
832 + break;
833 + case 3:
834 + laguna_nor_partitions[3].size = SZ_32M - SZ_256K - SZ_128K - SZ_2M;
835 + laguna_nor_res.end = CNS3XXX_FLASH_BASE + SZ_32M - 1;
836 + break;
837 + case 4:
838 + laguna_nor_partitions[3].size = SZ_64M - SZ_256K - SZ_128K - SZ_2M;
839 + laguna_nor_res.end = CNS3XXX_FLASH_BASE + SZ_64M - 1;
840 + break;
841 + case 5:
842 + laguna_nor_partitions[3].size = SZ_128M - SZ_256K - SZ_128K - SZ_2M;
843 + laguna_nor_res.end = CNS3XXX_FLASH_BASE + SZ_128M - 1;
844 + break;
845 + }
846 + platform_device_register(&laguna_nor_pdev);
847 + }
848 +
849 + if (laguna_info.config2_bitmap & (SPI_FLASH_LOAD)) {
850 + switch (laguna_info.spi_flash_size) {
851 + case 1:
852 + laguna_spi_partitions[3].size = SZ_4M - SZ_2M;
853 + break;
854 + case 2:
855 + laguna_spi_partitions[3].size = SZ_8M - SZ_2M;
856 + break;
857 + case 3:
858 + laguna_spi_partitions[3].size = SZ_16M - SZ_2M;
859 + break;
860 + case 4:
861 + laguna_spi_partitions[3].size = SZ_32M - SZ_2M;
862 + break;
863 + case 5:
864 + laguna_spi_partitions[3].size = SZ_64M - SZ_2M;
865 + break;
866 + }
867 + spi_register_board_info(ARRAY_AND_SIZE(laguna_spi_devices));
868 + }
869 +
870 + if ((laguna_info.config_bitmap & SPI0_LOAD) ||
871 + (laguna_info.config_bitmap & SPI1_LOAD))
872 + platform_device_register(&laguna_spi_controller);
873 +
874 + /*
875 + * Do any model specific setup not known by the bitmap by matching
876 + * the first 6 characters of the model name
877 + */
878 +
879 + if ( (strncmp(laguna_info.model, "GW2388", 6) == 0)
880 + || (strncmp(laguna_info.model, "GW2389", 6) == 0) )
881 + {
882 + // configure GPIO's
883 + laguna_register_gpio(ARRAY_AND_SIZE(laguna_gpio_gw2388));
884 + // configure LED's
885 + laguna_gpio_leds_data.num_leds = 2;
886 + } else if (strncmp(laguna_info.model, "GW2387", 6) == 0) {
887 + // configure GPIO's
888 + laguna_register_gpio(ARRAY_AND_SIZE(laguna_gpio_gw2387));
889 + // configure LED's
890 + laguna_gpio_leds_data.num_leds = 2;
891 + } else if (strncmp(laguna_info.model, "GW2384", 6) == 0) {
892 + // configure GPIO's
893 + laguna_register_gpio(ARRAY_AND_SIZE(laguna_gpio_gw2384));
894 + // configure LED's
895 + laguna_gpio_leds_data.num_leds = 1;
896 + } else if (strncmp(laguna_info.model, "GW2383", 6) == 0) {
897 + // configure GPIO's
898 + laguna_register_gpio(ARRAY_AND_SIZE(laguna_gpio_gw2383));
899 + // configure LED's
900 + laguna_gpio_leds[0].gpio = 107;
901 + laguna_gpio_leds_data.num_leds = 1;
902 + } else if (strncmp(laguna_info.model, "GW2382", 6) == 0) {
903 + // configure GPIO's
904 + laguna_register_gpio(ARRAY_AND_SIZE(laguna_gpio_gw2382));
905 + // configure LED's
906 + laguna_gpio_leds[0].gpio = 107;
907 + laguna_gpio_leds_data.num_leds = 1;
908 + } else if (strncmp(laguna_info.model, "GW2380", 6) == 0) {
909 + // configure GPIO's
910 + laguna_register_gpio(ARRAY_AND_SIZE(laguna_gpio_gw2380));
911 + // configure LED's
912 + laguna_gpio_leds[0].gpio = 107;
913 + laguna_gpio_leds[1].gpio = 106;
914 + laguna_gpio_leds_data.num_leds = 2;
915 + } else if (strncmp(laguna_info.model, "GW2391", 6) == 0) {
916 + // configure GPIO's
917 + laguna_register_gpio(ARRAY_AND_SIZE(laguna_gpio_gw2391));
918 + // configure LED's
919 + laguna_gpio_leds_data.num_leds = 2;
920 + }
921 + platform_device_register(&laguna_gpio_leds_device);
922 + platform_device_register(&laguna_gpio_dev);
923 + } else {
924 + // Do some defaults here, not sure what yet
925 + }
926 + return 0;
927 +}
928 +
929 +late_initcall(laguna_model_setup);
930 +
931 +MACHINE_START(GW2388, "Gateworks Corporation Laguna Platform")
932 + .atag_offset = 0x100,
933 + .map_io = laguna_map_io,
934 + .init_irq = cns3xxx_init_irq,
935 + .timer = &cns3xxx_timer,
936 + .handle_irq = gic_handle_irq,
937 + .init_machine = laguna_init,
938 + .restart = cns3xxx_restart,
939 +MACHINE_END
940 --- a/arch/arm/mach-cns3xxx/Kconfig
941 +++ b/arch/arm/mach-cns3xxx/Kconfig
942 @@ -11,4 +11,14 @@ config MACH_CNS3420VB
943 This is a platform with an on-board ARM11 MPCore and has support
944 for USB, USB-OTG, MMC/SD/SDIO, SATA, PCI-E, etc.
945
946 +config MACH_GW2388
947 + bool "Support for Gateworks Laguna Platform"
948 + select HAVE_ARM_SCU if SMP
949 + select MIGHT_HAVE_PCI
950 + help
951 + Include support for the Gateworks Laguna Platform
952 +
953 + This is a platform with an on-board ARM11 MPCore and has support
954 + for USB, USB-OTG, MMC/SD/SDIO, SATA, PCI-E, I2C, GIG, etc.
955 +
956 endmenu
957 --- a/arch/arm/mach-cns3xxx/Makefile
958 +++ b/arch/arm/mach-cns3xxx/Makefile
959 @@ -1,6 +1,7 @@
960 obj-$(CONFIG_ARCH_CNS3XXX) += core.o pm.o devices.o
961 obj-$(CONFIG_PCI) += pcie.o
962 obj-$(CONFIG_MACH_CNS3420VB) += cns3420vb.o
963 +obj-$(CONFIG_MACH_GW2388) += laguna.o
964 obj-$(CONFIG_SMP) += platsmp.o headsmp.o
965 obj-$(CONFIG_HOTPLUG_CPU) += hotplug.o
966 obj-$(CONFIG_LOCAL_TIMERS) += localtimer.o
967 --- a/arch/arm/mach-cns3xxx/devices.c
968 +++ b/arch/arm/mach-cns3xxx/devices.c
969 @@ -19,6 +19,7 @@
970 #include <mach/cns3xxx.h>
971 #include <mach/irqs.h>
972 #include <mach/pm.h>
973 +#include <asm/mach-types.h>
974 #include "core.h"
975 #include "devices.h"
976
977 @@ -102,7 +103,11 @@ void __init cns3xxx_sdhci_init(void)
978 u32 gpioa_pins = __raw_readl(gpioa);
979
980 /* MMC/SD pins share with GPIOA */
981 - gpioa_pins |= 0x1fff0004;
982 + if (machine_is_gw2388()) {
983 + gpioa_pins |= 0x1fff0000;
984 + } else {
985 + gpioa_pins |= 0x1fff0004;
986 + }
987 __raw_writel(gpioa_pins, gpioa);
988
989 cns3xxx_pwr_clk_en(CNS3XXX_PWR_CLK_EN(SDIO));