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/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");