[mirror_ubuntu-artful-kernel.git] / arch / arm / mach-sa1100 / simpad.c

/*
 * linux/arch/arm/mach-sa1100/simpad.c
 */

#include <linux/module.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/tty.h>
#include <linux/proc_fs.h>
#include <linux/string.h>
#include <linux/pm.h>
#include <linux/platform_data/sa11x0-serial.h>
#include <linux/platform_device.h>
#include <linux/mfd/ucb1x00.h>
#include <linux/mtd/mtd.h>
#include <linux/mtd/partitions.h>
#include <linux/io.h>
#include <linux/gpio/driver.h>

#include <mach/hardware.h>
#include <asm/setup.h>
#include <asm/irq.h>

#include <asm/mach-types.h>
#include <asm/mach/arch.h>
#include <asm/mach/flash.h>
#include <asm/mach/map.h>
#include <linux/platform_data/mfd-mcp-sa11x0.h>
#include <mach/simpad.h>
#include <mach/irqs.h>

#include <linux/serial_core.h>
#include <linux/ioport.h>
#include <linux/input.h>
#include <linux/gpio_keys.h>
#include <linux/leds.h>
#include <linux/i2c-gpio.h>

#include "generic.h"

/*
 * CS3 support
 */

static long cs3_shadow;
static spinlock_t cs3_lock;
static struct gpio_chip cs3_gpio;

long simpad_get_cs3_ro(void)
{
	return readl(CS3_BASE);
}
EXPORT_SYMBOL(simpad_get_cs3_ro);

long simpad_get_cs3_shadow(void)
{
	return cs3_shadow;
}
EXPORT_SYMBOL(simpad_get_cs3_shadow);

static void __simpad_write_cs3(void)
{
	writel(cs3_shadow, CS3_BASE);
}

void simpad_set_cs3_bit(int value)
{
	unsigned long flags;

	spin_lock_irqsave(&cs3_lock, flags);
	cs3_shadow |= value;
	__simpad_write_cs3();
	spin_unlock_irqrestore(&cs3_lock, flags);
}
EXPORT_SYMBOL(simpad_set_cs3_bit);

void simpad_clear_cs3_bit(int value)
{
	unsigned long flags;

	spin_lock_irqsave(&cs3_lock, flags);
	cs3_shadow &= ~value;
	__simpad_write_cs3();
	spin_unlock_irqrestore(&cs3_lock, flags);
}
EXPORT_SYMBOL(simpad_clear_cs3_bit);

static void cs3_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
{
	if (offset > 15)
		return;
	if (value)
		simpad_set_cs3_bit(1 << offset);
	else
		simpad_clear_cs3_bit(1 << offset);
};

static int cs3_gpio_get(struct gpio_chip *chip, unsigned offset)
{
	if (offset > 15)
		return !!(simpad_get_cs3_ro() & (1 << (offset - 16)));
	return !!(simpad_get_cs3_shadow() & (1 << offset));
};

static int cs3_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
{
	if (offset > 15)
		return 0;
	return -EINVAL;
};

static int cs3_gpio_direction_output(struct gpio_chip *chip, unsigned offset,
	int value)
{
	if (offset > 15)
		return -EINVAL;
	cs3_gpio_set(chip, offset, value);
	return 0;
};

static struct map_desc simpad_io_desc[] __initdata = {
	{	/* MQ200 */
		.virtual	=  0xf2800000,
		.pfn		= __phys_to_pfn(0x4b800000),
		.length		= 0x00800000,
		.type		= MT_DEVICE
	}, {	/* Simpad CS3 */
		.virtual	= (unsigned long)CS3_BASE,
		.pfn		= __phys_to_pfn(SA1100_CS3_PHYS),
		.length		= 0x00100000,
		.type		= MT_DEVICE
	},
};


static void simpad_uart_pm(struct uart_port *port, u_int state, u_int oldstate)
{
	if (port->mapbase == (u_int)&Ser1UTCR0) {
		if (state)
		{
			simpad_clear_cs3_bit(RS232_ON);
			simpad_clear_cs3_bit(DECT_POWER_ON);
		}else
		{
			simpad_set_cs3_bit(RS232_ON);
			simpad_set_cs3_bit(DECT_POWER_ON);
		}
	}
}

