[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>

#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)
{
	if (power_on)
		gpio_set_value(NOKIA770_GPIO_MMC_POWER, 1);
	else
		gpio_set_value(NOKIA770_GPIO_MMC_POWER, 0);

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