[deliverable/linux.git] / arch / arm / mach-orion5x / dns323-setup.c

/*
 * arch/arm/mach-orion5x/dns323-setup.c
 *
 * Copyright (C) 2007 Herbert Valerio Riedel <hvr@gnu.org>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU Lesser General Public License as
 * published by the Free Software Foundation; either version 2 of the
 * License, or (at your option) any later version.
 *
 */

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/platform_device.h>
#include <linux/pci.h>
#include <linux/irq.h>
#include <linux/mtd/physmap.h>
#include <linux/mv643xx_eth.h>
#include <linux/leds.h>
#include <linux/gpio_keys.h>
#include <linux/input.h>
#include <linux/i2c.h>
#include <linux/ata_platform.h>
#include <asm/mach-types.h>
#include <asm/gpio.h>
#include <asm/mach/arch.h>
#include <asm/mach/pci.h>
#include <mach/orion5x.h>
#include "common.h"
#include "mpp.h"

#define DNS323_GPIO_LED_RIGHT_AMBER	1
#define DNS323_GPIO_LED_LEFT_AMBER	2
#define DNS323_GPIO_SYSTEM_UP		3
#define DNS323_GPIO_LED_POWER1		4
#define DNS323_GPIO_LED_POWER2		5
#define DNS323_GPIO_OVERTEMP		6
#define DNS323_GPIO_RTC			7
#define DNS323_GPIO_POWER_OFF		8
#define DNS323_GPIO_KEY_POWER		9
#define DNS323_GPIO_KEY_RESET		10

/****************************************************************************
 * PCI setup
 */

static int __init dns323_pci_map_irq(struct pci_dev *dev, u8 slot, u8 pin)
{
	int irq;

	/*
	 * Check for devices with hard-wired IRQs.
	 */
	irq = orion5x_pci_map_irq(dev, slot, pin);
	if (irq != -1)
		return irq;

	return -1;
}

static struct hw_pci dns323_pci __initdata = {
	.nr_controllers = 2,
	.swizzle	= pci_std_swizzle,
	.setup		= orion5x_pci_sys_setup,
	.scan		= orion5x_pci_sys_scan_bus,
	.map_irq	= dns323_pci_map_irq,
};

static int __init dns323_dev_id(void)
{
	u32 dev, rev;

	orion5x_pcie_id(&dev, &rev);

	return dev;
}

static int __init dns323_pci_init(void)
{
	/* The 5182 doesn't really use its PCI bus, and initialising PCI
	 * gets in the way of initialising the SATA controller.
	 */
	if (machine_is_dns323() && dns323_dev_id() != MV88F5182_DEV_ID)
		pci_common_init(&dns323_pci);

	return 0;
}

subsys_initcall(dns323_pci_init);

/****************************************************************************
 * 8MiB NOR flash (Spansion S29GL064M90TFIR4)
 *
 * Layout as used by D-Link:
 *  0x00000000-0x00010000 : "MTD1"
 *  0x00010000-0x00020000 : "MTD2"
 *  0x00020000-0x001a0000 : "Linux Kernel"
 *  0x001a0000-0x007d0000 : "File System"
 *  0x007d0000-0x00800000 : "u-boot"
 */

#define DNS323_NOR_BOOT_BASE 0xf4000000
#define DNS323_NOR_BOOT_SIZE SZ_8M

static struct mtd_partition dns323_partitions[] = {
	{
		.name	= "MTD1",
		.size	= 0x00010000,
		.offset	= 0,
	}, {
		.name	= "MTD2",
		.size	= 0x00010000,
		.offset = 0x00010000,
	}, {
		.name	= "Linux Kernel",
		.size	= 0x00180000,
		.offset	= 0x00020000,
	}, {
		.name	= "File System",
		.size	= 0x00630000,
		.offset	= 0x001A0000,
	}, {
		.name	= "u-boot",
		.size	= 0x00030000,
		.offset	= 0x007d0000,
	},
};

static struct physmap_flash_data dns323_nor_flash_data = {
	.width		= 1,
	.parts		= dns323_partitions,
	.nr_parts	= ARRAY_SIZE(dns323_partitions)
};

static struct resource dns323_nor_flash_resource = {
	.flags		= IORESOURCE_MEM,
	.start		= DNS323_NOR_BOOT_BASE,
	.end		= DNS323_NOR_BOOT_BASE + DNS323_NOR_BOOT_SIZE - 1,
};

static struct platform_device dns323_nor_flash = {
	.name		= "physmap-flash",
	.id		= 0,
	.dev		= {
		.platform_data	= &dns323_nor_flash_data,
	},
	.resource	= &dns323_nor_flash_resource,
	.num_resources	= 1,
};

/****************************************************************************
 * Ethernet
 */

static struct mv643xx_eth_platform_data dns323_eth_data = {
	.phy_addr = MV643XX_ETH_PHY_ADDR(8),
};

