[deliverable/linux.git] / arch / arm / mach-omap1 / board-nokia770.c

/*
 * linux/arch/arm/mach-omap1/board-nokia770.c
 *
 * Modified from board-generic.c
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/mutex.h>
#include <linux/platform_device.h>
#include <linux/input.h>
#include <linux/clk.h>

#include <linux/spi/spi.h>
#include <linux/spi/ads7846.h>
#include <linux/workqueue.h>
#include <linux/delay.h>

#include <mach/hardware.h>
#include <asm/mach-types.h>
#include <asm/mach/arch.h>
#include <asm/mach/map.h>

#include <mach/gpio.h>
#include <mach/mux.h>
#include <mach/usb.h>
#include <mach/board.h>
#include <mach/keypad.h>
#include <mach/common.h>
#include <mach/dsp_common.h>
#include <mach/omapfb.h>
#include <mach/lcd_mipid.h>
#include <mach/mmc.h>
#include <mach/usb.h>

#define ADS7846_PENDOWN_GPIO	15

static void __init omap_nokia770_init_irq(void)
{
	/* On Nokia 770, the SleepX signal is masked with an
	 * MPUIO line by default.  It has to be unmasked for it
	 * to become functional */

	/* SleepX mask direction */
	omap_writew((omap_readw(0xfffb5008) & ~2), 0xfffb5008);
	/* Unmask SleepX signal */
	omap_writew((omap_readw(0xfffb5004) & ~2), 0xfffb5004);

	omap1_init_common_hw();
	omap_init_irq();
}

static int nokia770_keymap[] = {
	KEY(0, 1, GROUP_0 | KEY_UP),
	KEY(0, 2, GROUP_1 | KEY_F5),
	KEY(1, 0, GROUP_0 | KEY_LEFT),
	KEY(1, 1, GROUP_0 | KEY_ENTER),
	KEY(1, 2, GROUP_0 | KEY_RIGHT),
	KEY(2, 0, GROUP_1 | KEY_ESC),
	KEY(2, 1, GROUP_0 | KEY_DOWN),
	KEY(2, 2, GROUP_1 | KEY_F4),
	KEY(3, 0, GROUP_2 | KEY_F7),
	KEY(3, 1, GROUP_2 | KEY_F8),
	KEY(3, 2, GROUP_2 | KEY_F6),
	0
};

static struct resource nokia770_kp_resources[] = {
	[0] = {
		.start	= INT_KEYBOARD,
		.end	= INT_KEYBOARD,
		.flags	= IORESOURCE_IRQ,
	},
};

static struct omap_kp_platform_data nokia770_kp_data = {
	.rows		= 8,
	.cols		= 8,
	.keymap		= nokia770_keymap,
	.keymapsize	= ARRAY_SIZE(nokia770_keymap),
	.delay		= 4,
};

static struct platform_device nokia770_kp_device = {
	.name		= "omap-keypad",
	.id		= -1,
	.dev		= {
		.platform_data = &nokia770_kp_data,
	},
	.num_resources	= ARRAY_SIZE(nokia770_kp_resources),
	.resource	= nokia770_kp_resources,
};

static struct platform_device *nokia770_devices[] __initdata = {
	&nokia770_kp_device,
};

static void mipid_shutdown(struct mipid_platform_data *pdata)
{
	if (pdata->nreset_gpio != -1) {
		printk(KERN_INFO "shutdown LCD\n");
		gpio_set_value(pdata->nreset_gpio, 0);
		msleep(120);
	}
}

static struct mipid_platform_data nokia770_mipid_platform_data = {
	.shutdown = mipid_shutdown,
};

static void mipid_dev_init(void)
{
	const struct omap_lcd_config *conf;

	conf = omap_get_config(OMAP_TAG_LCD, struct omap_lcd_config);
	if (conf != NULL) {
		nokia770_mipid_platform_data.nreset_gpio = conf->nreset_gpio;
		nokia770_mipid_platform_data.data_lines = conf->data_lines;
	}
}

static void ads7846_dev_init(void)
{
	if (gpio_request(ADS7846_PENDOWN_GPIO, "ADS7846 pendown") < 0)
		printk(KERN_ERR "can't get ads7846 pen down GPIO\n");
}

