[linux.git] / drivers / mfd / ucb1400_core.c

/*
 * Core functions for:
 *  Philips UCB1400 multifunction chip
 *
 * Based on ucb1400_ts.c:
 *  Author:	Nicolas Pitre
 *  Created:	September 25, 2006
 *  Copyright:	MontaVista Software, Inc.
 *
 * Spliting done by: Marek Vasut <[email protected]>
 * If something doesn't work and it worked before spliting, e-mail me,
 * dont bother Nicolas please ;-)
 *
 * 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.
 *
 * This code is heavily based on ucb1x00-*.c copyrighted by Russell King
 * covering the UCB1100, UCB1200 and UCB1300..  Support for the UCB1400 has
 * been made separate from ucb1x00-core/ucb1x00-ts on Russell's request.
 */

#include <linux/module.h>
#include <linux/sched.h>
#include <linux/slab.h>
#include <linux/ucb1400.h>

unsigned int ucb1400_adc_read(struct snd_ac97 *ac97, u16 adc_channel,
		int adcsync)
{
	unsigned int val;

	if (adcsync)
		adc_channel |= UCB_ADC_SYNC_ENA;

	ucb1400_reg_write(ac97, UCB_ADC_CR, UCB_ADC_ENA | adc_channel);
	ucb1400_reg_write(ac97, UCB_ADC_CR, UCB_ADC_ENA | adc_channel |
			UCB_ADC_START);

	while (!((val = ucb1400_reg_read(ac97, UCB_ADC_DATA))
				& UCB_ADC_DAT_VALID))
		schedule_timeout_uninterruptible(1);

	return val & UCB_ADC_DAT_MASK;
}
EXPORT_SYMBOL_GPL(ucb1400_adc_read);

static int ucb1400_core_probe(struct device *dev)
{
	int err;
	struct ucb1400 *ucb;
	struct ucb1400_ts ucb_ts;
	struct ucb1400_gpio ucb_gpio;
	struct snd_ac97 *ac97;
	struct ucb1400_pdata *pdata = dev_get_platdata(dev);

	memset(&ucb_ts, 0, sizeof(ucb_ts));
	memset(&ucb_gpio, 0, sizeof(ucb_gpio));

	ucb = kzalloc(sizeof(struct ucb1400), GFP_KERNEL);
	if (!ucb) {
		err = -ENOMEM;
		goto err;
	}

	dev_set_drvdata(dev, ucb);

	ac97 = to_ac97_t(dev);

	ucb_ts.id = ucb1400_reg_read(ac97, UCB_ID);
	if (ucb_ts.id != UCB_ID_1400) {
		err = -ENODEV;
		goto err0;
	}

	/* GPIO */
	ucb_gpio.ac97 = ac97;
	if (pdata) {
		ucb_gpio.gpio_setup = pdata->gpio_setup;
		ucb_gpio.gpio_teardown = pdata->gpio_teardown;
		ucb_gpio.gpio_offset = pdata->gpio_offset;
	}
	ucb->ucb1400_gpio = platform_device_alloc("ucb1400_gpio", -1);
	if (!ucb->ucb1400_gpio) {
		err = -ENOMEM;
		goto err0;
	}
	err = platform_device_add_data(ucb->ucb1400_gpio, &ucb_gpio,
					sizeof(ucb_gpio));
	if (err)
		goto err1;
	err = platform_device_add(ucb->ucb1400_gpio);
	if (err)
		goto err1;

	/* TOUCHSCREEN */
	ucb_ts.ac97 = ac97;

	if (pdata != NULL && pdata->irq >= 0)
		ucb_ts.irq = pdata->irq;
	else
		ucb_ts.irq = -1;

	ucb->ucb1400_ts = platform_device_alloc("ucb1400_ts", -1);
	if (!ucb->ucb1400_ts) {
		err = -ENOMEM;
		goto err2;
	}
	err = platform_device_add_data(ucb->ucb1400_ts, &ucb_ts,
					sizeof(ucb_ts));
	if (err)
		goto err3;
	err = platform_device_add(ucb->ucb1400_ts);
	if (err)
		goto err3;

	return 0;

err3:
	platform_device_put(ucb->ucb1400_ts);
err2:
	platform_device_del(ucb->ucb1400_gpio);
err1:
	platform_device_put(ucb->ucb1400_gpio);
err0:
	kfree(ucb);
err:
	return err;
}