/* dns323_parse_hex_*() taken from tsx09-common.c; should a common copy of these
 * functions be kept somewhere?
 */
static int __init dns323_parse_hex_nibble(char n)
{
	if (n >= '0' && n <= '9')
		return n - '0';

	if (n >= 'A' && n <= 'F')
		return n - 'A' + 10;

	if (n >= 'a' && n <= 'f')
		return n - 'a' + 10;

	return -1;
}

static int __init dns323_parse_hex_byte(const char *b)
{
	int hi;
	int lo;

	hi = dns323_parse_hex_nibble(b[0]);
	lo = dns323_parse_hex_nibble(b[1]);

	if (hi < 0 || lo < 0)
		return -1;

	return (hi << 4) | lo;
}

static int __init dns323_read_mac_addr(void)
{
	u_int8_t addr[6];
	int i;
	char *mac_page;

	/* MAC address is stored as a regular ol' string in /dev/mtdblock4
	 * (0x007d0000-0x00800000) starting at offset 196480 (0x2ff80).
	 */
	mac_page = ioremap(DNS323_NOR_BOOT_BASE + 0x7d0000 + 196480, 1024);
	if (!mac_page)
		return -ENOMEM;

	/* Sanity check the string we're looking at */
	for (i = 0; i < 5; i++) {
		if (*(mac_page + (i * 3) + 2) != ':') {
			goto error_fail;
		}
	}

	for (i = 0; i < 6; i++)	{
		int byte;

		byte = dns323_parse_hex_byte(mac_page + (i * 3));
		if (byte < 0) {
			goto error_fail;
		}

		addr[i] = byte;
	}

	iounmap(mac_page);
	printk("DNS323: Found ethernet MAC address: ");
	for (i = 0; i < 6; i++)
		printk("%.2x%s", addr[i], (i < 5) ? ":" : ".\n");

	memcpy(dns323_eth_data.mac_addr, addr, 6);

	return 0;

error_fail:
	iounmap(mac_page);
	return -EINVAL;
}

/****************************************************************************
 * GPIO LEDs (simple - doesn't use hardware blinking support)
 */

#define ORION_BLINK_HALF_PERIOD 100 /* ms */

static int dns323_gpio_blink_set(unsigned gpio, int state,
	unsigned long *delay_on, unsigned long *delay_off)
{

	if (delay_on && delay_off && !*delay_on && !*delay_off)
		*delay_on = *delay_off = ORION_BLINK_HALF_PERIOD;

	switch(state) {
	case GPIO_LED_NO_BLINK_LOW:
	case GPIO_LED_NO_BLINK_HIGH:
		orion_gpio_set_blink(gpio, 0);
		gpio_set_value(gpio, state);
		break;
	case GPIO_LED_BLINK:
		orion_gpio_set_blink(gpio, 1);
	}
	return 0;
}

static struct gpio_led dns323_leds[] = {
	{
		.name = "power:blue",
		.gpio = DNS323_GPIO_LED_POWER2,
		.default_trigger = "timer",
		.active_low = 1,
	}, {
		.name = "right:amber",
		.gpio = DNS323_GPIO_LED_RIGHT_AMBER,
		.active_low = 1,
	}, {
		.name = "left:amber",
		.gpio = DNS323_GPIO_LED_LEFT_AMBER,
		.active_low = 1,
	},
};

static struct gpio_led_platform_data dns323_led_data = {
	.num_leds	= ARRAY_SIZE(dns323_leds),
	.leds		= dns323_leds,
	.gpio_blink_set = dns323_gpio_blink_set,
};

static struct platform_device dns323_gpio_leds = {
	.name		= "leds-gpio",
	.id		= -1,
	.dev		= {
		.platform_data	= &dns323_led_data,
	},
};

/****************************************************************************
 * GPIO Attached Keys
 */

static struct gpio_keys_button dns323_buttons[] = {
	{
		.code		= KEY_RESTART,
		.gpio		= DNS323_GPIO_KEY_RESET,
		.desc		= "Reset Button",
		.active_low	= 1,
	}, {
		.code		= KEY_POWER,
		.gpio		= DNS323_GPIO_KEY_POWER,
		.desc		= "Power Button",
		.active_low	= 1,
	},
};

static struct gpio_keys_platform_data dns323_button_data = {
	.buttons	= dns323_buttons,
	.nbuttons	= ARRAY_SIZE(dns323_buttons),
};

static struct platform_device dns323_button_device = {
	.name		= "gpio-keys",
	.id		= -1,
	.num_resources	= 0,
	.dev		= {
		.platform_data	= &dns323_button_data,
	},
};

/*****************************************************************************
 * SATA
 */
static struct mv_sata_platform_data dns323_sata_data = {
       .n_ports        = 2,
};

/****************************************************************************
 * General Setup
 */