static struct sa1100_port_fns simpad_port_fns __initdata = {
	.pm	   = simpad_uart_pm,
};


static struct mtd_partition simpad_partitions[] = {
	{
		.name       = "SIMpad boot firmware",
		.size       = 0x00080000,
		.offset     = 0,
		.mask_flags = MTD_WRITEABLE,
	}, {
		.name       = "SIMpad kernel",
		.size       = 0x0010000,
		.offset     = MTDPART_OFS_APPEND,
	}, {
		.name       = "SIMpad root jffs2",
		.size       = MTDPART_SIZ_FULL,
		.offset     = MTDPART_OFS_APPEND,
	}
};

static struct flash_platform_data simpad_flash_data = {
	.map_name    = "cfi_probe",
	.parts       = simpad_partitions,
	.nr_parts    = ARRAY_SIZE(simpad_partitions),
};


static struct resource simpad_flash_resources [] = {
	DEFINE_RES_MEM(SA1100_CS0_PHYS, SZ_16M),
	DEFINE_RES_MEM(SA1100_CS1_PHYS, SZ_16M),
};

static struct ucb1x00_plat_data simpad_ucb1x00_data = {
	.gpio_base	= SIMPAD_UCB1X00_GPIO_BASE,
};

static struct mcp_plat_data simpad_mcp_data = {
	.mccr0		= MCCR0_ADM,
	.sclk_rate	= 11981000,
	.codec_pdata	= &simpad_ucb1x00_data,
};


static void __init simpad_map_io(void)
{
	sa1100_map_io();

	iotable_init(simpad_io_desc, ARRAY_SIZE(simpad_io_desc));

	/* Initialize CS3 */
	cs3_shadow = (EN1 | EN0 | LED2_ON | DISPLAY_ON |
		RS232_ON | ENABLE_5V | RESET_SIMCARD | DECT_POWER_ON);
	__simpad_write_cs3(); /* Spinlocks not yet initialized */

        sa1100_register_uart_fns(&simpad_port_fns);
	sa1100_register_uart(0, 3);  /* serial interface */
	sa1100_register_uart(1, 1);  /* DECT             */

	// Reassign UART 1 pins
	GAFR |= GPIO_UART_TXD | GPIO_UART_RXD;
	GPDR |= GPIO_UART_TXD | GPIO_LDD13 | GPIO_LDD15;
	GPDR &= ~GPIO_UART_RXD;
	PPAR |= PPAR_UPR;

	/*
	 * Set up registers for sleep mode.
	 */


	PWER = PWER_GPIO0| PWER_RTC;
	PGSR = 0x818;
	PCFR = 0;
	PSDR = 0;

}

static void simpad_power_off(void)
{
	local_irq_disable();
	cs3_shadow = SD_MEDIAQ;
	__simpad_write_cs3(); /* Bypass spinlock here */

	/* disable internal oscillator, float CS lines */
	PCFR = (PCFR_OPDE | PCFR_FP | PCFR_FS);
	/* enable wake-up on GPIO0 */
	PWER = GFER = GRER = PWER_GPIO0;
	/*
	 * set scratchpad to zero, just in case it is used as a
	 * restart address by the bootloader.
	 */
	PSPR = 0;
	PGSR = 0;
	/* enter sleep mode */
	PMCR = PMCR_SF;
	while(1);

	local_irq_enable(); /* we won't ever call it */


}

/*
 * gpio_keys
*/

static struct gpio_keys_button simpad_button_table[] = {
	{ KEY_POWER, IRQ_GPIO_POWER_BUTTON, 1, "power button" },
};

static struct gpio_keys_platform_data simpad_keys_data = {
	.buttons = simpad_button_table,
	.nbuttons = ARRAY_SIZE(simpad_button_table),
};

static struct platform_device simpad_keys = {
	.name = "gpio-keys",
	.dev = {
		.platform_data = &simpad_keys_data,
	},
};