static int ads7846_get_pendown_state(void)
{
	return !gpio_get_value(ADS7846_PENDOWN_GPIO);
}

static struct ads7846_platform_data nokia770_ads7846_platform_data __initdata = {
	.x_max		= 0x0fff,
	.y_max		= 0x0fff,
	.x_plate_ohms	= 180,
	.pressure_max	= 255,
	.debounce_max	= 10,
	.debounce_tol	= 3,
	.debounce_rep	= 1,
	.get_pendown_state	= ads7846_get_pendown_state,
};

static struct spi_board_info nokia770_spi_board_info[] __initdata = {
	[0] = {
		.modalias       = "lcd_mipid",
		.bus_num        = 2,
		.chip_select    = 3,
		.max_speed_hz   = 12000000,
		.platform_data	= &nokia770_mipid_platform_data,
	},
	[1] = {
		.modalias       = "ads7846",
		.bus_num        = 2,
		.chip_select    = 0,
		.max_speed_hz   = 2500000,
		.irq		= OMAP_GPIO_IRQ(15),
		.platform_data	= &nokia770_ads7846_platform_data,
	},
};


/* assume no Mini-AB port */

static struct omap_usb_config nokia770_usb_config __initdata = {
	.otg		= 1,
	.register_host	= 1,
	.register_dev	= 1,
	.hmc_mode	= 16,
	.pins[0]	= 6,
};

#if defined(CONFIG_MMC_OMAP) || defined(CONFIG_MMC_OMAP_MODULE)

#define NOKIA770_GPIO_MMC_POWER		41
#define NOKIA770_GPIO_MMC_SWITCH	23

static int nokia770_mmc_set_power(struct device *dev, int slot, int power_on,
				int vdd)
{
	gpio_set_value(NOKIA770_GPIO_MMC_POWER, power_on);
	return 0;
}

static int nokia770_mmc_get_cover_state(struct device *dev, int slot)
{
	return gpio_get_value(NOKIA770_GPIO_MMC_SWITCH);
}

static struct omap_mmc_platform_data nokia770_mmc2_data = {
	.nr_slots                       = 1,
	.dma_mask			= 0xffffffff,
	.slots[0]       = {
		.set_power		= nokia770_mmc_set_power,
		.get_cover_state	= nokia770_mmc_get_cover_state,
		.name                   = "mmcblk",
	},
};

static struct omap_mmc_platform_data *nokia770_mmc_data[OMAP16XX_NR_MMC];

static void __init nokia770_mmc_init(void)
{
	int ret;

	ret = gpio_request(NOKIA770_GPIO_MMC_POWER, "MMC power");
	if (ret < 0)
		return;
	gpio_direction_output(NOKIA770_GPIO_MMC_POWER, 0);

	ret = gpio_request(NOKIA770_GPIO_MMC_SWITCH, "MMC cover");
	if (ret < 0) {
		gpio_free(NOKIA770_GPIO_MMC_POWER);
		return;
	}
	gpio_direction_input(NOKIA770_GPIO_MMC_SWITCH);

	/* Only the second MMC controller is used */
	nokia770_mmc_data[1] = &nokia770_mmc2_data;
	omap1_init_mmc(nokia770_mmc_data, OMAP16XX_NR_MMC);
}

#else
static inline void nokia770_mmc_init(void)
{
}
#endif

#if	defined(CONFIG_OMAP_DSP)
/*
 * audio power control
 */
#define	HEADPHONE_GPIO		14
#define	AMPLIFIER_CTRL_GPIO	58

static struct clk *dspxor_ck;
static DEFINE_MUTEX(audio_pwr_lock);
/*
 * audio_pwr_state
 * +--+-------------------------+---------------------------------------+
 * |-1|down			|power-up request -> 0			|
 * +--+-------------------------+---------------------------------------+
 * | 0|up			|power-down(1) request -> 1		|
 * |  |				|power-down(2) request -> (ignore)	|
 * +--+-------------------------+---------------------------------------+
 * | 1|up,			|power-up request -> 0			|
 * |  |received down(1) request	|power-down(2) request -> -1		|
 * +--+-------------------------+---------------------------------------+
 */
static int audio_pwr_state = -1;

