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