static struct orion5x_mpp_mode dns323_mv88f5181_mpp_modes[] __initdata = {
	{  0, MPP_PCIE_RST_OUTn },
	{  1, MPP_GPIO },		/* right amber LED (sata ch0) */
	{  2, MPP_GPIO },		/* left amber LED (sata ch1) */
	{  3, MPP_UNUSED },
	{  4, MPP_GPIO },		/* power button LED */
	{  5, MPP_GPIO },		/* power button LED */
	{  6, MPP_GPIO },		/* GMT G751-2f overtemp */
	{  7, MPP_GPIO },		/* M41T80 nIRQ/OUT/SQW */
	{  8, MPP_GPIO },		/* triggers power off */
	{  9, MPP_GPIO },		/* power button switch */
	{ 10, MPP_GPIO },		/* reset button switch */
	{ 11, MPP_UNUSED },
	{ 12, MPP_UNUSED },
	{ 13, MPP_UNUSED },
	{ 14, MPP_UNUSED },
	{ 15, MPP_UNUSED },
	{ 16, MPP_UNUSED },
	{ 17, MPP_UNUSED },
	{ 18, MPP_UNUSED },
	{ 19, MPP_UNUSED },
	{ -1 },
};

static struct orion5x_mpp_mode dns323_mv88f5182_mpp_modes[] __initdata = {
	{  0, MPP_UNUSED },
	{  1, MPP_GPIO },		/* right amber LED (sata ch0) */
	{  2, MPP_GPIO },		/* left amber LED (sata ch1) */
	{  3, MPP_GPIO },		/* system up flag */
	{  4, MPP_GPIO },		/* power button LED */
	{  5, MPP_GPIO },		/* power button LED */
	{  6, MPP_GPIO },		/* GMT G751-2f overtemp */
	{  7, MPP_GPIO },		/* M41T80 nIRQ/OUT/SQW */
	{  8, MPP_GPIO },		/* triggers power off */
	{  9, MPP_GPIO },		/* power button switch */
	{ 10, MPP_GPIO },		/* reset button switch */
	{ 11, MPP_UNUSED },
	{ 12, MPP_SATA_LED },
	{ 13, MPP_SATA_LED },
	{ 14, MPP_SATA_LED },
	{ 15, MPP_SATA_LED },
	{ 16, MPP_UNUSED },
	{ 17, MPP_UNUSED },
	{ 18, MPP_UNUSED },
	{ 19, MPP_UNUSED },
	{ -1 },
};

/*
 * On the DNS-323 the following devices are attached via I2C:
 *
 *  i2c addr | chip        | description
 *  0x3e     | GMT G760Af  | fan speed PWM controller
 *  0x48     | GMT G751-2f | temp. sensor and therm. watchdog (LM75 compatible)
 *  0x68     | ST M41T80   | RTC w/ alarm
 */
static struct i2c_board_info __initdata dns323_i2c_devices[] = {
	{
		I2C_BOARD_INFO("g760a", 0x3e),
	}, {
		I2C_BOARD_INFO("lm75", 0x48),
	}, {
		I2C_BOARD_INFO("m41t80", 0x68),
	},
};

/* DNS-323 rev. A specific power off method */
static void dns323a_power_off(void)
{
	pr_info("%s: triggering power-off...\n", __func__);
	gpio_set_value(DNS323_GPIO_POWER_OFF, 1);
}

/* DNS-323 rev B specific power off method */
static void dns323b_power_off(void)
{
	pr_info("%s: triggering power-off...\n", __func__);
	/* Pin has to be changed to 1 and back to 0 to do actual power off. */
	gpio_set_value(DNS323_GPIO_POWER_OFF, 1);
	mdelay(100);
	gpio_set_value(DNS323_GPIO_POWER_OFF, 0);
}