static inline void aic23_power_up(void)
{
}
static inline void aic23_power_down(void)
{
}

/*
 * audio_pwr_up / down should be called under audio_pwr_lock
 */
static void nokia770_audio_pwr_up(void)
{
	clk_enable(dspxor_ck);

	/* Turn on codec */
	aic23_power_up();

	if (gpio_get_value(HEADPHONE_GPIO))
		/* HP not connected, turn on amplifier */
		gpio_set_value(AMPLIFIER_CTRL_GPIO, 1);
	else
		/* HP connected, do not turn on amplifier */
		printk("HP connected\n");
}

static void codec_delayed_power_down(struct work_struct *work)
{
	mutex_lock(&audio_pwr_lock);
	if (audio_pwr_state == -1)
		aic23_power_down();
	clk_disable(dspxor_ck);
	mutex_unlock(&audio_pwr_lock);
}

static DECLARE_DELAYED_WORK(codec_power_down_work, codec_delayed_power_down);

static void nokia770_audio_pwr_down(void)
{
	/* Turn off amplifier */
	gpio_set_value(AMPLIFIER_CTRL_GPIO, 0);

	/* Turn off codec: schedule delayed work */
	schedule_delayed_work(&codec_power_down_work, HZ / 20);	/* 50ms */
}

static int
nokia770_audio_pwr_up_request(struct dsp_kfunc_device *kdev, int stage)
{
	mutex_lock(&audio_pwr_lock);
	if (audio_pwr_state == -1)
		nokia770_audio_pwr_up();
	/* force audio_pwr_state = 0, even if it was 1. */
	audio_pwr_state = 0;
	mutex_unlock(&audio_pwr_lock);
	return 0;
}

static int
nokia770_audio_pwr_down_request(struct dsp_kfunc_device *kdev, int stage)
{
	mutex_lock(&audio_pwr_lock);
	switch (stage) {
	case 1:
		if (audio_pwr_state == 0)
			audio_pwr_state = 1;
		break;
	case 2:
		if (audio_pwr_state == 1) {
			nokia770_audio_pwr_down();
			audio_pwr_state = -1;
		}
		break;
	}
	mutex_unlock(&audio_pwr_lock);
	return 0;
}

static struct dsp_kfunc_device nokia770_audio_device = {
	.name	 = "audio",
	.type	 = DSP_KFUNC_DEV_TYPE_AUDIO,
	.enable  = nokia770_audio_pwr_up_request,
	.disable = nokia770_audio_pwr_down_request,
};

static __init int omap_dsp_init(void)
{
	int ret;

	dspxor_ck = clk_get(0, "dspxor_ck");
	if (IS_ERR(dspxor_ck)) {
		printk(KERN_ERR "couldn't acquire dspxor_ck\n");
		return PTR_ERR(dspxor_ck);
	}

	ret = dsp_kfunc_device_register(&nokia770_audio_device);
	if (ret) {
		printk(KERN_ERR
		       "KFUNC device registration faild: %s\n",
		       nokia770_audio_device.name);
		goto out;
	}
	return 0;
 out:
	return ret;
}
#else
#define omap_dsp_init()		do {} while (0)
#endif	/* CONFIG_OMAP_DSP */

static void __init omap_nokia770_init(void)
{
	platform_add_devices(nokia770_devices, ARRAY_SIZE(nokia770_devices));
	spi_register_board_info(nokia770_spi_board_info,
				ARRAY_SIZE(nokia770_spi_board_info));
	omap_gpio_init();
	omap_serial_init();
	omap_register_i2c_bus(1, 100, NULL, 0);
	omap_dsp_init();
	ads7846_dev_init();
	mipid_dev_init();
	omap_usb_init(&nokia770_usb_config);
	nokia770_mmc_init();
}

static void __init omap_nokia770_map_io(void)
{
	omap1_map_common_io();
}

MACHINE_START(NOKIA770, "Nokia 770")
	.phys_io	= 0xfff00000,
	.io_pg_offst	= ((0xfef00000) >> 18) & 0xfffc,
	.boot_params	= 0x10000100,
	.map_io		= omap_nokia770_map_io,
	.init_irq	= omap_nokia770_init_irq,
	.init_machine	= omap_nokia770_init,
	.timer		= &omap_timer,
