484 lines
12 KiB
C
484 lines
12 KiB
C
/*
|
|
* Copyright (C) ST-Ericsson SA 2010
|
|
*
|
|
* License Terms: GNU General Public License v2
|
|
*
|
|
* Authors: Bengt Jonsson <bengt.g.jonsson@stericsson.com>
|
|
*
|
|
* This file is based on drivers/regulator/ab8500.c
|
|
*
|
|
* AB8500 external regulators
|
|
*
|
|
* ab8500-ext supports the following regulators:
|
|
* - VextSupply3
|
|
*/
|
|
#include <linux/init.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/err.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/regulator/driver.h>
|
|
#include <linux/regulator/machine.h>
|
|
#include <linux/regulator/of_regulator.h>
|
|
#include <linux/mfd/abx500.h>
|
|
#include <linux/mfd/abx500/ab8500.h>
|
|
#include <linux/regulator/ab8500.h>
|
|
|
|
/**
|
|
* struct ab8500_ext_regulator_info - ab8500 regulator information
|
|
* @dev: device pointer
|
|
* @desc: regulator description
|
|
* @rdev: regulator device
|
|
* @cfg: regulator configuration (extension of regulator FW configuration)
|
|
* @update_bank: bank to control on/off
|
|
* @update_reg: register to control on/off
|
|
* @update_mask: mask to enable/disable and set mode of regulator
|
|
* @update_val: bits holding the regulator current mode
|
|
* @update_val_hp: bits to set EN pin active (LPn pin deactive)
|
|
* normally this means high power mode
|
|
* @update_val_lp: bits to set EN pin active and LPn pin active
|
|
* normally this means low power mode
|
|
* @update_val_hw: bits to set regulator pins in HW control
|
|
* SysClkReq pins and logic will choose mode
|
|
*/
|
|
struct ab8500_ext_regulator_info {
|
|
struct device *dev;
|
|
struct regulator_desc desc;
|
|
struct regulator_dev *rdev;
|
|
struct ab8500_ext_regulator_cfg *cfg;
|
|
u8 update_bank;
|
|
u8 update_reg;
|
|
u8 update_mask;
|
|
u8 update_val;
|
|
u8 update_val_hp;
|
|
u8 update_val_lp;
|
|
u8 update_val_hw;
|
|
};
|
|
|
|
static int ab8500_ext_regulator_enable(struct regulator_dev *rdev)
|
|
{
|
|
int ret;
|
|
struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev);
|
|
u8 regval;
|
|
|
|
if (info == NULL) {
|
|
dev_err(rdev_get_dev(rdev), "regulator info null pointer\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
/*
|
|
* To satisfy both HW high power request and SW request, the regulator
|
|
* must be on in high power.
|
|
*/
|
|
if (info->cfg && info->cfg->hwreq)
|
|
regval = info->update_val_hp;
|
|
else
|
|
regval = info->update_val;
|
|
|
|
ret = abx500_mask_and_set_register_interruptible(info->dev,
|
|
info->update_bank, info->update_reg,
|
|
info->update_mask, regval);
|
|
if (ret < 0) {
|
|
dev_err(rdev_get_dev(info->rdev),
|
|
"couldn't set enable bits for regulator\n");
|
|
return ret;
|
|
}
|
|
|
|
dev_dbg(rdev_get_dev(rdev),
|
|
"%s-enable (bank, reg, mask, value): 0x%02x, 0x%02x, 0x%02x, 0x%02x\n",
|
|
info->desc.name, info->update_bank, info->update_reg,
|
|
info->update_mask, regval);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ab8500_ext_regulator_disable(struct regulator_dev *rdev)
|
|
{
|
|
int ret;
|
|
struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev);
|
|
u8 regval;
|
|
|
|
if (info == NULL) {
|
|
dev_err(rdev_get_dev(rdev), "regulator info null pointer\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
/*
|
|
* Set the regulator in HW request mode if configured
|
|
*/
|
|
if (info->cfg && info->cfg->hwreq)
|
|
regval = info->update_val_hw;
|
|
else
|
|
regval = 0;
|
|
|
|
ret = abx500_mask_and_set_register_interruptible(info->dev,
|
|
info->update_bank, info->update_reg,
|
|
info->update_mask, regval);
|
|
if (ret < 0) {
|
|
dev_err(rdev_get_dev(info->rdev),
|
|
"couldn't set disable bits for regulator\n");
|
|
return ret;
|
|
}
|
|
|
|
dev_dbg(rdev_get_dev(rdev), "%s-disable (bank, reg, mask, value):"
|
|
" 0x%02x, 0x%02x, 0x%02x, 0x%02x\n",
|
|
info->desc.name, info->update_bank, info->update_reg,
|
|
info->update_mask, regval);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ab8500_ext_regulator_is_enabled(struct regulator_dev *rdev)
|
|
{
|
|
int ret;
|
|
struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev);
|
|
u8 regval;
|
|
|
|
if (info == NULL) {
|
|
dev_err(rdev_get_dev(rdev), "regulator info null pointer\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
ret = abx500_get_register_interruptible(info->dev,
|
|
info->update_bank, info->update_reg, ®val);
|
|
if (ret < 0) {
|
|
dev_err(rdev_get_dev(rdev),
|
|
"couldn't read 0x%x register\n", info->update_reg);
|
|
return ret;
|
|
}
|
|
|
|
dev_dbg(rdev_get_dev(rdev), "%s-is_enabled (bank, reg, mask, value):"
|
|
" 0x%02x, 0x%02x, 0x%02x, 0x%02x\n",
|
|
info->desc.name, info->update_bank, info->update_reg,
|
|
info->update_mask, regval);
|
|
|
|
if (((regval & info->update_mask) == info->update_val_lp) ||
|
|
((regval & info->update_mask) == info->update_val_hp))
|
|
return 1;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
static int ab8500_ext_regulator_set_mode(struct regulator_dev *rdev,
|
|
unsigned int mode)
|
|
{
|
|
int ret = 0;
|
|
struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev);
|
|
u8 regval;
|
|
|
|
if (info == NULL) {
|
|
dev_err(rdev_get_dev(rdev), "regulator info null pointer\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
switch (mode) {
|
|
case REGULATOR_MODE_NORMAL:
|
|
regval = info->update_val_hp;
|
|
break;
|
|
case REGULATOR_MODE_IDLE:
|
|
regval = info->update_val_lp;
|
|
break;
|
|
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* If regulator is enabled and info->cfg->hwreq is set, the regulator
|
|
must be on in high power, so we don't need to write the register with
|
|
the same value.
|
|
*/
|
|
if (ab8500_ext_regulator_is_enabled(rdev) &&
|
|
!(info->cfg && info->cfg->hwreq)) {
|
|
ret = abx500_mask_and_set_register_interruptible(info->dev,
|
|
info->update_bank, info->update_reg,
|
|
info->update_mask, regval);
|
|
if (ret < 0) {
|
|
dev_err(rdev_get_dev(rdev),
|
|
"Could not set regulator mode.\n");
|
|
return ret;
|
|
}
|
|
|
|
dev_dbg(rdev_get_dev(rdev),
|
|
"%s-set_mode (bank, reg, mask, value): "
|
|
"0x%x, 0x%x, 0x%x, 0x%x\n",
|
|
info->desc.name, info->update_bank, info->update_reg,
|
|
info->update_mask, regval);
|
|
}
|
|
|
|
info->update_val = regval;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static unsigned int ab8500_ext_regulator_get_mode(struct regulator_dev *rdev)
|
|
{
|
|
struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev);
|
|
int ret;
|
|
|
|
if (info == NULL) {
|
|
dev_err(rdev_get_dev(rdev), "regulator info null pointer\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (info->update_val == info->update_val_hp)
|
|
ret = REGULATOR_MODE_NORMAL;
|
|
else if (info->update_val == info->update_val_lp)
|
|
ret = REGULATOR_MODE_IDLE;
|
|
else
|
|
ret = -EINVAL;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int ab8500_ext_set_voltage(struct regulator_dev *rdev, int min_uV,
|
|
int max_uV, unsigned *selector)
|
|
{
|
|
struct regulation_constraints *regu_constraints = rdev->constraints;
|
|
|
|
if (!regu_constraints) {
|
|
dev_err(rdev_get_dev(rdev), "No regulator constraints\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (regu_constraints->min_uV == min_uV &&
|
|
regu_constraints->max_uV == max_uV)
|
|
return 0;
|
|
|
|
dev_err(rdev_get_dev(rdev),
|
|
"Requested min %duV max %duV != constrained min %duV max %duV\n",
|
|
min_uV, max_uV,
|
|
regu_constraints->min_uV, regu_constraints->max_uV);
|
|
|
|
return -EINVAL;
|
|
}
|
|
|
|
static int ab8500_ext_list_voltage(struct regulator_dev *rdev,
|
|
unsigned selector)
|
|
{
|
|
struct regulation_constraints *regu_constraints = rdev->constraints;
|
|
|
|
if (regu_constraints == NULL) {
|
|
dev_err(rdev_get_dev(rdev), "regulator constraints null pointer\n");
|
|
return -EINVAL;
|
|
}
|
|
/* return the uV for the fixed regulators */
|
|
if (regu_constraints->min_uV && regu_constraints->max_uV) {
|
|
if (regu_constraints->min_uV == regu_constraints->max_uV)
|
|
return regu_constraints->min_uV;
|
|
}
|
|
return -EINVAL;
|
|
}
|
|
|
|
static struct regulator_ops ab8500_ext_regulator_ops = {
|
|
.enable = ab8500_ext_regulator_enable,
|
|
.disable = ab8500_ext_regulator_disable,
|
|
.is_enabled = ab8500_ext_regulator_is_enabled,
|
|
.set_mode = ab8500_ext_regulator_set_mode,
|
|
.get_mode = ab8500_ext_regulator_get_mode,
|
|
.set_voltage = ab8500_ext_set_voltage,
|
|
.list_voltage = ab8500_ext_list_voltage,
|
|
};
|
|
|
|
static struct ab8500_ext_regulator_info
|
|
ab8500_ext_regulator_info[AB8500_NUM_EXT_REGULATORS] = {
|
|
[AB8500_EXT_SUPPLY1] = {
|
|
.desc = {
|
|
.name = "VEXTSUPPLY1",
|
|
.ops = &ab8500_ext_regulator_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.id = AB8500_EXT_SUPPLY1,
|
|
.owner = THIS_MODULE,
|
|
.n_voltages = 1,
|
|
},
|
|
.update_bank = 0x04,
|
|
.update_reg = 0x08,
|
|
.update_mask = 0x03,
|
|
.update_val = 0x01,
|
|
.update_val_hp = 0x01,
|
|
.update_val_lp = 0x03,
|
|
.update_val_hw = 0x02,
|
|
},
|
|
[AB8500_EXT_SUPPLY2] = {
|
|
.desc = {
|
|
.name = "VEXTSUPPLY2",
|
|
.ops = &ab8500_ext_regulator_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.id = AB8500_EXT_SUPPLY2,
|
|
.owner = THIS_MODULE,
|
|
.n_voltages = 1,
|
|
},
|
|
.update_bank = 0x04,
|
|
.update_reg = 0x08,
|
|
.update_mask = 0x0c,
|
|
.update_val = 0x04,
|
|
.update_val_hp = 0x04,
|
|
.update_val_lp = 0x0c,
|
|
.update_val_hw = 0x08,
|
|
},
|
|
[AB8500_EXT_SUPPLY3] = {
|
|
.desc = {
|
|
.name = "VEXTSUPPLY3",
|
|
.ops = &ab8500_ext_regulator_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.id = AB8500_EXT_SUPPLY3,
|
|
.owner = THIS_MODULE,
|
|
.n_voltages = 1,
|
|
},
|
|
.update_bank = 0x04,
|
|
.update_reg = 0x08,
|
|
.update_mask = 0x30,
|
|
.update_val = 0x10,
|
|
.update_val_hp = 0x10,
|
|
.update_val_lp = 0x30,
|
|
.update_val_hw = 0x20,
|
|
},
|
|
};
|
|
|
|
static struct of_regulator_match ab8500_ext_regulator_match[] = {
|
|
{ .name = "ab8500_ext1", .driver_data = (void *) AB8500_EXT_SUPPLY1, },
|
|
{ .name = "ab8500_ext2", .driver_data = (void *) AB8500_EXT_SUPPLY2, },
|
|
{ .name = "ab8500_ext3", .driver_data = (void *) AB8500_EXT_SUPPLY3, },
|
|
};
|
|
|
|
static int ab8500_ext_regulator_probe(struct platform_device *pdev)
|
|
{
|
|
struct ab8500 *ab8500 = dev_get_drvdata(pdev->dev.parent);
|
|
struct ab8500_platform_data *ppdata;
|
|
struct ab8500_regulator_platform_data *pdata;
|
|
struct device_node *np = pdev->dev.of_node;
|
|
struct regulator_config config = { };
|
|
int i, err;
|
|
|
|
if (np) {
|
|
err = of_regulator_match(&pdev->dev, np,
|
|
ab8500_ext_regulator_match,
|
|
ARRAY_SIZE(ab8500_ext_regulator_match));
|
|
if (err < 0) {
|
|
dev_err(&pdev->dev,
|
|
"Error parsing regulator init data: %d\n", err);
|
|
return err;
|
|
}
|
|
}
|
|
|
|
if (!ab8500) {
|
|
dev_err(&pdev->dev, "null mfd parent\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
ppdata = dev_get_platdata(ab8500->dev);
|
|
if (!ppdata) {
|
|
dev_err(&pdev->dev, "null parent pdata\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
pdata = ppdata->regulator;
|
|
if (!pdata) {
|
|
dev_err(&pdev->dev, "null pdata\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* make sure the platform data has the correct size */
|
|
if (pdata->num_ext_regulator != ARRAY_SIZE(ab8500_ext_regulator_info)) {
|
|
dev_err(&pdev->dev, "Configuration error: size mismatch.\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* check for AB8500 2.x */
|
|
if (is_ab8500_2p0_or_earlier(ab8500)) {
|
|
struct ab8500_ext_regulator_info *info;
|
|
|
|
/* VextSupply3LPn is inverted on AB8500 2.x */
|
|
info = &ab8500_ext_regulator_info[AB8500_EXT_SUPPLY3];
|
|
info->update_val = 0x30;
|
|
info->update_val_hp = 0x30;
|
|
info->update_val_lp = 0x10;
|
|
}
|
|
|
|
/* register all regulators */
|
|
for (i = 0; i < ARRAY_SIZE(ab8500_ext_regulator_info); i++) {
|
|
struct ab8500_ext_regulator_info *info = NULL;
|
|
|
|
/* assign per-regulator data */
|
|
info = &ab8500_ext_regulator_info[i];
|
|
info->dev = &pdev->dev;
|
|
info->cfg = (struct ab8500_ext_regulator_cfg *)
|
|
pdata->ext_regulator[i].driver_data;
|
|
|
|
config.dev = &pdev->dev;
|
|
config.driver_data = info;
|
|
config.of_node = ab8500_ext_regulator_match[i].of_node;
|
|
config.init_data = (np) ?
|
|
ab8500_ext_regulator_match[i].init_data :
|
|
&pdata->ext_regulator[i];
|
|
|
|
/* register regulator with framework */
|
|
info->rdev = regulator_register(&info->desc, &config);
|
|
if (IS_ERR(info->rdev)) {
|
|
err = PTR_ERR(info->rdev);
|
|
dev_err(&pdev->dev, "failed to register regulator %s\n",
|
|
info->desc.name);
|
|
/* when we fail, un-register all earlier regulators */
|
|
while (--i >= 0) {
|
|
info = &ab8500_ext_regulator_info[i];
|
|
regulator_unregister(info->rdev);
|
|
}
|
|
return err;
|
|
}
|
|
|
|
dev_dbg(rdev_get_dev(info->rdev),
|
|
"%s-probed\n", info->desc.name);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ab8500_ext_regulator_remove(struct platform_device *pdev)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(ab8500_ext_regulator_info); i++) {
|
|
struct ab8500_ext_regulator_info *info = NULL;
|
|
info = &ab8500_ext_regulator_info[i];
|
|
|
|
dev_vdbg(rdev_get_dev(info->rdev),
|
|
"%s-remove\n", info->desc.name);
|
|
|
|
regulator_unregister(info->rdev);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct platform_driver ab8500_ext_regulator_driver = {
|
|
.probe = ab8500_ext_regulator_probe,
|
|
.remove = ab8500_ext_regulator_remove,
|
|
.driver = {
|
|
.name = "ab8500-ext-regulator",
|
|
.owner = THIS_MODULE,
|
|
},
|
|
};
|
|
|
|
static int __init ab8500_ext_regulator_init(void)
|
|
{
|
|
int ret;
|
|
|
|
ret = platform_driver_register(&ab8500_ext_regulator_driver);
|
|
if (ret)
|
|
pr_err("Failed to register ab8500 ext regulator: %d\n", ret);
|
|
|
|
return ret;
|
|
}
|
|
subsys_initcall(ab8500_ext_regulator_init);
|
|
|
|
static void __exit ab8500_ext_regulator_exit(void)
|
|
{
|
|
platform_driver_unregister(&ab8500_ext_regulator_driver);
|
|
}
|
|
module_exit(ab8500_ext_regulator_exit);
|
|
|
|
MODULE_LICENSE("GPL v2");
|
|
MODULE_AUTHOR("Bengt Jonsson <bengt.g.jonsson@stericsson.com>");
|
|
MODULE_DESCRIPTION("AB8500 external regulator driver");
|
|
MODULE_ALIAS("platform:ab8500-ext-regulator");
|