Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 1 | /* |
| 2 | * tps6507x-regulator.c |
| 3 | * |
| 4 | * Regulator driver for TPS65073 PMIC |
| 5 | * |
| 6 | * Copyright (C) 2009 Texas Instrument Incorporated - http://www.ti.com/ |
| 7 | * |
| 8 | * This program is free software; you can redistribute it and/or |
| 9 | * modify it under the terms of the GNU General Public License as |
| 10 | * published by the Free Software Foundation version 2. |
| 11 | * |
| 12 | * This program is distributed "as is" WITHOUT ANY WARRANTY of any kind, |
| 13 | * whether express or implied; without even the implied warranty of |
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 15 | * General Public License for more details. |
| 16 | */ |
| 17 | |
| 18 | #include <linux/kernel.h> |
| 19 | #include <linux/module.h> |
| 20 | #include <linux/init.h> |
| 21 | #include <linux/err.h> |
| 22 | #include <linux/platform_device.h> |
| 23 | #include <linux/regulator/driver.h> |
| 24 | #include <linux/regulator/machine.h> |
Anuj Aggarwal | 7d14831 | 2010-07-12 17:54:06 +0530 | [diff] [blame] | 25 | #include <linux/regulator/tps6507x.h> |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 26 | #include <linux/delay.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 27 | #include <linux/slab.h> |
Todd Fischer | d183fcc | 2010-04-05 20:23:56 -0600 | [diff] [blame] | 28 | #include <linux/mfd/tps6507x.h> |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 29 | |
| 30 | /* DCDC's */ |
| 31 | #define TPS6507X_DCDC_1 0 |
| 32 | #define TPS6507X_DCDC_2 1 |
| 33 | #define TPS6507X_DCDC_3 2 |
| 34 | /* LDOs */ |
| 35 | #define TPS6507X_LDO_1 3 |
| 36 | #define TPS6507X_LDO_2 4 |
| 37 | |
| 38 | #define TPS6507X_MAX_REG_ID TPS6507X_LDO_2 |
| 39 | |
| 40 | /* Number of step-down converters available */ |
| 41 | #define TPS6507X_NUM_DCDC 3 |
| 42 | /* Number of LDO voltage regulators available */ |
| 43 | #define TPS6507X_NUM_LDO 2 |
| 44 | /* Number of total regulators available */ |
| 45 | #define TPS6507X_NUM_REGULATOR (TPS6507X_NUM_DCDC + TPS6507X_NUM_LDO) |
| 46 | |
| 47 | /* Supported voltage values for regulators (in milliVolts) */ |
| 48 | static const u16 VDCDCx_VSEL_table[] = { |
| 49 | 725, 750, 775, 800, |
| 50 | 825, 850, 875, 900, |
| 51 | 925, 950, 975, 1000, |
| 52 | 1025, 1050, 1075, 1100, |
| 53 | 1125, 1150, 1175, 1200, |
| 54 | 1225, 1250, 1275, 1300, |
| 55 | 1325, 1350, 1375, 1400, |
| 56 | 1425, 1450, 1475, 1500, |
| 57 | 1550, 1600, 1650, 1700, |
| 58 | 1750, 1800, 1850, 1900, |
| 59 | 1950, 2000, 2050, 2100, |
| 60 | 2150, 2200, 2250, 2300, |
| 61 | 2350, 2400, 2450, 2500, |
| 62 | 2550, 2600, 2650, 2700, |
| 63 | 2750, 2800, 2850, 2900, |
| 64 | 3000, 3100, 3200, 3300, |
| 65 | }; |
| 66 | |
| 67 | static const u16 LDO1_VSEL_table[] = { |
| 68 | 1000, 1100, 1200, 1250, |
| 69 | 1300, 1350, 1400, 1500, |
| 70 | 1600, 1800, 2500, 2750, |
| 71 | 2800, 3000, 3100, 3300, |
| 72 | }; |
| 73 | |
| 74 | static const u16 LDO2_VSEL_table[] = { |
| 75 | 725, 750, 775, 800, |
| 76 | 825, 850, 875, 900, |
| 77 | 925, 950, 975, 1000, |
| 78 | 1025, 1050, 1075, 1100, |
| 79 | 1125, 1150, 1175, 1200, |
| 80 | 1225, 1250, 1275, 1300, |
| 81 | 1325, 1350, 1375, 1400, |
| 82 | 1425, 1450, 1475, 1500, |
| 83 | 1550, 1600, 1650, 1700, |
| 84 | 1750, 1800, 1850, 1900, |
| 85 | 1950, 2000, 2050, 2100, |
| 86 | 2150, 2200, 2250, 2300, |
| 87 | 2350, 2400, 2450, 2500, |
| 88 | 2550, 2600, 2650, 2700, |
| 89 | 2750, 2800, 2850, 2900, |
| 90 | 3000, 3100, 3200, 3300, |
| 91 | }; |
| 92 | |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 93 | struct tps_info { |
| 94 | const char *name; |
| 95 | unsigned min_uV; |
| 96 | unsigned max_uV; |
| 97 | u8 table_len; |
| 98 | const u16 *table; |
Anuj Aggarwal | 7d14831 | 2010-07-12 17:54:06 +0530 | [diff] [blame] | 99 | |
| 100 | /* Does DCDC high or the low register defines output voltage? */ |
| 101 | bool defdcdc_default; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 102 | }; |
| 103 | |
Anuj Aggarwal | 7d14831 | 2010-07-12 17:54:06 +0530 | [diff] [blame] | 104 | static struct tps_info tps6507x_pmic_regs[] = { |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 105 | { |
| 106 | .name = "VDCDC1", |
| 107 | .min_uV = 725000, |
| 108 | .max_uV = 3300000, |
| 109 | .table_len = ARRAY_SIZE(VDCDCx_VSEL_table), |
| 110 | .table = VDCDCx_VSEL_table, |
| 111 | }, |
| 112 | { |
| 113 | .name = "VDCDC2", |
| 114 | .min_uV = 725000, |
| 115 | .max_uV = 3300000, |
| 116 | .table_len = ARRAY_SIZE(VDCDCx_VSEL_table), |
| 117 | .table = VDCDCx_VSEL_table, |
| 118 | }, |
| 119 | { |
| 120 | .name = "VDCDC3", |
| 121 | .min_uV = 725000, |
| 122 | .max_uV = 3300000, |
| 123 | .table_len = ARRAY_SIZE(VDCDCx_VSEL_table), |
| 124 | .table = VDCDCx_VSEL_table, |
| 125 | }, |
| 126 | { |
| 127 | .name = "LDO1", |
| 128 | .min_uV = 1000000, |
| 129 | .max_uV = 3300000, |
| 130 | .table_len = ARRAY_SIZE(LDO1_VSEL_table), |
| 131 | .table = LDO1_VSEL_table, |
| 132 | }, |
| 133 | { |
| 134 | .name = "LDO2", |
| 135 | .min_uV = 725000, |
| 136 | .max_uV = 3300000, |
| 137 | .table_len = ARRAY_SIZE(LDO2_VSEL_table), |
| 138 | .table = LDO2_VSEL_table, |
| 139 | }, |
| 140 | }; |
| 141 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 142 | struct tps6507x_pmic { |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 143 | struct regulator_desc desc[TPS6507X_NUM_REGULATOR]; |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 144 | struct tps6507x_dev *mfd; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 145 | struct regulator_dev *rdev[TPS6507X_NUM_REGULATOR]; |
Anuj Aggarwal | 7d14831 | 2010-07-12 17:54:06 +0530 | [diff] [blame] | 146 | struct tps_info *info[TPS6507X_NUM_REGULATOR]; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 147 | struct mutex io_lock; |
| 148 | }; |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 149 | static inline int tps6507x_pmic_read(struct tps6507x_pmic *tps, u8 reg) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 150 | { |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 151 | u8 val; |
| 152 | int err; |
| 153 | |
| 154 | err = tps->mfd->read_dev(tps->mfd, reg, 1, &val); |
| 155 | |
| 156 | if (err) |
| 157 | return err; |
| 158 | |
| 159 | return val; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 160 | } |
| 161 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 162 | static inline int tps6507x_pmic_write(struct tps6507x_pmic *tps, u8 reg, u8 val) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 163 | { |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 164 | return tps->mfd->write_dev(tps->mfd, reg, 1, &val); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 165 | } |
| 166 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 167 | static int tps6507x_pmic_set_bits(struct tps6507x_pmic *tps, u8 reg, u8 mask) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 168 | { |
| 169 | int err, data; |
| 170 | |
| 171 | mutex_lock(&tps->io_lock); |
| 172 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 173 | data = tps6507x_pmic_read(tps, reg); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 174 | if (data < 0) { |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 175 | dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 176 | err = data; |
| 177 | goto out; |
| 178 | } |
| 179 | |
| 180 | data |= mask; |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 181 | err = tps6507x_pmic_write(tps, reg, data); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 182 | if (err) |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 183 | dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 184 | |
| 185 | out: |
| 186 | mutex_unlock(&tps->io_lock); |
| 187 | return err; |
| 188 | } |
| 189 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 190 | static int tps6507x_pmic_clear_bits(struct tps6507x_pmic *tps, u8 reg, u8 mask) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 191 | { |
| 192 | int err, data; |
| 193 | |
| 194 | mutex_lock(&tps->io_lock); |
| 195 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 196 | data = tps6507x_pmic_read(tps, reg); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 197 | if (data < 0) { |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 198 | dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 199 | err = data; |
| 200 | goto out; |
| 201 | } |
| 202 | |
| 203 | data &= ~mask; |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 204 | err = tps6507x_pmic_write(tps, reg, data); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 205 | if (err) |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 206 | dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 207 | |
| 208 | out: |
| 209 | mutex_unlock(&tps->io_lock); |
| 210 | return err; |
| 211 | } |
| 212 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 213 | static int tps6507x_pmic_reg_read(struct tps6507x_pmic *tps, u8 reg) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 214 | { |
| 215 | int data; |
| 216 | |
| 217 | mutex_lock(&tps->io_lock); |
| 218 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 219 | data = tps6507x_pmic_read(tps, reg); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 220 | if (data < 0) |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 221 | dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 222 | |
| 223 | mutex_unlock(&tps->io_lock); |
| 224 | return data; |
| 225 | } |
| 226 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 227 | static int tps6507x_pmic_reg_write(struct tps6507x_pmic *tps, u8 reg, u8 val) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 228 | { |
| 229 | int err; |
| 230 | |
| 231 | mutex_lock(&tps->io_lock); |
| 232 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 233 | err = tps6507x_pmic_write(tps, reg, val); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 234 | if (err < 0) |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 235 | dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 236 | |
| 237 | mutex_unlock(&tps->io_lock); |
| 238 | return err; |
| 239 | } |
| 240 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 241 | static int tps6507x_pmic_dcdc_is_enabled(struct regulator_dev *dev) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 242 | { |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 243 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 244 | int data, dcdc = rdev_get_id(dev); |
| 245 | u8 shift; |
| 246 | |
| 247 | if (dcdc < TPS6507X_DCDC_1 || dcdc > TPS6507X_DCDC_3) |
| 248 | return -EINVAL; |
| 249 | |
| 250 | shift = TPS6507X_MAX_REG_ID - dcdc; |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 251 | data = tps6507x_pmic_reg_read(tps, TPS6507X_REG_CON_CTRL1); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 252 | |
| 253 | if (data < 0) |
| 254 | return data; |
| 255 | else |
| 256 | return (data & 1<<shift) ? 1 : 0; |
| 257 | } |
| 258 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 259 | static int tps6507x_pmic_ldo_is_enabled(struct regulator_dev *dev) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 260 | { |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 261 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 262 | int data, ldo = rdev_get_id(dev); |
| 263 | u8 shift; |
| 264 | |
| 265 | if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2) |
| 266 | return -EINVAL; |
| 267 | |
| 268 | shift = TPS6507X_MAX_REG_ID - ldo; |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 269 | data = tps6507x_pmic_reg_read(tps, TPS6507X_REG_CON_CTRL1); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 270 | |
| 271 | if (data < 0) |
| 272 | return data; |
| 273 | else |
| 274 | return (data & 1<<shift) ? 1 : 0; |
| 275 | } |
| 276 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 277 | static int tps6507x_pmic_dcdc_enable(struct regulator_dev *dev) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 278 | { |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 279 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 280 | int dcdc = rdev_get_id(dev); |
| 281 | u8 shift; |
| 282 | |
| 283 | if (dcdc < TPS6507X_DCDC_1 || dcdc > TPS6507X_DCDC_3) |
| 284 | return -EINVAL; |
| 285 | |
| 286 | shift = TPS6507X_MAX_REG_ID - dcdc; |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 287 | return tps6507x_pmic_set_bits(tps, TPS6507X_REG_CON_CTRL1, 1 << shift); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 288 | } |
| 289 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 290 | static int tps6507x_pmic_dcdc_disable(struct regulator_dev *dev) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 291 | { |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 292 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 293 | int dcdc = rdev_get_id(dev); |
| 294 | u8 shift; |
| 295 | |
| 296 | if (dcdc < TPS6507X_DCDC_1 || dcdc > TPS6507X_DCDC_3) |
| 297 | return -EINVAL; |
| 298 | |
| 299 | shift = TPS6507X_MAX_REG_ID - dcdc; |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 300 | return tps6507x_pmic_clear_bits(tps, TPS6507X_REG_CON_CTRL1, |
| 301 | 1 << shift); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 302 | } |
| 303 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 304 | static int tps6507x_pmic_ldo_enable(struct regulator_dev *dev) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 305 | { |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 306 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 307 | int ldo = rdev_get_id(dev); |
| 308 | u8 shift; |
| 309 | |
| 310 | if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2) |
| 311 | return -EINVAL; |
| 312 | |
| 313 | shift = TPS6507X_MAX_REG_ID - ldo; |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 314 | return tps6507x_pmic_set_bits(tps, TPS6507X_REG_CON_CTRL1, 1 << shift); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 315 | } |
| 316 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 317 | static int tps6507x_pmic_ldo_disable(struct regulator_dev *dev) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 318 | { |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 319 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 320 | int ldo = rdev_get_id(dev); |
| 321 | u8 shift; |
| 322 | |
| 323 | if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2) |
| 324 | return -EINVAL; |
| 325 | |
| 326 | shift = TPS6507X_MAX_REG_ID - ldo; |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 327 | return tps6507x_pmic_clear_bits(tps, TPS6507X_REG_CON_CTRL1, |
| 328 | 1 << shift); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 329 | } |
| 330 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 331 | static int tps6507x_pmic_dcdc_get_voltage(struct regulator_dev *dev) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 332 | { |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 333 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 334 | int data, dcdc = rdev_get_id(dev); |
| 335 | u8 reg; |
| 336 | |
| 337 | switch (dcdc) { |
| 338 | case TPS6507X_DCDC_1: |
| 339 | reg = TPS6507X_REG_DEFDCDC1; |
| 340 | break; |
| 341 | case TPS6507X_DCDC_2: |
Anuj Aggarwal | 7d14831 | 2010-07-12 17:54:06 +0530 | [diff] [blame] | 342 | if (tps->info[dcdc]->defdcdc_default) |
| 343 | reg = TPS6507X_REG_DEFDCDC2_HIGH; |
| 344 | else |
| 345 | reg = TPS6507X_REG_DEFDCDC2_LOW; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 346 | break; |
| 347 | case TPS6507X_DCDC_3: |
Anuj Aggarwal | 7d14831 | 2010-07-12 17:54:06 +0530 | [diff] [blame] | 348 | if (tps->info[dcdc]->defdcdc_default) |
| 349 | reg = TPS6507X_REG_DEFDCDC3_HIGH; |
| 350 | else |
| 351 | reg = TPS6507X_REG_DEFDCDC3_LOW; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 352 | break; |
| 353 | default: |
| 354 | return -EINVAL; |
| 355 | } |
| 356 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 357 | data = tps6507x_pmic_reg_read(tps, reg); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 358 | if (data < 0) |
| 359 | return data; |
| 360 | |
| 361 | data &= TPS6507X_DEFDCDCX_DCDC_MASK; |
| 362 | return tps->info[dcdc]->table[data] * 1000; |
| 363 | } |
| 364 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 365 | static int tps6507x_pmic_dcdc_set_voltage(struct regulator_dev *dev, |
Mark Brown | 3a93f2a | 2010-11-10 14:38:29 +0000 | [diff] [blame] | 366 | int min_uV, int max_uV, |
| 367 | unsigned *selector) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 368 | { |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 369 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 370 | int data, vsel, dcdc = rdev_get_id(dev); |
| 371 | u8 reg; |
| 372 | |
| 373 | switch (dcdc) { |
| 374 | case TPS6507X_DCDC_1: |
| 375 | reg = TPS6507X_REG_DEFDCDC1; |
| 376 | break; |
| 377 | case TPS6507X_DCDC_2: |
Anuj Aggarwal | 7d14831 | 2010-07-12 17:54:06 +0530 | [diff] [blame] | 378 | if (tps->info[dcdc]->defdcdc_default) |
| 379 | reg = TPS6507X_REG_DEFDCDC2_HIGH; |
| 380 | else |
| 381 | reg = TPS6507X_REG_DEFDCDC2_LOW; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 382 | break; |
| 383 | case TPS6507X_DCDC_3: |
Anuj Aggarwal | 7d14831 | 2010-07-12 17:54:06 +0530 | [diff] [blame] | 384 | if (tps->info[dcdc]->defdcdc_default) |
| 385 | reg = TPS6507X_REG_DEFDCDC3_HIGH; |
| 386 | else |
| 387 | reg = TPS6507X_REG_DEFDCDC3_LOW; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 388 | break; |
| 389 | default: |
| 390 | return -EINVAL; |
| 391 | } |
| 392 | |
| 393 | if (min_uV < tps->info[dcdc]->min_uV |
| 394 | || min_uV > tps->info[dcdc]->max_uV) |
| 395 | return -EINVAL; |
| 396 | if (max_uV < tps->info[dcdc]->min_uV |
| 397 | || max_uV > tps->info[dcdc]->max_uV) |
| 398 | return -EINVAL; |
| 399 | |
| 400 | for (vsel = 0; vsel < tps->info[dcdc]->table_len; vsel++) { |
| 401 | int mV = tps->info[dcdc]->table[vsel]; |
| 402 | int uV = mV * 1000; |
| 403 | |
| 404 | /* Break at the first in-range value */ |
| 405 | if (min_uV <= uV && uV <= max_uV) |
| 406 | break; |
| 407 | } |
| 408 | |
| 409 | /* write to the register in case we found a match */ |
| 410 | if (vsel == tps->info[dcdc]->table_len) |
| 411 | return -EINVAL; |
| 412 | |
Mark Brown | 3a93f2a | 2010-11-10 14:38:29 +0000 | [diff] [blame] | 413 | *selector = vsel; |
| 414 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 415 | data = tps6507x_pmic_reg_read(tps, reg); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 416 | if (data < 0) |
| 417 | return data; |
| 418 | |
| 419 | data &= ~TPS6507X_DEFDCDCX_DCDC_MASK; |
| 420 | data |= vsel; |
| 421 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 422 | return tps6507x_pmic_reg_write(tps, reg, data); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 423 | } |
| 424 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 425 | static int tps6507x_pmic_ldo_get_voltage(struct regulator_dev *dev) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 426 | { |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 427 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 428 | int data, ldo = rdev_get_id(dev); |
| 429 | u8 reg, mask; |
| 430 | |
| 431 | if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2) |
| 432 | return -EINVAL; |
| 433 | else { |
| 434 | reg = (ldo == TPS6507X_LDO_1 ? |
| 435 | TPS6507X_REG_LDO_CTRL1 : TPS6507X_REG_DEFLDO2); |
| 436 | mask = (ldo == TPS6507X_LDO_1 ? |
| 437 | TPS6507X_REG_LDO_CTRL1_LDO1_MASK : |
| 438 | TPS6507X_REG_DEFLDO2_LDO2_MASK); |
| 439 | } |
| 440 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 441 | data = tps6507x_pmic_reg_read(tps, reg); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 442 | if (data < 0) |
| 443 | return data; |
| 444 | |
| 445 | data &= mask; |
| 446 | return tps->info[ldo]->table[data] * 1000; |
| 447 | } |
| 448 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 449 | static int tps6507x_pmic_ldo_set_voltage(struct regulator_dev *dev, |
Mark Brown | 3a93f2a | 2010-11-10 14:38:29 +0000 | [diff] [blame] | 450 | int min_uV, int max_uV, |
| 451 | unsigned *selector) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 452 | { |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 453 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 454 | int data, vsel, ldo = rdev_get_id(dev); |
| 455 | u8 reg, mask; |
| 456 | |
| 457 | if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2) |
| 458 | return -EINVAL; |
| 459 | else { |
| 460 | reg = (ldo == TPS6507X_LDO_1 ? |
| 461 | TPS6507X_REG_LDO_CTRL1 : TPS6507X_REG_DEFLDO2); |
| 462 | mask = (ldo == TPS6507X_LDO_1 ? |
| 463 | TPS6507X_REG_LDO_CTRL1_LDO1_MASK : |
| 464 | TPS6507X_REG_DEFLDO2_LDO2_MASK); |
| 465 | } |
| 466 | |
| 467 | if (min_uV < tps->info[ldo]->min_uV || min_uV > tps->info[ldo]->max_uV) |
| 468 | return -EINVAL; |
| 469 | if (max_uV < tps->info[ldo]->min_uV || max_uV > tps->info[ldo]->max_uV) |
| 470 | return -EINVAL; |
| 471 | |
| 472 | for (vsel = 0; vsel < tps->info[ldo]->table_len; vsel++) { |
| 473 | int mV = tps->info[ldo]->table[vsel]; |
| 474 | int uV = mV * 1000; |
| 475 | |
| 476 | /* Break at the first in-range value */ |
| 477 | if (min_uV <= uV && uV <= max_uV) |
| 478 | break; |
| 479 | } |
| 480 | |
| 481 | if (vsel == tps->info[ldo]->table_len) |
| 482 | return -EINVAL; |
| 483 | |
Mark Brown | 3a93f2a | 2010-11-10 14:38:29 +0000 | [diff] [blame] | 484 | *selector = vsel; |
| 485 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 486 | data = tps6507x_pmic_reg_read(tps, reg); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 487 | if (data < 0) |
| 488 | return data; |
| 489 | |
| 490 | data &= ~mask; |
| 491 | data |= vsel; |
| 492 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 493 | return tps6507x_pmic_reg_write(tps, reg, data); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 494 | } |
| 495 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 496 | static int tps6507x_pmic_dcdc_list_voltage(struct regulator_dev *dev, |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 497 | unsigned selector) |
| 498 | { |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 499 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 500 | int dcdc = rdev_get_id(dev); |
| 501 | |
| 502 | if (dcdc < TPS6507X_DCDC_1 || dcdc > TPS6507X_DCDC_3) |
| 503 | return -EINVAL; |
| 504 | |
| 505 | if (selector >= tps->info[dcdc]->table_len) |
| 506 | return -EINVAL; |
| 507 | else |
| 508 | return tps->info[dcdc]->table[selector] * 1000; |
| 509 | } |
| 510 | |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 511 | static int tps6507x_pmic_ldo_list_voltage(struct regulator_dev *dev, |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 512 | unsigned selector) |
| 513 | { |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 514 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 515 | int ldo = rdev_get_id(dev); |
| 516 | |
| 517 | if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2) |
| 518 | return -EINVAL; |
| 519 | |
| 520 | if (selector >= tps->info[ldo]->table_len) |
| 521 | return -EINVAL; |
| 522 | else |
| 523 | return tps->info[ldo]->table[selector] * 1000; |
| 524 | } |
| 525 | |
| 526 | /* Operations permitted on VDCDCx */ |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 527 | static struct regulator_ops tps6507x_pmic_dcdc_ops = { |
| 528 | .is_enabled = tps6507x_pmic_dcdc_is_enabled, |
| 529 | .enable = tps6507x_pmic_dcdc_enable, |
| 530 | .disable = tps6507x_pmic_dcdc_disable, |
| 531 | .get_voltage = tps6507x_pmic_dcdc_get_voltage, |
| 532 | .set_voltage = tps6507x_pmic_dcdc_set_voltage, |
| 533 | .list_voltage = tps6507x_pmic_dcdc_list_voltage, |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 534 | }; |
| 535 | |
| 536 | /* Operations permitted on LDOx */ |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 537 | static struct regulator_ops tps6507x_pmic_ldo_ops = { |
| 538 | .is_enabled = tps6507x_pmic_ldo_is_enabled, |
| 539 | .enable = tps6507x_pmic_ldo_enable, |
| 540 | .disable = tps6507x_pmic_ldo_disable, |
| 541 | .get_voltage = tps6507x_pmic_ldo_get_voltage, |
| 542 | .set_voltage = tps6507x_pmic_ldo_set_voltage, |
| 543 | .list_voltage = tps6507x_pmic_ldo_list_voltage, |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 544 | }; |
| 545 | |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 546 | static __devinit |
| 547 | int tps6507x_pmic_probe(struct platform_device *pdev) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 548 | { |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 549 | struct tps6507x_dev *tps6507x_dev = dev_get_drvdata(pdev->dev.parent); |
Anuj Aggarwal | 7d14831 | 2010-07-12 17:54:06 +0530 | [diff] [blame] | 550 | struct tps_info *info = &tps6507x_pmic_regs[0]; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 551 | struct regulator_init_data *init_data; |
| 552 | struct regulator_dev *rdev; |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 553 | struct tps6507x_pmic *tps; |
Todd Fischer | 0bc20bb | 2010-04-05 20:23:57 -0600 | [diff] [blame] | 554 | struct tps6507x_board *tps_board; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 555 | int i; |
Dmitry Torokhov | 56c2349 | 2010-02-23 23:38:12 -0800 | [diff] [blame] | 556 | int error; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 557 | |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 558 | /** |
Todd Fischer | 0bc20bb | 2010-04-05 20:23:57 -0600 | [diff] [blame] | 559 | * tps_board points to pmic related constants |
| 560 | * coming from the board-evm file. |
| 561 | */ |
| 562 | |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 563 | tps_board = dev_get_platdata(tps6507x_dev->dev); |
Todd Fischer | 0bc20bb | 2010-04-05 20:23:57 -0600 | [diff] [blame] | 564 | if (!tps_board) |
| 565 | return -EINVAL; |
| 566 | |
| 567 | /** |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 568 | * init_data points to array of regulator_init structures |
| 569 | * coming from the board-evm file. |
| 570 | */ |
Todd Fischer | 0bc20bb | 2010-04-05 20:23:57 -0600 | [diff] [blame] | 571 | init_data = tps_board->tps6507x_pmic_init_data; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 572 | if (!init_data) |
Todd Fischer | 0bc20bb | 2010-04-05 20:23:57 -0600 | [diff] [blame] | 573 | return -EINVAL; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 574 | |
| 575 | tps = kzalloc(sizeof(*tps), GFP_KERNEL); |
| 576 | if (!tps) |
| 577 | return -ENOMEM; |
| 578 | |
| 579 | mutex_init(&tps->io_lock); |
| 580 | |
| 581 | /* common for all regulators */ |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 582 | tps->mfd = tps6507x_dev; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 583 | |
| 584 | for (i = 0; i < TPS6507X_NUM_REGULATOR; i++, info++, init_data++) { |
| 585 | /* Register the regulators */ |
| 586 | tps->info[i] = info; |
Anuj Aggarwal | 7d14831 | 2010-07-12 17:54:06 +0530 | [diff] [blame] | 587 | if (init_data->driver_data) { |
| 588 | struct tps6507x_reg_platform_data *data = |
| 589 | init_data->driver_data; |
| 590 | tps->info[i]->defdcdc_default = data->defdcdc_default; |
| 591 | } |
| 592 | |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 593 | tps->desc[i].name = info->name; |
Axel Lin | 77fa44d | 2011-05-12 13:47:50 +0800 | [diff] [blame] | 594 | tps->desc[i].id = i; |
Axel Lin | 0fcdb10 | 2011-08-02 15:34:12 +0800 | [diff] [blame] | 595 | tps->desc[i].n_voltages = info->table_len; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 596 | tps->desc[i].ops = (i > TPS6507X_DCDC_3 ? |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 597 | &tps6507x_pmic_ldo_ops : &tps6507x_pmic_dcdc_ops); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 598 | tps->desc[i].type = REGULATOR_VOLTAGE; |
| 599 | tps->desc[i].owner = THIS_MODULE; |
| 600 | |
| 601 | rdev = regulator_register(&tps->desc[i], |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 602 | tps6507x_dev->dev, init_data, tps); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 603 | if (IS_ERR(rdev)) { |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 604 | dev_err(tps6507x_dev->dev, |
| 605 | "failed to register %s regulator\n", |
| 606 | pdev->name); |
Dmitry Torokhov | 56c2349 | 2010-02-23 23:38:12 -0800 | [diff] [blame] | 607 | error = PTR_ERR(rdev); |
| 608 | goto fail; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 609 | } |
| 610 | |
| 611 | /* Save regulator for cleanup */ |
| 612 | tps->rdev[i] = rdev; |
| 613 | } |
| 614 | |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 615 | tps6507x_dev->pmic = tps; |
Axel Lin | d7399fa | 2010-08-09 15:51:23 +0800 | [diff] [blame] | 616 | platform_set_drvdata(pdev, tps6507x_dev); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 617 | |
| 618 | return 0; |
Dmitry Torokhov | 56c2349 | 2010-02-23 23:38:12 -0800 | [diff] [blame] | 619 | |
| 620 | fail: |
| 621 | while (--i >= 0) |
| 622 | regulator_unregister(tps->rdev[i]); |
| 623 | |
| 624 | kfree(tps); |
| 625 | return error; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 626 | } |
| 627 | |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 628 | static int __devexit tps6507x_pmic_remove(struct platform_device *pdev) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 629 | { |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 630 | struct tps6507x_dev *tps6507x_dev = platform_get_drvdata(pdev); |
| 631 | struct tps6507x_pmic *tps = tps6507x_dev->pmic; |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 632 | int i; |
| 633 | |
| 634 | for (i = 0; i < TPS6507X_NUM_REGULATOR; i++) |
| 635 | regulator_unregister(tps->rdev[i]); |
| 636 | |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 637 | kfree(tps); |
| 638 | |
| 639 | return 0; |
| 640 | } |
| 641 | |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 642 | static struct platform_driver tps6507x_pmic_driver = { |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 643 | .driver = { |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 644 | .name = "tps6507x-pmic", |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 645 | .owner = THIS_MODULE, |
| 646 | }, |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 647 | .probe = tps6507x_pmic_probe, |
| 648 | .remove = __devexit_p(tps6507x_pmic_remove), |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 649 | }; |
| 650 | |
| 651 | /** |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 652 | * tps6507x_pmic_init |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 653 | * |
| 654 | * Module init function |
| 655 | */ |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 656 | static int __init tps6507x_pmic_init(void) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 657 | { |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 658 | return platform_driver_register(&tps6507x_pmic_driver); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 659 | } |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 660 | subsys_initcall(tps6507x_pmic_init); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 661 | |
| 662 | /** |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 663 | * tps6507x_pmic_cleanup |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 664 | * |
| 665 | * Module exit function |
| 666 | */ |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 667 | static void __exit tps6507x_pmic_cleanup(void) |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 668 | { |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 669 | platform_driver_unregister(&tps6507x_pmic_driver); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 670 | } |
Todd Fischer | 4ce5ba5 | 2010-04-05 20:23:58 -0600 | [diff] [blame] | 671 | module_exit(tps6507x_pmic_cleanup); |
Anuj Aggarwal | 3fa5b8e | 2009-08-21 00:39:39 +0530 | [diff] [blame] | 672 | |
| 673 | MODULE_AUTHOR("Texas Instruments"); |
| 674 | MODULE_DESCRIPTION("TPS6507x voltage regulator driver"); |
Liam Girdwood | 9e108d3 | 2009-08-24 10:31:34 +0100 | [diff] [blame] | 675 | MODULE_LICENSE("GPL v2"); |
Todd Fischer | 31dd6a2 | 2010-04-08 09:04:55 +0200 | [diff] [blame] | 676 | MODULE_ALIAS("platform:tps6507x-pmic"); |