static void __init dns323_init(void)
{
	/* Setup basic Orion functions. Need to be called early. */
	orion5x_init();

	/* Just to be tricky, the 5182 has a completely different
	 * set of MPP modes to the 5181.
	 */
	if (dns323_dev_id() == MV88F5182_DEV_ID)
		orion5x_mpp_conf(dns323_mv88f5182_mpp_modes);
	else {
		orion5x_mpp_conf(dns323_mv88f5181_mpp_modes);
		writel(0, MPP_DEV_CTRL);		/* DEV_D[31:16] */
	}

	/* setup flash mapping
	 * CS3 holds a 8 MB Spansion S29GL064M90TFIR4
	 */
	orion5x_setup_dev_boot_win(DNS323_NOR_BOOT_BASE, DNS323_NOR_BOOT_SIZE);
	platform_device_register(&dns323_nor_flash);

	/* The 5181 power LED is active low and requires
	 * DNS323_GPIO_LED_POWER1 to also be low.
	 */
	if (dns323_dev_id() == MV88F5181_DEV_ID) {
		dns323_leds[0].active_low = 1;
		gpio_request(DNS323_GPIO_LED_POWER1, "Power Led Enable");
		gpio_direction_output(DNS323_GPIO_LED_POWER1, 0);
	}

	platform_device_register(&dns323_gpio_leds);

	platform_device_register(&dns323_button_device);

	i2c_register_board_info(0, dns323_i2c_devices,
				ARRAY_SIZE(dns323_i2c_devices));

	/*
	 * Configure peripherals.
	 */
	if (dns323_read_mac_addr() < 0)
		printk("DNS323: Failed to read MAC address\n");

	orion5x_ehci0_init();
	orion5x_eth_init(&dns323_eth_data);
	orion5x_i2c_init();
	orion5x_uart0_init();

	/* The 5182 has its SATA controller on-chip, and needs its own little
	 * init routine.
	 */
	if (dns323_dev_id() == MV88F5182_DEV_ID)
		orion5x_sata_init(&dns323_sata_data);

	/* The 5182 has flag to indicate the system is up. Without this flag
	 * set, power LED will flash and cannot be controlled via leds-gpio.
	 */
	if (dns323_dev_id() == MV88F5182_DEV_ID)
		gpio_set_value(DNS323_GPIO_SYSTEM_UP, 1);

	/* Register dns323 specific power-off method */
	if (gpio_request(DNS323_GPIO_POWER_OFF, "POWEROFF") != 0 ||
	    gpio_direction_output(DNS323_GPIO_POWER_OFF, 0) != 0)
		pr_err("DNS323: failed to setup power-off GPIO\n");
	if (dns323_dev_id() == MV88F5182_DEV_ID)
		pm_power_off = dns323b_power_off;
	else
		pm_power_off = dns323a_power_off;
}

/* Warning: D-Link uses a wrong mach-type (=526) in their bootloader */
MACHINE_START(DNS323, "D-Link DNS-323")
	/* Maintainer: Herbert Valerio Riedel <hvr@gnu.org> */
	.phys_io	= ORION5X_REGS_PHYS_BASE,
	.io_pg_offst	= ((ORION5X_REGS_VIRT_BASE) >> 18) & 0xFFFC,
	.boot_params	= 0x00000100,
	.init_machine	= dns323_init,
	.map_io		= orion5x_map_io,
	.init_irq	= orion5x_init_irq,
	.timer		= &orion5x_timer,
	.fixup		= tag_fixup_mem32,
MACHINE_END
Commit	Line	Data
555a3656	1	/*
9dd0b194	2	* arch/arm/mach-orion5x/dns323-setup.c
555a3656 HVR	3	*
	4	* Copyright (C) 2007 Herbert Valerio Riedel <hvr@gnu.org>
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU Lesser General Public License as
	8	* published by the Free Software Foundation; either version 2 of the
	9	* License, or (at your option) any later version.
	10	*
	11	*/
	12
	13	#include <linux/kernel.h>
	14	#include <linux/init.h>
cf11052a	15	#include <linux/delay.h>
555a3656 HVR	16	#include <linux/platform_device.h>
	17	#include <linux/pci.h>
	18	#include <linux/irq.h>
	19	#include <linux/mtd/physmap.h>
	20	#include <linux/mv643xx_eth.h>
	21	#include <linux/leds.h>
	22	#include <linux/gpio_keys.h>
	23	#include <linux/input.h>
	24	#include <linux/i2c.h>
f93e4159	25	#include <linux/ata_platform.h>
555a3656 HVR	26	#include <asm/mach-types.h>
	27	#include <asm/gpio.h>
	28	#include <asm/mach/arch.h>
	29	#include <asm/mach/pci.h>
a09e64fb	30	#include <mach/orion5x.h>
555a3656	31	#include "common.h"
19cfd5c0	32	#include "mpp.h"
555a3656 HVR	33
	34	#define DNS323_GPIO_LED_RIGHT_AMBER 1
	35	#define DNS323_GPIO_LED_LEFT_AMBER 2
cf11052a	36	#define DNS323_GPIO_SYSTEM_UP 3
b2a731aa LB	37	#define DNS323_GPIO_LED_POWER1 4
b2a731aa LB	38	#define DNS323_GPIO_LED_POWER2 5
555a3656 HVR	39	#define DNS323_GPIO_OVERTEMP 6
	40	#define DNS323_GPIO_RTC 7
	41	#define DNS323_GPIO_POWER_OFF 8
	42	#define DNS323_GPIO_KEY_POWER 9
	43	#define DNS323_GPIO_KEY_RESET 10
	44
	45	/****************************************************************************
	46	* PCI setup
	47	*/
	48
	49	static int __init dns323_pci_map_irq(struct pci_dev *dev, u8 slot, u8 pin)
	50	{
92b913b0	51	int irq;
555a3656	52
92b913b0 LB	53	/*
	54	* Check for devices with hard-wired IRQs.
	55	*/
	56	irq = orion5x_pci_map_irq(dev, slot, pin);
	57	if (irq != -1)
	58	return irq;
	59
555a3656 HVR	60	return -1;
	61	}
	62
	63	static struct hw_pci dns323_pci __initdata = {
bbdf1c1e	64	.nr_controllers = 2,
555a3656	65	.swizzle = pci_std_swizzle,
9dd0b194 LB	66	.setup = orion5x_pci_sys_setup,
9dd0b194 LB	67	.scan = orion5x_pci_sys_scan_bus,
555a3656 HVR	68	.map_irq = dns323_pci_map_irq,
	69	};
	70
