drivers/mfd/tps65912-core.c

   1 /*
   2  * tps65912-core.c  --  TI TPS65912x
   3  *
   4  * Copyright 2011 Texas Instruments Inc.
   5  *
   6  * Author: Margarita Olaya Cabrera <magi@slimlogic.co.uk>
   7  *
   8  *  This program is free software; you can redistribute it and/or modify it
   9  *  under  the terms of the GNU General  Public License as published by the
  10  *  Free Software Foundation;  either version 2 of the License, or (at your
  11  *  option) any later version.
  12  *
  13  *  This driver is based on wm8350 implementation.
  14  */
  15
  16 #include <linux/module.h>
  17 #include <linux/moduleparam.h>
  18 #include <linux/slab.h>
  19 #include <linux/gpio.h>
  20 #include <linux/mfd/core.h>
  21 #include <linux/mfd/tps65912.h>
  22
  23 static const struct mfd_cell tps65912s[] = {
  24         {
  25                 .name = "tps65912-pmic",
  26         },
  27 };
  28
  29 int tps65912_set_bits(struct tps65912 *tps65912, u8 reg, u8 mask)
  30 {
  31         u8 data;
  32         int err;
  33
  34         mutex_lock(&tps65912->io_mutex);
  35
  36         err = tps65912->read(tps65912, reg, 1, &data);
  37         if (err) {
  38                 dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg);
  39                 goto out;
  40         }
  41
  42         data |= mask;
  43         err = tps65912->write(tps65912, reg, 1, &data);
  44         if (err)
  45                 dev_err(tps65912->dev, "Write to reg 0x%x failed\n", reg);
  46
  47 out:
  48         mutex_unlock(&tps65912->io_mutex);
  49         return err;
  50 }
  51 EXPORT_SYMBOL_GPL(tps65912_set_bits);
  52
  53 int tps65912_clear_bits(struct tps65912 *tps65912, u8 reg, u8 mask)
  54 {
  55         u8 data;
  56         int err;
  57
  58         mutex_lock(&tps65912->io_mutex);
  59         err = tps65912->read(tps65912, reg, 1, &data);
  60         if (err) {
  61                 dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg);
  62                 goto out;
  63         }
  64
  65         data &= ~mask;
  66         err = tps65912->write(tps65912, reg, 1, &data);
  67         if (err)
  68                 dev_err(tps65912->dev, "Write to reg 0x%x failed\n", reg);
  69
  70 out:
  71         mutex_unlock(&tps65912->io_mutex);
  72         return err;
  73 }
  74 EXPORT_SYMBOL_GPL(tps65912_clear_bits);
  75
  76 static inline int tps65912_read(struct tps65912 *tps65912, u8 reg)
  77 {
  78         u8 val;
  79         int err;
  80
  81         err = tps65912->read(tps65912, reg, 1, &val);
  82         if (err < 0)
  83                 return err;
  84
  85         return val;
  86 }
  87
  88 static inline int tps65912_write(struct tps65912 *tps65912, u8 reg, u8 val)
  89 {
  90         return tps65912->write(tps65912, reg, 1, &val);
  91 }
  92
  93 int tps65912_reg_read(struct tps65912 *tps65912, u8 reg)
  94 {
  95         int data;
  96
  97         mutex_lock(&tps65912->io_mutex);
  98
  99         data = tps65912_read(tps65912, reg);
 100         if (data < 0)
 101                 dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg);
 102
 103         mutex_unlock(&tps65912->io_mutex);
 104         return data;
 105 }
 106 EXPORT_SYMBOL_GPL(tps65912_reg_read);
 107
 108 int tps65912_reg_write(struct tps65912 *tps65912, u8 reg, u8 val)
 109 {
 110         int err;
 111
 112         mutex_lock(&tps65912->io_mutex);
 113
 114         err = tps65912_write(tps65912, reg, val);
 115         if (err < 0)
 116                 dev_err(tps65912->dev, "Write for reg 0x%x failed\n", reg);
 117
 118         mutex_unlock(&tps65912->io_mutex);
 119         return err;
 120 }
 121 EXPORT_SYMBOL_GPL(tps65912_reg_write);
 122
 123 int tps65912_device_init(struct tps65912 *tps65912)
 124 {
 125         struct tps65912_board *pmic_plat_data = dev_get_platdata(tps65912->dev);
 126         struct tps65912_platform_data *init_data;
 127         int ret, dcdc_avs, value;
 128
 129         init_data = kzalloc(sizeof(struct tps65912_platform_data), GFP_KERNEL);
 130         if (init_data == NULL)
 131                 return -ENOMEM;
 132
 133         mutex_init(&tps65912->io_mutex);
 134         dev_set_drvdata(tps65912->dev, tps65912);
 135
 136         dcdc_avs = (pmic_plat_data->is_dcdc1_avs << 0 |
 137                         pmic_plat_data->is_dcdc2_avs  << 1 |
 138                                 pmic_plat_data->is_dcdc3_avs << 2 |
 139                                         pmic_plat_data->is_dcdc4_avs << 3);
 140         if (dcdc_avs) {
 141                 tps65912->read(tps65912, TPS65912_I2C_SPI_CFG, 1, &value);
 142                 dcdc_avs |= value;
 143                 tps65912->write(tps65912, TPS65912_I2C_SPI_CFG, 1, &dcdc_avs);
 144         }
 145
 146         ret = mfd_add_devices(tps65912->dev, -1,
 147                               tps65912s, ARRAY_SIZE(tps65912s),
 148                               NULL, 0, NULL);
 149         if (ret < 0)
 150                 goto err;
 151
 152         init_data->irq = pmic_plat_data->irq;
 153         init_data->irq_base = pmic_plat_data->irq_base;
 154         ret = tps65912_irq_init(tps65912, init_data->irq, init_data);
 155         if (ret < 0)
 156                 goto err;
 157
 158         kfree(init_data);
 159         return ret;
 160
 161 err:
 162         kfree(init_data);
 163         mfd_remove_devices(tps65912->dev);
 164         return ret;
 165 }
 166
 167 void tps65912_device_exit(struct tps65912 *tps65912)
 168 {
 169         mfd_remove_devices(tps65912->dev);
 170         tps65912_irq_exit(tps65912);
 171 }
 172
 173 MODULE_AUTHOR("Margarita Olaya  <magi@slimlogic.co.uk>");
 174 MODULE_DESCRIPTION("TPS65912x chip family multi-function driver");
 175 MODULE_LICENSE("GPL");