static struct gpio_keys_button simpad_polled_button_table[] = {
	{ KEY_PROG1, SIMPAD_UCB1X00_GPIO_PROG1, 1, "prog1 button" },
	{ KEY_PROG2, SIMPAD_UCB1X00_GPIO_PROG2, 1, "prog2 button" },
	{ KEY_UP,    SIMPAD_UCB1X00_GPIO_UP,    1, "up button" },
	{ KEY_DOWN,  SIMPAD_UCB1X00_GPIO_DOWN,  1, "down button" },
	{ KEY_LEFT,  SIMPAD_UCB1X00_GPIO_LEFT,  1, "left button" },
	{ KEY_RIGHT, SIMPAD_UCB1X00_GPIO_RIGHT, 1, "right button" },
};

static struct gpio_keys_platform_data simpad_polled_keys_data = {
	.buttons = simpad_polled_button_table,
	.nbuttons = ARRAY_SIZE(simpad_polled_button_table),
	.poll_interval = 50,
};

static struct platform_device simpad_polled_keys = {
	.name = "gpio-keys-polled",
	.dev = {
		.platform_data = &simpad_polled_keys_data,
	},
};

/*
 * GPIO LEDs
 */

static struct gpio_led simpad_leds[] = {
	{
		.name = "simpad:power",
		.gpio = SIMPAD_CS3_LED2_ON,
		.active_low = 0,
		.default_trigger = "default-on",
	},
};

static struct gpio_led_platform_data simpad_led_data = {
	.num_leds = ARRAY_SIZE(simpad_leds),
	.leds = simpad_leds,
};

static struct platform_device simpad_gpio_leds = {
	.name = "leds-gpio",
	.id = 0,
	.dev = {
		.platform_data = &simpad_led_data,
	},
};

/*
 * i2c
 */
static struct i2c_gpio_platform_data simpad_i2c_data = {
	.sda_pin = GPIO_GPIO21,
	.scl_pin = GPIO_GPIO25,
	.udelay = 10,
	.timeout = HZ,
};

static struct platform_device simpad_i2c = {
	.name = "i2c-gpio",
	.id = 0,
	.dev = {
		.platform_data = &simpad_i2c_data,
	},
};

/*
 * MediaQ Video Device
 */
static struct platform_device simpad_mq200fb = {
	.name = "simpad-mq200",
	.id   = 0,
};

static struct platform_device *devices[] __initdata = {
	&simpad_keys,
	&simpad_polled_keys,
	&simpad_mq200fb,
	&simpad_gpio_leds,
	&simpad_i2c,
};


static int __init simpad_init(void)
{
	int ret;

	spin_lock_init(&cs3_lock);

	cs3_gpio.label = "simpad_cs3";
	cs3_gpio.base = SIMPAD_CS3_GPIO_BASE;
	cs3_gpio.ngpio = 24;
	cs3_gpio.set = cs3_gpio_set;
	cs3_gpio.get = cs3_gpio_get;
	cs3_gpio.direction_input = cs3_gpio_direction_input;
	cs3_gpio.direction_output = cs3_gpio_direction_output;
	ret = gpiochip_add_data(&cs3_gpio, NULL);
	if (ret)
		printk(KERN_WARNING "simpad: Unable to register cs3 GPIO device");

	pm_power_off = simpad_power_off;

	sa11x0_ppc_configure_mcp();
	sa11x0_register_mtd(&simpad_flash_data, simpad_flash_resources,
			      ARRAY_SIZE(simpad_flash_resources));
	sa11x0_register_mcp(&simpad_mcp_data);

	ret = platform_add_devices(devices, ARRAY_SIZE(devices));
	if(ret)
		printk(KERN_WARNING "simpad: Unable to register mq200 framebuffer device");

	return 0;
}

arch_initcall(simpad_init);


MACHINE_START(SIMPAD, "Simpad")
	/* Maintainer: Holger Freyther */
	.atag_offset	= 0x100,
	.map_io		= simpad_map_io,
	.nr_irqs	= SA1100_NR_IRQS,
	.init_irq	= sa1100_init_irq,
	.init_late	= sa11x0_init_late,
	.init_time	= sa1100_timer_init,
	.restart	= sa11x0_restart,
MACHINE_END
Commit	Line	Data
1da177e4 LT	1	/*
	2	* linux/arch/arm/mach-sa1100/simpad.c
	3	*/
	4
