mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-21 08:19:28 +00:00
![Axel Lin](/assets/img/avatar_default.png)
Use regulator_set_ramp_delay_regmap instead of open-coded. Signed-off-by: Axel Lin <axel.lin@ingics.com> Message-Id: <20210525102708.2519323-1-axel.lin@ingics.com> Signed-off-by: Mark Brown <broonie@sirena.org.uk>
374 lines
8.6 KiB
C
374 lines
8.6 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
//
|
|
// MP8867/MP8869 regulator driver
|
|
//
|
|
// Copyright (C) 2020 Synaptics Incorporated
|
|
//
|
|
// Author: Jisheng Zhang <jszhang@kernel.org>
|
|
|
|
#include <linux/gpio/consumer.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of_device.h>
|
|
#include <linux/regmap.h>
|
|
#include <linux/regulator/driver.h>
|
|
#include <linux/regulator/of_regulator.h>
|
|
|
|
#define MP886X_VSEL 0x00
|
|
#define MP886X_V_BOOT (1 << 7)
|
|
#define MP886X_SYSCNTLREG1 0x01
|
|
#define MP886X_MODE (1 << 0)
|
|
#define MP886X_SLEW_SHIFT 3
|
|
#define MP886X_SLEW_MASK (0x7 << MP886X_SLEW_SHIFT)
|
|
#define MP886X_GO (1 << 6)
|
|
#define MP886X_EN (1 << 7)
|
|
#define MP8869_SYSCNTLREG2 0x02
|
|
|
|
struct mp886x_cfg_info {
|
|
const struct regulator_ops *rops;
|
|
const unsigned int slew_rates[8];
|
|
const int switch_freq[4];
|
|
const u8 fs_reg;
|
|
const u8 fs_shift;
|
|
};
|
|
|
|
struct mp886x_device_info {
|
|
struct device *dev;
|
|
struct regulator_desc desc;
|
|
struct regulator_init_data *regulator;
|
|
struct gpio_desc *en_gpio;
|
|
const struct mp886x_cfg_info *ci;
|
|
u32 r[2];
|
|
unsigned int sel;
|
|
};
|
|
|
|
static void mp886x_set_switch_freq(struct mp886x_device_info *di,
|
|
struct regmap *regmap,
|
|
u32 freq)
|
|
{
|
|
const struct mp886x_cfg_info *ci = di->ci;
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(ci->switch_freq); i++) {
|
|
if (freq == ci->switch_freq[i]) {
|
|
regmap_update_bits(regmap, ci->fs_reg,
|
|
0x3 << ci->fs_shift, i << ci->fs_shift);
|
|
return;
|
|
}
|
|
}
|
|
|
|
dev_err(di->dev, "invalid frequency %d\n", freq);
|
|
}
|
|
|
|
static int mp886x_set_mode(struct regulator_dev *rdev, unsigned int mode)
|
|
{
|
|
switch (mode) {
|
|
case REGULATOR_MODE_FAST:
|
|
regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
|
|
MP886X_MODE, MP886X_MODE);
|
|
break;
|
|
case REGULATOR_MODE_NORMAL:
|
|
regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
|
|
MP886X_MODE, 0);
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static unsigned int mp886x_get_mode(struct regulator_dev *rdev)
|
|
{
|
|
u32 val;
|
|
int ret;
|
|
|
|
ret = regmap_read(rdev->regmap, MP886X_SYSCNTLREG1, &val);
|
|
if (ret < 0)
|
|
return ret;
|
|
if (val & MP886X_MODE)
|
|
return REGULATOR_MODE_FAST;
|
|
else
|
|
return REGULATOR_MODE_NORMAL;
|
|
}
|
|
|
|
static int mp8869_set_voltage_sel(struct regulator_dev *rdev, unsigned int sel)
|
|
{
|
|
int ret;
|
|
|
|
ret = regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
|
|
MP886X_GO, MP886X_GO);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
sel <<= ffs(rdev->desc->vsel_mask) - 1;
|
|
return regmap_update_bits(rdev->regmap, rdev->desc->vsel_reg,
|
|
MP886X_V_BOOT | rdev->desc->vsel_mask, sel);
|
|
}
|
|
|
|
static inline unsigned int mp8869_scale(unsigned int uv, u32 r1, u32 r2)
|
|
{
|
|
u32 tmp = uv * r1 / r2;
|
|
|
|
return uv + tmp;
|
|
}
|
|
|
|
static int mp8869_get_voltage_sel(struct regulator_dev *rdev)
|
|
{
|
|
struct mp886x_device_info *di = rdev_get_drvdata(rdev);
|
|
int ret, uv;
|
|
unsigned int val;
|
|
bool fbloop;
|
|
|
|
ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val);
|
|
if (ret)
|
|
return ret;
|
|
|
|
fbloop = val & MP886X_V_BOOT;
|
|
if (fbloop) {
|
|
uv = rdev->desc->min_uV;
|
|
uv = mp8869_scale(uv, di->r[0], di->r[1]);
|
|
return regulator_map_voltage_linear(rdev, uv, uv);
|
|
}
|
|
|
|
val &= rdev->desc->vsel_mask;
|
|
val >>= ffs(rdev->desc->vsel_mask) - 1;
|
|
|
|
return val;
|
|
}
|
|
|
|
static const struct regulator_ops mp8869_regulator_ops = {
|
|
.set_voltage_sel = mp8869_set_voltage_sel,
|
|
.get_voltage_sel = mp8869_get_voltage_sel,
|
|
.set_voltage_time_sel = regulator_set_voltage_time_sel,
|
|
.map_voltage = regulator_map_voltage_linear,
|
|
.list_voltage = regulator_list_voltage_linear,
|
|
.enable = regulator_enable_regmap,
|
|
.disable = regulator_disable_regmap,
|
|
.is_enabled = regulator_is_enabled_regmap,
|
|
.set_mode = mp886x_set_mode,
|
|
.get_mode = mp886x_get_mode,
|
|
.set_ramp_delay = regulator_set_ramp_delay_regmap,
|
|
};
|
|
|
|
static const struct mp886x_cfg_info mp8869_ci = {
|
|
.rops = &mp8869_regulator_ops,
|
|
.slew_rates = {
|
|
40000,
|
|
30000,
|
|
20000,
|
|
10000,
|
|
5000,
|
|
2500,
|
|
1250,
|
|
625,
|
|
},
|
|
.switch_freq = {
|
|
500000,
|
|
750000,
|
|
1000000,
|
|
1250000,
|
|
},
|
|
.fs_reg = MP8869_SYSCNTLREG2,
|
|
.fs_shift = 4,
|
|
};
|
|
|
|
static int mp8867_set_voltage_sel(struct regulator_dev *rdev, unsigned int sel)
|
|
{
|
|
struct mp886x_device_info *di = rdev_get_drvdata(rdev);
|
|
int ret, delta;
|
|
|
|
ret = mp8869_set_voltage_sel(rdev, sel);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
delta = di->sel - sel;
|
|
if (abs(delta) <= 5)
|
|
ret = regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
|
|
MP886X_GO, 0);
|
|
di->sel = sel;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int mp8867_get_voltage_sel(struct regulator_dev *rdev)
|
|
{
|
|
struct mp886x_device_info *di = rdev_get_drvdata(rdev);
|
|
int ret, uv;
|
|
unsigned int val;
|
|
bool fbloop;
|
|
|
|
ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val);
|
|
if (ret)
|
|
return ret;
|
|
|
|
fbloop = val & MP886X_V_BOOT;
|
|
|
|
val &= rdev->desc->vsel_mask;
|
|
val >>= ffs(rdev->desc->vsel_mask) - 1;
|
|
|
|
if (fbloop) {
|
|
uv = regulator_list_voltage_linear(rdev, val);
|
|
uv = mp8869_scale(uv, di->r[0], di->r[1]);
|
|
return regulator_map_voltage_linear(rdev, uv, uv);
|
|
}
|
|
|
|
return val;
|
|
}
|
|
|
|
static const struct regulator_ops mp8867_regulator_ops = {
|
|
.set_voltage_sel = mp8867_set_voltage_sel,
|
|
.get_voltage_sel = mp8867_get_voltage_sel,
|
|
.set_voltage_time_sel = regulator_set_voltage_time_sel,
|
|
.map_voltage = regulator_map_voltage_linear,
|
|
.list_voltage = regulator_list_voltage_linear,
|
|
.enable = regulator_enable_regmap,
|
|
.disable = regulator_disable_regmap,
|
|
.is_enabled = regulator_is_enabled_regmap,
|
|
.set_mode = mp886x_set_mode,
|
|
.get_mode = mp886x_get_mode,
|
|
.set_ramp_delay = regulator_set_ramp_delay_regmap,
|
|
};
|
|
|
|
static const struct mp886x_cfg_info mp8867_ci = {
|
|
.rops = &mp8867_regulator_ops,
|
|
.slew_rates = {
|
|
64000,
|
|
32000,
|
|
16000,
|
|
8000,
|
|
4000,
|
|
2000,
|
|
1000,
|
|
500,
|
|
},
|
|
.switch_freq = {
|
|
500000,
|
|
750000,
|
|
1000000,
|
|
1500000,
|
|
},
|
|
.fs_reg = MP886X_SYSCNTLREG1,
|
|
.fs_shift = 1,
|
|
};
|
|
|
|
static int mp886x_regulator_register(struct mp886x_device_info *di,
|
|
struct regulator_config *config)
|
|
{
|
|
struct regulator_desc *rdesc = &di->desc;
|
|
struct regulator_dev *rdev;
|
|
|
|
rdesc->name = "mp886x-reg";
|
|
rdesc->supply_name = "vin";
|
|
rdesc->ops = di->ci->rops;
|
|
rdesc->type = REGULATOR_VOLTAGE;
|
|
rdesc->n_voltages = 128;
|
|
rdesc->enable_reg = MP886X_SYSCNTLREG1;
|
|
rdesc->enable_mask = MP886X_EN;
|
|
rdesc->min_uV = 600000;
|
|
rdesc->uV_step = 10000;
|
|
rdesc->vsel_reg = MP886X_VSEL;
|
|
rdesc->vsel_mask = 0x3f;
|
|
rdesc->ramp_reg = MP886X_SYSCNTLREG1;
|
|
rdesc->ramp_mask = MP886X_SLEW_MASK;
|
|
rdesc->ramp_delay_table = di->ci->slew_rates;
|
|
rdesc->n_ramp_values = ARRAY_SIZE(di->ci->slew_rates);
|
|
rdesc->owner = THIS_MODULE;
|
|
|
|
rdev = devm_regulator_register(di->dev, &di->desc, config);
|
|
if (IS_ERR(rdev))
|
|
return PTR_ERR(rdev);
|
|
di->sel = rdesc->ops->get_voltage_sel(rdev);
|
|
return 0;
|
|
}
|
|
|
|
static const struct regmap_config mp886x_regmap_config = {
|
|
.reg_bits = 8,
|
|
.val_bits = 8,
|
|
};
|
|
|
|
static int mp886x_i2c_probe(struct i2c_client *client)
|
|
{
|
|
struct device *dev = &client->dev;
|
|
struct device_node *np = dev->of_node;
|
|
struct mp886x_device_info *di;
|
|
struct regulator_config config = { };
|
|
struct regmap *regmap;
|
|
u32 freq;
|
|
int ret;
|
|
|
|
di = devm_kzalloc(dev, sizeof(struct mp886x_device_info), GFP_KERNEL);
|
|
if (!di)
|
|
return -ENOMEM;
|
|
|
|
di->regulator = of_get_regulator_init_data(dev, np, &di->desc);
|
|
if (!di->regulator) {
|
|
dev_err(dev, "Platform data not found!\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
ret = of_property_read_u32_array(np, "mps,fb-voltage-divider",
|
|
di->r, 2);
|
|
if (ret)
|
|
return ret;
|
|
|
|
di->en_gpio = devm_gpiod_get(dev, "enable", GPIOD_OUT_HIGH);
|
|
if (IS_ERR(di->en_gpio))
|
|
return PTR_ERR(di->en_gpio);
|
|
|
|
di->ci = of_device_get_match_data(dev);
|
|
di->dev = dev;
|
|
|
|
regmap = devm_regmap_init_i2c(client, &mp886x_regmap_config);
|
|
if (IS_ERR(regmap)) {
|
|
dev_err(dev, "Failed to allocate regmap!\n");
|
|
return PTR_ERR(regmap);
|
|
}
|
|
i2c_set_clientdata(client, di);
|
|
|
|
config.dev = di->dev;
|
|
config.init_data = di->regulator;
|
|
config.regmap = regmap;
|
|
config.driver_data = di;
|
|
config.of_node = np;
|
|
|
|
if (!of_property_read_u32(np, "mps,switch-frequency-hz", &freq))
|
|
mp886x_set_switch_freq(di, regmap, freq);
|
|
|
|
ret = mp886x_regulator_register(di, &config);
|
|
if (ret < 0)
|
|
dev_err(dev, "Failed to register regulator!\n");
|
|
return ret;
|
|
}
|
|
|
|
static const struct of_device_id mp886x_dt_ids[] = {
|
|
{
|
|
.compatible = "mps,mp8867",
|
|
.data = &mp8867_ci
|
|
},
|
|
{
|
|
.compatible = "mps,mp8869",
|
|
.data = &mp8869_ci
|
|
},
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, mp886x_dt_ids);
|
|
|
|
static const struct i2c_device_id mp886x_id[] = {
|
|
{ "mp886x", },
|
|
{ },
|
|
};
|
|
MODULE_DEVICE_TABLE(i2c, mp886x_id);
|
|
|
|
static struct i2c_driver mp886x_regulator_driver = {
|
|
.driver = {
|
|
.name = "mp886x-regulator",
|
|
.of_match_table = of_match_ptr(mp886x_dt_ids),
|
|
},
|
|
.probe_new = mp886x_i2c_probe,
|
|
.id_table = mp886x_id,
|
|
};
|
|
module_i2c_driver(mp886x_regulator_driver);
|
|
|
|
MODULE_AUTHOR("Jisheng Zhang <jszhang@kernel.org>");
|
|
MODULE_DESCRIPTION("MP886x regulator driver");
|
|
MODULE_LICENSE("GPL v2");
|