MACHINE_END
Commit	Line	Data
9b6553cd TL	1	/*
	2	* linux/arch/arm/mach-omap1/board-nokia770.c
	3	*
	4	* Modified from board-generic.c
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License version 2 as
	8	* published by the Free Software Foundation.
	9	*/
	10
	11	#include <linux/kernel.h>
	12	#include <linux/init.h>
d41d219e	13	#include <linux/mutex.h>
9b6553cd TL	14	#include <linux/platform_device.h>
	15	#include <linux/input.h>
	16	#include <linux/clk.h>
	17
	18	#include <linux/spi/spi.h>
	19	#include <linux/spi/ads7846.h>
19350610 DB	20	#include <linux/workqueue.h>
19350610 DB	21	#include <linux/delay.h>
9b6553cd	22
a09e64fb	23	#include <mach/hardware.h>
9b6553cd TL	24	#include <asm/mach-types.h>
	25	#include <asm/mach/arch.h>
	26	#include <asm/mach/map.h>
	27
a09e64fb RK	28	#include <mach/gpio.h>
	29	#include <mach/mux.h>
	30	#include <mach/usb.h>
	31	#include <mach/board.h>
	32	#include <mach/keypad.h>
	33	#include <mach/common.h>
	34	#include <mach/dsp_common.h>
