| Marek VaĊĦut | d9105c2 | 2008-08-03 21:34:08 +0100 | [diff] [blame] | 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"); |