static int ucb1400_core_remove(struct device *dev)
{
	struct ucb1400 *ucb = dev_get_drvdata(dev);

	platform_device_unregister(ucb->ucb1400_ts);
	platform_device_unregister(ucb->ucb1400_gpio);

	kfree(ucb);
	return 0;
}

static struct device_driver ucb1400_core_driver = {
	.name	= "ucb1400_core",
	.bus	= &ac97_bus_type,
	.probe	= ucb1400_core_probe,
	.remove	= ucb1400_core_remove,
};

static int __init ucb1400_core_init(void)
{
	return driver_register(&ucb1400_core_driver);
}

static void __exit ucb1400_core_exit(void)
{
	driver_unregister(&ucb1400_core_driver);
}

module_init(ucb1400_core_init);
module_exit(ucb1400_core_exit);

MODULE_DESCRIPTION("Philips UCB1400 driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
d9105c2b MV	1	/*
	2	* Core functions for:
	3	* Philips UCB1400 multifunction chip
	4	*
	5	* Based on ucb1400_ts.c:
	6	* Author: Nicolas Pitre
	7	* Created: September 25, 2006
	8	* Copyright: MontaVista Software, Inc.
	9	*
	10	* Spliting done by: Marek Vasut <[email protected]>
25985edc	11	* If something doesn't work and it worked before spliting, e-mail me,
d9105c2b MV	12	* dont bother Nicolas please ;-)
	13	*
	14	* This program is free software; you can redistribute it and/or modify
	15	* it under the terms of the GNU General Public License version 2 as
	16	* published by the Free Software Foundation.
	17	*
	18	* This code is heavily based on ucb1x00-*.c copyrighted by Russell King
	19	* covering the UCB1100, UCB1200 and UCB1300.. Support for the UCB1400 has
	20	* been made separate from ucb1x00-core/ucb1x00-ts on Russell's request.
	21	*/
	22
	23	#include <linux/module.h>
a99bbaf5	24	#include <linux/sched.h>
5a0e3ad6	25	#include <linux/slab.h>
d9105c2b MV	26	#include <linux/ucb1400.h>
d9105c2b MV	27
cbf806dd SAS	28	unsigned int ucb1400_adc_read(struct snd_ac97 *ac97, u16 adc_channel,
	29	int adcsync)
	30	{
	31	unsigned int val;
	32
	33	if (adcsync)
	34	adc_channel \|= UCB_ADC_SYNC_ENA;
	35
	36	ucb1400_reg_write(ac97, UCB_ADC_CR, UCB_ADC_ENA \| adc_channel);
	37	ucb1400_reg_write(ac97, UCB_ADC_CR, UCB_ADC_ENA \| adc_channel \|
	38	UCB_ADC_START);
	39
	40	while (!((val = ucb1400_reg_read(ac97, UCB_ADC_DATA))
	41	& UCB_ADC_DAT_VALID))
	42	schedule_timeout_uninterruptible(1);
	43
	44	return val & UCB_ADC_DAT_MASK;
	45	}
	46	EXPORT_SYMBOL_GPL(ucb1400_adc_read);
	47
d9105c2b MV	48	static int ucb1400_core_probe(struct device *dev)
	49	{
	50	int err;
	51	struct ucb1400 *ucb;
	52	struct ucb1400_ts ucb_ts;
4cf8e53b	53	struct ucb1400_gpio ucb_gpio;
d9105c2b	54	struct snd_ac97 *ac97;
334a41ce	55	struct ucb1400_pdata *pdata = dev_get_platdata(dev);
d9105c2b MV	56
d9105c2b MV	57	memset(&ucb_ts, 0, sizeof(ucb_ts));
4cf8e53b	58	memset(&ucb_gpio, 0, sizeof(ucb_gpio));
d9105c2b MV	59
	60	ucb = kzalloc(sizeof(struct ucb1400), GFP_KERNEL);
	61	if (!ucb) {
	62	err = -ENOMEM;
	63	goto err;
	64	}
	65
	66	dev_set_drvdata(dev, ucb);
	67
	68	ac97 = to_ac97_t(dev);
	69
	70	ucb_ts.id = ucb1400_reg_read(ac97, UCB_ID);
	71	if (ucb_ts.id != UCB_ID_1400) {
	72	err = -ENODEV;
	73	goto err0;
	74	}
	75
4cf8e53b MV	76	/* GPIO */
4cf8e53b MV	77	ucb_gpio.ac97 = ac97;
360e64d8 MV	78	if (pdata) {
	79	ucb_gpio.gpio_setup = pdata->gpio_setup;
	80	ucb_gpio.gpio_teardown = pdata->gpio_teardown;
	81	ucb_gpio.gpio_offset = pdata->gpio_offset;
	82	}
4cf8e53b MV	83	ucb->ucb1400_gpio = platform_device_alloc("ucb1400_gpio", -1);
	84	if (!ucb->ucb1400_gpio) {
	85	err = -ENOMEM;
	86	goto err0;
	87	}
	88	err = platform_device_add_data(ucb->ucb1400_gpio, &ucb_gpio,
	89	sizeof(ucb_gpio));
	90	if (err)
	91	goto err1;
	92	err = platform_device_add(ucb->ucb1400_gpio);
	93	if (err)
	94	goto err1;
	95
d9105c2b MV	96	/* TOUCHSCREEN */
d9105c2b MV	97	ucb_ts.ac97 = ac97;
fb141597 MV	98
	99	if (pdata != NULL && pdata->irq >= 0)
	100	ucb_ts.irq = pdata->irq;
	101	else
	102	ucb_ts.irq = -1;
	103
d9105c2b MV	104	ucb->ucb1400_ts = platform_device_alloc("ucb1400_ts", -1);
	105	if (!ucb->ucb1400_ts) {
	106	err = -ENOMEM;
4cf8e53b	107	goto err2;
d9105c2b MV	108	}
	109	err = platform_device_add_data(ucb->ucb1400_ts, &ucb_ts,
	110	sizeof(ucb_ts));
	111	if (err)
4cf8e53b	112	goto err3;
d9105c2b MV	113	err = platform_device_add(ucb->ucb1400_ts);
d9105c2b MV	114	if (err)
4cf8e53b	115	goto err3;
d9105c2b MV	116
	117	return 0;
	118
4cf8e53b	119	err3:
d9105c2b	120	platform_device_put(ucb->ucb1400_ts);
4cf8e53b	121	err2:
ef256176	122	platform_device_del(ucb->ucb1400_gpio);
4cf8e53b MV	123	err1:
4cf8e53b MV	124	platform_device_put(ucb->ucb1400_gpio);
d9105c2b MV	125	err0:
	126	kfree(ucb);
	127	err:
	128	return err;
	129	}
	130
	131	static int ucb1400_core_remove(struct device *dev)
	132	{
	133	struct ucb1400 *ucb = dev_get_drvdata(dev);
	134
	135	platform_device_unregister(ucb->ucb1400_ts);
4cf8e53b MV	136	platform_device_unregister(ucb->ucb1400_gpio);
4cf8e53b MV	137
d9105c2b MV	138	kfree(ucb);
	139	return 0;
	140	}
	141
	142	static struct device_driver ucb1400_core_driver = {
	143	.name = "ucb1400_core",
	144	.bus = &ac97_bus_type,
	145	.probe = ucb1400_core_probe,
	146	.remove = ucb1400_core_remove,
	147	};
	148
	149	static int __init ucb1400_core_init(void)
	150	{
	151	return driver_register(&ucb1400_core_driver);
	152	}
	153
	154	static void __exit ucb1400_core_exit(void)
	155	{
	156	driver_unregister(&ucb1400_core_driver);
	157	}
	158
	159	module_init(ucb1400_core_init);
	160	module_exit(ucb1400_core_exit);
	161
	162	MODULE_DESCRIPTION("Philips UCB1400 driver");
	163	MODULE_LICENSE("GPL");