1da177e4 LT	5	#include <linux/module.h>
	6	#include <linux/init.h>
	7	#include <linux/kernel.h>
	8	#include <linux/tty.h>
	9	#include <linux/proc_fs.h>
f314f33b	10	#include <linux/string.h>
1da177e4	11	#include <linux/pm.h>
6920b5a7	12	#include <linux/platform_data/sa11x0-serial.h>
d052d1be	13	#include <linux/platform_device.h>
abe06082	14	#include <linux/mfd/ucb1x00.h>
1da177e4 LT	15	#include <linux/mtd/mtd.h>
1da177e4 LT	16	#include <linux/mtd/partitions.h>
fced80c7	17	#include <linux/io.h>
985b7f23	18	#include <linux/gpio/driver.h>
1da177e4	19
a09e64fb	20	#include <mach/hardware.h>
1da177e4	21	#include <asm/setup.h>
9a48aa4c	22	#include <asm/irq.h>
1da177e4 LT	23
	24	#include <asm/mach-types.h>
	25	#include <asm/mach/arch.h>
	26	#include <asm/mach/flash.h>
	27	#include <asm/mach/map.h>
a1fd844c	28	#include <linux/platform_data/mfd-mcp-sa11x0.h>
a09e64fb	29	#include <mach/simpad.h>
f314f33b	30	#include <mach/irqs.h>
1da177e4 LT	31
	32	#include <linux/serial_core.h>
	33	#include <linux/ioport.h>
dbd406f9 JF	34	#include <linux/input.h>
dbd406f9 JF	35	#include <linux/gpio_keys.h>
d056f5a8	36	#include <linux/leds.h>
dbd406f9	37	#include <linux/i2c-gpio.h>
1da177e4 LT	38
	39	#include "generic.h"
	40
de0bc0d1 JF	41	/*
	42	* CS3 support
	43	*/
	44
	45	static long cs3_shadow;
	46	static spinlock_t cs3_lock;
	47	static struct gpio_chip cs3_gpio;
	48
	49	long simpad_get_cs3_ro(void)
	50	{
	51	return readl(CS3_BASE);
	52	}
	53	EXPORT_SYMBOL(simpad_get_cs3_ro);
1da177e4	54
de0bc0d1	55	long simpad_get_cs3_shadow(void)
1da177e4 LT	56	{
	57	return cs3_shadow;
	58	}
de0bc0d1	59	EXPORT_SYMBOL(simpad_get_cs3_shadow);
1da177e4	60
de0bc0d1	61	static void __simpad_write_cs3(void)
1da177e4	62	{
de0bc0d1	63	writel(cs3_shadow, CS3_BASE);
1da177e4 LT	64	}
1da177e4 LT	65
de0bc0d1	66	void simpad_set_cs3_bit(int value)
1da177e4	67	{
de0bc0d1 JF	68	unsigned long flags;
	69
	70	spin_lock_irqsave(&cs3_lock, flags);
1da177e4	71	cs3_shadow \|= value;
de0bc0d1 JF	72	__simpad_write_cs3();
de0bc0d1 JF	73	spin_unlock_irqrestore(&cs3_lock, flags);
1da177e4	74	}
de0bc0d1	75	EXPORT_SYMBOL(simpad_set_cs3_bit);
1da177e4	76
de0bc0d1	77	void simpad_clear_cs3_bit(int value)
1da177e4	78	{
de0bc0d1 JF	79	unsigned long flags;
	80
	81	spin_lock_irqsave(&cs3_lock, flags);
1da177e4	82	cs3_shadow &= ~value;
de0bc0d1 JF	83	__simpad_write_cs3();
de0bc0d1 JF	84	spin_unlock_irqrestore(&cs3_lock, flags);
1da177e4	85	}
de0bc0d1 JF	86	EXPORT_SYMBOL(simpad_clear_cs3_bit);
	87
	88	static void cs3_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
	89	{
	90	if (offset > 15)
	91	return;
	92	if (value)
	93	simpad_set_cs3_bit(1 << offset);
	94	else
	95	simpad_clear_cs3_bit(1 << offset);
	96	};
