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/ucb1400.h>
  25
  26static 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
  68err1:
  69        platform_device_put(ucb->ucb1400_ts);
  70err0:
  71        kfree(ucb);
  72err:
  73        return err;
  74}
  75
  76static 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
  85static 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
  92static int __init ucb1400_core_init(void)
  93{
  94        return driver_register(&ucb1400_core_driver);
  95}
  96
  97static void __exit ucb1400_core_exit(void)
  98{
  99        driver_unregister(&ucb1400_core_driver);
 100}
 101
 102module_init(ucb1400_core_init);
 103module_exit(ucb1400_core_exit);
 104
 105MODULE_DESCRIPTION("Philips UCB1400 driver");
 106MODULE_LICENSE("GPL");
 107