f93e4159 MP	71	static int __init dns323_dev_id(void)
	72	{
	73	u32 dev, rev;
	74
	75	orion5x_pcie_id(&dev, &rev);
	76
	77	return dev;
	78	}
	79
555a3656 HVR	80	static int __init dns323_pci_init(void)
555a3656 HVR	81	{
ace14b82	82	/* The 5182 doesn't really use its PCI bus, and initialising PCI
f93e4159 MP	83	* gets in the way of initialising the SATA controller.
	84	*/
	85	if (machine_is_dns323() && dns323_dev_id() != MV88F5182_DEV_ID)
555a3656 HVR	86	pci_common_init(&dns323_pci);
	87
	88	return 0;
	89	}
	90
	91	subsys_initcall(dns323_pci_init);
	92
555a3656 HVR	93	/****************************************************************************
	94	* 8MiB NOR flash (Spansion S29GL064M90TFIR4)
	95	*
	96	* Layout as used by D-Link:
	97	* 0x00000000-0x00010000 : "MTD1"
	98	* 0x00010000-0x00020000 : "MTD2"
	99	* 0x00020000-0x001a0000 : "Linux Kernel"
	100	* 0x001a0000-0x007d0000 : "File System"
	101	* 0x007d0000-0x00800000 : "u-boot"
	102	*/
	103
	104	#define DNS323_NOR_BOOT_BASE 0xf4000000
	105	#define DNS323_NOR_BOOT_SIZE SZ_8M
	106
	107	static struct mtd_partition dns323_partitions[] = {
	108	{
	109	.name = "MTD1",
	110	.size = 0x00010000,
	111	.offset = 0,
	112	}, {
	113	.name = "MTD2",
	114	.size = 0x00010000,
	115	.offset = 0x00010000,
	116	}, {
	117	.name = "Linux Kernel",
	118	.size = 0x00180000,
	119	.offset = 0x00020000,
	120	}, {
	121	.name = "File System",
	122	.size = 0x00630000,
	123	.offset = 0x001A0000,
	124	}, {
	125	.name = "u-boot",
	126	.size = 0x00030000,
	127	.offset = 0x007d0000,
e7068ad3	128	},
555a3656 HVR	129	};
	130
	131	static struct physmap_flash_data dns323_nor_flash_data = {
	132	.width = 1,
	133	.parts = dns323_partitions,
	134	.nr_parts = ARRAY_SIZE(dns323_partitions)
	135	};
	136
	137	static struct resource dns323_nor_flash_resource = {
	138	.flags = IORESOURCE_MEM,
	139	.start = DNS323_NOR_BOOT_BASE,
	140	.end = DNS323_NOR_BOOT_BASE + DNS323_NOR_BOOT_SIZE - 1,
	141	};
	142
	143	static struct platform_device dns323_nor_flash = {
	144	.name = "physmap-flash",
	145	.id = 0,
e7068ad3 LB	146	.dev = {
	147	.platform_data = &dns323_nor_flash_data,
	148	},
555a3656 HVR	149	.resource = &dns323_nor_flash_resource,
	150	.num_resources = 1,
	151	};
	152