a09e64fb RK	35	#include <mach/omapfb.h>
a09e64fb RK	36	#include <mach/lcd_mipid.h>
d8874665	37	#include <mach/mmc.h>
ebe3b0e7	38	#include <mach/usb.h>
9b6553cd	39
06767fb2 ID	40	#define ADS7846_PENDOWN_GPIO 15
06767fb2 ID	41
9b6553cd TL	42	static void __init omap_nokia770_init_irq(void)
	43	{
	44	/* On Nokia 770, the SleepX signal is masked with an
	45	* MPUIO line by default. It has to be unmasked for it
	46	* to become functional */
	47
	48	/* SleepX mask direction */
	49	omap_writew((omap_readw(0xfffb5008) & ~2), 0xfffb5008);
	50	/* Unmask SleepX signal */
	51	omap_writew((omap_readw(0xfffb5004) & ~2), 0xfffb5004);
	52
	53	omap1_init_common_hw();
	54	omap_init_irq();
	55	}
	56
	57	static int nokia770_keymap[] = {
	58	KEY(0, 1, GROUP_0 \| KEY_UP),
	59	KEY(0, 2, GROUP_1 \| KEY_F5),
	60	KEY(1, 0, GROUP_0 \| KEY_LEFT),
	61	KEY(1, 1, GROUP_0 \| KEY_ENTER),
	62	KEY(1, 2, GROUP_0 \| KEY_RIGHT),
	63	KEY(2, 0, GROUP_1 \| KEY_ESC),
	64	KEY(2, 1, GROUP_0 \| KEY_DOWN),
	65	KEY(2, 2, GROUP_1 \| KEY_F4),
	66	KEY(3, 0, GROUP_2 \| KEY_F7),
	67	KEY(3, 1, GROUP_2 \| KEY_F8),
	68	KEY(3, 2, GROUP_2 \| KEY_F6),
	69	0
	70	};
	71
	72	static struct resource nokia770_kp_resources[] = {
	73	[0] = {
	74	.start = INT_KEYBOARD,
	75	.end = INT_KEYBOARD,
	76	.flags = IORESOURCE_IRQ,
	77	},
	78	};
	79
	80	static struct omap_kp_platform_data nokia770_kp_data = {
4d24607b KS	81	.rows = 8,
	82	.cols = 8,
	83	.keymap = nokia770_keymap,
6d5aefb8	84	.keymapsize = ARRAY_SIZE(nokia770_keymap),
4d24607b	85	.delay = 4,
9b6553cd TL	86	};
	87
	88	static struct platform_device nokia770_kp_device = {
	89	.name = "omap-keypad",
	90	.id = -1,
	91	.dev = {
	92	.platform_data = &nokia770_kp_data,
	93	},
	94	.num_resources = ARRAY_SIZE(nokia770_kp_resources),
	95	.resource = nokia770_kp_resources,
	96	};
	97
	98	static struct platform_device *nokia770_devices[] __initdata = {
a524626b	99	&nokia770_kp_device,
9b6553cd TL	100	};
9b6553cd TL	101
06767fb2 ID	102	static void mipid_shutdown(struct mipid_platform_data *pdata)
	103	{
	104	if (pdata->nreset_gpio != -1) {
	105	printk(KERN_INFO "shutdown LCD\n");
0b84b5ca	106	gpio_set_value(pdata->nreset_gpio, 0);
06767fb2 ID	107	msleep(120);
	108	}
	109	}
	110
	111	static struct mipid_platform_data nokia770_mipid_platform_data = {
	112	.shutdown = mipid_shutdown,
	113	};
	114
	115	static void mipid_dev_init(void)
	116	{
	117	const struct omap_lcd_config *conf;
	118
	119	conf = omap_get_config(OMAP_TAG_LCD, struct omap_lcd_config);
	120	if (conf != NULL) {
	121	nokia770_mipid_platform_data.nreset_gpio = conf->nreset_gpio;
	122	nokia770_mipid_platform_data.data_lines = conf->data_lines;
	123	}
	124	}
	125
	126	static void ads7846_dev_init(void)
	127	{
f2d18fea	128	if (gpio_request(ADS7846_PENDOWN_GPIO, "ADS7846 pendown") < 0)
06767fb2 ID	129	printk(KERN_ERR "can't get ads7846 pen down GPIO\n");
	130	}
	131
	132	static int ads7846_get_pendown_state(void)
	133	{
0b84b5ca	134	return !gpio_get_value(ADS7846_PENDOWN_GPIO);
06767fb2 ID	135	}
06767fb2 ID	136
9b6553cd TL	137	static struct ads7846_platform_data nokia770_ads7846_platform_data __initdata = {
	138	.x_max = 0x0fff,
	139	.y_max = 0x0fff,
	140	.x_plate_ohms = 180,
	141	.pressure_max = 255,
	142	.debounce_max = 10,
	143	.debounce_tol = 3,
06767fb2 ID	144	.debounce_rep = 1,
06767fb2 ID	145	.get_pendown_state = ads7846_get_pendown_state,
9b6553cd TL	146	};
	147
	148	static struct spi_board_info nokia770_spi_board_info[] __initdata = {
	149	[0] = {
a524626b	150	.modalias = "lcd_mipid",
9b6553cd TL	151	.bus_num = 2,
	152	.chip_select = 3,
	153	.max_speed_hz = 12000000,
06767fb2	154	.platform_data = &nokia770_mipid_platform_data,
9b6553cd TL	155	},
	156	[1] = {
	157	.modalias = "ads7846",
	158	.bus_num = 2,
	159	.chip_select = 0,
	160	.max_speed_hz = 2500000,
	161	.irq = OMAP_GPIO_IRQ(15),
	162	.platform_data = &nokia770_ads7846_platform_data,
	163	},
	164	};
	165
	166
	167	/* assume no Mini-AB port */
	168
	169	static struct omap_usb_config nokia770_usb_config __initdata = {
	170	.otg = 1,
	171	.register_host = 1,
	172	.register_dev = 1,
	173	.hmc_mode = 16,
	174	.pins[0] = 6,
	175	};
	176
d8874665 TL	177	#if defined(CONFIG_MMC_OMAP) \|\| defined(CONFIG_MMC_OMAP_MODULE)
	178
	179	#define NOKIA770_GPIO_MMC_POWER 41
	180	#define NOKIA770_GPIO_MMC_SWITCH 23
	181
	182	static int nokia770_mmc_set_power(struct device *dev, int slot, int power_on,
	183	int vdd)
	184	{
bac5b29f	185	gpio_set_value(NOKIA770_GPIO_MMC_POWER, power_on);
d8874665 TL	186	return 0;
	187	}
	188
	189	static int nokia770_mmc_get_cover_state(struct device *dev, int slot)
	190	{
	191	return gpio_get_value(NOKIA770_GPIO_MMC_SWITCH);
	192	}
	193
	194	static struct omap_mmc_platform_data nokia770_mmc2_data = {
	195	.nr_slots = 1,
	196	.dma_mask = 0xffffffff,
	197	.slots[0] = {
	198	.set_power = nokia770_mmc_set_power,
	199	.get_cover_state = nokia770_mmc_get_cover_state,
	200	.name = "mmcblk",
9b6553cd TL	201	},
	202	};
	203
