LXR linux/drivers/mfd/ucb1400

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