1da177e4	97
de0bc0d1 JF	98	static int cs3_gpio_get(struct gpio_chip *chip, unsigned offset)
	99	{
	100	if (offset > 15)
1f33b013 LW	101	return !!(simpad_get_cs3_ro() & (1 << (offset - 16)));
1f33b013 LW	102	return !!(simpad_get_cs3_shadow() & (1 << offset));
de0bc0d1 JF	103	};
	104
	105	static int cs3_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
	106	{
	107	if (offset > 15)
	108	return 0;
	109	return -EINVAL;
	110	};
	111
	112	static int cs3_gpio_direction_output(struct gpio_chip *chip, unsigned offset,
	113	int value)
	114	{
	115	if (offset > 15)
	116	return -EINVAL;
	117	cs3_gpio_set(chip, offset, value);
	118	return 0;
	119	};
1da177e4 LT	120
1da177e4 LT	121	static struct map_desc simpad_io_desc[] __initdata = {
92519d82 DS	122	{ /* MQ200 */
	123	.virtual = 0xf2800000,
	124	.pfn = __phys_to_pfn(0x4b800000),
	125	.length = 0x00800000,
	126	.type = MT_DEVICE
de0bc0d1	127	}, { /* Simpad CS3 */
b55056ea	128	.virtual = (unsigned long)CS3_BASE,
de0bc0d1	129	.pfn = __phys_to_pfn(SA1100_CS3_PHYS),
92519d82 DS	130	.length = 0x00100000,
	131	.type = MT_DEVICE
	132	},
1da177e4 LT	133	};
	134
	135
	136	static void simpad_uart_pm(struct uart_port *port, u_int state, u_int oldstate)
	137	{
	138	if (port->mapbase == (u_int)&Ser1UTCR0) {
	139	if (state)
	140	{
de0bc0d1 JF	141	simpad_clear_cs3_bit(RS232_ON);
de0bc0d1 JF	142	simpad_clear_cs3_bit(DECT_POWER_ON);
1da177e4 LT	143	}else
1da177e4 LT	144	{
de0bc0d1 JF	145	simpad_set_cs3_bit(RS232_ON);
de0bc0d1 JF	146	simpad_set_cs3_bit(DECT_POWER_ON);
1da177e4 LT	147	}
	148	}
	149	}
	150
	151	static struct sa1100_port_fns simpad_port_fns __initdata = {
	152	.pm = simpad_uart_pm,
	153	};
	154
	155
	156	static struct mtd_partition simpad_partitions[] = {
	157	{
	158	.name = "SIMpad boot firmware",
	159	.size = 0x00080000,
	160	.offset = 0,
	161	.mask_flags = MTD_WRITEABLE,
	162	}, {
	163	.name = "SIMpad kernel",
	164	.size = 0x0010000,
	165	.offset = MTDPART_OFS_APPEND,
	166	}, {
	167	.name = "SIMpad root jffs2",
	168	.size = MTDPART_SIZ_FULL,
	169	.offset = MTDPART_OFS_APPEND,
	170	}
	171	};
	172
	173	static struct flash_platform_data simpad_flash_data = {
	174	.map_name = "cfi_probe",
	175	.parts = simpad_partitions,
	176	.nr_parts = ARRAY_SIZE(simpad_partitions),
	177	};
	178
	179
	180	static struct resource simpad_flash_resources [] = {
a181099e RK	181	DEFINE_RES_MEM(SA1100_CS0_PHYS, SZ_16M),
a181099e RK	182	DEFINE_RES_MEM(SA1100_CS1_PHYS, SZ_16M),
1da177e4 LT	183	};
1da177e4 LT	184
abe06082 RK	185	static struct ucb1x00_plat_data simpad_ucb1x00_data = {
	186	.gpio_base = SIMPAD_UCB1X00_GPIO_BASE,
	187	};
	188
