qeth: avoid skb_under_panic for malformatted inbound data
[linux-2.6/mini2440.git] / drivers / mfd / ucb1400_core.c
blob178159e264ce8f69e523ee4d0d35e2150c4cd455
1 /*
2 * Core functions for:
3 * Philips UCB1400 multifunction chip
5 * Based on ucb1400_ts.c:
6 * Author: Nicolas Pitre
7 * Created: September 25, 2006
8 * Copyright: MontaVista Software, Inc.
10 * Spliting done by: Marek Vasut <marek.vasut@gmail.com>
11 * If something doesnt work and it worked before spliting, e-mail me,
12 * dont bother Nicolas please ;-)
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.
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.
23 #include <linux/module.h>
24 #include <linux/ucb1400.h>
26 static int ucb1400_core_probe(struct device *dev)
28 int err;
29 struct ucb1400 *ucb;
30 struct ucb1400_ts ucb_ts;
31 struct snd_ac97 *ac97;
33 memset(&ucb_ts, 0, sizeof(ucb_ts));
35 ucb = kzalloc(sizeof(struct ucb1400), GFP_KERNEL);
36 if (!ucb) {
37 err = -ENOMEM;
38 goto err;
41 dev_set_drvdata(dev, ucb);
43 ac97 = to_ac97_t(dev);
45 ucb_ts.id = ucb1400_reg_read(ac97, UCB_ID);
46 if (ucb_ts.id != UCB_ID_1400) {
47 err = -ENODEV;
48 goto err0;
51 /* TOUCHSCREEN */
52 ucb_ts.ac97 = ac97;
53 ucb->ucb1400_ts = platform_device_alloc("ucb1400_ts", -1);
54 if (!ucb->ucb1400_ts) {
55 err = -ENOMEM;
56 goto err0;
58 err = platform_device_add_data(ucb->ucb1400_ts, &ucb_ts,
59 sizeof(ucb_ts));
60 if (err)
61 goto err1;
62 err = platform_device_add(ucb->ucb1400_ts);
63 if (err)
64 goto err1;
66 return 0;
68 err1:
69 platform_device_put(ucb->ucb1400_ts);
70 err0:
71 kfree(ucb);
72 err:
73 return err;
76 static int ucb1400_core_remove(struct device *dev)
78 struct ucb1400 *ucb = dev_get_drvdata(dev);
80 platform_device_unregister(ucb->ucb1400_ts);
81 kfree(ucb);
82 return 0;
85 static struct device_driver ucb1400_core_driver = {
86 .name = "ucb1400_core",
87 .bus = &ac97_bus_type,
88 .probe = ucb1400_core_probe,
89 .remove = ucb1400_core_remove,
92 static int __init ucb1400_core_init(void)
94 return driver_register(&ucb1400_core_driver);
97 static void __exit ucb1400_core_exit(void)
99 driver_unregister(&ucb1400_core_driver);
102 module_init(ucb1400_core_init);
103 module_exit(ucb1400_core_exit);
105 MODULE_DESCRIPTION("Philips UCB1400 driver");
106 MODULE_LICENSE("GPL");