drivers/mfd/tps65910.c

   1 /*
   2  * tps65910.c  --  TI TPS6591x
   3  *
   4  * Copyright 2010 Texas Instruments Inc.
   5  *
   6  * Author: Graeme Gregory <gg@slimlogic.co.uk>
   7  * Author: Jorge Eduardo Candelaria <jedu@slimlogic.co.uk>
   8  *
   9  *  This program is free software; you can redistribute it and/or modify it
  10  *  under  the terms of the GNU General  Public License as published by the
  11  *  Free Software Foundation;  either version 2 of the License, or (at your
  12  *  option) any later version.
  13  *
  14  */
  15
  16 #include <linux/module.h>
  17 #include <linux/moduleparam.h>
  18 #include <linux/init.h>
  19 #include <linux/slab.h>
  20 #include <linux/i2c.h>
  21 #include <linux/gpio.h>
  22 #include <linux/mfd/core.h>
  23 #include <linux/mfd/tps65910.h>
  24
  25 static struct mfd_cell tps65910s[] = {
  26         {
  27                 .name = "tps65910-pmic",
  28         },
  29         {
  30                 .name = "tps65910-rtc",
  31         },
  32         {
  33                 .name = "tps65910-power",
  34         },
  35 };
  36
  37
  38 static int tps65910_i2c_read(struct tps65910 *tps65910, u8 reg,
  39                                   int bytes, void *dest)
  40 {
  41         struct i2c_client *i2c = tps65910->i2c_client;
  42         struct i2c_msg xfer[2];
  43         int ret;
  44
  45         /* Write register */
  46         xfer[0].addr = i2c->addr;
  47         xfer[0].flags = 0;
  48         xfer[0].len = 1;
  49         xfer[0].buf = &reg;
  50
  51         /* Read data */
  52         xfer[1].addr = i2c->addr;
  53         xfer[1].flags = I2C_M_RD;
  54         xfer[1].len = bytes;
  55         xfer[1].buf = dest;
  56
  57         ret = i2c_transfer(i2c->adapter, xfer, 2);
  58         if (ret == 2)
  59                 ret = 0;
  60         else if (ret >= 0)
  61                 ret = -EIO;
  62
  63         return ret;
  64 }
  65
  66 static int tps65910_i2c_write(struct tps65910 *tps65910, u8 reg,
  67                                    int bytes, void *src)
  68 {
  69         struct i2c_client *i2c = tps65910->i2c_client;
  70         /* we add 1 byte for device register */
  71         u8 msg[TPS65910_MAX_REGISTER + 1];
  72         int ret;
  73
  74         if (bytes > TPS65910_MAX_REGISTER)
  75                 return -EINVAL;
  76
  77         msg[0] = reg;
  78         memcpy(&msg[1], src, bytes);
  79
  80         ret = i2c_master_send(i2c, msg, bytes + 1);
  81         if (ret < 0)
  82                 return ret;
  83         if (ret != bytes + 1)
  84                 return -EIO;
  85         return 0;
  86 }
  87
  88 int tps65910_set_bits(struct tps65910 *tps65910, u8 reg, u8 mask)
  89 {
  90         u8 data;
  91         int err;
  92
  93         mutex_lock(&tps65910->io_mutex);
  94         err = tps65910_i2c_read(tps65910, reg, 1, &data);
  95         if (err) {
  96                 dev_err(tps65910->dev, "read from reg %x failed\n", reg);
  97                 goto out;
  98         }
  99
 100         data |= mask;
 101         err = tps65910_i2c_write(tps65910, reg, 1, &data);
 102         if (err)
 103                 dev_err(tps65910->dev, "write to reg %x failed\n", reg);
 104
 105 out:
 106         mutex_unlock(&tps65910->io_mutex);
 107         return err;
 108 }
 109 EXPORT_SYMBOL_GPL(tps65910_set_bits);
 110
 111 int tps65910_clear_bits(struct tps65910 *tps65910, u8 reg, u8 mask)
 112 {
 113         u8 data;
 114         int err;
 115
 116         mutex_lock(&tps65910->io_mutex);
 117         err = tps65910_i2c_read(tps65910, reg, 1, &data);
 118         if (err) {
 119                 dev_err(tps65910->dev, "read from reg %x failed\n", reg);
 120                 goto out;
 121         }
 122
 123         data &= mask;
 124         err = tps65910_i2c_write(tps65910, reg, 1, &data);
 125         if (err)
 126                 dev_err(tps65910->dev, "write to reg %x failed\n", reg);
 127
 128 out:
 129         mutex_unlock(&tps65910->io_mutex);
 130         return err;
 131 }
 132 EXPORT_SYMBOL_GPL(tps65910_clear_bits);
 133
 134 static int tps65910_i2c_probe(struct i2c_client *i2c,
 135                             const struct i2c_device_id *id)
 136 {
 137         struct tps65910 *tps65910;
 138         struct tps65910_board *pmic_plat_data;
 139         struct tps65910_platform_data *init_data;
 140         int ret = 0;
 141
 142         pmic_plat_data = dev_get_platdata(&i2c->dev);
 143         if (!pmic_plat_data)
 144                 return -EINVAL;
 145
 146         init_data = kzalloc(sizeof(struct tps65910_platform_data), GFP_KERNEL);
 147         if (init_data == NULL)
 148                 return -ENOMEM;
 149
 150         init_data->irq = pmic_plat_data->irq;
 151         init_data->irq_base = pmic_plat_data->irq;
 152
 153         tps65910 = kzalloc(sizeof(struct tps65910), GFP_KERNEL);
 154         if (tps65910 == NULL)
 155                 return -ENOMEM;
 156
 157         i2c_set_clientdata(i2c, tps65910);
 158         tps65910->dev = &i2c->dev;
 159         tps65910->i2c_client = i2c;
 160         tps65910->id = id->driver_data;
 161         tps65910->read = tps65910_i2c_read;
 162         tps65910->write = tps65910_i2c_write;
 163         mutex_init(&tps65910->io_mutex);
 164
 165         ret = mfd_add_devices(tps65910->dev, -1,
 166                               tps65910s, ARRAY_SIZE(tps65910s),
 167                               NULL, 0);
 168         if (ret < 0)
 169                 goto err;
 170
 171         tps65910_gpio_init(tps65910, pmic_plat_data->gpio_base);
 172
 173         ret = tps65910_irq_init(tps65910, init_data->irq, init_data);
 174         if (ret < 0)
 175                 goto err;
 176
 177         return ret;
 178
 179 err:
 180         mfd_remove_devices(tps65910->dev);
 181         kfree(tps65910);
 182         return ret;
 183 }
 184
 185 static int tps65910_i2c_remove(struct i2c_client *i2c)
 186 {
 187         struct tps65910 *tps65910 = i2c_get_clientdata(i2c);
 188
 189         mfd_remove_devices(tps65910->dev);
 190         kfree(tps65910);
 191
 192         return 0;
 193 }
 194
 195 static const struct i2c_device_id tps65910_i2c_id[] = {
 196        { "tps65910", TPS65910 },
 197        { "tps65911", TPS65911 },
 198        { }
 199 };
 200 MODULE_DEVICE_TABLE(i2c, tps65910_i2c_id);
 201
 202
 203 static struct i2c_driver tps65910_i2c_driver = {
 204         .driver = {
 205                    .name = "tps65910",
 206                    .owner = THIS_MODULE,
 207         },
 208         .probe = tps65910_i2c_probe,
 209         .remove = tps65910_i2c_remove,
 210         .id_table = tps65910_i2c_id,
 211 };
 212
 213 static int __init tps65910_i2c_init(void)
 214 {
 215         return i2c_add_driver(&tps65910_i2c_driver);
 216 }
 217 /* init early so consumer devices can complete system boot */
 218 subsys_initcall(tps65910_i2c_init);
 219
 220 static void __exit tps65910_i2c_exit(void)
 221 {
 222         i2c_del_driver(&tps65910_i2c_driver);
 223 }
 224 module_exit(tps65910_i2c_exit);
 225
 226 MODULE_AUTHOR("Graeme Gregory <gg@slimlogic.co.uk>");
 227 MODULE_AUTHOR("Jorge Eduardo Candelaria <jedu@slimlogic.co.uk>");
 228 MODULE_DESCRIPTION("TPS6591x chip family multi-function driver");
 229 MODULE_LICENSE("GPL");