d8874665 TL	204	static struct omap_mmc_platform_data *nokia770_mmc_data[OMAP16XX_NR_MMC];
	205
	206	static void __init nokia770_mmc_init(void)
	207	{
	208	int ret;
	209
	210	ret = gpio_request(NOKIA770_GPIO_MMC_POWER, "MMC power");
	211	if (ret < 0)
	212	return;
	213	gpio_direction_output(NOKIA770_GPIO_MMC_POWER, 0);
	214
	215	ret = gpio_request(NOKIA770_GPIO_MMC_SWITCH, "MMC cover");
	216	if (ret < 0) {
	217	gpio_free(NOKIA770_GPIO_MMC_POWER);
	218	return;
	219	}
	220	gpio_direction_input(NOKIA770_GPIO_MMC_SWITCH);
	221
	222	/* Only the second MMC controller is used */
	223	nokia770_mmc_data[1] = &nokia770_mmc2_data;
	224	omap1_init_mmc(nokia770_mmc_data, OMAP16XX_NR_MMC);
	225	}
	226
	227	#else
	228	static inline void nokia770_mmc_init(void)
	229	{
	230	}
	231	#endif
	232
a524626b	233	#if defined(CONFIG_OMAP_DSP)
9b6553cd TL	234	/*
	235	* audio power control
	236	*/
	237	#define HEADPHONE_GPIO 14
	238	#define AMPLIFIER_CTRL_GPIO 58
	239
	240	static struct clk *dspxor_ck;
d41d219e	241	static DEFINE_MUTEX(audio_pwr_lock);
9b6553cd TL	242	/*
	243	* audio_pwr_state
	244	* +--+-------------------------+---------------------------------------+
	245	* \|-1\|down \|power-up request -> 0 \|
	246	* +--+-------------------------+---------------------------------------+
	247	* \| 0\|up \|power-down(1) request -> 1 \|
	248	* \| \| \|power-down(2) request -> (ignore) \|
	249	* +--+-------------------------+---------------------------------------+
	250	* \| 1\|up, \|power-up request -> 0 \|
	251	* \| \|received down(1) request \|power-down(2) request -> -1 \|
	252	* +--+-------------------------+---------------------------------------+
	253	*/
	254	static int audio_pwr_state = -1;
	255
e999bbe7 TL	256	static inline void aic23_power_up(void)
	257	{
	258	}
	259	static inline void aic23_power_down(void)
	260	{
	261	}
	262
9b6553cd	263	/*
d41d219e	264	* audio_pwr_up / down should be called under audio_pwr_lock
9b6553cd TL	265	*/
	266	static void nokia770_audio_pwr_up(void)
	267	{
	268	clk_enable(dspxor_ck);
	269
	270	/* Turn on codec */
a524626b	271	aic23_power_up();
9b6553cd	272
0b84b5ca	273	if (gpio_get_value(HEADPHONE_GPIO))
9b6553cd	274	/* HP not connected, turn on amplifier */
0b84b5ca	275	gpio_set_value(AMPLIFIER_CTRL_GPIO, 1);
9b6553cd TL	276	else
	277	/* HP connected, do not turn on amplifier */
	278	printk("HP connected\n");
	279	}
	280
6d5aefb8	281	static void codec_delayed_power_down(struct work_struct *work)
9b6553cd	282	{
d41d219e	283	mutex_lock(&audio_pwr_lock);
9b6553cd	284	if (audio_pwr_state == -1)
a524626b	285	aic23_power_down();
9b6553cd	286	clk_disable(dspxor_ck);
d41d219e	287	mutex_unlock(&audio_pwr_lock);
9b6553cd TL	288	}
9b6553cd TL	289
6d5aefb8	290	static DECLARE_DELAYED_WORK(codec_power_down_work, codec_delayed_power_down);
9b6553cd TL	291
	292	static void nokia770_audio_pwr_down(void)
	293	{
	294	/* Turn off amplifier */
0b84b5ca	295	gpio_set_value(AMPLIFIER_CTRL_GPIO, 0);
9b6553cd TL	296
	297	/* Turn off codec: schedule delayed work */
	298	schedule_delayed_work(&codec_power_down_work, HZ / 20); /* 50ms */
	299	}
	300
