Linux Audio

Check our new training course

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