drivers/regulator/mp886x.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 //
   3 // MP8867/MP8869 regulator driver
   4 //
   5 // Copyright (C) 2020 Synaptics Incorporated
   6 //
   7 // Author: Jisheng Zhang <jszhang@kernel.org>
   8
   9 #include <linux/gpio/consumer.h>
  10 #include <linux/i2c.h>
  11 #include <linux/module.h>
  12 #include <linux/of_device.h>
  13 #include <linux/regmap.h>
  14 #include <linux/regulator/driver.h>
  15 #include <linux/regulator/of_regulator.h>
  16
  17 #define MP886X_VSEL             0x00
  18 #define  MP886X_V_BOOT          (1 << 7)
  19 #define MP886X_SYSCNTLREG1      0x01
  20 #define  MP886X_MODE            (1 << 0)
  21 #define  MP886X_SLEW_SHIFT      3
  22 #define  MP886X_SLEW_MASK       (0x7 << MP886X_SLEW_SHIFT)
  23 #define  MP886X_GO              (1 << 6)
  24 #define  MP886X_EN              (1 << 7)
  25 #define MP8869_SYSCNTLREG2      0x02
  26
  27 struct mp886x_cfg_info {
  28         const struct regulator_ops *rops;
  29         const unsigned int slew_rates[8];
  30         const int switch_freq[4];
  31         const u8 fs_reg;
  32         const u8 fs_shift;
  33 };
  34
  35 struct mp886x_device_info {
  36         struct device *dev;
  37         struct regulator_desc desc;
  38         struct regulator_init_data *regulator;
  39         struct gpio_desc *en_gpio;
  40         const struct mp886x_cfg_info *ci;
  41         u32 r[2];
  42         unsigned int sel;
  43 };
  44
  45 static void mp886x_set_switch_freq(struct mp886x_device_info *di,
  46                                    struct regmap *regmap,
  47                                    u32 freq)
  48 {
  49         const struct mp886x_cfg_info *ci = di->ci;
  50         int i;
  51
  52         for (i = 0; i < ARRAY_SIZE(ci->switch_freq); i++) {
  53                 if (freq == ci->switch_freq[i]) {
  54                         regmap_update_bits(regmap, ci->fs_reg,
  55                                   0x3 << ci->fs_shift, i << ci->fs_shift);
  56                         return;
  57                 }
  58         }
  59
  60         dev_err(di->dev, "invalid frequency %d\n", freq);
  61 }
  62
  63 static int mp886x_set_mode(struct regulator_dev *rdev, unsigned int mode)
  64 {
  65         switch (mode) {
  66         case REGULATOR_MODE_FAST:
  67                 regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
  68                                    MP886X_MODE, MP886X_MODE);
  69                 break;
  70         case REGULATOR_MODE_NORMAL:
  71                 regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
  72                                    MP886X_MODE, 0);
  73                 break;
  74         default:
  75                 return -EINVAL;
  76         }
  77         return 0;
  78 }
  79
  80 static unsigned int mp886x_get_mode(struct regulator_dev *rdev)
  81 {
  82         u32 val;
  83         int ret;
  84
  85         ret = regmap_read(rdev->regmap, MP886X_SYSCNTLREG1, &val);
  86         if (ret < 0)
  87                 return ret;
  88         if (val & MP886X_MODE)
  89                 return REGULATOR_MODE_FAST;
  90         else
  91                 return REGULATOR_MODE_NORMAL;
  92 }
  93
  94 static int mp8869_set_voltage_sel(struct regulator_dev *rdev, unsigned int sel)
  95 {
  96         int ret;
  97
  98         ret = regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
  99                                  MP886X_GO, MP886X_GO);
 100         if (ret < 0)
 101                 return ret;
 102
 103         sel <<= ffs(rdev->desc->vsel_mask) - 1;
 104         return regmap_update_bits(rdev->regmap, rdev->desc->vsel_reg,
 105                                   MP886X_V_BOOT | rdev->desc->vsel_mask, sel);
 106 }
 107
 108 static inline unsigned int mp8869_scale(unsigned int uv, u32 r1, u32 r2)
 109 {
 110         u32 tmp = uv * r1 / r2;
 111
 112         return uv + tmp;
 113 }
 114
 115 static int mp8869_get_voltage_sel(struct regulator_dev *rdev)
 116 {
 117         struct mp886x_device_info *di = rdev_get_drvdata(rdev);
 118         int ret, uv;
 119         unsigned int val;
 120         bool fbloop;
 121
 122         ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val);
 123         if (ret)
 124                 return ret;
 125
 126         fbloop = val & MP886X_V_BOOT;
 127         if (fbloop) {
 128                 uv = rdev->desc->min_uV;
 129                 uv = mp8869_scale(uv, di->r[0], di->r[1]);
 130                 return regulator_map_voltage_linear(rdev, uv, uv);
 131         }
 132
 133         val &= rdev->desc->vsel_mask;
 134         val >>= ffs(rdev->desc->vsel_mask) - 1;
 135
 136         return val;
 137 }
 138
 139 static const struct regulator_ops mp8869_regulator_ops = {
 140         .set_voltage_sel = mp8869_set_voltage_sel,
 141         .get_voltage_sel = mp8869_get_voltage_sel,
 142         .set_voltage_time_sel = regulator_set_voltage_time_sel,
 143         .map_voltage = regulator_map_voltage_linear,
 144         .list_voltage = regulator_list_voltage_linear,
 145         .enable = regulator_enable_regmap,
 146         .disable = regulator_disable_regmap,
 147         .is_enabled = regulator_is_enabled_regmap,
 148         .set_mode = mp886x_set_mode,
 149         .get_mode = mp886x_get_mode,
 150         .set_ramp_delay = regulator_set_ramp_delay_regmap,
 151 };
 152
 153 static const struct mp886x_cfg_info mp8869_ci = {
 154         .rops = &mp8869_regulator_ops,
 155         .slew_rates = {
 156                 40000,
 157                 30000,
 158                 20000,
 159                 10000,
 160                 5000,
 161                 2500,
 162                 1250,
 163                 625,
 164         },
 165         .switch_freq = {
 166                 500000,
 167                 750000,
 168                 1000000,
 169                 1250000,
 170         },
 171         .fs_reg = MP8869_SYSCNTLREG2,
 172         .fs_shift = 4,
 173 };
 174
 175 static int mp8867_set_voltage_sel(struct regulator_dev *rdev, unsigned int sel)
 176 {
 177         struct mp886x_device_info *di = rdev_get_drvdata(rdev);
 178         int ret, delta;
 179
 180         ret = mp8869_set_voltage_sel(rdev, sel);
 181         if (ret < 0)
 182                 return ret;
 183
 184         delta = di->sel - sel;
 185         if (abs(delta) <= 5)
 186                 ret = regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
 187                                          MP886X_GO, 0);
 188         di->sel = sel;
 189
 190         return ret;
 191 }
 192
 193 static int mp8867_get_voltage_sel(struct regulator_dev *rdev)
 194 {
 195         struct mp886x_device_info *di = rdev_get_drvdata(rdev);
 196         int ret, uv;
 197         unsigned int val;
 198         bool fbloop;
 199
 200         ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val);
 201         if (ret)
 202                 return ret;
 203
 204         fbloop = val & MP886X_V_BOOT;
 205
 206         val &= rdev->desc->vsel_mask;
 207         val >>= ffs(rdev->desc->vsel_mask) - 1;
 208
 209         if (fbloop) {
 210                 uv = regulator_list_voltage_linear(rdev, val);
 211                 uv = mp8869_scale(uv, di->r[0], di->r[1]);
 212                 return regulator_map_voltage_linear(rdev, uv, uv);
 213         }
 214
 215         return val;
 216 }
 217
 218 static const struct regulator_ops mp8867_regulator_ops = {
 219         .set_voltage_sel = mp8867_set_voltage_sel,
 220         .get_voltage_sel = mp8867_get_voltage_sel,
 221         .set_voltage_time_sel = regulator_set_voltage_time_sel,
 222         .map_voltage = regulator_map_voltage_linear,
 223         .list_voltage = regulator_list_voltage_linear,
 224         .enable = regulator_enable_regmap,
 225         .disable = regulator_disable_regmap,
 226         .is_enabled = regulator_is_enabled_regmap,
 227         .set_mode = mp886x_set_mode,
 228         .get_mode = mp886x_get_mode,
 229         .set_ramp_delay = regulator_set_ramp_delay_regmap,
 230 };
 231
 232 static const struct mp886x_cfg_info mp8867_ci = {
 233         .rops = &mp8867_regulator_ops,
 234         .slew_rates = {
 235                 64000,
 236                 32000,
 237                 16000,
 238                 8000,
 239                 4000,
 240                 2000,
 241                 1000,
 242                 500,
 243         },
 244         .switch_freq = {
 245                 500000,
 246                 750000,
 247                 1000000,
 248                 1500000,
 249         },
 250         .fs_reg = MP886X_SYSCNTLREG1,
 251         .fs_shift = 1,
 252 };
 253
 254 static int mp886x_regulator_register(struct mp886x_device_info *di,
 255                                      struct regulator_config *config)
 256 {
 257         struct regulator_desc *rdesc = &di->desc;
 258         struct regulator_dev *rdev;
 259
 260         rdesc->name = "mp886x-reg";
 261         rdesc->supply_name = "vin";
 262         rdesc->ops = di->ci->rops;
 263         rdesc->type = REGULATOR_VOLTAGE;
 264         rdesc->n_voltages = 128;
 265         rdesc->enable_reg = MP886X_SYSCNTLREG1;
 266         rdesc->enable_mask = MP886X_EN;
 267         rdesc->min_uV = 600000;
 268         rdesc->uV_step = 10000;
 269         rdesc->vsel_reg = MP886X_VSEL;
 270         rdesc->vsel_mask = 0x3f;
 271         rdesc->ramp_reg = MP886X_SYSCNTLREG1;
 272         rdesc->ramp_mask = MP886X_SLEW_MASK;
 273         rdesc->ramp_delay_table = di->ci->slew_rates;
 274         rdesc->n_ramp_values = ARRAY_SIZE(di->ci->slew_rates);
 275         rdesc->owner = THIS_MODULE;
 276
 277         rdev = devm_regulator_register(di->dev, &di->desc, config);
 278         if (IS_ERR(rdev))
 279                 return PTR_ERR(rdev);
 280         di->sel = rdesc->ops->get_voltage_sel(rdev);
 281         return 0;
 282 }
 283
 284 static const struct regmap_config mp886x_regmap_config = {
 285         .reg_bits = 8,
 286         .val_bits = 8,
 287 };
 288
 289 static int mp886x_i2c_probe(struct i2c_client *client)
 290 {
 291         struct device *dev = &client->dev;
 292         struct device_node *np = dev->of_node;
 293         struct mp886x_device_info *di;
 294         struct regulator_config config = { };
 295         struct regmap *regmap;
 296         u32 freq;
 297         int ret;
 298
 299         di = devm_kzalloc(dev, sizeof(struct mp886x_device_info), GFP_KERNEL);
 300         if (!di)
 301                 return -ENOMEM;
 302
 303         di->regulator = of_get_regulator_init_data(dev, np, &di->desc);
 304         if (!di->regulator) {
 305                 dev_err(dev, "Platform data not found!\n");
 306                 return -EINVAL;
 307         }
 308
 309         ret = of_property_read_u32_array(np, "mps,fb-voltage-divider",
 310                                          di->r, 2);
 311         if (ret)
 312                 return ret;
 313
 314         di->en_gpio = devm_gpiod_get(dev, "enable", GPIOD_OUT_HIGH);
 315         if (IS_ERR(di->en_gpio))
 316                 return PTR_ERR(di->en_gpio);
 317
 318         di->ci = of_device_get_match_data(dev);
 319         di->dev = dev;
 320
 321         regmap = devm_regmap_init_i2c(client, &mp886x_regmap_config);
 322         if (IS_ERR(regmap)) {
 323                 dev_err(dev, "Failed to allocate regmap!\n");
 324                 return PTR_ERR(regmap);
 325         }
 326         i2c_set_clientdata(client, di);
 327
 328         config.dev = di->dev;
 329         config.init_data = di->regulator;
 330         config.regmap = regmap;
 331         config.driver_data = di;
 332         config.of_node = np;
 333
 334         if (!of_property_read_u32(np, "mps,switch-frequency-hz", &freq))
 335                 mp886x_set_switch_freq(di, regmap, freq);
 336
 337         ret = mp886x_regulator_register(di, &config);
 338         if (ret < 0)
 339                 dev_err(dev, "Failed to register regulator!\n");
 340         return ret;
 341 }
 342
 343 static const struct of_device_id mp886x_dt_ids[] = {
 344         {
 345                 .compatible = "mps,mp8867",
 346                 .data = &mp8867_ci
 347         },
 348         {
 349                 .compatible = "mps,mp8869",
 350                 .data = &mp8869_ci
 351         },
 352         { }
 353 };
 354 MODULE_DEVICE_TABLE(of, mp886x_dt_ids);
 355
 356 static const struct i2c_device_id mp886x_id[] = {
 357         { "mp886x", },
 358         { },
 359 };
 360 MODULE_DEVICE_TABLE(i2c, mp886x_id);
 361
 362 static struct i2c_driver mp886x_regulator_driver = {
 363         .driver = {
 364                 .name = "mp886x-regulator",
 365                 .of_match_table = of_match_ptr(mp886x_dt_ids),
 366         },
 367         .probe_new = mp886x_i2c_probe,
 368         .id_table = mp886x_id,
 369 };
 370 module_i2c_driver(mp886x_regulator_driver);
 371
 372 MODULE_AUTHOR("Jisheng Zhang <jszhang@kernel.org>");
 373 MODULE_DESCRIPTION("MP886x regulator driver");
 374 MODULE_LICENSE("GPL v2");