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 | { |
Laxman Dewangan | 7c7fac3 | 2012-07-13 19:20:32 +0530 | [diff] [blame] | 73 | return rdev_get_dev(rdev)->parent; |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 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 | |
Laxman Dewangan | 9394b80 | 2012-09-04 14:43:39 -0600 | [diff] [blame^] | 165 | static struct regulator_ops tps6586x_sys_regulator_ops = { |
| 166 | }; |
| 167 | |
Axel Lin | f464703 | 2012-06-05 22:52:06 +0800 | [diff] [blame] | 168 | static const unsigned int tps6586x_ldo0_voltages[] = { |
| 169 | 1200000, 1500000, 1800000, 2500000, 2700000, 2850000, 3100000, 3300000, |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 170 | }; |
| 171 | |
Axel Lin | f464703 | 2012-06-05 22:52:06 +0800 | [diff] [blame] | 172 | static const unsigned int tps6586x_ldo4_voltages[] = { |
| 173 | 1700000, 1725000, 1750000, 1775000, 1800000, 1825000, 1850000, 1875000, |
| 174 | 1900000, 1925000, 1950000, 1975000, 2000000, 2025000, 2050000, 2075000, |
| 175 | 2100000, 2125000, 2150000, 2175000, 2200000, 2225000, 2250000, 2275000, |
| 176 | 2300000, 2325000, 2350000, 2375000, 2400000, 2425000, 2450000, 2475000, |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 177 | }; |
| 178 | |
Axel Lin | f464703 | 2012-06-05 22:52:06 +0800 | [diff] [blame] | 179 | static const unsigned int tps6586x_ldo_voltages[] = { |
| 180 | 1250000, 1500000, 1800000, 2500000, 2700000, 2850000, 3100000, 3300000, |
Gary King | 4cc2e39 | 2010-07-30 22:58:58 +0300 | [diff] [blame] | 181 | }; |
| 182 | |
Axel Lin | f464703 | 2012-06-05 22:52:06 +0800 | [diff] [blame] | 183 | static const unsigned int tps6586x_sm2_voltages[] = { |
| 184 | 3000000, 3050000, 3100000, 3150000, 3200000, 3250000, 3300000, 3350000, |
| 185 | 3400000, 3450000, 3500000, 3550000, 3600000, 3650000, 3700000, 3750000, |
| 186 | 3800000, 3850000, 3900000, 3950000, 4000000, 4050000, 4100000, 4150000, |
| 187 | 4200000, 4250000, 4300000, 4350000, 4400000, 4450000, 4500000, 4550000, |
| 188 | }; |
| 189 | |
| 190 | static const unsigned int tps6586x_dvm_voltages[] = { |
| 191 | 725000, 750000, 775000, 800000, 825000, 850000, 875000, 900000, |
| 192 | 925000, 950000, 975000, 1000000, 1025000, 1050000, 1075000, 1100000, |
| 193 | 1125000, 1150000, 1175000, 1200000, 1225000, 1250000, 1275000, 1300000, |
| 194 | 1325000, 1350000, 1375000, 1400000, 1425000, 1450000, 1475000, 1500000, |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 195 | }; |
| 196 | |
Laxman Dewangan | 7c7fac3 | 2012-07-13 19:20:32 +0530 | [diff] [blame] | 197 | #define TPS6586X_REGULATOR(_id, _pin_name, vdata, vreg, shift, nbits, \ |
Danny Huang | 64db657 | 2010-12-01 13:37:29 -0700 | [diff] [blame] | 198 | ereg0, ebit0, ereg1, ebit1) \ |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 199 | .desc = { \ |
Laxman Dewangan | 7c7fac3 | 2012-07-13 19:20:32 +0530 | [diff] [blame] | 200 | .supply_name = _pin_name, \ |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 201 | .name = "REG-" #_id, \ |
Axel Lin | e181623 | 2012-03-24 09:44:42 +0800 | [diff] [blame] | 202 | .ops = &tps6586x_regulator_ops, \ |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 203 | .type = REGULATOR_VOLTAGE, \ |
| 204 | .id = TPS6586X_ID_##_id, \ |
| 205 | .n_voltages = ARRAY_SIZE(tps6586x_##vdata##_voltages), \ |
Axel Lin | f464703 | 2012-06-05 22:52:06 +0800 | [diff] [blame] | 206 | .volt_table = tps6586x_##vdata##_voltages, \ |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 207 | .owner = THIS_MODULE, \ |
| 208 | }, \ |
| 209 | .volt_reg = TPS6586X_##vreg, \ |
| 210 | .volt_shift = (shift), \ |
| 211 | .volt_nbits = (nbits), \ |
| 212 | .enable_reg[0] = TPS6586X_SUPPLY##ereg0, \ |
| 213 | .enable_bit[0] = (ebit0), \ |
| 214 | .enable_reg[1] = TPS6586X_SUPPLY##ereg1, \ |
Axel Lin | f464703 | 2012-06-05 22:52:06 +0800 | [diff] [blame] | 215 | .enable_bit[1] = (ebit1), |
Danny Huang | 64db657 | 2010-12-01 13:37:29 -0700 | [diff] [blame] | 216 | |
| 217 | #define TPS6586X_REGULATOR_DVM_GOREG(goreg, gobit) \ |
| 218 | .go_reg = TPS6586X_##goreg, \ |
| 219 | .go_bit = (gobit), |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 220 | |
Laxman Dewangan | 7c7fac3 | 2012-07-13 19:20:32 +0530 | [diff] [blame] | 221 | #define TPS6586X_LDO(_id, _pname, vdata, vreg, shift, nbits, \ |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 222 | ereg0, ebit0, ereg1, ebit1) \ |
Danny Huang | 64db657 | 2010-12-01 13:37:29 -0700 | [diff] [blame] | 223 | { \ |
Laxman Dewangan | 7c7fac3 | 2012-07-13 19:20:32 +0530 | [diff] [blame] | 224 | TPS6586X_REGULATOR(_id, _pname, vdata, vreg, shift, nbits, \ |
Danny Huang | 64db657 | 2010-12-01 13:37:29 -0700 | [diff] [blame] | 225 | ereg0, ebit0, ereg1, ebit1) \ |
| 226 | } |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 227 | |
Laxman Dewangan | 7c7fac3 | 2012-07-13 19:20:32 +0530 | [diff] [blame] | 228 | #define TPS6586X_DVM(_id, _pname, vdata, vreg, shift, nbits, \ |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 229 | ereg0, ebit0, ereg1, ebit1, goreg, gobit) \ |
Danny Huang | 64db657 | 2010-12-01 13:37:29 -0700 | [diff] [blame] | 230 | { \ |
Laxman Dewangan | 7c7fac3 | 2012-07-13 19:20:32 +0530 | [diff] [blame] | 231 | TPS6586X_REGULATOR(_id, _pname, vdata, vreg, shift, nbits, \ |
Danny Huang | 64db657 | 2010-12-01 13:37:29 -0700 | [diff] [blame] | 232 | ereg0, ebit0, ereg1, ebit1) \ |
| 233 | TPS6586X_REGULATOR_DVM_GOREG(goreg, gobit) \ |
| 234 | } |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 235 | |
Laxman Dewangan | 9394b80 | 2012-09-04 14:43:39 -0600 | [diff] [blame^] | 236 | #define TPS6586X_SYS_REGULATOR() \ |
| 237 | { \ |
| 238 | .desc = { \ |
| 239 | .supply_name = "sys", \ |
| 240 | .name = "REG-SYS", \ |
| 241 | .ops = &tps6586x_sys_regulator_ops, \ |
| 242 | .type = REGULATOR_VOLTAGE, \ |
| 243 | .id = TPS6586X_ID_SYS, \ |
| 244 | .owner = THIS_MODULE, \ |
| 245 | }, \ |
| 246 | } |
| 247 | |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 248 | static struct tps6586x_regulator tps6586x_regulator[] = { |
Laxman Dewangan | 9394b80 | 2012-09-04 14:43:39 -0600 | [diff] [blame^] | 249 | TPS6586X_SYS_REGULATOR(), |
Laxman Dewangan | 7c7fac3 | 2012-07-13 19:20:32 +0530 | [diff] [blame] | 250 | TPS6586X_LDO(LDO_0, "vinldo01", ldo0, SUPPLYV1, 5, 3, ENC, 0, END, 0), |
| 251 | TPS6586X_LDO(LDO_3, "vinldo23", ldo, SUPPLYV4, 0, 3, ENC, 2, END, 2), |
Laxman Dewangan | 9394b80 | 2012-09-04 14:43:39 -0600 | [diff] [blame^] | 252 | TPS6586X_LDO(LDO_5, "REG-SYS", ldo, SUPPLYV6, 0, 3, ENE, 6, ENE, 6), |
Laxman Dewangan | 7c7fac3 | 2012-07-13 19:20:32 +0530 | [diff] [blame] | 253 | TPS6586X_LDO(LDO_6, "vinldo678", ldo, SUPPLYV3, 0, 3, ENC, 4, END, 4), |
| 254 | TPS6586X_LDO(LDO_7, "vinldo678", ldo, SUPPLYV3, 3, 3, ENC, 5, END, 5), |
| 255 | TPS6586X_LDO(LDO_8, "vinldo678", ldo, SUPPLYV2, 5, 3, ENC, 6, END, 6), |
| 256 | TPS6586X_LDO(LDO_9, "vinldo9", ldo, SUPPLYV6, 3, 3, ENE, 7, ENE, 7), |
Laxman Dewangan | 9394b80 | 2012-09-04 14:43:39 -0600 | [diff] [blame^] | 257 | TPS6586X_LDO(LDO_RTC, "REG-SYS", ldo, SUPPLYV4, 3, 3, V4, 7, V4, 7), |
Laxman Dewangan | 7c7fac3 | 2012-07-13 19:20:32 +0530 | [diff] [blame] | 258 | TPS6586X_LDO(LDO_1, "vinldo01", dvm, SUPPLYV1, 0, 5, ENC, 1, END, 1), |
Laxman Dewangan | 7f852e0 | 2012-07-24 13:48:00 +0530 | [diff] [blame] | 259 | TPS6586X_LDO(SM_2, "vin-sm2", sm2, SUPPLYV2, 0, 5, ENC, 7, END, 7), |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 260 | |
Laxman Dewangan | 7c7fac3 | 2012-07-13 19:20:32 +0530 | [diff] [blame] | 261 | TPS6586X_DVM(LDO_2, "vinldo23", dvm, LDO2BV1, 0, 5, ENA, 3, |
| 262 | ENB, 3, VCC2, 6), |
| 263 | TPS6586X_DVM(LDO_4, "vinldo4", ldo4, LDO4V1, 0, 5, ENC, 3, |
| 264 | END, 3, VCC1, 6), |
Laxman Dewangan | 7f852e0 | 2012-07-24 13:48:00 +0530 | [diff] [blame] | 265 | TPS6586X_DVM(SM_0, "vin-sm0", dvm, SM0V1, 0, 5, ENA, 1, |
| 266 | ENB, 1, VCC1, 2), |
| 267 | TPS6586X_DVM(SM_1, "vin-sm1", dvm, SM1V1, 0, 5, ENA, 0, |
| 268 | ENB, 0, VCC1, 0), |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 269 | }; |
| 270 | |
| 271 | /* |
| 272 | * TPS6586X has 2 enable bits that are OR'ed to determine the actual |
| 273 | * regulator state. Clearing one of this bits allows switching |
| 274 | * regulator on and of with single register write. |
| 275 | */ |
| 276 | static inline int tps6586x_regulator_preinit(struct device *parent, |
| 277 | struct tps6586x_regulator *ri) |
| 278 | { |
| 279 | uint8_t val1, val2; |
| 280 | int ret; |
| 281 | |
Danny Huang | 1dbcf35 | 2010-12-01 13:37:30 -0700 | [diff] [blame] | 282 | if (ri->enable_reg[0] == ri->enable_reg[1] && |
| 283 | ri->enable_bit[0] == ri->enable_bit[1]) |
| 284 | return 0; |
| 285 | |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 286 | ret = tps6586x_read(parent, ri->enable_reg[0], &val1); |
| 287 | if (ret) |
| 288 | return ret; |
| 289 | |
| 290 | ret = tps6586x_read(parent, ri->enable_reg[1], &val2); |
| 291 | if (ret) |
| 292 | return ret; |
| 293 | |
Danny Huang | 4f586707 | 2010-12-01 13:37:28 -0700 | [diff] [blame] | 294 | if (!(val2 & (1 << ri->enable_bit[1]))) |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 295 | return 0; |
| 296 | |
| 297 | /* |
| 298 | * The regulator is on, but it's enabled with the bit we don't |
| 299 | * want to use, so we switch the enable bits |
| 300 | */ |
Danny Huang | 4f586707 | 2010-12-01 13:37:28 -0700 | [diff] [blame] | 301 | if (!(val1 & (1 << ri->enable_bit[0]))) { |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 302 | ret = tps6586x_set_bits(parent, ri->enable_reg[0], |
| 303 | 1 << ri->enable_bit[0]); |
| 304 | if (ret) |
| 305 | return ret; |
| 306 | } |
| 307 | |
| 308 | return tps6586x_clr_bits(parent, ri->enable_reg[1], |
| 309 | 1 << ri->enable_bit[1]); |
| 310 | } |
| 311 | |
Xin Xie | 500c524 | 2011-08-09 18:47:50 +0800 | [diff] [blame] | 312 | static int tps6586x_regulator_set_slew_rate(struct platform_device *pdev) |
| 313 | { |
| 314 | struct device *parent = pdev->dev.parent; |
| 315 | struct regulator_init_data *p = pdev->dev.platform_data; |
| 316 | struct tps6586x_settings *setting = p->driver_data; |
| 317 | uint8_t reg; |
| 318 | |
| 319 | if (setting == NULL) |
| 320 | return 0; |
| 321 | |
| 322 | if (!(setting->slew_rate & TPS6586X_SLEW_RATE_SET)) |
| 323 | return 0; |
| 324 | |
| 325 | /* only SM0 and SM1 can have the slew rate settings */ |
| 326 | switch (pdev->id) { |
| 327 | case TPS6586X_ID_SM_0: |
| 328 | reg = TPS6586X_SM0SL; |
| 329 | break; |
| 330 | case TPS6586X_ID_SM_1: |
| 331 | reg = TPS6586X_SM1SL; |
| 332 | break; |
| 333 | default: |
| 334 | dev_warn(&pdev->dev, "Only SM0/SM1 can set slew rate\n"); |
| 335 | return -EINVAL; |
| 336 | } |
| 337 | |
| 338 | return tps6586x_write(parent, reg, |
| 339 | setting->slew_rate & TPS6586X_SLEW_RATE_MASK); |
| 340 | } |
| 341 | |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 342 | static inline struct tps6586x_regulator *find_regulator_info(int id) |
| 343 | { |
| 344 | struct tps6586x_regulator *ri; |
| 345 | int i; |
| 346 | |
| 347 | for (i = 0; i < ARRAY_SIZE(tps6586x_regulator); i++) { |
| 348 | ri = &tps6586x_regulator[i]; |
| 349 | if (ri->desc.id == id) |
| 350 | return ri; |
| 351 | } |
| 352 | return NULL; |
| 353 | } |
| 354 | |
| 355 | static int __devinit tps6586x_regulator_probe(struct platform_device *pdev) |
| 356 | { |
| 357 | struct tps6586x_regulator *ri = NULL; |
Mark Brown | c172708 | 2012-04-04 00:50:22 +0100 | [diff] [blame] | 358 | struct regulator_config config = { }; |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 359 | struct regulator_dev *rdev; |
| 360 | int id = pdev->id; |
| 361 | int err; |
| 362 | |
Thierry Reding | 394ee3d | 2012-03-08 15:51:24 +0100 | [diff] [blame] | 363 | dev_dbg(&pdev->dev, "Probing regulator %d\n", id); |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 364 | |
| 365 | ri = find_regulator_info(id); |
| 366 | if (ri == NULL) { |
| 367 | dev_err(&pdev->dev, "invalid regulator ID specified\n"); |
| 368 | return -EINVAL; |
| 369 | } |
| 370 | |
| 371 | err = tps6586x_regulator_preinit(pdev->dev.parent, ri); |
| 372 | if (err) |
| 373 | return err; |
| 374 | |
Laxman Dewangan | 7c7fac3 | 2012-07-13 19:20:32 +0530 | [diff] [blame] | 375 | config.dev = pdev->dev.parent; |
Thierry Reding | 62f6b08 | 2012-04-26 16:52:21 +0200 | [diff] [blame] | 376 | config.of_node = pdev->dev.of_node; |
Mark Brown | c172708 | 2012-04-04 00:50:22 +0100 | [diff] [blame] | 377 | config.init_data = pdev->dev.platform_data; |
| 378 | config.driver_data = ri; |
| 379 | |
| 380 | rdev = regulator_register(&ri->desc, &config); |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 381 | if (IS_ERR(rdev)) { |
| 382 | dev_err(&pdev->dev, "failed to register regulator %s\n", |
| 383 | ri->desc.name); |
| 384 | return PTR_ERR(rdev); |
| 385 | } |
| 386 | |
Axel Lin | e7973c3 | 2010-08-09 15:58:06 +0800 | [diff] [blame] | 387 | platform_set_drvdata(pdev, rdev); |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 388 | |
Xin Xie | 500c524 | 2011-08-09 18:47:50 +0800 | [diff] [blame] | 389 | return tps6586x_regulator_set_slew_rate(pdev); |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 390 | } |
| 391 | |
| 392 | static int __devexit tps6586x_regulator_remove(struct platform_device *pdev) |
| 393 | { |
Axel Lin | e7973c3 | 2010-08-09 15:58:06 +0800 | [diff] [blame] | 394 | struct regulator_dev *rdev = platform_get_drvdata(pdev); |
| 395 | |
| 396 | regulator_unregister(rdev); |
Mike Rapoport | 4961023 | 2010-07-27 14:03:01 +0300 | [diff] [blame] | 397 | return 0; |
| 398 | } |
| 399 | |
| 400 | static struct platform_driver tps6586x_regulator_driver = { |
| 401 | .driver = { |
| 402 | .name = "tps6586x-regulator", |
| 403 | .owner = THIS_MODULE, |
| 404 | }, |
| 405 | .probe = tps6586x_regulator_probe, |
| 406 | .remove = __devexit_p(tps6586x_regulator_remove), |
| 407 | }; |
| 408 | |
| 409 | static int __init tps6586x_regulator_init(void) |
| 410 | { |
| 411 | return platform_driver_register(&tps6586x_regulator_driver); |
| 412 | } |
| 413 | subsys_initcall(tps6586x_regulator_init); |
| 414 | |
| 415 | static void __exit tps6586x_regulator_exit(void) |
| 416 | { |
| 417 | platform_driver_unregister(&tps6586x_regulator_driver); |
| 418 | } |
| 419 | module_exit(tps6586x_regulator_exit); |
| 420 | |
| 421 | MODULE_LICENSE("GPL"); |
| 422 | MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>"); |
| 423 | MODULE_DESCRIPTION("Regulator Driver for TI TPS6586X PMIC"); |
| 424 | MODULE_ALIAS("platform:tps6586x-regulator"); |