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
741