Merge branch 'core/debugobjects' of git://git.kernel.org/pub/scm/linux/kernel/git...
[linux-2.6] / drivers / mfd / ucb1400_core.c
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 <marek.vasut@gmail.com>
11  * If something doesnt work and it worked before spliting, e-mail me,
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>
24 #include <linux/ucb1400.h>
25
26 static int ucb1400_core_probe(struct device *dev)
27 {
28         int err;
29         struct ucb1400 *ucb;
30         struct ucb1400_ts ucb_ts;
31         struct snd_ac97 *ac97;
32
33         memset(&ucb_ts, 0, sizeof(ucb_ts));
34
35         ucb = kzalloc(sizeof(struct ucb1400), GFP_KERNEL);
36         if (!ucb) {
37                 err = -ENOMEM;
38                 goto err;
39         }
40
41         dev_set_drvdata(dev, ucb);
42
43         ac97 = to_ac97_t(dev);
44
45         ucb_ts.id = ucb1400_reg_read(ac97, UCB_ID);
46         if (ucb_ts.id != UCB_ID_1400) {
47                 err = -ENODEV;
48                 goto err0;
49         }
50
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;
57         }
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;
65
66         return 0;
67
68 err1:
69         platform_device_put(ucb->ucb1400_ts);
70 err0:
71         kfree(ucb);
72 err:
73         return err;
74 }
75
76 static int ucb1400_core_remove(struct device *dev)
77 {
78         struct ucb1400 *ucb = dev_get_drvdata(dev);
79
80         platform_device_unregister(ucb->ucb1400_ts);
81         kfree(ucb);
82         return 0;
83 }
84
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,
90 };
91
92 static int __init ucb1400_core_init(void)
93 {
94         return driver_register(&ucb1400_core_driver);
95 }
96
97 static void __exit ucb1400_core_exit(void)
98 {
99         driver_unregister(&ucb1400_core_driver);
100 }
101
102 module_init(ucb1400_core_init);
103 module_exit(ucb1400_core_exit);
104
105 MODULE_DESCRIPTION("Philips UCB1400 driver");
106 MODULE_LICENSE("GPL");