a93f44c1 MP	153	/****************************************************************************
	154	* Ethernet
	155	*/
	156
	157	static struct mv643xx_eth_platform_data dns323_eth_data = {
	158	.phy_addr = MV643XX_ETH_PHY_ADDR(8),
	159	};
	160
	161	/* dns323_parse_hex_*() taken from tsx09-common.c; should a common copy of these
	162	* functions be kept somewhere?
	163	*/
	164	static int __init dns323_parse_hex_nibble(char n)
	165	{
	166	if (n >= '0' && n <= '9')
	167	return n - '0';
	168
	169	if (n >= 'A' && n <= 'F')
	170	return n - 'A' + 10;
	171
	172	if (n >= 'a' && n <= 'f')
	173	return n - 'a' + 10;
	174
	175	return -1;
	176	}
	177
	178	static int __init dns323_parse_hex_byte(const char *b)
	179	{
	180	int hi;
	181	int lo;
	182
	183	hi = dns323_parse_hex_nibble(b[0]);
	184	lo = dns323_parse_hex_nibble(b[1]);
	185
	186	if (hi < 0 \|\| lo < 0)
	187	return -1;
	188
	189	return (hi << 4) \| lo;
	190	}
	191
	192	static int __init dns323_read_mac_addr(void)
	193	{
	194	u_int8_t addr[6];
	195	int i;
	196	char *mac_page;
	197
	198	/* MAC address is stored as a regular ol' string in /dev/mtdblock4
	199	* (0x007d0000-0x00800000) starting at offset 196480 (0x2ff80).
	200	*/
	201	mac_page = ioremap(DNS323_NOR_BOOT_BASE + 0x7d0000 + 196480, 1024);
	202	if (!mac_page)
	203	return -ENOMEM;
	204
	205	/* Sanity check the string we're looking at */
	206	for (i = 0; i < 5; i++) {
	207	if ((mac_page + (i 3) + 2) != ':') {
	208	goto error_fail;
	209	}
	210	}
	211
	212	for (i = 0; i < 6; i++) {
	213	int byte;
	214
	215	byte = dns323_parse_hex_byte(mac_page + (i * 3));
	216	if (byte < 0) {
217	goto error_fail;
218	}
219
220	addr[i] = byte;
221	}
222
223	iounmap(mac_page);
224	printk("DNS323: Found ethernet MAC address: ");
225	for (i = 0; i < 6; i++)
226	printk("%.2x%s", addr[i], (i < 5) ? ":" : ".\n");
227
228	memcpy(dns323_eth_data.mac_addr, addr, 6);
229
230	return 0;
231
232	error_fail:
233	iounmap(mac_page);
234	return -EINVAL;
235	}
236
555a3656 HVR	237	/****************************************************************************
	238	* GPIO LEDs (simple - doesn't use hardware blinking support)
	239	*/
	240
b2a731aa LB	241	#define ORION_BLINK_HALF_PERIOD 100 /* ms */
b2a731aa LB	242
2146325d	243	static int dns323_gpio_blink_set(unsigned gpio, int state,
b2a731aa LB	244	unsigned long delay_on, unsigned long delay_off)
b2a731aa LB	245	{
b2a731aa	246
2146325d	247	if (delay_on && delay_off && !delay_on && !delay_off)
b2a731aa LB	248	delay_on = delay_off = ORION_BLINK_HALF_PERIOD;
b2a731aa LB	249
2146325d BH	250	switch(state) {
	251	case GPIO_LED_NO_BLINK_LOW:
	252	case GPIO_LED_NO_BLINK_HIGH:
	253	orion_gpio_set_blink(gpio, 0);
	254	gpio_set_value(gpio, state);
	255	break;
	256	case GPIO_LED_BLINK:
	257	orion_gpio_set_blink(gpio, 1);
b2a731aa	258	}
2146325d	259	return 0;
b2a731aa LB	260	}
b2a731aa LB	261
555a3656 HVR	262	static struct gpio_led dns323_leds[] = {
	263	{
	264	.name = "power:blue",
b2a731aa LB	265	.gpio = DNS323_GPIO_LED_POWER2,
b2a731aa LB	266	.default_trigger = "timer",
2146325d	267	.active_low = 1,
555a3656 HVR	268	}, {
	269	.name = "right:amber",
	270	.gpio = DNS323_GPIO_LED_RIGHT_AMBER,
	271	.active_low = 1,
	272	}, {
	273	.name = "left:amber",
	274	.gpio = DNS323_GPIO_LED_LEFT_AMBER,
	275	.active_low = 1,
	276	},
	277	};
	278
	279	static struct gpio_led_platform_data dns323_led_data = {
	280	.num_leds = ARRAY_SIZE(dns323_leds),
	281	.leds = dns323_leds,
b2a731aa	282	.gpio_blink_set = dns323_gpio_blink_set,
555a3656 HVR	283	};
	284
	285	static struct platform_device dns323_gpio_leds = {
	286	.name = "leds-gpio",
	287	.id = -1,
e7068ad3 LB	288	.dev = {
	289	.platform_data = &dns323_led_data,
	290	},
555a3656 HVR	291	};
	292
	293	/****************************************************************************
	294	* GPIO Attached Keys
	295	*/
	296
	297	static struct gpio_keys_button dns323_buttons[] = {
	298	{
	299	.code = KEY_RESTART,
	300	.gpio = DNS323_GPIO_KEY_RESET,
	301	.desc = "Reset Button",
	302	.active_low = 1,
e7068ad3	303	}, {
555a3656 HVR	304	.code = KEY_POWER,
	305	.gpio = DNS323_GPIO_KEY_POWER,
	306	.desc = "Power Button",
	307	.active_low = 1,
e7068ad3	308	},
555a3656 HVR	309	};
	310
	311	static struct gpio_keys_platform_data dns323_button_data = {
	312	.buttons = dns323_buttons,
e7068ad3	313	.nbuttons = ARRAY_SIZE(dns323_buttons),
555a3656 HVR	314	};
	315
	316	static struct platform_device dns323_button_device = {
	317	.name = "gpio-keys",
	318	.id = -1,
	319	.num_resources = 0,
e7068ad3 LB	320	.dev = {
	321	.platform_data = &dns323_button_data,
	322	},
555a3656 HVR	323	};
555a3656 HVR	324
f93e4159 MP	325	/*****************************************************************************
	326	* SATA
	327	*/
	328	static struct mv_sata_platform_data dns323_sata_data = {
	329	.n_ports = 2,
	330	};
	331
