Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 1 | /* |
| 2 | * Regulator driver for TI TPS6586x |
| 3 | * |
| 4 | * Copyright (C) 2010 Compulab Ltd. |
| 5 | * Author: Mike Rapoport <mike@compulab.co.il> |
| 6 | * |
| 7 | * Based on da903x |
| 8 | * Copyright (C) 2006-2008 Marvell International Ltd. |
| 9 | * Copyright (C) 2008 Compulab Ltd. |
| 10 | * |
| 11 | * This program is free software; you can redistribute it and/or modify |
| 12 | * it under the terms of the GNU General Public License version 2 as |
| 13 | * published by the Free Software Foundation. |
| 14 | */ |
| 15 | |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 16 | #include <linux/kernel.h> |
Paul Gortmaker | 65602c3 | 2011-07-17 16:28:23 -0400 | [diff] [blame] | 17 | #include <linux/module.h> |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 18 | #include <linux/init.h> |
| 19 | #include <linux/err.h> |
| 20 | #include <linux/slab.h> |
| 21 | #include <linux/platform_device.h> |
| 22 | #include <linux/regulator/driver.h> |
| 23 | #include <linux/regulator/machine.h> |
| 24 | #include <linux/mfd/tps6586x.h> |
| 25 | |
| 26 | /* supply control and voltage setting */ |
| 27 | #define TPS6586X_SUPPLYENA 0x10 |
| 28 | #define TPS6586X_SUPPLYENB 0x11 |
| 29 | #define TPS6586X_SUPPLYENC 0x12 |
| 30 | #define TPS6586X_SUPPLYEND 0x13 |
| 31 | #define TPS6586X_SUPPLYENE 0x14 |
| 32 | #define TPS6586X_VCC1 0x20 |
| 33 | #define TPS6586X_VCC2 0x21 |
| 34 | #define TPS6586X_SM1V1 0x23 |
| 35 | #define TPS6586X_SM1V2 0x24 |
| 36 | #define TPS6586X_SM1SL 0x25 |
| 37 | #define TPS6586X_SM0V1 0x26 |
| 38 | #define TPS6586X_SM0V2 0x27 |
| 39 | #define TPS6586X_SM0SL 0x28 |
| 40 | #define TPS6586X_LDO2AV1 0x29 |
| 41 | #define TPS6586X_LDO2AV2 0x2A |
| 42 | #define TPS6586X_LDO2BV1 0x2F |
| 43 | #define TPS6586X_LDO2BV2 0x30 |
| 44 | #define TPS6586X_LDO4V1 0x32 |
| 45 | #define TPS6586X_LDO4V2 0x33 |
| 46 | |
| 47 | /* converter settings */ |
| 48 | #define TPS6586X_SUPPLYV1 0x41 |
| 49 | #define TPS6586X_SUPPLYV2 0x42 |
| 50 | #define TPS6586X_SUPPLYV3 0x43 |
| 51 | #define TPS6586X_SUPPLYV4 0x44 |
| 52 | #define TPS6586X_SUPPLYV5 0x45 |
| 53 | #define TPS6586X_SUPPLYV6 0x46 |
| 54 | #define TPS6586X_SMODE1 0x47 |
| 55 | #define TPS6586X_SMODE2 0x48 |
| 56 | |
| 57 | struct tps6586x_regulator { |
| 58 | struct regulator_desc desc; |
| 59 | |
| 60 | int volt_reg; |
| 61 | int volt_shift; |
| 62 | int volt_nbits; |
| 63 | int enable_bit[2]; |
| 64 | int enable_reg[2]; |
| 65 | |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 66 | /* for DVM regulators */ |
| 67 | int go_reg; |
| 68 | int go_bit; |
| 69 | }; |
| 70 | |
| 71 | static inline struct device *to_tps6586x_dev(struct regulator_dev *rdev) |
| 72 | { |
| 73 | return rdev_get_dev(rdev)->parent->parent; |
| 74 | } |
| 75 | |
Axel Lin | eed0651 | 2012-03-24 09:42:26 +0800 | [diff] [blame] | 76 | static int tps6586x_set_voltage_sel(struct regulator_dev *rdev, |
| 77 | unsigned selector) |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 78 | { |
| 79 | struct tps6586x_regulator *ri = rdev_get_drvdata(rdev); |
| 80 | struct device *parent = to_tps6586x_dev(rdev); |
Axel Lin | eed0651 | 2012-03-24 09:42:26 +0800 | [diff] [blame] | 81 | int ret, val, rid = rdev_get_id(rdev); |
| 82 | uint8_t mask; |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 83 | |
Axel Lin | eed0651 | 2012-03-24 09:42:26 +0800 | [diff] [blame] | 84 | val = selector << ri->volt_shift; |
| 85 | mask = ((1 << ri->volt_nbits) - 1) << ri->volt_shift; |
| 86 | |
| 87 | ret = tps6586x_update(parent, ri->volt_reg, val, mask); |
| 88 | if (ret) |
| 89 | return ret; |
| 90 | |
| 91 | /* Update go bit for DVM regulators */ |
| 92 | switch (rid) { |
| 93 | case TPS6586X_ID_LDO_2: |
| 94 | case TPS6586X_ID_LDO_4: |
| 95 | case TPS6586X_ID_SM_0: |
| 96 | case TPS6586X_ID_SM_1: |
| 97 | ret = tps6586x_set_bits(parent, ri->go_reg, 1 << ri->go_bit); |
| 98 | break; |
| 99 | } |
| 100 | return ret; |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 101 | } |
| 102 | |
Axel Lin | 44a7cda | 2012-03-24 09:38:30 +0800 | [diff] [blame] | 103 | static int tps6586x_get_voltage_sel(struct regulator_dev *rdev) |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 104 | { |
| 105 | struct tps6586x_regulator *ri = rdev_get_drvdata(rdev); |
| 106 | struct device *parent = to_tps6586x_dev(rdev); |
| 107 | uint8_t val, mask; |
| 108 | int ret; |
| 109 | |
| 110 | ret = tps6586x_read(parent, ri->volt_reg, &val); |
| 111 | if (ret) |
| 112 | return ret; |
| 113 | |
| 114 | mask = ((1 << ri->volt_nbits) - 1) << ri->volt_shift; |
| 115 | val = (val & mask) >> ri->volt_shift; |
| 116 | |
Axel Lin | 327531b | 2010-08-22 22:38:15 +0800 | [diff] [blame] | 117 | if (val >= ri->desc.n_voltages) |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 118 | BUG(); |
| 119 | |
Axel Lin | 44a7cda | 2012-03-24 09:38:30 +0800 | [diff] [blame] | 120 | return val; |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 121 | } |
| 122 | |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 123 | static int tps6586x_regulator_enable(struct regulator_dev *rdev) |
| 124 | { |
| 125 | struct tps6586x_regulator *ri = rdev_get_drvdata(rdev); |
| 126 | struct device *parent = to_tps6586x_dev(rdev); |
| 127 | |
| 128 | return tps6586x_set_bits(parent, ri->enable_reg[0], |
| 129 | 1 << ri->enable_bit[0]); |
| 130 | } |
| 131 | |
| 132 | static int tps6586x_regulator_disable(struct regulator_dev *rdev) |
| 133 | { |
| 134 | struct tps6586x_regulator *ri = rdev_get_drvdata(rdev); |
| 135 | struct device *parent = to_tps6586x_dev(rdev); |
| 136 | |
| 137 | return tps6586x_clr_bits(parent, ri->enable_reg[0], |
| 138 | 1 << ri->enable_bit[0]); |
| 139 | } |
| 140 | |
| 141 | static int tps6586x_regulator_is_enabled(struct regulator_dev *rdev) |
| 142 | { |
| 143 | struct tps6586x_regulator *ri = rdev_get_drvdata(rdev); |
| 144 | struct device *parent = to_tps6586x_dev(rdev); |
| 145 | uint8_t reg_val; |
| 146 | int ret; |
| 147 | |
| 148 | ret = tps6586x_read(parent, ri->enable_reg[0], ®_val); |
| 149 | if (ret) |
| 150 | return ret; |
| 151 | |
| 152 | return !!(reg_val & (1 << ri->enable_bit[0])); |
| 153 | } |
| 154 | |
Axel Lin | e181623 | 2012-03-24 09:44:42 +0800 | [diff] [blame] | 155 | static struct regulator_ops tps6586x_regulator_ops = { |
Axel Lin | f464703 | 2012-06-05 22:52:06 +0800 | [diff] [blame^] | 156 | .list_voltage = regulator_list_voltage_table, |
Axel Lin | 44a7cda | 2012-03-24 09:38:30 +0800 | [diff] [blame] | 157 | .get_voltage_sel = tps6586x_get_voltage_sel, |
Axel Lin | eed0651 | 2012-03-24 09:42:26 +0800 | [diff] [blame] | 158 | .set_voltage_sel = tps6586x_set_voltage_sel, |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 159 | |
| 160 | .is_enabled = tps6586x_regulator_is_enabled, |
| 161 | .enable = tps6586x_regulator_enable, |
| 162 | .disable = tps6586x_regulator_disable, |
| 163 | }; |
| 164 | |
Axel Lin | f464703 | 2012-06-05 22:52:06 +0800 | [diff] [blame^] | 165 | static const unsigned int tps6586x_ldo0_voltages[] = { |
| 166 | 1200000, 1500000, 1800000, 2500000, 2700000, 2850000, 3100000, 3300000, |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 167 | }; |
| 168 | |
Axel Lin | f464703 | 2012-06-05 22:52:06 +0800 | [diff] [blame^] | 169 | static const unsigned int tps6586x_ldo4_voltages[] = { |
| 170 | 1700000, 1725000, 1750000, 1775000, 1800000, 1825000, 1850000, 1875000, |
| 171 | 1900000, 1925000, 1950000, 1975000, 2000000, 2025000, 2050000, 2075000, |
| 172 | 2100000, 2125000, 2150000, 2175000, 2200000, 2225000, 2250000, 2275000, |
| 173 | 2300000, 2325000, 2350000, 2375000, 2400000, 2425000, 2450000, 2475000, |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 174 | }; |
| 175 | |
Axel Lin | f464703 | 2012-06-05 22:52:06 +0800 | [diff] [blame^] | 176 | static const unsigned int tps6586x_ldo_voltages[] = { |
| 177 | 1250000, 1500000, 1800000, 2500000, 2700000, 2850000, 3100000, 3300000, |
Gary King | 4cc2e39 | 2010-07-30 22:58:58 +0300 | [diff] [blame] | 178 | }; |
| 179 | |
Axel Lin | f464703 | 2012-06-05 22:52:06 +0800 | [diff] [blame^] | 180 | static const unsigned int tps6586x_sm2_voltages[] = { |
| 181 | 3000000, 3050000, 3100000, 3150000, 3200000, 3250000, 3300000, 3350000, |
| 182 | 3400000, 3450000, 3500000, 3550000, 3600000, 3650000, 3700000, 3750000, |
| 183 | 3800000, 3850000, 3900000, 3950000, 4000000, 4050000, 4100000, 4150000, |
| 184 | 4200000, 4250000, 4300000, 4350000, 4400000, 4450000, 4500000, 4550000, |
| 185 | }; |
| 186 | |
| 187 | static const unsigned int tps6586x_dvm_voltages[] = { |
| 188 | 725000, 750000, 775000, 800000, 825000, 850000, 875000, 900000, |
| 189 | 925000, 950000, 975000, 1000000, 1025000, 1050000, 1075000, 1100000, |
| 190 | 1125000, 1150000, 1175000, 1200000, 1225000, 1250000, 1275000, 1300000, |
| 191 | 1325000, 1350000, 1375000, 1400000, 1425000, 1450000, 1475000, 1500000, |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 192 | }; |
| 193 | |
Axel Lin | e181623 | 2012-03-24 09:44:42 +0800 | [diff] [blame] | 194 | #define TPS6586X_REGULATOR(_id, vdata, vreg, shift, nbits, \ |
Danny Huang | 64db657 | 2010-12-01 13:37:29 -0700 | [diff] [blame] | 195 | ereg0, ebit0, ereg1, ebit1) \ |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 196 | .desc = { \ |
| 197 | .name = "REG-" #_id, \ |
Axel Lin | e181623 | 2012-03-24 09:44:42 +0800 | [diff] [blame] | 198 | .ops = &tps6586x_regulator_ops, \ |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 199 | .type = REGULATOR_VOLTAGE, \ |
| 200 | .id = TPS6586X_ID_##_id, \ |
| 201 | .n_voltages = ARRAY_SIZE(tps6586x_##vdata##_voltages), \ |
Axel Lin | f464703 | 2012-06-05 22:52:06 +0800 | [diff] [blame^] | 202 | .volt_table = tps6586x_##vdata##_voltages, \ |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 203 | .owner = THIS_MODULE, \ |
| 204 | }, \ |
| 205 | .volt_reg = TPS6586X_##vreg, \ |
| 206 | .volt_shift = (shift), \ |
| 207 | .volt_nbits = (nbits), \ |
| 208 | .enable_reg[0] = TPS6586X_SUPPLY##ereg0, \ |
| 209 | .enable_bit[0] = (ebit0), \ |
| 210 | .enable_reg[1] = TPS6586X_SUPPLY##ereg1, \ |
Axel Lin | f464703 | 2012-06-05 22:52:06 +0800 | [diff] [blame^] | 211 | .enable_bit[1] = (ebit1), |
Danny Huang | 64db657 | 2010-12-01 13:37:29 -0700 | [diff] [blame] | 212 | |
| 213 | #define TPS6586X_REGULATOR_DVM_GOREG(goreg, gobit) \ |
| 214 | .go_reg = TPS6586X_##goreg, \ |
| 215 | .go_bit = (gobit), |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 216 | |
| 217 | #define TPS6586X_LDO(_id, vdata, vreg, shift, nbits, \ |
| 218 | ereg0, ebit0, ereg1, ebit1) \ |
Danny Huang | 64db657 | 2010-12-01 13:37:29 -0700 | [diff] [blame] | 219 | { \ |
Axel Lin | e181623 | 2012-03-24 09:44:42 +0800 | [diff] [blame] | 220 | TPS6586X_REGULATOR(_id, vdata, vreg, shift, nbits, \ |
Danny Huang | 64db657 | 2010-12-01 13:37:29 -0700 | [diff] [blame] | 221 | ereg0, ebit0, ereg1, ebit1) \ |
| 222 | } |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 223 | |
| 224 | #define TPS6586X_DVM(_id, vdata, vreg, shift, nbits, \ |
| 225 | ereg0, ebit0, ereg1, ebit1, goreg, gobit) \ |
Danny Huang | 64db657 | 2010-12-01 13:37:29 -0700 | [diff] [blame] | 226 | { \ |
Axel Lin | e181623 | 2012-03-24 09:44:42 +0800 | [diff] [blame] | 227 | TPS6586X_REGULATOR(_id, vdata, vreg, shift, nbits, \ |
Danny Huang | 64db657 | 2010-12-01 13:37:29 -0700 | [diff] [blame] | 228 | ereg0, ebit0, ereg1, ebit1) \ |
| 229 | TPS6586X_REGULATOR_DVM_GOREG(goreg, gobit) \ |
| 230 | } |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 231 | |
| 232 | static struct tps6586x_regulator tps6586x_regulator[] = { |
Axel Lin | f464703 | 2012-06-05 22:52:06 +0800 | [diff] [blame^] | 233 | TPS6586X_LDO(LDO_0, ldo0, SUPPLYV1, 5, 3, ENC, 0, END, 0), |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 234 | TPS6586X_LDO(LDO_3, ldo, SUPPLYV4, 0, 3, ENC, 2, END, 2), |
| 235 | TPS6586X_LDO(LDO_5, ldo, SUPPLYV6, 0, 3, ENE, 6, ENE, 6), |
| 236 | TPS6586X_LDO(LDO_6, ldo, SUPPLYV3, 0, 3, ENC, 4, END, 4), |
| 237 | TPS6586X_LDO(LDO_7, ldo, SUPPLYV3, 3, 3, ENC, 5, END, 5), |
Danny Huang | 1b39ed0 | 2010-12-01 13:37:31 -0700 | [diff] [blame] | 238 | TPS6586X_LDO(LDO_8, ldo, SUPPLYV2, 5, 3, ENC, 6, END, 6), |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 239 | TPS6586X_LDO(LDO_9, ldo, SUPPLYV6, 3, 3, ENE, 7, ENE, 7), |
Danny Huang | 1b39ed0 | 2010-12-01 13:37:31 -0700 | [diff] [blame] | 240 | TPS6586X_LDO(LDO_RTC, ldo, SUPPLYV4, 3, 3, V4, 7, V4, 7), |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 241 | TPS6586X_LDO(LDO_1, dvm, SUPPLYV1, 0, 5, ENC, 1, END, 1), |
Danny Huang | 1b39ed0 | 2010-12-01 13:37:31 -0700 | [diff] [blame] | 242 | TPS6586X_LDO(SM_2, sm2, SUPPLYV2, 0, 5, ENC, 7, END, 7), |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 243 | |
| 244 | TPS6586X_DVM(LDO_2, dvm, LDO2BV1, 0, 5, ENA, 3, ENB, 3, VCC2, 6), |
| 245 | TPS6586X_DVM(LDO_4, ldo4, LDO4V1, 0, 5, ENC, 3, END, 3, VCC1, 6), |
| 246 | TPS6586X_DVM(SM_0, dvm, SM0V1, 0, 5, ENA, 1, ENB, 1, VCC1, 2), |
| 247 | TPS6586X_DVM(SM_1, dvm, SM1V1, 0, 5, ENA, 0, ENB, 0, VCC1, 0), |
| 248 | }; |
| 249 | |
| 250 | /* |
| 251 | * TPS6586X has 2 enable bits that are OR'ed to determine the actual |
| 252 | * regulator state. Clearing one of this bits allows switching |
| 253 | * regulator on and of with single register write. |
| 254 | */ |
| 255 | static inline int tps6586x_regulator_preinit(struct device *parent, |
| 256 | struct tps6586x_regulator *ri) |
| 257 | { |
| 258 | uint8_t val1, val2; |
| 259 | int ret; |
| 260 | |
Danny Huang | 1dbcf35 | 2010-12-01 13:37:30 -0700 | [diff] [blame] | 261 | if (ri->enable_reg[0] == ri->enable_reg[1] && |
| 262 | ri->enable_bit[0] == ri->enable_bit[1]) |
| 263 | return 0; |
| 264 | |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 265 | ret = tps6586x_read(parent, ri->enable_reg[0], &val1); |
| 266 | if (ret) |
| 267 | return ret; |
| 268 | |
| 269 | ret = tps6586x_read(parent, ri->enable_reg[1], &val2); |
| 270 | if (ret) |
| 271 | return ret; |
| 272 | |
Danny Huang | 4f586707 | 2010-12-01 13:37:28 -0700 | [diff] [blame] | 273 | if (!(val2 & (1 << ri->enable_bit[1]))) |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 274 | return 0; |
| 275 | |
| 276 | /* |
| 277 | * The regulator is on, but it's enabled with the bit we don't |
| 278 | * want to use, so we switch the enable bits |
| 279 | */ |
Danny Huang | 4f586707 | 2010-12-01 13:37:28 -0700 | [diff] [blame] | 280 | if (!(val1 & (1 << ri->enable_bit[0]))) { |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 281 | ret = tps6586x_set_bits(parent, ri->enable_reg[0], |
| 282 | 1 << ri->enable_bit[0]); |
| 283 | if (ret) |
| 284 | return ret; |
| 285 | } |
| 286 | |
| 287 | return tps6586x_clr_bits(parent, ri->enable_reg[1], |
| 288 | 1 << ri->enable_bit[1]); |
| 289 | } |
| 290 | |
Xin Xie | 500c524 | 2011-08-09 18:47:50 +0800 | [diff] [blame] | 291 | static int tps6586x_regulator_set_slew_rate(struct platform_device *pdev) |
| 292 | { |
| 293 | struct device *parent = pdev->dev.parent; |
| 294 | struct regulator_init_data *p = pdev->dev.platform_data; |
| 295 | struct tps6586x_settings *setting = p->driver_data; |
| 296 | uint8_t reg; |
| 297 | |
| 298 | if (setting == NULL) |
| 299 | return 0; |
| 300 | |
| 301 | if (!(setting->slew_rate & TPS6586X_SLEW_RATE_SET)) |
| 302 | return 0; |
| 303 | |
| 304 | /* only SM0 and SM1 can have the slew rate settings */ |
| 305 | switch (pdev->id) { |
| 306 | case TPS6586X_ID_SM_0: |
| 307 | reg = TPS6586X_SM0SL; |
| 308 | break; |
| 309 | case TPS6586X_ID_SM_1: |
| 310 | reg = TPS6586X_SM1SL; |
| 311 | break; |
| 312 | default: |
| 313 | dev_warn(&pdev->dev, "Only SM0/SM1 can set slew rate\n"); |
| 314 | return -EINVAL; |
| 315 | } |
| 316 | |
| 317 | return tps6586x_write(parent, reg, |
| 318 | setting->slew_rate & TPS6586X_SLEW_RATE_MASK); |
| 319 | } |
| 320 | |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 321 | static inline struct tps6586x_regulator *find_regulator_info(int id) |
| 322 | { |
| 323 | struct tps6586x_regulator *ri; |
| 324 | int i; |
| 325 | |
| 326 | for (i = 0; i < ARRAY_SIZE(tps6586x_regulator); i++) { |
| 327 | ri = &tps6586x_regulator[i]; |
| 328 | if (ri->desc.id == id) |
| 329 | return ri; |
| 330 | } |
| 331 | return NULL; |
| 332 | } |
| 333 | |
| 334 | static int __devinit tps6586x_regulator_probe(struct platform_device *pdev) |
| 335 | { |
| 336 | struct tps6586x_regulator *ri = NULL; |
Mark Brown | c172708 | 2012-04-04 00:50:22 +0100 | [diff] [blame] | 337 | struct regulator_config config = { }; |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 338 | struct regulator_dev *rdev; |
| 339 | int id = pdev->id; |
| 340 | int err; |
| 341 | |
Thierry Reding | 394ee3d | 2012-03-08 15:51:24 +0100 | [diff] [blame] | 342 | dev_dbg(&pdev->dev, "Probing regulator %d\n", id); |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 343 | |
| 344 | ri = find_regulator_info(id); |
| 345 | if (ri == NULL) { |
| 346 | dev_err(&pdev->dev, "invalid regulator ID specified\n"); |
| 347 | return -EINVAL; |
| 348 | } |
| 349 | |
| 350 | err = tps6586x_regulator_preinit(pdev->dev.parent, ri); |
| 351 | if (err) |
| 352 | return err; |
| 353 | |
Mark Brown | c172708 | 2012-04-04 00:50:22 +0100 | [diff] [blame] | 354 | config.dev = &pdev->dev; |
Thierry Reding | 62f6b08 | 2012-04-26 16:52:21 +0200 | [diff] [blame] | 355 | config.of_node = pdev->dev.of_node; |
Mark Brown | c172708 | 2012-04-04 00:50:22 +0100 | [diff] [blame] | 356 | config.init_data = pdev->dev.platform_data; |
| 357 | config.driver_data = ri; |
| 358 | |
| 359 | rdev = regulator_register(&ri->desc, &config); |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 360 | if (IS_ERR(rdev)) { |
| 361 | dev_err(&pdev->dev, "failed to register regulator %s\n", |
| 362 | ri->desc.name); |
| 363 | return PTR_ERR(rdev); |
| 364 | } |
| 365 | |
Axel Lin | e7973c3 | 2010-08-09 15:58:06 +0800 | [diff] [blame] | 366 | platform_set_drvdata(pdev, rdev); |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 367 | |
Xin Xie | 500c524 | 2011-08-09 18:47:50 +0800 | [diff] [blame] | 368 | return tps6586x_regulator_set_slew_rate(pdev); |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 369 | } |
| 370 | |
| 371 | static int __devexit tps6586x_regulator_remove(struct platform_device *pdev) |
| 372 | { |
Axel Lin | e7973c3 | 2010-08-09 15:58:06 +0800 | [diff] [blame] | 373 | struct regulator_dev *rdev = platform_get_drvdata(pdev); |
| 374 | |
| 375 | regulator_unregister(rdev); |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 376 | return 0; |
| 377 | } |
| 378 | |
| 379 | static struct platform_driver tps6586x_regulator_driver = { |
| 380 | .driver = { |
| 381 | .name = "tps6586x-regulator", |
| 382 | .owner = THIS_MODULE, |
| 383 | }, |
| 384 | .probe = tps6586x_regulator_probe, |
| 385 | .remove = __devexit_p(tps6586x_regulator_remove), |
| 386 | }; |
| 387 | |
| 388 | static int __init tps6586x_regulator_init(void) |
| 389 | { |
| 390 | return platform_driver_register(&tps6586x_regulator_driver); |
| 391 | } |
| 392 | subsys_initcall(tps6586x_regulator_init); |
| 393 | |
| 394 | static void __exit tps6586x_regulator_exit(void) |
| 395 | { |
| 396 | platform_driver_unregister(&tps6586x_regulator_driver); |
| 397 | } |
| 398 | module_exit(tps6586x_regulator_exit); |
| 399 | |
| 400 | MODULE_LICENSE("GPL"); |
| 401 | MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>"); |
| 402 | MODULE_DESCRIPTION("Regulator Driver for TI TPS6586X PMIC"); |
| 403 | MODULE_ALIAS("platform:tps6586x-regulator"); |