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 | |
Sebastian Andrzej Siewior | cbf806d | 2009-05-27 06:22:58 -0700 | [diff] [blame] | 26 | unsigned int ucb1400_adc_read(struct snd_ac97 *ac97, u16 adc_channel, |
| 27 | int adcsync) |
| 28 | { |
| 29 | unsigned int val; |
| 30 | |
| 31 | if (adcsync) |
| 32 | adc_channel |= UCB_ADC_SYNC_ENA; |
| 33 | |
| 34 | ucb1400_reg_write(ac97, UCB_ADC_CR, UCB_ADC_ENA | adc_channel); |
| 35 | ucb1400_reg_write(ac97, UCB_ADC_CR, UCB_ADC_ENA | adc_channel | |
| 36 | UCB_ADC_START); |
| 37 | |
| 38 | while (!((val = ucb1400_reg_read(ac97, UCB_ADC_DATA)) |
| 39 | & UCB_ADC_DAT_VALID)) |
| 40 | schedule_timeout_uninterruptible(1); |
| 41 | |
| 42 | return val & UCB_ADC_DAT_MASK; |
| 43 | } |
| 44 | EXPORT_SYMBOL_GPL(ucb1400_adc_read); |
| 45 | |
Marek Vašut | d9105c2 | 2008-08-03 21:34:08 +0100 | [diff] [blame] | 46 | static int ucb1400_core_probe(struct device *dev) |
| 47 | { |
| 48 | int err; |
| 49 | struct ucb1400 *ucb; |
| 50 | struct ucb1400_ts ucb_ts; |
Marek Vasut | 4cf8e53 | 2009-09-22 16:46:35 -0700 | [diff] [blame] | 51 | struct ucb1400_gpio ucb_gpio; |
Marek Vašut | d9105c2 | 2008-08-03 21:34:08 +0100 | [diff] [blame] | 52 | struct snd_ac97 *ac97; |
| 53 | |
| 54 | memset(&ucb_ts, 0, sizeof(ucb_ts)); |
Marek Vasut | 4cf8e53 | 2009-09-22 16:46:35 -0700 | [diff] [blame] | 55 | memset(&ucb_gpio, 0, sizeof(ucb_gpio)); |
Marek Vašut | d9105c2 | 2008-08-03 21:34:08 +0100 | [diff] [blame] | 56 | |
| 57 | ucb = kzalloc(sizeof(struct ucb1400), GFP_KERNEL); |
| 58 | if (!ucb) { |
| 59 | err = -ENOMEM; |
| 60 | goto err; |
| 61 | } |
| 62 | |
| 63 | dev_set_drvdata(dev, ucb); |
| 64 | |
| 65 | ac97 = to_ac97_t(dev); |
| 66 | |
| 67 | ucb_ts.id = ucb1400_reg_read(ac97, UCB_ID); |
| 68 | if (ucb_ts.id != UCB_ID_1400) { |
| 69 | err = -ENODEV; |
| 70 | goto err0; |
| 71 | } |
| 72 | |
Marek Vasut | 4cf8e53 | 2009-09-22 16:46:35 -0700 | [diff] [blame] | 73 | /* GPIO */ |
| 74 | ucb_gpio.ac97 = ac97; |
| 75 | ucb->ucb1400_gpio = platform_device_alloc("ucb1400_gpio", -1); |
| 76 | if (!ucb->ucb1400_gpio) { |
| 77 | err = -ENOMEM; |
| 78 | goto err0; |
| 79 | } |
| 80 | err = platform_device_add_data(ucb->ucb1400_gpio, &ucb_gpio, |
| 81 | sizeof(ucb_gpio)); |
| 82 | if (err) |
| 83 | goto err1; |
| 84 | err = platform_device_add(ucb->ucb1400_gpio); |
| 85 | if (err) |
| 86 | goto err1; |
| 87 | |
Marek Vašut | d9105c2 | 2008-08-03 21:34:08 +0100 | [diff] [blame] | 88 | /* TOUCHSCREEN */ |
| 89 | ucb_ts.ac97 = ac97; |
| 90 | ucb->ucb1400_ts = platform_device_alloc("ucb1400_ts", -1); |
| 91 | if (!ucb->ucb1400_ts) { |
| 92 | err = -ENOMEM; |
Marek Vasut | 4cf8e53 | 2009-09-22 16:46:35 -0700 | [diff] [blame] | 93 | goto err2; |
Marek Vašut | d9105c2 | 2008-08-03 21:34:08 +0100 | [diff] [blame] | 94 | } |
| 95 | err = platform_device_add_data(ucb->ucb1400_ts, &ucb_ts, |
| 96 | sizeof(ucb_ts)); |
| 97 | if (err) |
Marek Vasut | 4cf8e53 | 2009-09-22 16:46:35 -0700 | [diff] [blame] | 98 | goto err3; |
Marek Vašut | d9105c2 | 2008-08-03 21:34:08 +0100 | [diff] [blame] | 99 | err = platform_device_add(ucb->ucb1400_ts); |
| 100 | if (err) |
Marek Vasut | 4cf8e53 | 2009-09-22 16:46:35 -0700 | [diff] [blame] | 101 | goto err3; |
Marek Vašut | d9105c2 | 2008-08-03 21:34:08 +0100 | [diff] [blame] | 102 | |
| 103 | return 0; |
| 104 | |
Marek Vasut | 4cf8e53 | 2009-09-22 16:46:35 -0700 | [diff] [blame] | 105 | err3: |
Marek Vašut | d9105c2 | 2008-08-03 21:34:08 +0100 | [diff] [blame] | 106 | platform_device_put(ucb->ucb1400_ts); |
Marek Vasut | 4cf8e53 | 2009-09-22 16:46:35 -0700 | [diff] [blame] | 107 | err2: |
| 108 | platform_device_unregister(ucb->ucb1400_gpio); |
| 109 | err1: |
| 110 | platform_device_put(ucb->ucb1400_gpio); |
Marek Vašut | d9105c2 | 2008-08-03 21:34:08 +0100 | [diff] [blame] | 111 | err0: |
| 112 | kfree(ucb); |
| 113 | err: |
| 114 | return err; |
| 115 | } |
| 116 | |
| 117 | static int ucb1400_core_remove(struct device *dev) |
| 118 | { |
| 119 | struct ucb1400 *ucb = dev_get_drvdata(dev); |
| 120 | |
| 121 | platform_device_unregister(ucb->ucb1400_ts); |
Marek Vasut | 4cf8e53 | 2009-09-22 16:46:35 -0700 | [diff] [blame] | 122 | platform_device_unregister(ucb->ucb1400_gpio); |
| 123 | |
Marek Vašut | d9105c2 | 2008-08-03 21:34:08 +0100 | [diff] [blame] | 124 | kfree(ucb); |
| 125 | return 0; |
| 126 | } |
| 127 | |
| 128 | static struct device_driver ucb1400_core_driver = { |
| 129 | .name = "ucb1400_core", |
| 130 | .bus = &ac97_bus_type, |
| 131 | .probe = ucb1400_core_probe, |
| 132 | .remove = ucb1400_core_remove, |
| 133 | }; |
| 134 | |
| 135 | static int __init ucb1400_core_init(void) |
| 136 | { |
| 137 | return driver_register(&ucb1400_core_driver); |
| 138 | } |
| 139 | |
| 140 | static void __exit ucb1400_core_exit(void) |
| 141 | { |
| 142 | driver_unregister(&ucb1400_core_driver); |
| 143 | } |
| 144 | |
| 145 | module_init(ucb1400_core_init); |
| 146 | module_exit(ucb1400_core_exit); |
| 147 | |
| 148 | MODULE_DESCRIPTION("Philips UCB1400 driver"); |
| 149 | MODULE_LICENSE("GPL"); |