mirror of
https://github.com/torvalds/linux.git
synced 2024-11-14 16:12:02 +00:00
af1296d15d
A fixed LDO VOUT property has been added to specify the fixed_uV of the regulator_desc. Additionally, a check has been included in this version to ensure that the fixed_uV matches the constraints. Signed-off-by: Alina Yu <alina_yu@richtek.com> Link: https://msgid.link/r/39357ff9e6e5f3dec5a6f7f833a3591c0defc63a.1716870419.git.alina_yu@richtek.com Signed-off-by: Mark Brown <broonie@kernel.org>
639 lines
18 KiB
C
639 lines
18 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
|
|
#include <linux/bitops.h>
|
|
#include <linux/bitfield.h>
|
|
#include <linux/util_macros.h>
|
|
#include <linux/module.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/regmap.h>
|
|
#include <linux/regulator/driver.h>
|
|
#include <linux/regulator/machine.h>
|
|
#include <linux/regulator/of_regulator.h>
|
|
#include <linux/mod_devicetable.h>
|
|
|
|
/* Register */
|
|
#define RTQ2208_REG_GLOBAL_INT1 0x12
|
|
#define RTQ2208_REG_FLT_RECORDBUCK_CB 0x18
|
|
#define RTQ2208_REG_GLOBAL_INT1_MASK 0x1D
|
|
#define RTQ2208_REG_FLT_MASKBUCK_CB 0x1F
|
|
#define RTQ2208_REG_BUCK_C_CFG0 0x32
|
|
#define RTQ2208_REG_BUCK_B_CFG0 0x42
|
|
#define RTQ2208_REG_BUCK_A_CFG0 0x52
|
|
#define RTQ2208_REG_BUCK_D_CFG0 0x62
|
|
#define RTQ2208_REG_BUCK_G_CFG0 0x72
|
|
#define RTQ2208_REG_BUCK_F_CFG0 0x82
|
|
#define RTQ2208_REG_BUCK_E_CFG0 0x92
|
|
#define RTQ2208_REG_BUCK_H_CFG0 0xA2
|
|
#define RTQ2208_REG_LDO1_CFG 0xB1
|
|
#define RTQ2208_REG_LDO2_CFG 0xC1
|
|
#define RTQ2208_REG_LDO_DVS_CTRL 0xD0
|
|
|
|
/* Mask */
|
|
#define RTQ2208_BUCK_NR_MTP_SEL_MASK GENMASK(7, 0)
|
|
#define RTQ2208_BUCK_EN_NR_MTP_SEL0_MASK BIT(0)
|
|
#define RTQ2208_BUCK_EN_NR_MTP_SEL1_MASK BIT(1)
|
|
#define RTQ2208_BUCK_RSPUP_MASK GENMASK(6, 4)
|
|
#define RTQ2208_BUCK_RSPDN_MASK GENMASK(2, 0)
|
|
#define RTQ2208_BUCK_NRMODE_MASK BIT(5)
|
|
#define RTQ2208_BUCK_STRMODE_MASK BIT(5)
|
|
#define RTQ2208_BUCK_EN_STR_MASK BIT(0)
|
|
#define RTQ2208_LDO_EN_STR_MASK BIT(7)
|
|
#define RTQ2208_EN_DIS_MASK BIT(0)
|
|
#define RTQ2208_BUCK_RAMP_SEL_MASK GENMASK(2, 0)
|
|
#define RTQ2208_HD_INT_MASK BIT(0)
|
|
#define RTQ2208_LDO1_DISCHG_EN_MASK BIT(4)
|
|
#define RTQ2208_LDO1_VOSEL_SD_MASK BIT(5)
|
|
#define RTQ2208_LDO2_DISCHG_EN_MASK BIT(6)
|
|
#define RTQ2208_LDO2_VOSEL_SD_MASK BIT(7)
|
|
|
|
/* Size */
|
|
#define RTQ2208_VOUT_MAXNUM 256
|
|
#define RTQ2208_BUCK_NUM_IRQ_REGS 5
|
|
#define RTQ2208_STS_NUM_IRQ_REGS 2
|
|
|
|
/* Value */
|
|
#define RTQ2208_RAMP_VALUE_MIN_uV 500
|
|
#define RTQ2208_RAMP_VALUE_MAX_uV 16000
|
|
|
|
#define RTQ2208_BUCK_MASK(uv_irq, ov_irq) (1 << ((uv_irq) % 8) | 1 << ((ov_irq) % 8))
|
|
|
|
enum {
|
|
RTQ2208_BUCK_B = 0,
|
|
RTQ2208_BUCK_C,
|
|
RTQ2208_BUCK_D,
|
|
RTQ2208_BUCK_A,
|
|
RTQ2208_BUCK_F,
|
|
RTQ2208_BUCK_G,
|
|
RTQ2208_BUCK_H,
|
|
RTQ2208_BUCK_E,
|
|
RTQ2208_LDO2,
|
|
RTQ2208_LDO1,
|
|
RTQ2208_LDO_MAX,
|
|
};
|
|
|
|
enum {
|
|
RTQ2208_AUTO_MODE = 0,
|
|
RTQ2208_FCCM,
|
|
};
|
|
|
|
struct rtq2208_regulator_desc {
|
|
struct regulator_desc desc;
|
|
unsigned int mtp_sel_reg;
|
|
unsigned int mtp_sel_mask;
|
|
unsigned int mode_reg;
|
|
unsigned int mode_mask;
|
|
unsigned int suspend_config_reg;
|
|
unsigned int suspend_enable_mask;
|
|
unsigned int suspend_mode_mask;
|
|
};
|
|
|
|
struct rtq2208_rdev_map {
|
|
struct regulator_dev *rdev[RTQ2208_LDO_MAX];
|
|
struct regmap *regmap;
|
|
struct device *dev;
|
|
};
|
|
|
|
/* set Normal Auto/FCCM mode */
|
|
static int rtq2208_set_mode(struct regulator_dev *rdev, unsigned int mode)
|
|
{
|
|
const struct rtq2208_regulator_desc *rdesc =
|
|
(const struct rtq2208_regulator_desc *)rdev->desc;
|
|
unsigned int val, shift;
|
|
|
|
switch (mode) {
|
|
case REGULATOR_MODE_NORMAL:
|
|
val = RTQ2208_AUTO_MODE;
|
|
break;
|
|
case REGULATOR_MODE_FAST:
|
|
val = RTQ2208_FCCM;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
shift = ffs(rdesc->mode_mask) - 1;
|
|
return regmap_update_bits(rdev->regmap, rdesc->mode_reg,
|
|
rdesc->mode_mask, val << shift);
|
|
}
|
|
|
|
static unsigned int rtq2208_get_mode(struct regulator_dev *rdev)
|
|
{
|
|
const struct rtq2208_regulator_desc *rdesc =
|
|
(const struct rtq2208_regulator_desc *)rdev->desc;
|
|
unsigned int mode_val;
|
|
int ret;
|
|
|
|
ret = regmap_read(rdev->regmap, rdesc->mode_reg, &mode_val);
|
|
if (ret)
|
|
return REGULATOR_MODE_INVALID;
|
|
|
|
return (mode_val & rdesc->mode_mask) ? REGULATOR_MODE_FAST : REGULATOR_MODE_NORMAL;
|
|
}
|
|
|
|
static int rtq2208_set_ramp_delay(struct regulator_dev *rdev, int ramp_delay)
|
|
{
|
|
const struct regulator_desc *desc = rdev->desc;
|
|
unsigned int sel = 0, val;
|
|
|
|
ramp_delay = max(ramp_delay, RTQ2208_RAMP_VALUE_MIN_uV);
|
|
ramp_delay = min(ramp_delay, RTQ2208_RAMP_VALUE_MAX_uV);
|
|
|
|
ramp_delay /= RTQ2208_RAMP_VALUE_MIN_uV;
|
|
|
|
/*
|
|
* fls(ramp_delay) - 1: doing LSB shift, let it starts from 0
|
|
*
|
|
* RTQ2208_BUCK_RAMP_SEL_MASK - sel: doing descending order shifting.
|
|
* Because the relation of seleltion and value is like that
|
|
*
|
|
* seletion: value
|
|
* 010: 16mv
|
|
* ...
|
|
* 111: 0.5mv
|
|
*
|
|
* For example, if I would like to select 16mv, the fls(ramp_delay) - 1 will be 0b010,
|
|
* and I need to use 0b111 - sel to do the shifting
|
|
*/
|
|
|
|
sel = fls(ramp_delay) - 1;
|
|
sel = RTQ2208_BUCK_RAMP_SEL_MASK - sel;
|
|
|
|
val = FIELD_PREP(RTQ2208_BUCK_RSPUP_MASK, sel) | FIELD_PREP(RTQ2208_BUCK_RSPDN_MASK, sel);
|
|
|
|
return regmap_update_bits(rdev->regmap, desc->ramp_reg,
|
|
RTQ2208_BUCK_RSPUP_MASK | RTQ2208_BUCK_RSPDN_MASK, val);
|
|
}
|
|
|
|
static int rtq2208_set_suspend_enable(struct regulator_dev *rdev)
|
|
{
|
|
const struct rtq2208_regulator_desc *rdesc =
|
|
(const struct rtq2208_regulator_desc *)rdev->desc;
|
|
|
|
return regmap_set_bits(rdev->regmap, rdesc->suspend_config_reg, rdesc->suspend_enable_mask);
|
|
}
|
|
|
|
static int rtq2208_set_suspend_disable(struct regulator_dev *rdev)
|
|
{
|
|
const struct rtq2208_regulator_desc *rdesc =
|
|
(const struct rtq2208_regulator_desc *)rdev->desc;
|
|
|
|
return regmap_update_bits(rdev->regmap, rdesc->suspend_config_reg, rdesc->suspend_enable_mask, 0);
|
|
}
|
|
|
|
static int rtq2208_set_suspend_mode(struct regulator_dev *rdev, unsigned int mode)
|
|
{
|
|
const struct rtq2208_regulator_desc *rdesc =
|
|
(const struct rtq2208_regulator_desc *)rdev->desc;
|
|
unsigned int val, shift;
|
|
|
|
switch (mode) {
|
|
case REGULATOR_MODE_NORMAL:
|
|
val = RTQ2208_AUTO_MODE;
|
|
break;
|
|
case REGULATOR_MODE_FAST:
|
|
val = RTQ2208_FCCM;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
shift = ffs(rdesc->suspend_mode_mask) - 1;
|
|
|
|
return regmap_update_bits(rdev->regmap, rdesc->suspend_config_reg,
|
|
rdesc->suspend_mode_mask, val << shift);
|
|
}
|
|
|
|
static const struct regulator_ops rtq2208_regulator_buck_ops = {
|
|
.enable = regulator_enable_regmap,
|
|
.disable = regulator_disable_regmap,
|
|
.is_enabled = regulator_is_enabled_regmap,
|
|
.list_voltage = regulator_list_voltage_linear_range,
|
|
.set_voltage_sel = regulator_set_voltage_sel_regmap,
|
|
.get_voltage_sel = regulator_get_voltage_sel_regmap,
|
|
.set_mode = rtq2208_set_mode,
|
|
.get_mode = rtq2208_get_mode,
|
|
.set_ramp_delay = rtq2208_set_ramp_delay,
|
|
.set_active_discharge = regulator_set_active_discharge_regmap,
|
|
.set_suspend_enable = rtq2208_set_suspend_enable,
|
|
.set_suspend_disable = rtq2208_set_suspend_disable,
|
|
.set_suspend_mode = rtq2208_set_suspend_mode,
|
|
};
|
|
|
|
static const struct regulator_ops rtq2208_regulator_ldo_fix_ops = {
|
|
.enable = regulator_enable_regmap,
|
|
.disable = regulator_disable_regmap,
|
|
.is_enabled = regulator_is_enabled_regmap,
|
|
.set_active_discharge = regulator_set_active_discharge_regmap,
|
|
.set_suspend_enable = rtq2208_set_suspend_enable,
|
|
.set_suspend_disable = rtq2208_set_suspend_disable,
|
|
};
|
|
|
|
static const struct regulator_ops rtq2208_regulator_ldo_adj_ops = {
|
|
.enable = regulator_enable_regmap,
|
|
.disable = regulator_disable_regmap,
|
|
.is_enabled = regulator_is_enabled_regmap,
|
|
.list_voltage = regulator_list_voltage_table,
|
|
.set_voltage_sel = regulator_set_voltage_sel_regmap,
|
|
.get_voltage_sel = regulator_get_voltage_sel_regmap,
|
|
.set_active_discharge = regulator_set_active_discharge_regmap,
|
|
.set_suspend_enable = rtq2208_set_suspend_enable,
|
|
.set_suspend_disable = rtq2208_set_suspend_disable,
|
|
};
|
|
|
|
static const unsigned int rtq2208_ldo_volt_table[] = {
|
|
1800000,
|
|
3300000,
|
|
};
|
|
|
|
static struct of_regulator_match rtq2208_ldo_match[] = {
|
|
{.name = "ldo2", },
|
|
{.name = "ldo1", },
|
|
};
|
|
|
|
static unsigned int rtq2208_of_map_mode(unsigned int mode)
|
|
{
|
|
switch (mode) {
|
|
case RTQ2208_AUTO_MODE:
|
|
return REGULATOR_MODE_NORMAL;
|
|
case RTQ2208_FCCM:
|
|
return REGULATOR_MODE_FAST;
|
|
default:
|
|
return REGULATOR_MODE_INVALID;
|
|
}
|
|
}
|
|
|
|
static int rtq2208_init_irq_mask(struct rtq2208_rdev_map *rdev_map, unsigned int *buck_masks)
|
|
{
|
|
unsigned char buck_clr_masks[5] = {0x33, 0x33, 0x33, 0x33, 0x33},
|
|
sts_clr_masks[2] = {0xE7, 0xF7}, sts_masks[2] = {0xE6, 0xF6};
|
|
int ret;
|
|
|
|
/* write clear all buck irq once */
|
|
ret = regmap_bulk_write(rdev_map->regmap, RTQ2208_REG_FLT_RECORDBUCK_CB, buck_clr_masks, 5);
|
|
if (ret)
|
|
return dev_err_probe(rdev_map->dev, ret, "Failed to clr buck irqs\n");
|
|
|
|
/* write clear general irq once */
|
|
ret = regmap_bulk_write(rdev_map->regmap, RTQ2208_REG_GLOBAL_INT1, sts_clr_masks, 2);
|
|
if (ret)
|
|
return dev_err_probe(rdev_map->dev, ret, "Failed to clr general irqs\n");
|
|
|
|
/* unmask buck ov/uv irq */
|
|
ret = regmap_bulk_write(rdev_map->regmap, RTQ2208_REG_FLT_MASKBUCK_CB, buck_masks, 5);
|
|
if (ret)
|
|
return dev_err_probe(rdev_map->dev, ret, "Failed to unmask buck irqs\n");
|
|
|
|
/* unmask needed general irq */
|
|
return regmap_bulk_write(rdev_map->regmap, RTQ2208_REG_GLOBAL_INT1_MASK, sts_masks, 2);
|
|
}
|
|
|
|
static irqreturn_t rtq2208_irq_handler(int irqno, void *devid)
|
|
{
|
|
unsigned char buck_flags[RTQ2208_BUCK_NUM_IRQ_REGS], sts_flags[RTQ2208_STS_NUM_IRQ_REGS];
|
|
int ret = 0, i, uv_bit, ov_bit;
|
|
struct rtq2208_rdev_map *rdev_map = devid;
|
|
struct regulator_dev *rdev;
|
|
|
|
if (!rdev_map)
|
|
return IRQ_NONE;
|
|
|
|
/* read irq event */
|
|
ret = regmap_bulk_read(rdev_map->regmap, RTQ2208_REG_FLT_RECORDBUCK_CB,
|
|
buck_flags, ARRAY_SIZE(buck_flags));
|
|
if (ret)
|
|
return IRQ_NONE;
|
|
|
|
ret = regmap_bulk_read(rdev_map->regmap, RTQ2208_REG_GLOBAL_INT1,
|
|
sts_flags, ARRAY_SIZE(sts_flags));
|
|
if (ret)
|
|
return IRQ_NONE;
|
|
|
|
/* clear irq event */
|
|
ret = regmap_bulk_write(rdev_map->regmap, RTQ2208_REG_FLT_RECORDBUCK_CB,
|
|
buck_flags, ARRAY_SIZE(buck_flags));
|
|
if (ret)
|
|
return IRQ_NONE;
|
|
|
|
ret = regmap_bulk_write(rdev_map->regmap, RTQ2208_REG_GLOBAL_INT1,
|
|
sts_flags, ARRAY_SIZE(sts_flags));
|
|
if (ret)
|
|
return IRQ_NONE;
|
|
|
|
for (i = 0; i < RTQ2208_LDO_MAX; i++) {
|
|
if (!rdev_map->rdev[i])
|
|
continue;
|
|
|
|
rdev = rdev_map->rdev[i];
|
|
/* uv irq */
|
|
uv_bit = (i & 1) ? 4 : 0;
|
|
if (buck_flags[i >> 1] & (1 << uv_bit))
|
|
regulator_notifier_call_chain(rdev,
|
|
REGULATOR_EVENT_UNDER_VOLTAGE, NULL);
|
|
/* ov irq */
|
|
ov_bit = uv_bit + 1;
|
|
if (buck_flags[i >> 1] & (1 << ov_bit))
|
|
regulator_notifier_call_chain(rdev,
|
|
REGULATOR_EVENT_REGULATION_OUT, NULL);
|
|
|
|
/* hd irq */
|
|
if (sts_flags[1] & RTQ2208_HD_INT_MASK)
|
|
regulator_notifier_call_chain(rdev,
|
|
REGULATOR_EVENT_OVER_TEMP, NULL);
|
|
}
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static int rtq2208_of_get_ldo_dvs_ability(struct device *dev)
|
|
{
|
|
struct device_node *np;
|
|
struct of_regulator_match *match;
|
|
struct regulator_desc *desc;
|
|
struct regulator_init_data *init_data;
|
|
u32 fixed_uV;
|
|
int ret, i;
|
|
|
|
if (!dev->of_node)
|
|
return -ENODEV;
|
|
|
|
np = of_get_child_by_name(dev->of_node, "regulators");
|
|
if (!np)
|
|
np = dev->of_node;
|
|
|
|
ret = of_regulator_match(dev, np, rtq2208_ldo_match, ARRAY_SIZE(rtq2208_ldo_match));
|
|
|
|
of_node_put(np);
|
|
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(rtq2208_ldo_match); i++) {
|
|
match = rtq2208_ldo_match + i;
|
|
init_data = match->init_data;
|
|
desc = (struct regulator_desc *)match->desc;
|
|
|
|
if (!init_data || !desc)
|
|
continue;
|
|
|
|
/* specify working fixed voltage if the propery exists */
|
|
ret = of_property_read_u32(match->of_node, "richtek,fixed-microvolt", &fixed_uV);
|
|
|
|
if (!ret) {
|
|
if (fixed_uV != init_data->constraints.min_uV ||
|
|
fixed_uV != init_data->constraints.max_uV)
|
|
return -EINVAL;
|
|
desc->n_voltages = 1;
|
|
desc->fixed_uV = fixed_uV;
|
|
desc->fixed_uV = init_data->constraints.min_uV;
|
|
desc->ops = &rtq2208_regulator_ldo_fix_ops;
|
|
} else {
|
|
desc->n_voltages = ARRAY_SIZE(rtq2208_ldo_volt_table);
|
|
desc->volt_table = rtq2208_ldo_volt_table;
|
|
desc->ops = &rtq2208_regulator_ldo_adj_ops;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
#define BUCK_INFO(_name, _id) \
|
|
{ \
|
|
.name = _name, \
|
|
.base = RTQ2208_REG_BUCK_##_id##_CFG0, \
|
|
.enable_reg = BUCK_RG_SHIFT(RTQ2208_REG_BUCK_##_id##_CFG0, 2), \
|
|
.dis_reg = RTQ2208_REG_BUCK_##_id##_CFG0, \
|
|
}
|
|
|
|
#define LDO_INFO(_name, _id) \
|
|
{ \
|
|
.name = _name, \
|
|
.base = RTQ2208_REG_LDO##_id##_CFG, \
|
|
.enable_reg = RTQ2208_REG_LDO##_id##_CFG, \
|
|
.dis_mask = RTQ2208_LDO##_id##_DISCHG_EN_MASK, \
|
|
.dis_on = RTQ2208_LDO##_id##_DISCHG_EN_MASK, \
|
|
.vsel_mask = RTQ2208_LDO##_id##_VOSEL_SD_MASK, \
|
|
}
|
|
|
|
#define BUCK_RG_SHIFT(_base, _shift) (_base + _shift)
|
|
#define VSEL_SHIFT(_sel) (_sel ? 3 : 1)
|
|
#define MTP_SEL_MASK(_sel) RTQ2208_BUCK_EN_NR_MTP_SEL##_sel##_MASK
|
|
|
|
static const struct linear_range rtq2208_vout_range[] = {
|
|
REGULATOR_LINEAR_RANGE(400000, 0, 180, 5000),
|
|
REGULATOR_LINEAR_RANGE(1310000, 181, 255, 10000),
|
|
};
|
|
|
|
static void rtq2208_init_regulator_desc(struct rtq2208_regulator_desc *rdesc, int mtp_sel, int idx)
|
|
{
|
|
struct regulator_desc *desc;
|
|
static const struct {
|
|
char *name;
|
|
int base;
|
|
int enable_reg;
|
|
int dis_reg;
|
|
int dis_mask;
|
|
int dis_on;
|
|
int vsel_mask;
|
|
} regulator_info[] = {
|
|
BUCK_INFO("buck-b", B),
|
|
BUCK_INFO("buck-c", C),
|
|
BUCK_INFO("buck-d", D),
|
|
BUCK_INFO("buck-a", A),
|
|
BUCK_INFO("buck-f", F),
|
|
BUCK_INFO("buck-g", G),
|
|
BUCK_INFO("buck-h", H),
|
|
BUCK_INFO("buck-e", E),
|
|
LDO_INFO("ldo2", 2),
|
|
LDO_INFO("ldo1", 1),
|
|
}, *curr_info;
|
|
|
|
curr_info = regulator_info + idx;
|
|
desc = &rdesc->desc;
|
|
desc->name = curr_info->name;
|
|
desc->of_match = of_match_ptr(curr_info->name);
|
|
desc->regulators_node = of_match_ptr("regulators");
|
|
desc->id = idx;
|
|
desc->owner = THIS_MODULE;
|
|
desc->type = REGULATOR_VOLTAGE;
|
|
desc->enable_mask = mtp_sel ? MTP_SEL_MASK(1) : MTP_SEL_MASK(0);
|
|
desc->enable_reg = curr_info->enable_reg;
|
|
desc->active_discharge_off = 0;
|
|
|
|
rdesc->mode_mask = RTQ2208_BUCK_NRMODE_MASK;
|
|
|
|
if (idx >= RTQ2208_BUCK_B && idx <= RTQ2208_BUCK_E) {
|
|
/* init buck desc */
|
|
desc->ops = &rtq2208_regulator_buck_ops;
|
|
desc->vsel_reg = curr_info->base + VSEL_SHIFT(mtp_sel);
|
|
desc->vsel_mask = RTQ2208_BUCK_NR_MTP_SEL_MASK;
|
|
desc->n_voltages = RTQ2208_VOUT_MAXNUM;
|
|
desc->linear_ranges = rtq2208_vout_range;
|
|
desc->n_linear_ranges = ARRAY_SIZE(rtq2208_vout_range);
|
|
desc->ramp_reg = BUCK_RG_SHIFT(curr_info->base, 5);
|
|
desc->of_map_mode = rtq2208_of_map_mode;
|
|
desc->active_discharge_reg = curr_info->dis_reg;
|
|
desc->active_discharge_on = RTQ2208_EN_DIS_MASK;
|
|
desc->active_discharge_mask = RTQ2208_EN_DIS_MASK;
|
|
|
|
rdesc->mode_reg = BUCK_RG_SHIFT(curr_info->base, 2);
|
|
rdesc->suspend_config_reg = BUCK_RG_SHIFT(curr_info->base, 4);
|
|
rdesc->suspend_enable_mask = RTQ2208_BUCK_EN_STR_MASK;
|
|
rdesc->suspend_mode_mask = RTQ2208_BUCK_STRMODE_MASK;
|
|
} else {
|
|
/* init ldo desc */
|
|
desc->active_discharge_reg = RTQ2208_REG_LDO_DVS_CTRL;
|
|
desc->active_discharge_on = curr_info->dis_on;
|
|
desc->active_discharge_mask = curr_info->dis_mask;
|
|
desc->vsel_reg = RTQ2208_REG_LDO_DVS_CTRL;
|
|
desc->vsel_mask = curr_info->vsel_mask;
|
|
|
|
rdesc->suspend_config_reg = curr_info->base;
|
|
rdesc->suspend_enable_mask = RTQ2208_LDO_EN_STR_MASK;
|
|
}
|
|
}
|
|
|
|
static int rtq2208_parse_regulator_dt_data(int n_regulator, const unsigned int *regulator_idx_table,
|
|
struct rtq2208_regulator_desc *rdesc[RTQ2208_LDO_MAX], struct device *dev)
|
|
{
|
|
int mtp_sel, i, idx, ret;
|
|
|
|
/* get mtp_sel0 or mtp_sel1 */
|
|
mtp_sel = device_property_read_bool(dev, "richtek,mtp-sel-high");
|
|
|
|
for (i = 0; i < n_regulator; i++) {
|
|
idx = regulator_idx_table[i];
|
|
|
|
rdesc[i] = devm_kcalloc(dev, 1, sizeof(*rdesc[0]), GFP_KERNEL);
|
|
if (!rdesc[i])
|
|
return -ENOMEM;
|
|
|
|
rtq2208_init_regulator_desc(rdesc[i], mtp_sel, idx);
|
|
|
|
/* init ldo dvs ability */
|
|
if (idx >= RTQ2208_LDO2)
|
|
rtq2208_ldo_match[idx - RTQ2208_LDO2].desc = &rdesc[i]->desc;
|
|
}
|
|
|
|
/* init ldo fixed_uV */
|
|
ret = rtq2208_of_get_ldo_dvs_ability(dev);
|
|
if (ret)
|
|
return dev_err_probe(dev, ret, "Failed to get ldo fixed_uV\n");
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
/** different slave address corresponds different used bucks
|
|
* slave address 0x10: BUCK[BCA FGE]
|
|
* slave address 0x20: BUCK[BC FGHE]
|
|
* slave address 0x40: BUCK[C G]
|
|
*/
|
|
static int rtq2208_regulator_check(int slave_addr, int *num,
|
|
int *regulator_idx_table, unsigned int *buck_masks)
|
|
{
|
|
static bool rtq2208_used_table[3][RTQ2208_LDO_MAX] = {
|
|
/* BUCK[BCA FGE], LDO[12] */
|
|
{1, 1, 0, 1, 1, 1, 0, 1, 1, 1},
|
|
/* BUCK[BC FGHE], LDO[12]*/
|
|
{1, 1, 0, 0, 1, 1, 1, 1, 1, 1},
|
|
/* BUCK[C G], LDO[12] */
|
|
{0, 1, 0, 0, 0, 1, 0, 0, 1, 1},
|
|
};
|
|
int i, idx = ffs(slave_addr >> 4) - 1;
|
|
u8 mask;
|
|
|
|
for (i = 0; i < RTQ2208_LDO_MAX; i++) {
|
|
if (!rtq2208_used_table[idx][i])
|
|
continue;
|
|
|
|
regulator_idx_table[(*num)++] = i;
|
|
|
|
mask = RTQ2208_BUCK_MASK(4 * i, 4 * i + 1);
|
|
buck_masks[i >> 1] &= ~mask;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct regmap_config rtq2208_regmap_config = {
|
|
.reg_bits = 8,
|
|
.val_bits = 8,
|
|
.max_register = 0xEF,
|
|
};
|
|
|
|
static int rtq2208_probe(struct i2c_client *i2c)
|
|
{
|
|
struct device *dev = &i2c->dev;
|
|
struct regmap *regmap;
|
|
struct rtq2208_regulator_desc *rdesc[RTQ2208_LDO_MAX];
|
|
struct regulator_dev *rdev;
|
|
struct regulator_config cfg;
|
|
struct rtq2208_rdev_map *rdev_map;
|
|
int i, ret = 0, idx, n_regulator = 0;
|
|
unsigned int regulator_idx_table[RTQ2208_LDO_MAX],
|
|
buck_masks[RTQ2208_BUCK_NUM_IRQ_REGS] = {0x33, 0x33, 0x33, 0x33, 0x33};
|
|
|
|
rdev_map = devm_kzalloc(dev, sizeof(struct rtq2208_rdev_map), GFP_KERNEL);
|
|
if (!rdev_map)
|
|
return -ENOMEM;
|
|
|
|
regmap = devm_regmap_init_i2c(i2c, &rtq2208_regmap_config);
|
|
if (IS_ERR(regmap))
|
|
return dev_err_probe(dev, PTR_ERR(regmap), "Failed to allocate regmap\n");
|
|
|
|
/* get needed regulator */
|
|
ret = rtq2208_regulator_check(i2c->addr, &n_regulator, regulator_idx_table, buck_masks);
|
|
if (ret)
|
|
return dev_err_probe(dev, ret, "Failed to check used regulators\n");
|
|
|
|
rdev_map->regmap = regmap;
|
|
rdev_map->dev = dev;
|
|
|
|
cfg.dev = dev;
|
|
|
|
/* init regulator desc */
|
|
ret = rtq2208_parse_regulator_dt_data(n_regulator, regulator_idx_table, rdesc, dev);
|
|
if (ret)
|
|
return ret;
|
|
|
|
for (i = 0; i < n_regulator; i++) {
|
|
idx = regulator_idx_table[i];
|
|
|
|
/* register regulator */
|
|
rdev = devm_regulator_register(dev, &rdesc[i]->desc, &cfg);
|
|
if (IS_ERR(rdev))
|
|
return PTR_ERR(rdev);
|
|
|
|
rdev_map->rdev[idx] = rdev;
|
|
}
|
|
|
|
/* init interrupt mask */
|
|
ret = rtq2208_init_irq_mask(rdev_map, buck_masks);
|
|
if (ret)
|
|
return ret;
|
|
|
|
/* register interrupt */
|
|
return devm_request_threaded_irq(dev, i2c->irq, NULL, rtq2208_irq_handler,
|
|
IRQF_ONESHOT, dev_name(dev), rdev_map);
|
|
}
|
|
|
|
static const struct of_device_id rtq2208_device_tables[] = {
|
|
{ .compatible = "richtek,rtq2208" },
|
|
{}
|
|
};
|
|
MODULE_DEVICE_TABLE(of, rtq2208_device_tables);
|
|
|
|
static struct i2c_driver rtq2208_driver = {
|
|
.driver = {
|
|
.name = "rtq2208",
|
|
.of_match_table = rtq2208_device_tables,
|
|
},
|
|
.probe = rtq2208_probe,
|
|
};
|
|
module_i2c_driver(rtq2208_driver);
|
|
|
|
MODULE_AUTHOR("Alina Yu <alina_yu@richtek.com>");
|
|
MODULE_DESCRIPTION("Richtek RTQ2208 Regulator Driver");
|
|
MODULE_LICENSE("GPL");
|