[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/hwa742.h>
#include <mach/lcd_mipid.h>
#include <mach/mmc.h>
#include <mach/usb.h>
#include <mach/clock.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,
	},
};

static struct hwa742_platform_data nokia770_hwa742_platform_data = {
	.te_connected		= 1,
};

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