302 строки
8.0 KiB
C
302 строки
8.0 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
//
|
|
// Copyright (c) 2021 MediaTek Inc.
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/of_device.h>
|
|
#include <linux/regmap.h>
|
|
#include <linux/regulator/driver.h>
|
|
#include <linux/regulator/machine.h>
|
|
#include <linux/regulator/mt6315-regulator.h>
|
|
#include <linux/regulator/of_regulator.h>
|
|
#include <linux/spmi.h>
|
|
|
|
#define MT6315_BUCK_MODE_AUTO 0
|
|
#define MT6315_BUCK_MODE_FORCE_PWM 1
|
|
#define MT6315_BUCK_MODE_LP 2
|
|
|
|
struct mt6315_regulator_info {
|
|
struct regulator_desc desc;
|
|
u32 status_reg;
|
|
u32 lp_mode_mask;
|
|
u32 lp_mode_shift;
|
|
};
|
|
|
|
struct mt_regulator_init_data {
|
|
u32 modeset_mask[MT6315_VBUCK_MAX];
|
|
};
|
|
|
|
struct mt6315_chip {
|
|
struct device *dev;
|
|
struct regmap *regmap;
|
|
};
|
|
|
|
#define MT_BUCK(_name, _bid, _vsel) \
|
|
[_bid] = { \
|
|
.desc = { \
|
|
.name = _name, \
|
|
.of_match = of_match_ptr(_name), \
|
|
.regulators_node = "regulators", \
|
|
.ops = &mt6315_volt_range_ops, \
|
|
.type = REGULATOR_VOLTAGE, \
|
|
.id = _bid, \
|
|
.owner = THIS_MODULE, \
|
|
.n_voltages = 0xc0, \
|
|
.linear_ranges = mt_volt_range1, \
|
|
.n_linear_ranges = ARRAY_SIZE(mt_volt_range1), \
|
|
.vsel_reg = _vsel, \
|
|
.vsel_mask = 0xff, \
|
|
.enable_reg = MT6315_BUCK_TOP_CON0, \
|
|
.enable_mask = BIT(_bid), \
|
|
.of_map_mode = mt6315_map_mode, \
|
|
}, \
|
|
.status_reg = _bid##_DBG4, \
|
|
.lp_mode_mask = BIT(_bid), \
|
|
.lp_mode_shift = _bid, \
|
|
}
|
|
|
|
static const struct linear_range mt_volt_range1[] = {
|
|
REGULATOR_LINEAR_RANGE(0, 0, 0xbf, 6250),
|
|
};
|
|
|
|
static unsigned int mt6315_map_mode(unsigned int mode)
|
|
{
|
|
switch (mode) {
|
|
case MT6315_BUCK_MODE_AUTO:
|
|
return REGULATOR_MODE_NORMAL;
|
|
case MT6315_BUCK_MODE_FORCE_PWM:
|
|
return REGULATOR_MODE_FAST;
|
|
case MT6315_BUCK_MODE_LP:
|
|
return REGULATOR_MODE_IDLE;
|
|
default:
|
|
return REGULATOR_MODE_INVALID;
|
|
}
|
|
}
|
|
|
|
static unsigned int mt6315_regulator_get_mode(struct regulator_dev *rdev)
|
|
{
|
|
struct mt_regulator_init_data *init = rdev_get_drvdata(rdev);
|
|
const struct mt6315_regulator_info *info;
|
|
int ret, regval;
|
|
u32 modeset_mask;
|
|
|
|
info = container_of(rdev->desc, struct mt6315_regulator_info, desc);
|
|
modeset_mask = init->modeset_mask[rdev_get_id(rdev)];
|
|
ret = regmap_read(rdev->regmap, MT6315_BUCK_TOP_4PHASE_ANA_CON42, ®val);
|
|
if (ret != 0) {
|
|
dev_err(&rdev->dev, "Failed to get mode: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
if ((regval & modeset_mask) == modeset_mask)
|
|
return REGULATOR_MODE_FAST;
|
|
|
|
ret = regmap_read(rdev->regmap, MT6315_BUCK_TOP_CON1, ®val);
|
|
if (ret != 0) {
|
|
dev_err(&rdev->dev, "Failed to get lp mode: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
if (regval & info->lp_mode_mask)
|
|
return REGULATOR_MODE_IDLE;
|
|
else
|
|
return REGULATOR_MODE_NORMAL;
|
|
}
|
|
|
|
static int mt6315_regulator_set_mode(struct regulator_dev *rdev,
|
|
u32 mode)
|
|
{
|
|
struct mt_regulator_init_data *init = rdev_get_drvdata(rdev);
|
|
const struct mt6315_regulator_info *info;
|
|
int ret, val, curr_mode;
|
|
u32 modeset_mask;
|
|
|
|
info = container_of(rdev->desc, struct mt6315_regulator_info, desc);
|
|
modeset_mask = init->modeset_mask[rdev_get_id(rdev)];
|
|
curr_mode = mt6315_regulator_get_mode(rdev);
|
|
switch (mode) {
|
|
case REGULATOR_MODE_FAST:
|
|
ret = regmap_update_bits(rdev->regmap,
|
|
MT6315_BUCK_TOP_4PHASE_ANA_CON42,
|
|
modeset_mask,
|
|
modeset_mask);
|
|
break;
|
|
case REGULATOR_MODE_NORMAL:
|
|
if (curr_mode == REGULATOR_MODE_FAST) {
|
|
ret = regmap_update_bits(rdev->regmap,
|
|
MT6315_BUCK_TOP_4PHASE_ANA_CON42,
|
|
modeset_mask,
|
|
0);
|
|
} else if (curr_mode == REGULATOR_MODE_IDLE) {
|
|
ret = regmap_update_bits(rdev->regmap,
|
|
MT6315_BUCK_TOP_CON1,
|
|
info->lp_mode_mask,
|
|
0);
|
|
usleep_range(100, 110);
|
|
} else {
|
|
ret = -EINVAL;
|
|
}
|
|
break;
|
|
case REGULATOR_MODE_IDLE:
|
|
val = MT6315_BUCK_MODE_LP >> 1;
|
|
val <<= info->lp_mode_shift;
|
|
ret = regmap_update_bits(rdev->regmap,
|
|
MT6315_BUCK_TOP_CON1,
|
|
info->lp_mode_mask,
|
|
val);
|
|
break;
|
|
default:
|
|
ret = -EINVAL;
|
|
dev_err(&rdev->dev, "Unsupported mode: %d\n", mode);
|
|
break;
|
|
}
|
|
|
|
if (ret != 0) {
|
|
dev_err(&rdev->dev, "Failed to set mode: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int mt6315_get_status(struct regulator_dev *rdev)
|
|
{
|
|
const struct mt6315_regulator_info *info;
|
|
int ret;
|
|
u32 regval;
|
|
|
|
info = container_of(rdev->desc, struct mt6315_regulator_info, desc);
|
|
ret = regmap_read(rdev->regmap, info->status_reg, ®val);
|
|
if (ret < 0) {
|
|
dev_err(&rdev->dev, "Failed to get enable reg: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
return (regval & BIT(0)) ? REGULATOR_STATUS_ON : REGULATOR_STATUS_OFF;
|
|
}
|
|
|
|
static const struct regulator_ops mt6315_volt_range_ops = {
|
|
.list_voltage = regulator_list_voltage_linear_range,
|
|
.map_voltage = regulator_map_voltage_linear_range,
|
|
.set_voltage_sel = regulator_set_voltage_sel_regmap,
|
|
.get_voltage_sel = regulator_get_voltage_sel_regmap,
|
|
.set_voltage_time_sel = regulator_set_voltage_time_sel,
|
|
.enable = regulator_enable_regmap,
|
|
.disable = regulator_disable_regmap,
|
|
.is_enabled = regulator_is_enabled_regmap,
|
|
.get_status = mt6315_get_status,
|
|
.set_mode = mt6315_regulator_set_mode,
|
|
.get_mode = mt6315_regulator_get_mode,
|
|
};
|
|
|
|
static const struct mt6315_regulator_info mt6315_regulators[MT6315_VBUCK_MAX] = {
|
|
MT_BUCK("vbuck1", MT6315_VBUCK1, MT6315_BUCK_TOP_ELR0),
|
|
MT_BUCK("vbuck2", MT6315_VBUCK2, MT6315_BUCK_TOP_ELR2),
|
|
MT_BUCK("vbuck3", MT6315_VBUCK3, MT6315_BUCK_TOP_ELR4),
|
|
MT_BUCK("vbuck4", MT6315_VBUCK4, MT6315_BUCK_TOP_ELR6),
|
|
};
|
|
|
|
static const struct regmap_config mt6315_regmap_config = {
|
|
.reg_bits = 16,
|
|
.val_bits = 8,
|
|
.max_register = 0x16d0,
|
|
.fast_io = true,
|
|
};
|
|
|
|
static const struct of_device_id mt6315_of_match[] = {
|
|
{
|
|
.compatible = "mediatek,mt6315-regulator",
|
|
}, {
|
|
/* sentinel */
|
|
},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, mt6315_of_match);
|
|
|
|
static int mt6315_regulator_probe(struct spmi_device *pdev)
|
|
{
|
|
struct device *dev = &pdev->dev;
|
|
struct regmap *regmap;
|
|
struct mt6315_chip *chip;
|
|
struct mt_regulator_init_data *init_data;
|
|
struct regulator_config config = {};
|
|
struct regulator_dev *rdev;
|
|
int i;
|
|
|
|
regmap = devm_regmap_init_spmi_ext(pdev, &mt6315_regmap_config);
|
|
if (IS_ERR(regmap))
|
|
return PTR_ERR(regmap);
|
|
|
|
chip = devm_kzalloc(dev, sizeof(struct mt6315_chip), GFP_KERNEL);
|
|
if (!chip)
|
|
return -ENOMEM;
|
|
|
|
init_data = devm_kzalloc(dev, sizeof(struct mt_regulator_init_data), GFP_KERNEL);
|
|
if (!init_data)
|
|
return -ENOMEM;
|
|
|
|
switch (pdev->usid) {
|
|
case MT6315_PP:
|
|
init_data->modeset_mask[MT6315_VBUCK1] = BIT(MT6315_VBUCK1) | BIT(MT6315_VBUCK2) |
|
|
BIT(MT6315_VBUCK4);
|
|
break;
|
|
case MT6315_SP:
|
|
case MT6315_RP:
|
|
init_data->modeset_mask[MT6315_VBUCK1] = BIT(MT6315_VBUCK1) | BIT(MT6315_VBUCK2);
|
|
break;
|
|
default:
|
|
init_data->modeset_mask[MT6315_VBUCK1] = BIT(MT6315_VBUCK1);
|
|
break;
|
|
}
|
|
for (i = MT6315_VBUCK2; i < MT6315_VBUCK_MAX; i++)
|
|
init_data->modeset_mask[i] = BIT(i);
|
|
|
|
chip->dev = dev;
|
|
chip->regmap = regmap;
|
|
dev_set_drvdata(dev, chip);
|
|
|
|
config.dev = dev;
|
|
config.regmap = regmap;
|
|
for (i = MT6315_VBUCK1; i < MT6315_VBUCK_MAX; i++) {
|
|
config.driver_data = init_data;
|
|
rdev = devm_regulator_register(dev, &mt6315_regulators[i].desc, &config);
|
|
if (IS_ERR(rdev)) {
|
|
dev_err(dev, "Failed to register %s\n",
|
|
mt6315_regulators[i].desc.name);
|
|
return PTR_ERR(rdev);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void mt6315_regulator_shutdown(struct spmi_device *pdev)
|
|
{
|
|
struct mt6315_chip *chip = dev_get_drvdata(&pdev->dev);
|
|
int ret = 0;
|
|
|
|
ret |= regmap_write(chip->regmap, MT6315_TOP_TMA_KEY_H, PROTECTION_KEY_H);
|
|
ret |= regmap_write(chip->regmap, MT6315_TOP_TMA_KEY, PROTECTION_KEY);
|
|
ret |= regmap_update_bits(chip->regmap, MT6315_TOP2_ELR7, 1, 1);
|
|
ret |= regmap_write(chip->regmap, MT6315_TOP_TMA_KEY, 0);
|
|
ret |= regmap_write(chip->regmap, MT6315_TOP_TMA_KEY_H, 0);
|
|
if (ret < 0)
|
|
dev_err(&pdev->dev, "[%#x] Failed to enable power off sequence. %d\n",
|
|
pdev->usid, ret);
|
|
}
|
|
|
|
static struct spmi_driver mt6315_regulator_driver = {
|
|
.driver = {
|
|
.name = "mt6315-regulator",
|
|
.probe_type = PROBE_PREFER_ASYNCHRONOUS,
|
|
.of_match_table = mt6315_of_match,
|
|
},
|
|
.probe = mt6315_regulator_probe,
|
|
.shutdown = mt6315_regulator_shutdown,
|
|
};
|
|
|
|
module_spmi_driver(mt6315_regulator_driver);
|
|
|
|
MODULE_AUTHOR("Hsin-Hsiung Wang <hsin-hsiung.wang@mediatek.com>");
|
|
MODULE_DESCRIPTION("Regulator Driver for MediaTek MT6315 PMIC");
|
|
MODULE_LICENSE("GPL");
|