107 строки
2.3 KiB
C
107 строки
2.3 KiB
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 <marek.vasut@gmail.com>
|
||
|
|
* If something doesnt 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/ucb1400.h>
|
||
|
|
|
||
|
|
static int ucb1400_core_probe(struct device *dev)
|
||
|
|
{
|
||
|
|
int err;
|
||
|
|
struct ucb1400 *ucb;
|
||
|
|
struct ucb1400_ts ucb_ts;
|
||
|
|
struct snd_ac97 *ac97;
|
||
|
|
|
||
|
|
memset(&ucb_ts, 0, sizeof(ucb_ts));
|
||
|
|
|
||
|
|
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;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* TOUCHSCREEN */
|
||
|
|
ucb_ts.ac97 = ac97;
|
||
|
|
ucb->ucb1400_ts = platform_device_alloc("ucb1400_ts", -1);
|
||
|
|
if (!ucb->ucb1400_ts) {
|
||
|
|
err = -ENOMEM;
|
||
|
|
goto err0;
|
||
|
|
}
|
||
|
|
err = platform_device_add_data(ucb->ucb1400_ts, &ucb_ts,
|
||
|
|
sizeof(ucb_ts));
|
||
|
|
if (err)
|
||
|
|
goto err1;
|
||
|
|
err = platform_device_add(ucb->ucb1400_ts);
|
||
|
|
if (err)
|
||
|
|
goto err1;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
|
||
|
|
err1:
|
||
|
|
platform_device_put(ucb->ucb1400_ts);
|
||
|
|
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);
|
||
|
|
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");
|