SAFE public projects git trees. - safe/jmp/linux-2.6/blob - 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/sched.h>
  25 #include <linux/ucb1400.h>
  26
  27 unsigned 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 }
  45 EXPORT_SYMBOL_GPL(ucb1400_adc_read);
  46
  47 static 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         struct ucb1400_pdata *pdata = dev->platform_data;
  55
  56         memset(&ucb_ts, 0, sizeof(ucb_ts));
  57         memset(&ucb_gpio, 0, sizeof(ucb_gpio));
  58
  59         ucb = kzalloc(sizeof(struct ucb1400), GFP_KERNEL);
  60         if (!ucb) {
  61                 err = -ENOMEM;
  62                 goto err;
  63         }
  64
  65         dev_set_drvdata(dev, ucb);
  66
  67         ac97 = to_ac97_t(dev);
  68
  69         ucb_ts.id = ucb1400_reg_read(ac97, UCB_ID);
  70         if (ucb_ts.id != UCB_ID_1400) {
  71                 err = -ENODEV;
  72                 goto err0;
  73         }
  74
  75         /* GPIO */
  76         ucb_gpio.ac97 = ac97;
  77         ucb->ucb1400_gpio = platform_device_alloc("ucb1400_gpio", -1);
  78         if (!ucb->ucb1400_gpio) {
  79                 err = -ENOMEM;
  80                 goto err0;
  81         }
  82         err = platform_device_add_data(ucb->ucb1400_gpio, &ucb_gpio,
  83                                         sizeof(ucb_gpio));
  84         if (err)
  85                 goto err1;
  86         err = platform_device_add(ucb->ucb1400_gpio);
  87         if (err)
  88                 goto err1;
  89
  90         /* TOUCHSCREEN */
  91         ucb_ts.ac97 = ac97;
  92
  93         if (pdata != NULL && pdata->irq >= 0)
  94                 ucb_ts.irq = pdata->irq;
  95         else
  96                 ucb_ts.irq = -1;
  97
  98         ucb->ucb1400_ts = platform_device_alloc("ucb1400_ts", -1);
  99         if (!ucb->ucb1400_ts) {
 100                 err = -ENOMEM;
 101                 goto err2;
 102         }
 103         err = platform_device_add_data(ucb->ucb1400_ts, &ucb_ts,
 104                                         sizeof(ucb_ts));
 105         if (err)
 106                 goto err3;
 107         err = platform_device_add(ucb->ucb1400_ts);
 108         if (err)
 109                 goto err3;
 110
 111         return 0;
 112
 113 err3:
 114         platform_device_put(ucb->ucb1400_ts);
 115 err2:
 116         platform_device_unregister(ucb->ucb1400_gpio);
 117 err1:
 118         platform_device_put(ucb->ucb1400_gpio);
 119 err0:
 120         kfree(ucb);
 121 err:
 122         return err;
 123 }
 124
 125 static int ucb1400_core_remove(struct device *dev)
 126 {
 127         struct ucb1400 *ucb = dev_get_drvdata(dev);
 128
 129         platform_device_unregister(ucb->ucb1400_ts);
 130         platform_device_unregister(ucb->ucb1400_gpio);
 131
 132         kfree(ucb);
 133         return 0;
 134 }
 135
 136 static struct device_driver ucb1400_core_driver = {
 137         .name   = "ucb1400_core",
 138         .bus    = &ac97_bus_type,
 139         .probe  = ucb1400_core_probe,
 140         .remove = ucb1400_core_remove,
 141 };
 142
 143 static int __init ucb1400_core_init(void)
 144 {
 145         return driver_register(&ucb1400_core_driver);
 146 }
 147
 148 static void __exit ucb1400_core_exit(void)
 149 {
 150         driver_unregister(&ucb1400_core_driver);
 151 }
 152
 153 module_init(ucb1400_core_init);
 154 module_exit(ucb1400_core_exit);
 155
 156 MODULE_DESCRIPTION("Philips UCB1400 driver");
 157 MODULE_LICENSE("GPL");