555a3656 HVR	332	/****************************************************************************
	333	* General Setup
	334	*/
f93e4159	335	static struct orion5x_mpp_mode dns323_mv88f5181_mpp_modes[] __initdata = {
19cfd5c0 LB	336	{ 0, MPP_PCIE_RST_OUTn },
	337	{ 1, MPP_GPIO }, /* right amber LED (sata ch0) */
	338	{ 2, MPP_GPIO }, /* left amber LED (sata ch1) */
	339	{ 3, MPP_UNUSED },
	340	{ 4, MPP_GPIO }, /* power button LED */
	341	{ 5, MPP_GPIO }, /* power button LED */
	342	{ 6, MPP_GPIO }, /* GMT G751-2f overtemp */
	343	{ 7, MPP_GPIO }, /* M41T80 nIRQ/OUT/SQW */
	344	{ 8, MPP_GPIO }, /* triggers power off */
	345	{ 9, MPP_GPIO }, /* power button switch */
	346	{ 10, MPP_GPIO }, /* reset button switch */
	347	{ 11, MPP_UNUSED },
	348	{ 12, MPP_UNUSED },
	349	{ 13, MPP_UNUSED },
	350	{ 14, MPP_UNUSED },
	351	{ 15, MPP_UNUSED },
	352	{ 16, MPP_UNUSED },
	353	{ 17, MPP_UNUSED },
	354	{ 18, MPP_UNUSED },
	355	{ 19, MPP_UNUSED },
	356	{ -1 },
	357	};
555a3656	358
f93e4159 MP	359	static struct orion5x_mpp_mode dns323_mv88f5182_mpp_modes[] __initdata = {
	360	{ 0, MPP_UNUSED },
	361	{ 1, MPP_GPIO }, /* right amber LED (sata ch0) */
	362	{ 2, MPP_GPIO }, /* left amber LED (sata ch1) */
cf11052a	363	{ 3, MPP_GPIO }, /* system up flag */
f93e4159 MP	364	{ 4, MPP_GPIO }, /* power button LED */
	365	{ 5, MPP_GPIO }, /* power button LED */
	366	{ 6, MPP_GPIO }, /* GMT G751-2f overtemp */
	367	{ 7, MPP_GPIO }, /* M41T80 nIRQ/OUT/SQW */
	368	{ 8, MPP_GPIO }, /* triggers power off */
	369	{ 9, MPP_GPIO }, /* power button switch */
	370	{ 10, MPP_GPIO }, /* reset button switch */
	371	{ 11, MPP_UNUSED },
	372	{ 12, MPP_SATA_LED },
	373	{ 13, MPP_SATA_LED },
	374	{ 14, MPP_SATA_LED },
	375	{ 15, MPP_SATA_LED },
	376	{ 16, MPP_UNUSED },
	377	{ 17, MPP_UNUSED },
	378	{ 18, MPP_UNUSED },
	379	{ 19, MPP_UNUSED },
	380	{ -1 },
	381	};
	382
555a3656 HVR	383	/*
	384	* On the DNS-323 the following devices are attached via I2C:
	385	*
	386	* i2c addr \| chip \| description
	387	* 0x3e \| GMT G760Af \| fan speed PWM controller
	388	* 0x48 \| GMT G751-2f \| temp. sensor and therm. watchdog (LM75 compatible)
	389	* 0x68 \| ST M41T80 \| RTC w/ alarm
	390	*/
	391	static struct i2c_board_info __initdata dns323_i2c_devices[] = {
	392	{
	393	I2C_BOARD_INFO("g760a", 0x3e),
e7068ad3	394	}, {
c0fe819b	395	I2C_BOARD_INFO("lm75", 0x48),
e7068ad3	396	}, {
3760f736	397	I2C_BOARD_INFO("m41t80", 0x68),
e7068ad3	398	},
555a3656 HVR	399	};
555a3656 HVR	400
cf11052a EB	401	/* DNS-323 rev. A specific power off method */
cf11052a EB	402	static void dns323a_power_off(void)
555a3656 HVR	403	{
	404	pr_info("%s: triggering power-off...\n", __func__);
	405	gpio_set_value(DNS323_GPIO_POWER_OFF, 1);
	406	}
	407
