Merge git://bedivere.hansenpartnership.com/git/scsi-rc-fixes-2.6
[linux-2.6.git] / arch / arm / mach-orion5x / dns323-setup.c
1 /*
2  * arch/arm/mach-orion5x/dns323-setup.c
3  *
4  * Copyright (C) 2007 Herbert Valerio Riedel <hvr@gnu.org>
5  *
6  * Support for HW Rev C1:
7  *
8  * Copyright (C) 2010 Benjamin Herrenschmidt <benh@kernel.crashing.org>
9  *
10  * This program is free software; you can redistribute it and/or modify
11  * it under the terms of the GNU Lesser General Public License as
12  * published by the Free Software Foundation; either version 2 of the
13  * License, or (at your option) any later version.
14  *
15  */
16
17 #include <linux/kernel.h>
18 #include <linux/init.h>
19 #include <linux/delay.h>
20 #include <linux/platform_device.h>
21 #include <linux/pci.h>
22 #include <linux/irq.h>
23 #include <linux/mtd/physmap.h>
24 #include <linux/mv643xx_eth.h>
25 #include <linux/leds.h>
26 #include <linux/gpio_keys.h>
27 #include <linux/input.h>
28 #include <linux/i2c.h>
29 #include <linux/ata_platform.h>
30 #include <linux/phy.h>
31 #include <linux/marvell_phy.h>
32 #include <asm/mach-types.h>
33 #include <asm/gpio.h>
34 #include <asm/mach/arch.h>
35 #include <asm/mach/pci.h>
36 #include <mach/orion5x.h>
37 #include "common.h"
38 #include "mpp.h"
39
40 /* Rev A1 and B1 */
41 #define DNS323_GPIO_LED_RIGHT_AMBER     1
42 #define DNS323_GPIO_LED_LEFT_AMBER      2
43 #define DNS323_GPIO_SYSTEM_UP           3
44 #define DNS323_GPIO_LED_POWER1          4
45 #define DNS323_GPIO_LED_POWER2          5
46 #define DNS323_GPIO_OVERTEMP            6
47 #define DNS323_GPIO_RTC                 7
48 #define DNS323_GPIO_POWER_OFF           8
49 #define DNS323_GPIO_KEY_POWER           9
50 #define DNS323_GPIO_KEY_RESET           10
51
52 /* Rev C1 */
53 #define DNS323C_GPIO_KEY_POWER          1
54 #define DNS323C_GPIO_POWER_OFF          2
55 #define DNS323C_GPIO_LED_RIGHT_AMBER    8
56 #define DNS323C_GPIO_LED_LEFT_AMBER     9
57 #define DNS323C_GPIO_LED_POWER          17
58 #define DNS323C_GPIO_FAN_BIT1           18
59 #define DNS323C_GPIO_FAN_BIT0           19
60
61 /* Exposed to userspace, do not change */
62 enum {
63         DNS323_REV_A1,  /* 0 */
64         DNS323_REV_B1,  /* 1 */
65         DNS323_REV_C1,  /* 2 */
66 };
67
68
69 /****************************************************************************
70  * PCI setup
71  */
72
73 static int __init dns323_pci_map_irq(const struct pci_dev *dev, u8 slot, u8 pin)
74 {
75         int irq;
76
77         /*
78          * Check for devices with hard-wired IRQs.
79          */
80         irq = orion5x_pci_map_irq(dev, slot, pin);
81         if (irq != -1)
82                 return irq;
83
84         return -1;
85 }
86
87 static struct hw_pci dns323_pci __initdata = {
88         .nr_controllers = 2,
89         .swizzle        = pci_std_swizzle,
90         .setup          = orion5x_pci_sys_setup,
91         .scan           = orion5x_pci_sys_scan_bus,
92         .map_irq        = dns323_pci_map_irq,
93 };
94
95 static int __init dns323_pci_init(void)
96 {
97         /* Rev B1 and C1 doesn't really use its PCI bus, and initialising PCI
98          * gets in the way of initialising the SATA controller.
99          */
100         if (machine_is_dns323() && system_rev == DNS323_REV_A1)
101                 pci_common_init(&dns323_pci);
102
103         return 0;
104 }
105
106 subsys_initcall(dns323_pci_init);
107
108 /****************************************************************************
109  * 8MiB NOR flash (Spansion S29GL064M90TFIR4)
110  *
111  * Layout as used by D-Link:
112  *  0x00000000-0x00010000 : "MTD1"
113  *  0x00010000-0x00020000 : "MTD2"
114  *  0x00020000-0x001a0000 : "Linux Kernel"
115  *  0x001a0000-0x007d0000 : "File System"
116  *  0x007d0000-0x00800000 : "u-boot"
117  */
118
119 #define DNS323_NOR_BOOT_BASE 0xf4000000
120 #define DNS323_NOR_BOOT_SIZE SZ_8M
121
122 static struct mtd_partition dns323_partitions[] = {
123         {
124                 .name   = "MTD1",
125                 .size   = 0x00010000,
126                 .offset = 0,
127         }, {
128                 .name   = "MTD2",
129                 .size   = 0x00010000,
130                 .offset = 0x00010000,
131         }, {
132                 .name   = "Linux Kernel",
133                 .size   = 0x00180000,
134                 .offset = 0x00020000,
135         }, {
136                 .name   = "File System",
137                 .size   = 0x00630000,
138                 .offset = 0x001A0000,
139         }, {
140                 .name   = "u-boot",
141                 .size   = 0x00030000,
142                 .offset = 0x007d0000,
143         },
144 };
145
146 static struct physmap_flash_data dns323_nor_flash_data = {
147         .width          = 1,
148         .parts          = dns323_partitions,
149         .nr_parts       = ARRAY_SIZE(dns323_partitions)
150 };
151
152 static struct resource dns323_nor_flash_resource = {
153         .flags          = IORESOURCE_MEM,
154         .start          = DNS323_NOR_BOOT_BASE,
155         .end            = DNS323_NOR_BOOT_BASE + DNS323_NOR_BOOT_SIZE - 1,
156 };
157
158 static struct platform_device dns323_nor_flash = {
159         .name           = "physmap-flash",
160         .id             = 0,
161         .dev            = {
162                 .platform_data  = &dns323_nor_flash_data,
163         },
164         .resource       = &dns323_nor_flash_resource,
165         .num_resources  = 1,
166 };
167
168 /****************************************************************************
169  * Ethernet
170  */
171
172 static struct mv643xx_eth_platform_data dns323_eth_data = {
173         .phy_addr = MV643XX_ETH_PHY_ADDR(8),
174 };
175
176 /* dns323_parse_hex_*() taken from tsx09-common.c; should a common copy of these
177  * functions be kept somewhere?
178  */
179 static int __init dns323_parse_hex_nibble(char n)
180 {
181         if (n >= '0' && n <= '9')
182                 return n - '0';
183
184         if (n >= 'A' && n <= 'F')
185                 return n - 'A' + 10;
186
187         if (n >= 'a' && n <= 'f')
188                 return n - 'a' + 10;
189
190         return -1;
191 }
192
193 static int __init dns323_parse_hex_byte(const char *b)
194 {
195         int hi;
196         int lo;
197
198         hi = dns323_parse_hex_nibble(b[0]);
199         lo = dns323_parse_hex_nibble(b[1]);
200
201         if (hi < 0 || lo < 0)
202                 return -1;
203
204         return (hi << 4) | lo;
205 }
206
207 static int __init dns323_read_mac_addr(void)
208 {
209         u_int8_t addr[6];
210         int i;
211         char *mac_page;
212
213         /* MAC address is stored as a regular ol' string in /dev/mtdblock4
214          * (0x007d0000-0x00800000) starting at offset 196480 (0x2ff80).
215          */
216         mac_page = ioremap(DNS323_NOR_BOOT_BASE + 0x7d0000 + 196480, 1024);
217         if (!mac_page)
218                 return -ENOMEM;
219
220         /* Sanity check the string we're looking at */
221         for (i = 0; i < 5; i++) {
222                 if (*(mac_page + (i * 3) + 2) != ':') {
223                         goto error_fail;
224                 }
225         }
226
227         for (i = 0; i < 6; i++) {
228                 int byte;
229
230                 byte = dns323_parse_hex_byte(mac_page + (i * 3));
231                 if (byte < 0) {
232                         goto error_fail;
233                 }
234
235                 addr[i] = byte;
236         }
237
238         iounmap(mac_page);
239         printk("DNS-323: Found ethernet MAC address: ");
240         for (i = 0; i < 6; i++)
241                 printk("%.2x%s", addr[i], (i < 5) ? ":" : ".\n");
242
243         memcpy(dns323_eth_data.mac_addr, addr, 6);
244
245         return 0;
246
247 error_fail:
248         iounmap(mac_page);
249         return -EINVAL;
250 }
251
252 /****************************************************************************
253  * GPIO LEDs (simple - doesn't use hardware blinking support)
254  */
255
256 #define ORION_BLINK_HALF_PERIOD 100 /* ms */
257
258 static int dns323_gpio_blink_set(unsigned gpio, int state,
259         unsigned long *delay_on, unsigned long *delay_off)
260 {
261
262         if (delay_on && delay_off && !*delay_on && !*delay_off)
263                 *delay_on = *delay_off = ORION_BLINK_HALF_PERIOD;
264
265         switch(state) {
266         case GPIO_LED_NO_BLINK_LOW:
267         case GPIO_LED_NO_BLINK_HIGH:
268                 orion_gpio_set_blink(gpio, 0);
269                 gpio_set_value(gpio, state);
270                 break;
271         case GPIO_LED_BLINK:
272                 orion_gpio_set_blink(gpio, 1);
273         }
274         return 0;
275 }
276
277 static struct gpio_led dns323ab_leds[] = {
278         {
279                 .name = "power:blue",
280                 .gpio = DNS323_GPIO_LED_POWER2,
281                 .default_trigger = "default-on",
282         }, {
283                 .name = "right:amber",
284                 .gpio = DNS323_GPIO_LED_RIGHT_AMBER,
285                 .active_low = 1,
286         }, {
287                 .name = "left:amber",
288                 .gpio = DNS323_GPIO_LED_LEFT_AMBER,
289                 .active_low = 1,
290         },
291 };
292
293
294 static struct gpio_led dns323c_leds[] = {
295         {
296                 .name = "power:blue",
297                 .gpio = DNS323C_GPIO_LED_POWER,
298                 .default_trigger = "timer",
299                 .active_low = 1,
300         }, {
301                 .name = "right:amber",
302                 .gpio = DNS323C_GPIO_LED_RIGHT_AMBER,
303                 .active_low = 1,
304         }, {
305                 .name = "left:amber",
306                 .gpio = DNS323C_GPIO_LED_LEFT_AMBER,
307                 .active_low = 1,
308         },
309 };
310
311
312 static struct gpio_led_platform_data dns323ab_led_data = {
313         .num_leds       = ARRAY_SIZE(dns323ab_leds),
314         .leds           = dns323ab_leds,
315         .gpio_blink_set = dns323_gpio_blink_set,
316 };
317
318 static struct gpio_led_platform_data dns323c_led_data = {
319         .num_leds       = ARRAY_SIZE(dns323c_leds),
320         .leds           = dns323c_leds,
321         .gpio_blink_set = dns323_gpio_blink_set,
322 };
323
324 static struct platform_device dns323_gpio_leds = {
325         .name           = "leds-gpio",
326         .id             = -1,
327         .dev            = {
328                 .platform_data  = &dns323ab_led_data,
329         },
330 };
331
332 /****************************************************************************
333  * GPIO Attached Keys
334  */
335
336 static struct gpio_keys_button dns323ab_buttons[] = {
337         {
338                 .code           = KEY_RESTART,
339                 .gpio           = DNS323_GPIO_KEY_RESET,
340                 .desc           = "Reset Button",
341                 .active_low     = 1,
342         }, {
343                 .code           = KEY_POWER,
344                 .gpio           = DNS323_GPIO_KEY_POWER,
345                 .desc           = "Power Button",
346                 .active_low     = 1,
347         },
348 };
349
350 static struct gpio_keys_platform_data dns323ab_button_data = {
351         .buttons        = dns323ab_buttons,
352         .nbuttons       = ARRAY_SIZE(dns323ab_buttons),
353 };
354
355 static struct gpio_keys_button dns323c_buttons[] = {
356         {
357                 .code           = KEY_POWER,
358                 .gpio           = DNS323C_GPIO_KEY_POWER,
359                 .desc           = "Power Button",
360                 .active_low     = 1,
361         },
362 };
363
364 static struct gpio_keys_platform_data dns323c_button_data = {
365         .buttons        = dns323c_buttons,
366         .nbuttons       = ARRAY_SIZE(dns323c_buttons),
367 };
368
369 static struct platform_device dns323_button_device = {
370         .name           = "gpio-keys",
371         .id             = -1,
372         .num_resources  = 0,
373         .dev            = {
374                 .platform_data  = &dns323ab_button_data,
375         },
376 };
377
378 /*****************************************************************************
379  * SATA
380  */
381 static struct mv_sata_platform_data dns323_sata_data = {
382        .n_ports        = 2,
383 };
384
385 /****************************************************************************
386  * General Setup
387  */
388 static unsigned int dns323a_mpp_modes[] __initdata = {
389         MPP0_PCIE_RST_OUTn,
390         MPP1_GPIO,              /* right amber LED (sata ch0) */
391         MPP2_GPIO,              /* left amber LED (sata ch1) */
392         MPP3_UNUSED,
393         MPP4_GPIO,              /* power button LED */
394         MPP5_GPIO,              /* power button LED */
395         MPP6_GPIO,              /* GMT G751-2f overtemp */
396         MPP7_GPIO,              /* M41T80 nIRQ/OUT/SQW */
397         MPP8_GPIO,              /* triggers power off */
398         MPP9_GPIO,              /* power button switch */
399         MPP10_GPIO,             /* reset button switch */
400         MPP11_UNUSED,
401         MPP12_UNUSED,
402         MPP13_UNUSED,
403         MPP14_UNUSED,
404         MPP15_UNUSED,
405         MPP16_UNUSED,
406         MPP17_UNUSED,
407         MPP18_UNUSED,
408         MPP19_UNUSED,
409         0,
410 };
411
412 static unsigned int dns323b_mpp_modes[] __initdata = {
413         MPP0_UNUSED,
414         MPP1_GPIO,              /* right amber LED (sata ch0) */
415         MPP2_GPIO,              /* left amber LED (sata ch1) */
416         MPP3_GPIO,              /* system up flag */
417         MPP4_GPIO,              /* power button LED */
418         MPP5_GPIO,              /* power button LED */
419         MPP6_GPIO,              /* GMT G751-2f overtemp */
420         MPP7_GPIO,              /* M41T80 nIRQ/OUT/SQW */
421         MPP8_GPIO,              /* triggers power off */
422         MPP9_GPIO,              /* power button switch */
423         MPP10_GPIO,             /* reset button switch */
424         MPP11_UNUSED,
425         MPP12_SATA_LED,
426         MPP13_SATA_LED,
427         MPP14_SATA_LED,
428         MPP15_SATA_LED,
429         MPP16_UNUSED,
430         MPP17_UNUSED,
431         MPP18_UNUSED,
432         MPP19_UNUSED,
433         0,
434 };
435
436 static unsigned int dns323c_mpp_modes[] __initdata = {
437         MPP0_GPIO,              /* ? input */
438         MPP1_GPIO,              /* input power switch (0 = pressed) */
439         MPP2_GPIO,              /* output power off */
440         MPP3_UNUSED,            /* ? output */
441         MPP4_UNUSED,            /* ? output */
442         MPP5_UNUSED,            /* ? output */
443         MPP6_UNUSED,            /* ? output */
444         MPP7_UNUSED,            /* ? output */
445         MPP8_GPIO,              /* i/o right amber LED */
446         MPP9_GPIO,              /* i/o left amber LED */
447         MPP10_GPIO,             /* input */
448         MPP11_UNUSED,
449         MPP12_SATA_LED,
450         MPP13_SATA_LED,
451         MPP14_SATA_LED,
452         MPP15_SATA_LED,
453         MPP16_UNUSED,
454         MPP17_GPIO,             /* power button LED */
455         MPP18_GPIO,             /* fan speed bit 0 */
456         MPP19_GPIO,             /* fan speed bit 1 */
457         0,
458 };
459
460 /* Rev C1 Fan speed notes:
461  *
462  * The fan is controlled by 2 GPIOs on this board. The settings
463  * of the bits is as follow:
464  *
465  *  GPIO 18    GPIO 19    Fan
466  *
467  *    0          0        stopped
468  *    0          1        low speed
469  *    1          0        high speed
470  *    1          1        don't do that (*)
471  *
472  * (*) I think the two bits control two feed-in resistors into a fixed
473  *     PWN circuit, setting both bits will basically go a 'bit' faster
474  *     than high speed, but d-link doesn't do it and you may get out of
475  *     HW spec so don't do it.
476  */
477
478 /*
479  * On the DNS-323 A1 and B1 the following devices are attached via I2C:
480  *
481  *  i2c addr | chip        | description
482  *  0x3e     | GMT G760Af  | fan speed PWM controller
483  *  0x48     | GMT G751-2f | temp. sensor and therm. watchdog (LM75 compatible)
484  *  0x68     | ST M41T80   | RTC w/ alarm
485  */
486 static struct i2c_board_info __initdata dns323ab_i2c_devices[] = {
487         {
488                 I2C_BOARD_INFO("g760a", 0x3e),
489         }, {
490                 I2C_BOARD_INFO("lm75", 0x48),
491         }, {
492                 I2C_BOARD_INFO("m41t80", 0x68),
493         },
494 };
495
496 /*
497  * On the DNS-323 C1 the following devices are attached via I2C:
498  *
499  *  i2c addr | chip        | description
500  *  0x48     | GMT G751-2f | temp. sensor and therm. watchdog (LM75 compatible)
501  *  0x68     | ST M41T80   | RTC w/ alarm
502  */
503 static struct i2c_board_info __initdata dns323c_i2c_devices[] = {
504         {
505                 I2C_BOARD_INFO("lm75", 0x48),
506         }, {
507                 I2C_BOARD_INFO("m41t80", 0x68),
508         },
509 };
510
511 /* DNS-323 rev. A specific power off method */
512 static void dns323a_power_off(void)
513 {
514         pr_info("DNS-323: Triggering power-off...\n");
515         gpio_set_value(DNS323_GPIO_POWER_OFF, 1);
516 }
517
518 /* DNS-323 rev B specific power off method */
519 static void dns323b_power_off(void)
520 {
521         pr_info("DNS-323: Triggering power-off...\n");
522         /* Pin has to be changed to 1 and back to 0 to do actual power off. */
523         gpio_set_value(DNS323_GPIO_POWER_OFF, 1);
524         mdelay(100);
525         gpio_set_value(DNS323_GPIO_POWER_OFF, 0);
526 }
527
528 /* DNS-323 rev. C specific power off method */
529 static void dns323c_power_off(void)
530 {
531         pr_info("DNS-323: Triggering power-off...\n");
532         gpio_set_value(DNS323C_GPIO_POWER_OFF, 1);
533 }
534
535 static int dns323c_phy_fixup(struct phy_device *phy)
536 {
537         phy->dev_flags |= MARVELL_PHY_M1118_DNS323_LEDS;
538
539         return 0;
540 }
541
542 static int __init dns323_identify_rev(void)
543 {
544         u32 dev, rev, i, reg;
545
546         pr_debug("DNS-323: Identifying board ... \n");
547
548         /* Rev A1 has a 5181 */
549         orion5x_pcie_id(&dev, &rev);
550         if (dev == MV88F5181_DEV_ID) {
551                 pr_debug("DNS-323: 5181 found, board is A1\n");
552                 return DNS323_REV_A1;
553         }
554         pr_debug("DNS-323: 5182 found, board is B1 or C1, checking PHY...\n");
555
556         /* Rev B1 and C1 both have 5182, let's poke at the eth PHY. This is
557          * a bit gross but we want to do that without links into the eth
558          * driver so let's poke at it directly. We default to rev B1 in
559          * case the accesses fail
560          */
561
562 #define ETH_SMI_REG             (ORION5X_ETH_VIRT_BASE + 0x2000 + 0x004)
563 #define  SMI_BUSY               0x10000000
564 #define  SMI_READ_VALID         0x08000000
565 #define  SMI_OPCODE_READ        0x04000000
566 #define  SMI_OPCODE_WRITE       0x00000000
567
568         for (i = 0; i < 1000; i++) {
569                 reg = readl(ETH_SMI_REG);
570                 if (!(reg & SMI_BUSY))
571                         break;
572         }
573         if (i >= 1000) {
574                 pr_warning("DNS-323: Timeout accessing PHY, assuming rev B1\n");
575                 return DNS323_REV_B1;
576         }
577         writel((3 << 21)        /* phy ID reg */ |
578                (8 << 16)        /* phy addr */ |
579                SMI_OPCODE_READ, ETH_SMI_REG);
580         for (i = 0; i < 1000; i++) {
581                 reg = readl(ETH_SMI_REG);
582                 if (reg & SMI_READ_VALID)
583                         break;
584         }
585         if (i >= 1000) {
586                 pr_warning("DNS-323: Timeout reading PHY, assuming rev B1\n");
587                 return DNS323_REV_B1;
588         }
589         pr_debug("DNS-323: Ethernet PHY ID 0x%x\n", reg & 0xffff);
590
591         /* Note: the Marvell tools mask the ID with 0x3f0 before comparison
592          * but I don't see that making a difference here, at least with
593          * any known Marvell PHY ID
594          */
595         switch(reg & 0xfff0) {
596         case 0x0cc0: /* MV88E1111 */
597                 return DNS323_REV_B1;
598         case 0x0e10: /* MV88E1118 */
599                 return DNS323_REV_C1;
600         default:
601                 pr_warning("DNS-323: Unknown PHY ID 0x%04x, assuming rev B1\n",
602                            reg & 0xffff);
603         }
604         return DNS323_REV_B1;
605 }
606
607 static void __init dns323_init(void)
608 {
609         /* Setup basic Orion functions. Need to be called early. */
610         orion5x_init();
611
612         /* Identify revision */
613         system_rev = dns323_identify_rev();
614         pr_info("DNS-323: Identified HW revision %c1\n", 'A' + system_rev);
615
616         /* Just to be tricky, the 5182 has a completely different
617          * set of MPP modes to the 5181.
618          */
619         switch(system_rev) {
620         case DNS323_REV_A1:
621                 orion5x_mpp_conf(dns323a_mpp_modes);
622                 writel(0, MPP_DEV_CTRL);                /* DEV_D[31:16] */
623                 break;
624         case DNS323_REV_B1:
625                 orion5x_mpp_conf(dns323b_mpp_modes);
626                 break;
627         case DNS323_REV_C1:
628                 orion5x_mpp_conf(dns323c_mpp_modes);
629                 break;
630         }
631
632         /* setup flash mapping
633          * CS3 holds a 8 MB Spansion S29GL064M90TFIR4
634          */
635         orion5x_setup_dev_boot_win(DNS323_NOR_BOOT_BASE, DNS323_NOR_BOOT_SIZE);
636         platform_device_register(&dns323_nor_flash);
637
638         /* Sort out LEDs, Buttons and i2c devices */
639         switch(system_rev) {
640         case DNS323_REV_A1:
641                 /* The 5181 power LED is active low and requires
642                  * DNS323_GPIO_LED_POWER1 to also be low.
643                  */
644                  dns323ab_leds[0].active_low = 1;
645                  gpio_request(DNS323_GPIO_LED_POWER1, "Power Led Enable");
646                  gpio_direction_output(DNS323_GPIO_LED_POWER1, 0);
647                 /* Fall through */
648         case DNS323_REV_B1:
649                 i2c_register_board_info(0, dns323ab_i2c_devices,
650                                 ARRAY_SIZE(dns323ab_i2c_devices));
651                 break;
652         case DNS323_REV_C1:
653                 /* Hookup LEDs & Buttons */
654                 dns323_gpio_leds.dev.platform_data = &dns323c_led_data;
655                 dns323_button_device.dev.platform_data = &dns323c_button_data;
656
657                 /* Hookup i2c devices and fan driver */
658                 i2c_register_board_info(0, dns323c_i2c_devices,
659                                 ARRAY_SIZE(dns323c_i2c_devices));
660                 platform_device_register_simple("dns323c-fan", 0, NULL, 0);
661
662                 /* Register fixup for the PHY LEDs */
663                 phy_register_fixup_for_uid(MARVELL_PHY_ID_88E1118,
664                                            MARVELL_PHY_ID_MASK,
665                                            dns323c_phy_fixup);
666         }
667
668         platform_device_register(&dns323_gpio_leds);
669         platform_device_register(&dns323_button_device);
670
671         /*
672          * Configure peripherals.
673          */
674         if (dns323_read_mac_addr() < 0)
675                 printk("DNS-323: Failed to read MAC address\n");
676         orion5x_ehci0_init();
677         orion5x_eth_init(&dns323_eth_data);
678         orion5x_i2c_init();
679         orion5x_uart0_init();
680
681         /* Remaining GPIOs */
682         switch(system_rev) {
683         case DNS323_REV_A1:
684                 /* Poweroff GPIO */
685                 if (gpio_request(DNS323_GPIO_POWER_OFF, "POWEROFF") != 0 ||
686                     gpio_direction_output(DNS323_GPIO_POWER_OFF, 0) != 0)
687                         pr_err("DNS-323: failed to setup power-off GPIO\n");
688                 pm_power_off = dns323a_power_off;
689                 break;
690         case DNS323_REV_B1:
691                 /* 5182 built-in SATA init */
692                 orion5x_sata_init(&dns323_sata_data);
693
694                 /* The DNS323 rev B1 has flag to indicate the system is up.
695                  * Without this flag set, power LED will flash and cannot be
696                  * controlled via leds-gpio.
697                  */
698                 if (gpio_request(DNS323_GPIO_SYSTEM_UP, "SYS_READY") == 0)
699                         gpio_direction_output(DNS323_GPIO_SYSTEM_UP, 1);
700
701                 /* Poweroff GPIO */
702                 if (gpio_request(DNS323_GPIO_POWER_OFF, "POWEROFF") != 0 ||
703                     gpio_direction_output(DNS323_GPIO_POWER_OFF, 0) != 0)
704                         pr_err("DNS-323: failed to setup power-off GPIO\n");
705                 pm_power_off = dns323b_power_off;
706                 break;
707         case DNS323_REV_C1:
708                 /* 5182 built-in SATA init */
709                 orion5x_sata_init(&dns323_sata_data);
710
711                 /* Poweroff GPIO */
712                 if (gpio_request(DNS323C_GPIO_POWER_OFF, "POWEROFF") != 0 ||
713                     gpio_direction_output(DNS323C_GPIO_POWER_OFF, 0) != 0)
714                         pr_err("DNS-323: failed to setup power-off GPIO\n");
715                 pm_power_off = dns323c_power_off;
716
717                 /* Now, -this- should theorically be done by the sata_mv driver
718                  * once I figure out what's going on there. Maybe the behaviour
719                  * of the LEDs should be somewhat passed via the platform_data.
720                  * for now, just whack the register and make the LEDs happy
721                  *
722                  * Note: AFAIK, rev B1 needs the same treatement but I'll let
723                  * somebody else test it.
724                  */
725                 writel(0x5, ORION5X_SATA_VIRT_BASE | 0x2c);
726                 break;
727         }
728 }
729
730 /* Warning: D-Link uses a wrong mach-type (=526) in their bootloader */
731 MACHINE_START(DNS323, "D-Link DNS-323")
732         /* Maintainer: Herbert Valerio Riedel <hvr@gnu.org> */
733         .boot_params    = 0x00000100,
734         .init_machine   = dns323_init,
735         .map_io         = orion5x_map_io,
736         .init_early     = orion5x_init_early,
737         .init_irq       = orion5x_init_irq,
738         .timer          = &orion5x_timer,
739         .fixup          = tag_fixup_mem32,
740 MACHINE_END