197be8288SJisheng Zhang // SPDX-License-Identifier: GPL-2.0 297be8288SJisheng Zhang // 3751ca3aaSJisheng Zhang // MP8867/MP8869 regulator driver 497be8288SJisheng Zhang // 597be8288SJisheng Zhang // Copyright (C) 2020 Synaptics Incorporated 697be8288SJisheng Zhang // 797be8288SJisheng Zhang // Author: Jisheng Zhang <jszhang@kernel.org> 897be8288SJisheng Zhang 997be8288SJisheng Zhang #include <linux/gpio/consumer.h> 1097be8288SJisheng Zhang #include <linux/i2c.h> 1197be8288SJisheng Zhang #include <linux/module.h> 1297be8288SJisheng Zhang #include <linux/of_device.h> 1397be8288SJisheng Zhang #include <linux/regmap.h> 1497be8288SJisheng Zhang #include <linux/regulator/driver.h> 1597be8288SJisheng Zhang #include <linux/regulator/of_regulator.h> 1697be8288SJisheng Zhang 1797be8288SJisheng Zhang #define MP886X_VSEL 0x00 1897be8288SJisheng Zhang #define MP886X_V_BOOT (1 << 7) 1997be8288SJisheng Zhang #define MP886X_SYSCNTLREG1 0x01 2097be8288SJisheng Zhang #define MP886X_MODE (1 << 0) 2197be8288SJisheng Zhang #define MP886X_GO (1 << 6) 2297be8288SJisheng Zhang #define MP886X_EN (1 << 7) 2397be8288SJisheng Zhang 2497be8288SJisheng Zhang struct mp886x_device_info { 2597be8288SJisheng Zhang struct device *dev; 2697be8288SJisheng Zhang struct regulator_desc desc; 2797be8288SJisheng Zhang struct regulator_init_data *regulator; 2897be8288SJisheng Zhang struct gpio_desc *en_gpio; 2997be8288SJisheng Zhang u32 r[2]; 3097be8288SJisheng Zhang unsigned int sel; 3197be8288SJisheng Zhang }; 3297be8288SJisheng Zhang 3397be8288SJisheng Zhang static int mp886x_set_mode(struct regulator_dev *rdev, unsigned int mode) 3497be8288SJisheng Zhang { 3597be8288SJisheng Zhang switch (mode) { 3697be8288SJisheng Zhang case REGULATOR_MODE_FAST: 3797be8288SJisheng Zhang regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1, 3897be8288SJisheng Zhang MP886X_MODE, MP886X_MODE); 3997be8288SJisheng Zhang break; 4097be8288SJisheng Zhang case REGULATOR_MODE_NORMAL: 4197be8288SJisheng Zhang regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1, 4297be8288SJisheng Zhang MP886X_MODE, 0); 4397be8288SJisheng Zhang break; 4497be8288SJisheng Zhang default: 4597be8288SJisheng Zhang return -EINVAL; 4697be8288SJisheng Zhang } 4797be8288SJisheng Zhang return 0; 4897be8288SJisheng Zhang } 4997be8288SJisheng Zhang 5097be8288SJisheng Zhang static unsigned int mp886x_get_mode(struct regulator_dev *rdev) 5197be8288SJisheng Zhang { 5297be8288SJisheng Zhang u32 val; 5397be8288SJisheng Zhang int ret; 5497be8288SJisheng Zhang 5597be8288SJisheng Zhang ret = regmap_read(rdev->regmap, MP886X_SYSCNTLREG1, &val); 5697be8288SJisheng Zhang if (ret < 0) 5797be8288SJisheng Zhang return ret; 5897be8288SJisheng Zhang if (val & MP886X_MODE) 5997be8288SJisheng Zhang return REGULATOR_MODE_FAST; 6097be8288SJisheng Zhang else 6197be8288SJisheng Zhang return REGULATOR_MODE_NORMAL; 6297be8288SJisheng Zhang } 6397be8288SJisheng Zhang 6497be8288SJisheng Zhang static int mp8869_set_voltage_sel(struct regulator_dev *rdev, unsigned int sel) 6597be8288SJisheng Zhang { 6697be8288SJisheng Zhang int ret; 6797be8288SJisheng Zhang 6897be8288SJisheng Zhang ret = regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1, 6997be8288SJisheng Zhang MP886X_GO, MP886X_GO); 7097be8288SJisheng Zhang if (ret < 0) 7197be8288SJisheng Zhang return ret; 7297be8288SJisheng Zhang 7397be8288SJisheng Zhang sel <<= ffs(rdev->desc->vsel_mask) - 1; 7497be8288SJisheng Zhang return regmap_update_bits(rdev->regmap, rdev->desc->vsel_reg, 7597be8288SJisheng Zhang MP886X_V_BOOT | rdev->desc->vsel_mask, sel); 7697be8288SJisheng Zhang } 7797be8288SJisheng Zhang 7897be8288SJisheng Zhang static inline unsigned int mp8869_scale(unsigned int uv, u32 r1, u32 r2) 7997be8288SJisheng Zhang { 8097be8288SJisheng Zhang u32 tmp = uv * r1 / r2; 8197be8288SJisheng Zhang 8297be8288SJisheng Zhang return uv + tmp; 8397be8288SJisheng Zhang } 8497be8288SJisheng Zhang 8597be8288SJisheng Zhang static int mp8869_get_voltage_sel(struct regulator_dev *rdev) 8697be8288SJisheng Zhang { 8797be8288SJisheng Zhang struct mp886x_device_info *di = rdev_get_drvdata(rdev); 8897be8288SJisheng Zhang int ret, uv; 8997be8288SJisheng Zhang unsigned int val; 9097be8288SJisheng Zhang bool fbloop; 9197be8288SJisheng Zhang 9297be8288SJisheng Zhang ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val); 9397be8288SJisheng Zhang if (ret) 9497be8288SJisheng Zhang return ret; 9597be8288SJisheng Zhang 9697be8288SJisheng Zhang fbloop = val & MP886X_V_BOOT; 9797be8288SJisheng Zhang if (fbloop) { 9897be8288SJisheng Zhang uv = rdev->desc->min_uV; 9997be8288SJisheng Zhang uv = mp8869_scale(uv, di->r[0], di->r[1]); 10097be8288SJisheng Zhang return regulator_map_voltage_linear(rdev, uv, uv); 10197be8288SJisheng Zhang } 10297be8288SJisheng Zhang 10397be8288SJisheng Zhang val &= rdev->desc->vsel_mask; 10497be8288SJisheng Zhang val >>= ffs(rdev->desc->vsel_mask) - 1; 10597be8288SJisheng Zhang 10697be8288SJisheng Zhang return val; 10797be8288SJisheng Zhang } 10897be8288SJisheng Zhang 10997be8288SJisheng Zhang static const struct regulator_ops mp8869_regulator_ops = { 11097be8288SJisheng Zhang .set_voltage_sel = mp8869_set_voltage_sel, 11197be8288SJisheng Zhang .get_voltage_sel = mp8869_get_voltage_sel, 11297be8288SJisheng Zhang .set_voltage_time_sel = regulator_set_voltage_time_sel, 11397be8288SJisheng Zhang .map_voltage = regulator_map_voltage_linear, 11497be8288SJisheng Zhang .list_voltage = regulator_list_voltage_linear, 11597be8288SJisheng Zhang .enable = regulator_enable_regmap, 11697be8288SJisheng Zhang .disable = regulator_disable_regmap, 11797be8288SJisheng Zhang .is_enabled = regulator_is_enabled_regmap, 11897be8288SJisheng Zhang .set_mode = mp886x_set_mode, 11997be8288SJisheng Zhang .get_mode = mp886x_get_mode, 12097be8288SJisheng Zhang }; 12197be8288SJisheng Zhang 122751ca3aaSJisheng Zhang static int mp8867_set_voltage_sel(struct regulator_dev *rdev, unsigned int sel) 123751ca3aaSJisheng Zhang { 124751ca3aaSJisheng Zhang struct mp886x_device_info *di = rdev_get_drvdata(rdev); 125751ca3aaSJisheng Zhang int ret, delta; 126751ca3aaSJisheng Zhang 127751ca3aaSJisheng Zhang ret = mp8869_set_voltage_sel(rdev, sel); 128751ca3aaSJisheng Zhang if (ret < 0) 129751ca3aaSJisheng Zhang return ret; 130751ca3aaSJisheng Zhang 131751ca3aaSJisheng Zhang delta = di->sel - sel; 132751ca3aaSJisheng Zhang if (abs(delta) <= 5) 133751ca3aaSJisheng Zhang ret = regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1, 134751ca3aaSJisheng Zhang MP886X_GO, 0); 135751ca3aaSJisheng Zhang di->sel = sel; 136751ca3aaSJisheng Zhang 137751ca3aaSJisheng Zhang return ret; 138751ca3aaSJisheng Zhang } 139751ca3aaSJisheng Zhang 140751ca3aaSJisheng Zhang static int mp8867_get_voltage_sel(struct regulator_dev *rdev) 141751ca3aaSJisheng Zhang { 142751ca3aaSJisheng Zhang struct mp886x_device_info *di = rdev_get_drvdata(rdev); 143751ca3aaSJisheng Zhang int ret, uv; 144751ca3aaSJisheng Zhang unsigned int val; 145751ca3aaSJisheng Zhang bool fbloop; 146751ca3aaSJisheng Zhang 147751ca3aaSJisheng Zhang ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val); 148751ca3aaSJisheng Zhang if (ret) 149751ca3aaSJisheng Zhang return ret; 150751ca3aaSJisheng Zhang 151751ca3aaSJisheng Zhang fbloop = val & MP886X_V_BOOT; 152751ca3aaSJisheng Zhang 153751ca3aaSJisheng Zhang val &= rdev->desc->vsel_mask; 154751ca3aaSJisheng Zhang val >>= ffs(rdev->desc->vsel_mask) - 1; 155751ca3aaSJisheng Zhang 156751ca3aaSJisheng Zhang if (fbloop) { 157751ca3aaSJisheng Zhang uv = regulator_list_voltage_linear(rdev, val); 158751ca3aaSJisheng Zhang uv = mp8869_scale(uv, di->r[0], di->r[1]); 159751ca3aaSJisheng Zhang return regulator_map_voltage_linear(rdev, uv, uv); 160751ca3aaSJisheng Zhang } 161751ca3aaSJisheng Zhang 162751ca3aaSJisheng Zhang return val; 163751ca3aaSJisheng Zhang } 164751ca3aaSJisheng Zhang 165751ca3aaSJisheng Zhang static const struct regulator_ops mp8867_regulator_ops = { 166751ca3aaSJisheng Zhang .set_voltage_sel = mp8867_set_voltage_sel, 167751ca3aaSJisheng Zhang .get_voltage_sel = mp8867_get_voltage_sel, 168751ca3aaSJisheng Zhang .set_voltage_time_sel = regulator_set_voltage_time_sel, 169751ca3aaSJisheng Zhang .map_voltage = regulator_map_voltage_linear, 170751ca3aaSJisheng Zhang .list_voltage = regulator_list_voltage_linear, 171751ca3aaSJisheng Zhang .enable = regulator_enable_regmap, 172751ca3aaSJisheng Zhang .disable = regulator_disable_regmap, 173751ca3aaSJisheng Zhang .is_enabled = regulator_is_enabled_regmap, 174751ca3aaSJisheng Zhang .set_mode = mp886x_set_mode, 175751ca3aaSJisheng Zhang .get_mode = mp886x_get_mode, 176751ca3aaSJisheng Zhang }; 177751ca3aaSJisheng Zhang 17897be8288SJisheng Zhang static int mp886x_regulator_register(struct mp886x_device_info *di, 17997be8288SJisheng Zhang struct regulator_config *config) 18097be8288SJisheng Zhang { 18197be8288SJisheng Zhang struct regulator_desc *rdesc = &di->desc; 18297be8288SJisheng Zhang struct regulator_dev *rdev; 18397be8288SJisheng Zhang 18497be8288SJisheng Zhang rdesc->name = "mp886x-reg"; 18597be8288SJisheng Zhang rdesc->supply_name = "vin"; 18697be8288SJisheng Zhang rdesc->ops = of_device_get_match_data(di->dev); 18797be8288SJisheng Zhang rdesc->type = REGULATOR_VOLTAGE; 18897be8288SJisheng Zhang rdesc->n_voltages = 128; 18997be8288SJisheng Zhang rdesc->enable_reg = MP886X_SYSCNTLREG1; 19097be8288SJisheng Zhang rdesc->enable_mask = MP886X_EN; 19197be8288SJisheng Zhang rdesc->min_uV = 600000; 19297be8288SJisheng Zhang rdesc->uV_step = 10000; 19397be8288SJisheng Zhang rdesc->vsel_reg = MP886X_VSEL; 19497be8288SJisheng Zhang rdesc->vsel_mask = 0x3f; 19597be8288SJisheng Zhang rdesc->owner = THIS_MODULE; 19697be8288SJisheng Zhang 19797be8288SJisheng Zhang rdev = devm_regulator_register(di->dev, &di->desc, config); 19897be8288SJisheng Zhang if (IS_ERR(rdev)) 19997be8288SJisheng Zhang return PTR_ERR(rdev); 20097be8288SJisheng Zhang di->sel = rdesc->ops->get_voltage_sel(rdev); 20197be8288SJisheng Zhang return 0; 20297be8288SJisheng Zhang } 20397be8288SJisheng Zhang 20497be8288SJisheng Zhang static const struct regmap_config mp886x_regmap_config = { 20597be8288SJisheng Zhang .reg_bits = 8, 20697be8288SJisheng Zhang .val_bits = 8, 20797be8288SJisheng Zhang }; 20897be8288SJisheng Zhang 20997be8288SJisheng Zhang static int mp886x_i2c_probe(struct i2c_client *client, 21097be8288SJisheng Zhang const struct i2c_device_id *id) 21197be8288SJisheng Zhang { 21297be8288SJisheng Zhang struct device *dev = &client->dev; 21397be8288SJisheng Zhang struct device_node *np = dev->of_node; 21497be8288SJisheng Zhang struct mp886x_device_info *di; 21597be8288SJisheng Zhang struct regulator_config config = { }; 21697be8288SJisheng Zhang struct regmap *regmap; 21797be8288SJisheng Zhang int ret; 21897be8288SJisheng Zhang 21997be8288SJisheng Zhang di = devm_kzalloc(dev, sizeof(struct mp886x_device_info), GFP_KERNEL); 22097be8288SJisheng Zhang if (!di) 22197be8288SJisheng Zhang return -ENOMEM; 22297be8288SJisheng Zhang 22397be8288SJisheng Zhang di->regulator = of_get_regulator_init_data(dev, np, &di->desc); 22497be8288SJisheng Zhang if (!di->regulator) { 22597be8288SJisheng Zhang dev_err(dev, "Platform data not found!\n"); 22697be8288SJisheng Zhang return -EINVAL; 22797be8288SJisheng Zhang } 22897be8288SJisheng Zhang 22997be8288SJisheng Zhang ret = of_property_read_u32_array(np, "mps,fb-voltage-divider", 23097be8288SJisheng Zhang di->r, 2); 23197be8288SJisheng Zhang if (ret) 23297be8288SJisheng Zhang return ret; 23397be8288SJisheng Zhang 23497be8288SJisheng Zhang di->en_gpio = devm_gpiod_get(dev, "enable", GPIOD_OUT_HIGH); 23597be8288SJisheng Zhang if (IS_ERR(di->en_gpio)) 23697be8288SJisheng Zhang return PTR_ERR(di->en_gpio); 23797be8288SJisheng Zhang 23897be8288SJisheng Zhang di->dev = dev; 23997be8288SJisheng Zhang 24097be8288SJisheng Zhang regmap = devm_regmap_init_i2c(client, &mp886x_regmap_config); 24197be8288SJisheng Zhang if (IS_ERR(regmap)) { 24297be8288SJisheng Zhang dev_err(dev, "Failed to allocate regmap!\n"); 24397be8288SJisheng Zhang return PTR_ERR(regmap); 24497be8288SJisheng Zhang } 24597be8288SJisheng Zhang i2c_set_clientdata(client, di); 24697be8288SJisheng Zhang 24797be8288SJisheng Zhang config.dev = di->dev; 24897be8288SJisheng Zhang config.init_data = di->regulator; 24997be8288SJisheng Zhang config.regmap = regmap; 25097be8288SJisheng Zhang config.driver_data = di; 25197be8288SJisheng Zhang config.of_node = np; 25297be8288SJisheng Zhang 25397be8288SJisheng Zhang ret = mp886x_regulator_register(di, &config); 25497be8288SJisheng Zhang if (ret < 0) 25597be8288SJisheng Zhang dev_err(dev, "Failed to register regulator!\n"); 25697be8288SJisheng Zhang return ret; 25797be8288SJisheng Zhang } 25897be8288SJisheng Zhang 25997be8288SJisheng Zhang static const struct of_device_id mp886x_dt_ids[] = { 26097be8288SJisheng Zhang { 261751ca3aaSJisheng Zhang .compatible = "mps,mp8867", 262751ca3aaSJisheng Zhang .data = &mp8867_regulator_ops 263751ca3aaSJisheng Zhang }, 264751ca3aaSJisheng Zhang { 26597be8288SJisheng Zhang .compatible = "mps,mp8869", 26697be8288SJisheng Zhang .data = &mp8869_regulator_ops 26797be8288SJisheng Zhang }, 26897be8288SJisheng Zhang { } 26997be8288SJisheng Zhang }; 27097be8288SJisheng Zhang MODULE_DEVICE_TABLE(of, mp886x_dt_ids); 27197be8288SJisheng Zhang 27297be8288SJisheng Zhang static const struct i2c_device_id mp886x_id[] = { 27397be8288SJisheng Zhang { "mp886x", }, 27497be8288SJisheng Zhang { }, 27597be8288SJisheng Zhang }; 27697be8288SJisheng Zhang MODULE_DEVICE_TABLE(i2c, mp886x_id); 27797be8288SJisheng Zhang 27897be8288SJisheng Zhang static struct i2c_driver mp886x_regulator_driver = { 27997be8288SJisheng Zhang .driver = { 28097be8288SJisheng Zhang .name = "mp886x-regulator", 28197be8288SJisheng Zhang .of_match_table = of_match_ptr(mp886x_dt_ids), 28297be8288SJisheng Zhang }, 28397be8288SJisheng Zhang .probe = mp886x_i2c_probe, 28497be8288SJisheng Zhang .id_table = mp886x_id, 28597be8288SJisheng Zhang }; 28697be8288SJisheng Zhang module_i2c_driver(mp886x_regulator_driver); 28797be8288SJisheng Zhang 28897be8288SJisheng Zhang MODULE_AUTHOR("Jisheng Zhang <jszhang@kernel.org>"); 28997be8288SJisheng Zhang MODULE_DESCRIPTION("MP886x regulator driver"); 29097be8288SJisheng Zhang MODULE_LICENSE("GPL v2"); 291