| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638 |
- // 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");
|