[GitHub/mt8127/android_kernel_alcatel_ttab.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,
	unsigned long *delay_on, unsigned long *delay_off)
{
	static int value = 0;

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

	if (ORION_BLINK_HALF_PERIOD == *delay_on
	    && ORION_BLINK_HALF_PERIOD == *delay_off) {
		value = !value;
		orion_gpio_set_blink(gpio, value);
		return 0;
	}

	return -EINVAL;
}

static struct gpio_led dns323_leds[] = {
	{
		.name = "power:blue",
		.gpio = DNS323_GPIO_LED_POWER2,
		.default_trigger = "timer",
	}, {
		.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 */
	242
	243	static int dns323_gpio_blink_set(unsigned gpio,
	244	unsigned long delay_on, unsigned long delay_off)
	245	{
	246	static int value = 0;
	247
	248	if (!delay_on && !delay_off)
	249	delay_on = delay_off = ORION_BLINK_HALF_PERIOD;
	250
	251	if (ORION_BLINK_HALF_PERIOD == *delay_on
	252	&& ORION_BLINK_HALF_PERIOD == *delay_off) {
	253	value = !value;
	254	orion_gpio_set_blink(gpio, value);
	255	return 0;
	256	}
	257
	258	return -EINVAL;
	259	}
	260
555a3656 HVR	261	static struct gpio_led dns323_leds[] = {
	262	{
	263	.name = "power:blue",
b2a731aa LB	264	.gpio = DNS323_GPIO_LED_POWER2,
b2a731aa LB	265	.default_trigger = "timer",
555a3656 HVR	266	}, {
	267	.name = "right:amber",
	268	.gpio = DNS323_GPIO_LED_RIGHT_AMBER,
	269	.active_low = 1,
	270	}, {
	271	.name = "left:amber",
	272	.gpio = DNS323_GPIO_LED_LEFT_AMBER,
	273	.active_low = 1,
	274	},
	275	};
	276
	277	static struct gpio_led_platform_data dns323_led_data = {
	278	.num_leds = ARRAY_SIZE(dns323_leds),
	279	.leds = dns323_leds,
b2a731aa	280	.gpio_blink_set = dns323_gpio_blink_set,
555a3656 HVR	281	};
	282
	283	static struct platform_device dns323_gpio_leds = {
	284	.name = "leds-gpio",
	285	.id = -1,
e7068ad3 LB	286	.dev = {
	287	.platform_data = &dns323_led_data,
	288	},
555a3656 HVR	289	};
	290
	291	/****************************************************************************
	292	* GPIO Attached Keys
	293	*/
	294
	295	static struct gpio_keys_button dns323_buttons[] = {
	296	{
	297	.code = KEY_RESTART,
	298	.gpio = DNS323_GPIO_KEY_RESET,
	299	.desc = "Reset Button",
	300	.active_low = 1,
e7068ad3	301	}, {
555a3656 HVR	302	.code = KEY_POWER,
	303	.gpio = DNS323_GPIO_KEY_POWER,
	304	.desc = "Power Button",
	305	.active_low = 1,
e7068ad3	306	},
555a3656 HVR	307	};
	308
	309	static struct gpio_keys_platform_data dns323_button_data = {
	310	.buttons = dns323_buttons,
e7068ad3	311	.nbuttons = ARRAY_SIZE(dns323_buttons),
555a3656 HVR	312	};
	313
	314	static struct platform_device dns323_button_device = {
	315	.name = "gpio-keys",
	316	.id = -1,
	317	.num_resources = 0,
e7068ad3 LB	318	.dev = {
	319	.platform_data = &dns323_button_data,
	320	},
555a3656 HVR	321	};
555a3656 HVR	322
f93e4159 MP	323	/*****************************************************************************
	324	* SATA
	325	*/
	326	static struct mv_sata_platform_data dns323_sata_data = {
	327	.n_ports = 2,
	328	};
	329
555a3656 HVR	330	/****************************************************************************
	331	* General Setup
	332	*/
f93e4159	333	static struct orion5x_mpp_mode dns323_mv88f5181_mpp_modes[] __initdata = {
19cfd5c0 LB	334	{ 0, MPP_PCIE_RST_OUTn },
	335	{ 1, MPP_GPIO }, /* right amber LED (sata ch0) */
	336	{ 2, MPP_GPIO }, /* left amber LED (sata ch1) */
	337	{ 3, MPP_UNUSED },
	338	{ 4, MPP_GPIO }, /* power button LED */
	339	{ 5, MPP_GPIO }, /* power button LED */
	340	{ 6, MPP_GPIO }, /* GMT G751-2f overtemp */
	341	{ 7, MPP_GPIO }, /* M41T80 nIRQ/OUT/SQW */
	342	{ 8, MPP_GPIO }, /* triggers power off */
	343	{ 9, MPP_GPIO }, /* power button switch */
	344	{ 10, MPP_GPIO }, /* reset button switch */
	345	{ 11, MPP_UNUSED },
	346	{ 12, MPP_UNUSED },
	347	{ 13, MPP_UNUSED },
	348	{ 14, MPP_UNUSED },
	349	{ 15, MPP_UNUSED },
	350	{ 16, MPP_UNUSED },
	351	{ 17, MPP_UNUSED },
	352	{ 18, MPP_UNUSED },
	353	{ 19, MPP_UNUSED },
	354	{ -1 },
	355	};
555a3656	356
f93e4159 MP	357	static struct orion5x_mpp_mode dns323_mv88f5182_mpp_modes[] __initdata = {
	358	{ 0, MPP_UNUSED },
	359	{ 1, MPP_GPIO }, /* right amber LED (sata ch0) */
	360	{ 2, MPP_GPIO }, /* left amber LED (sata ch1) */
cf11052a	361	{ 3, MPP_GPIO }, /* system up flag */
f93e4159 MP	362	{ 4, MPP_GPIO }, /* power button LED */
	363	{ 5, MPP_GPIO }, /* power button LED */
	364	{ 6, MPP_GPIO }, /* GMT G751-2f overtemp */
	365	{ 7, MPP_GPIO }, /* M41T80 nIRQ/OUT/SQW */
	366	{ 8, MPP_GPIO }, /* triggers power off */
	367	{ 9, MPP_GPIO }, /* power button switch */
	368	{ 10, MPP_GPIO }, /* reset button switch */
	369	{ 11, MPP_UNUSED },
	370	{ 12, MPP_SATA_LED },
	371	{ 13, MPP_SATA_LED },
	372	{ 14, MPP_SATA_LED },
	373	{ 15, MPP_SATA_LED },
	374	{ 16, MPP_UNUSED },
	375	{ 17, MPP_UNUSED },
	376	{ 18, MPP_UNUSED },
	377	{ 19, MPP_UNUSED },
	378	{ -1 },
	379	};
	380
555a3656 HVR	381	/*
	382	* On the DNS-323 the following devices are attached via I2C:
	383	*
	384	* i2c addr \| chip \| description
	385	* 0x3e \| GMT G760Af \| fan speed PWM controller
	386	* 0x48 \| GMT G751-2f \| temp. sensor and therm. watchdog (LM75 compatible)
	387	* 0x68 \| ST M41T80 \| RTC w/ alarm
	388	*/
	389	static struct i2c_board_info __initdata dns323_i2c_devices[] = {
	390	{
	391	I2C_BOARD_INFO("g760a", 0x3e),
e7068ad3	392	}, {
c0fe819b	393	I2C_BOARD_INFO("lm75", 0x48),
e7068ad3	394	}, {
3760f736	395	I2C_BOARD_INFO("m41t80", 0x68),
e7068ad3	396	},
555a3656 HVR	397	};
555a3656 HVR	398
cf11052a EB	399	/* DNS-323 rev. A specific power off method */
cf11052a EB	400	static void dns323a_power_off(void)
555a3656 HVR	401	{
	402	pr_info("%s: triggering power-off...\n", __func__);
	403	gpio_set_value(DNS323_GPIO_POWER_OFF, 1);
	404	}
	405
cf11052a EB	406	/* DNS-323 rev B specific power off method */
	407	static void dns323b_power_off(void)
	408	{
	409	pr_info("%s: triggering power-off...\n", __func__);
	410	/* Pin has to be changed to 1 and back to 0 to do actual power off. */
	411	gpio_set_value(DNS323_GPIO_POWER_OFF, 1);
	412	mdelay(100);
	413	gpio_set_value(DNS323_GPIO_POWER_OFF, 0);
	414	}
	415
555a3656 HVR	416	static void __init dns323_init(void)
	417	{
	418	/* Setup basic Orion functions. Need to be called early. */
9dd0b194	419	orion5x_init();
555a3656	420
f93e4159 MP	421	/* Just to be tricky, the 5182 has a completely different
	422	* set of MPP modes to the 5181.
	423	*/
	424	if (dns323_dev_id() == MV88F5182_DEV_ID)
	425	orion5x_mpp_conf(dns323_mv88f5182_mpp_modes);
	426	else {
	427	orion5x_mpp_conf(dns323_mv88f5181_mpp_modes);
	428	writel(0, MPP_DEV_CTRL); /* DEV_D[31:16] */
	429	}
555a3656	430
044f6c7c LB	431	/* setup flash mapping
	432	* CS3 holds a 8 MB Spansion S29GL064M90TFIR4
	433	*/
	434	orion5x_setup_dev_boot_win(DNS323_NOR_BOOT_BASE, DNS323_NOR_BOOT_SIZE);
	435	platform_device_register(&dns323_nor_flash);
	436
b2a731aa LB	437	/* The 5181 power LED is active low and requires
	438	* DNS323_GPIO_LED_POWER1 to also be low.
	439	*/
	440	if (dns323_dev_id() == MV88F5181_DEV_ID) {
	441	dns323_leds[0].active_low = 1;
5ccc8dab	442	gpio_request(DNS323_GPIO_LED_POWER1, "Power Led Enable");
b2a731aa LB	443	gpio_direction_output(DNS323_GPIO_LED_POWER1, 0);
	444	}
	445
044f6c7c	446	platform_device_register(&dns323_gpio_leds);
555a3656	447
044f6c7c	448	platform_device_register(&dns323_button_device);
555a3656 HVR	449
	450	i2c_register_board_info(0, dns323_i2c_devices,
	451	ARRAY_SIZE(dns323_i2c_devices));
	452
a93f44c1 MP	453	/*
	454	* Configure peripherals.
	455	*/
	456	if (dns323_read_mac_addr() < 0)
	457	printk("DNS323: Failed to read MAC address\n");
	458
	459	orion5x_ehci0_init();
	460	orion5x_eth_init(&dns323_eth_data);
	461	orion5x_i2c_init();
	462	orion5x_uart0_init();
	463
ace14b82	464	/* The 5182 has its SATA controller on-chip, and needs its own little
f93e4159 MP	465	* init routine.
	466	*/
	467	if (dns323_dev_id() == MV88F5182_DEV_ID)
	468	orion5x_sata_init(&dns323_sata_data);
	469
cf11052a EB	470	/* The 5182 has flag to indicate the system is up. Without this flag
	471	* set, power LED will flash and cannot be controlled via leds-gpio.
	472	*/
	473	if (dns323_dev_id() == MV88F5182_DEV_ID)
	474	gpio_set_value(DNS323_GPIO_SYSTEM_UP, 1);
	475
	476	/* Register dns323 specific power-off method */
044f6c7c LB	477	if (gpio_request(DNS323_GPIO_POWER_OFF, "POWEROFF") != 0 \|\|
	478	gpio_direction_output(DNS323_GPIO_POWER_OFF, 0) != 0)
	479	pr_err("DNS323: failed to setup power-off GPIO\n");
cf11052a EB	480	if (dns323_dev_id() == MV88F5182_DEV_ID)
	481	pm_power_off = dns323b_power_off;
	482	else
	483	pm_power_off = dns323a_power_off;
555a3656 HVR	484	}
	485
	486	/* Warning: D-Link uses a wrong mach-type (=526) in their bootloader */
	487	MACHINE_START(DNS323, "D-Link DNS-323")
	488	/* Maintainer: Herbert Valerio Riedel <hvr@gnu.org> */
9dd0b194 LB	489	.phys_io = ORION5X_REGS_PHYS_BASE,
9dd0b194 LB	490	.io_pg_offst = ((ORION5X_REGS_VIRT_BASE) >> 18) & 0xFFFC,
555a3656 HVR	491	.boot_params = 0x00000100,
555a3656 HVR	492	.init_machine = dns323_init,
9dd0b194 LB	493	.map_io = orion5x_map_io,
	494	.init_irq = orion5x_init_irq,
	495	.timer = &orion5x_timer,
be73a347	496	.fixup = tag_fixup_mem32,
555a3656	497	MACHINE_END