a524626b TL	301	static int
a524626b TL	302	nokia770_audio_pwr_up_request(struct dsp_kfunc_device *kdev, int stage)
9b6553cd	303	{
d41d219e	304	mutex_lock(&audio_pwr_lock);
9b6553cd TL	305	if (audio_pwr_state == -1)
	306	nokia770_audio_pwr_up();
	307	/* force audio_pwr_state = 0, even if it was 1. */
	308	audio_pwr_state = 0;
d41d219e	309	mutex_unlock(&audio_pwr_lock);
a524626b	310	return 0;
9b6553cd TL	311	}
9b6553cd TL	312
a524626b TL	313	static int
a524626b TL	314	nokia770_audio_pwr_down_request(struct dsp_kfunc_device *kdev, int stage)
9b6553cd	315	{
d41d219e	316	mutex_lock(&audio_pwr_lock);
9b6553cd TL	317	switch (stage) {
	318	case 1:
	319	if (audio_pwr_state == 0)
	320	audio_pwr_state = 1;
	321	break;
	322	case 2:
	323	if (audio_pwr_state == 1) {
	324	nokia770_audio_pwr_down();
	325	audio_pwr_state = -1;
	326	}
	327	break;
	328	}
d41d219e	329	mutex_unlock(&audio_pwr_lock);
a524626b TL	330	return 0;
	331	}
	332
	333	static struct dsp_kfunc_device nokia770_audio_device = {
	334	.name = "audio",
	335	.type = DSP_KFUNC_DEV_TYPE_AUDIO,
	336	.enable = nokia770_audio_pwr_up_request,
	337	.disable = nokia770_audio_pwr_down_request,
	338	};
	339
	340	static __init int omap_dsp_init(void)
	341	{
	342	int ret;
	343
	344	dspxor_ck = clk_get(0, "dspxor_ck");
	345	if (IS_ERR(dspxor_ck)) {
	346	printk(KERN_ERR "couldn't acquire dspxor_ck\n");
	347	return PTR_ERR(dspxor_ck);
	348	}
	349
	350	ret = dsp_kfunc_device_register(&nokia770_audio_device);
	351	if (ret) {
	352	printk(KERN_ERR
	353	"KFUNC device registration faild: %s\n",
	354	nokia770_audio_device.name);
	355	goto out;
	356	}
	357	return 0;
	358	out:
	359	return ret;
9b6553cd	360	}
f6f2a5db DW	361	#else
f6f2a5db DW	362	#define omap_dsp_init() do {} while (0)
a524626b	363	#endif /* CONFIG_OMAP_DSP */
9b6553cd TL	364
	365	static void __init omap_nokia770_init(void)
	366	{
9b6553cd TL	367	platform_add_devices(nokia770_devices, ARRAY_SIZE(nokia770_devices));
	368	spi_register_board_info(nokia770_spi_board_info,
	369	ARRAY_SIZE(nokia770_spi_board_info));
06767fb2	370	omap_gpio_init();
9b6553cd	371	omap_serial_init();
1ed16a86	372	omap_register_i2c_bus(1, 100, NULL, 0);
a524626b	373	omap_dsp_init();
06767fb2 ID	374	ads7846_dev_init();
06767fb2 ID	375	mipid_dev_init();
b0b5aa3f	376	omap_usb_init(&nokia770_usb_config);
d8874665	377	nokia770_mmc_init();
9b6553cd TL	378	}
	379
	380	static void __init omap_nokia770_map_io(void)
	381	{
	382	omap1_map_common_io();
	383	}
	384
	385	MACHINE_START(NOKIA770, "Nokia 770")
	386	.phys_io = 0xfff00000,
	387	.io_pg_offst = ((0xfef00000) >> 18) & 0xfffc,
	388	.boot_params = 0x10000100,
	389	.map_io = omap_nokia770_map_io,
	390	.init_irq = omap_nokia770_init_irq,
	391	.init_machine = omap_nokia770_init,
	392	.timer = &omap_timer,
	393	MACHINE_END