]>
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 <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"); |