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