323cdfc1 RK	189	static struct mcp_plat_data simpad_mcp_data = {
	190	.mccr0 = MCCR0_ADM,
	191	.sclk_rate = 11981000,
abe06082	192	.codec_pdata = &simpad_ucb1x00_data,
323cdfc1 RK	193	};
323cdfc1 RK	194
1da177e4 LT	195
	196
	197	static void __init simpad_map_io(void)
	198	{
	199	sa1100_map_io();
	200
	201	iotable_init(simpad_io_desc, ARRAY_SIZE(simpad_io_desc));
	202
de0bc0d1 JF	203	/* Initialize CS3 */
	204	cs3_shadow = (EN1 \| EN0 \| LED2_ON \| DISPLAY_ON \|
	205	RS232_ON \| ENABLE_5V \| RESET_SIMCARD \| DECT_POWER_ON);
	206	__simpad_write_cs3(); /* Spinlocks not yet initialized */
1da177e4 LT	207
	208	sa1100_register_uart_fns(&simpad_port_fns);
	209	sa1100_register_uart(0, 3); /* serial interface */
	210	sa1100_register_uart(1, 1); /* DECT */
	211
	212	// Reassign UART 1 pins
	213	GAFR \|= GPIO_UART_TXD \| GPIO_UART_RXD;
	214	GPDR \|= GPIO_UART_TXD \| GPIO_LDD13 \| GPIO_LDD15;
	215	GPDR &= ~GPIO_UART_RXD;
	216	PPAR \|= PPAR_UPR;
	217
	218	/*
	219	* Set up registers for sleep mode.
	220	*/
	221
	222
	223	PWER = PWER_GPIO0\| PWER_RTC;
	224	PGSR = 0x818;
	225	PCFR = 0;
	226	PSDR = 0;
	227
1da177e4 LT	228	}
	229
	230	static void simpad_power_off(void)
	231	{
de0bc0d1 JF	232	local_irq_disable();
	233	cs3_shadow = SD_MEDIAQ;
	234	__simpad_write_cs3(); /* Bypass spinlock here */
1da177e4 LT	235
	236	/* disable internal oscillator, float CS lines */
	237	PCFR = (PCFR_OPDE \| PCFR_FP \| PCFR_FS);
de0bc0d1 JF	238	/* enable wake-up on GPIO0 */
de0bc0d1 JF	239	PWER = GFER = GRER = PWER_GPIO0;
1da177e4 LT	240	/*
	241	* set scratchpad to zero, just in case it is used as a
	242	* restart address by the bootloader.
	243	*/
	244	PSPR = 0;
	245	PGSR = 0;
	246	/* enter sleep mode */
	247	PMCR = PMCR_SF;
	248	while(1);
	249
	250	local_irq_enable(); /* we won't ever call it */
	251
	252
	253	}
	254
dbd406f9 JF	255	/*
	256	* gpio_keys
	257	*/
	258
	259	static struct gpio_keys_button simpad_button_table[] = {
	260	{ KEY_POWER, IRQ_GPIO_POWER_BUTTON, 1, "power button" },
	261	};
	262
	263	static struct gpio_keys_platform_data simpad_keys_data = {
	264	.buttons = simpad_button_table,
	265	.nbuttons = ARRAY_SIZE(simpad_button_table),
	266	};
	267
	268	static struct platform_device simpad_keys = {
	269	.name = "gpio-keys",
	270	.dev = {
	271	.platform_data = &simpad_keys_data,
	272	},
	273	};
	274
	275	static struct gpio_keys_button simpad_polled_button_table[] = {
	276	{ KEY_PROG1, SIMPAD_UCB1X00_GPIO_PROG1, 1, "prog1 button" },
	277	{ KEY_PROG2, SIMPAD_UCB1X00_GPIO_PROG2, 1, "prog2 button" },
	278	{ KEY_UP, SIMPAD_UCB1X00_GPIO_UP, 1, "up button" },
	279	{ KEY_DOWN, SIMPAD_UCB1X00_GPIO_DOWN, 1, "down button" },
	280	{ KEY_LEFT, SIMPAD_UCB1X00_GPIO_LEFT, 1, "left button" },
	281	{ KEY_RIGHT, SIMPAD_UCB1X00_GPIO_RIGHT, 1, "right button" },
	282	};
	283
	284	static struct gpio_keys_platform_data simpad_polled_keys_data = {
	285	.buttons = simpad_polled_button_table,
	286	.nbuttons = ARRAY_SIZE(simpad_polled_button_table),
	287	.poll_interval = 50,
	288	};
	289
	290	static struct platform_device simpad_polled_keys = {
	291	.name = "gpio-keys-polled",
	292	.dev = {
	293	.platform_data = &simpad_polled_keys_data,
	294	},
	295	};
	296