cf11052a EB	408	/* DNS-323 rev B specific power off method */
	409	static void dns323b_power_off(void)
	410	{
	411	pr_info("%s: triggering power-off...\n", __func__);
	412	/* Pin has to be changed to 1 and back to 0 to do actual power off. */
	413	gpio_set_value(DNS323_GPIO_POWER_OFF, 1);
	414	mdelay(100);
	415	gpio_set_value(DNS323_GPIO_POWER_OFF, 0);
	416	}
	417
555a3656 HVR	418	static void __init dns323_init(void)
	419	{
	420	/* Setup basic Orion functions. Need to be called early. */
9dd0b194	421	orion5x_init();
555a3656	422
f93e4159 MP	423	/* Just to be tricky, the 5182 has a completely different
	424	* set of MPP modes to the 5181.
	425	*/
	426	if (dns323_dev_id() == MV88F5182_DEV_ID)
	427	orion5x_mpp_conf(dns323_mv88f5182_mpp_modes);
	428	else {
	429	orion5x_mpp_conf(dns323_mv88f5181_mpp_modes);
	430	writel(0, MPP_DEV_CTRL); /* DEV_D[31:16] */
	431	}
555a3656	432
044f6c7c LB	433	/* setup flash mapping
	434	* CS3 holds a 8 MB Spansion S29GL064M90TFIR4
	435	*/
	436	orion5x_setup_dev_boot_win(DNS323_NOR_BOOT_BASE, DNS323_NOR_BOOT_SIZE);
	437	platform_device_register(&dns323_nor_flash);
	438
b2a731aa LB	439	/* The 5181 power LED is active low and requires
	440	* DNS323_GPIO_LED_POWER1 to also be low.
	441	*/
	442	if (dns323_dev_id() == MV88F5181_DEV_ID) {
	443	dns323_leds[0].active_low = 1;
5ccc8dab	444	gpio_request(DNS323_GPIO_LED_POWER1, "Power Led Enable");
b2a731aa LB	445	gpio_direction_output(DNS323_GPIO_LED_POWER1, 0);
	446	}
	447
044f6c7c	448	platform_device_register(&dns323_gpio_leds);
555a3656	449
044f6c7c	450	platform_device_register(&dns323_button_device);
555a3656 HVR	451
	452	i2c_register_board_info(0, dns323_i2c_devices,
	453	ARRAY_SIZE(dns323_i2c_devices));
	454
a93f44c1 MP	455	/*
	456	* Configure peripherals.
	457	*/
	458	if (dns323_read_mac_addr() < 0)
	459	printk("DNS323: Failed to read MAC address\n");
	460
	461	orion5x_ehci0_init();
	462	orion5x_eth_init(&dns323_eth_data);
	463	orion5x_i2c_init();
	464	orion5x_uart0_init();
	465
ace14b82	466	/* The 5182 has its SATA controller on-chip, and needs its own little
f93e4159 MP	467	* init routine.
	468	*/
	469	if (dns323_dev_id() == MV88F5182_DEV_ID)
	470	orion5x_sata_init(&dns323_sata_data);
	471
cf11052a EB	472	/* The 5182 has flag to indicate the system is up. Without this flag
	473	* set, power LED will flash and cannot be controlled via leds-gpio.
	474	*/
	475	if (dns323_dev_id() == MV88F5182_DEV_ID)
	476	gpio_set_value(DNS323_GPIO_SYSTEM_UP, 1);
	477
	478	/* Register dns323 specific power-off method */
044f6c7c LB	479	if (gpio_request(DNS323_GPIO_POWER_OFF, "POWEROFF") != 0 \|\|
	480	gpio_direction_output(DNS323_GPIO_POWER_OFF, 0) != 0)
	481	pr_err("DNS323: failed to setup power-off GPIO\n");
cf11052a EB	482	if (dns323_dev_id() == MV88F5182_DEV_ID)
	483	pm_power_off = dns323b_power_off;
	484	else
	485	pm_power_off = dns323a_power_off;
555a3656 HVR	486	}
	487
	488	/* Warning: D-Link uses a wrong mach-type (=526) in their bootloader */
	489	MACHINE_START(DNS323, "D-Link DNS-323")
	490	/* Maintainer: Herbert Valerio Riedel <hvr@gnu.org> */
9dd0b194 LB	491	.phys_io = ORION5X_REGS_PHYS_BASE,
9dd0b194 LB	492	.io_pg_offst = ((ORION5X_REGS_VIRT_BASE) >> 18) & 0xFFFC,
555a3656 HVR	493	.boot_params = 0x00000100,
555a3656 HVR	494	.init_machine = dns323_init,
9dd0b194 LB	495	.map_io = orion5x_map_io,
	496	.init_irq = orion5x_init_irq,
	497	.timer = &orion5x_timer,
be73a347	498	.fixup = tag_fixup_mem32,
555a3656	499	MACHINE_END