d056f5a8 JF	297	/*
	298	* GPIO LEDs
	299	*/
	300
	301	static struct gpio_led simpad_leds[] = {
	302	{
	303	.name = "simpad:power",
	304	.gpio = SIMPAD_CS3_LED2_ON,
	305	.active_low = 0,
	306	.default_trigger = "default-on",
	307	},
	308	};
	309
	310	static struct gpio_led_platform_data simpad_led_data = {
	311	.num_leds = ARRAY_SIZE(simpad_leds),
	312	.leds = simpad_leds,
	313	};
	314
	315	static struct platform_device simpad_gpio_leds = {
	316	.name = "leds-gpio",
	317	.id = 0,
	318	.dev = {
	319	.platform_data = &simpad_led_data,
	320	},
	321	};
	322
dbd406f9 JF	323	/*
	324	* i2c
	325	*/
	326	static struct i2c_gpio_platform_data simpad_i2c_data = {
	327	.sda_pin = GPIO_GPIO21,
	328	.scl_pin = GPIO_GPIO25,
	329	.udelay = 10,
	330	.timeout = HZ,
	331	};
	332
	333	static struct platform_device simpad_i2c = {
	334	.name = "i2c-gpio",
	335	.id = 0,
	336	.dev = {
	337	.platform_data = &simpad_i2c_data,
	338	},
	339	};
1da177e4 LT	340
	341	/*
	342	* MediaQ Video Device
	343	*/
	344	static struct platform_device simpad_mq200fb = {
	345	.name = "simpad-mq200",
	346	.id = 0,
	347	};
	348
	349	static struct platform_device *devices[] __initdata = {
dbd406f9 JF	350	&simpad_keys,
	351	&simpad_polled_keys,
	352	&simpad_mq200fb,
d056f5a8	353	&simpad_gpio_leds,
dbd406f9	354	&simpad_i2c,
1da177e4 LT	355	};
	356
	357
	358
	359	static int __init simpad_init(void)
	360	{
	361	int ret;
	362
de0bc0d1 JF	363	spin_lock_init(&cs3_lock);
	364
	365	cs3_gpio.label = "simpad_cs3";
	366	cs3_gpio.base = SIMPAD_CS3_GPIO_BASE;
	367	cs3_gpio.ngpio = 24;
	368	cs3_gpio.set = cs3_gpio_set;
	369	cs3_gpio.get = cs3_gpio_get;
	370	cs3_gpio.direction_input = cs3_gpio_direction_input;
	371	cs3_gpio.direction_output = cs3_gpio_direction_output;
985b7f23	372	ret = gpiochip_add_data(&cs3_gpio, NULL);
de0bc0d1 JF	373	if (ret)
	374	printk(KERN_WARNING "simpad: Unable to register cs3 GPIO device");
	375
1da177e4 LT	376	pm_power_off = simpad_power_off;
1da177e4 LT	377
e36e26a8	378	sa11x0_ppc_configure_mcp();
4f444e2b JF	379	sa11x0_register_mtd(&simpad_flash_data, simpad_flash_resources,
	380	ARRAY_SIZE(simpad_flash_resources));
	381	sa11x0_register_mcp(&simpad_mcp_data);
	382
1da177e4 LT	383	ret = platform_add_devices(devices, ARRAY_SIZE(devices));
	384	if(ret)
	385	printk(KERN_WARNING "simpad: Unable to register mq200 framebuffer device");
	386
	387	return 0;
	388	}
	389
	390	arch_initcall(simpad_init);
	391
	392
	393	MACHINE_START(SIMPAD, "Simpad")
e9dea0c6	394	/* Maintainer: Holger Freyther */
17f4425d	395	.atag_offset = 0x100,
e9dea0c6	396	.map_io = simpad_map_io,
f314f33b	397	.nr_irqs = SA1100_NR_IRQS,
e9dea0c6	398	.init_irq = sa1100_init_irq,
7fea1ba5	399	.init_late = sa11x0_init_late,
6bb27d73	400	.init_time = sa1100_timer_init,
d9ca5839	401	.restart = sa11x0_restart,
1da177e4	402	MACHINE_END