forked from Minki/linux
3a93f2a9f4
Change the interface used by set_voltage() to report the selected value to the regulator core in terms of a selector used by list_voltage(). This allows the regulator core to know the voltage that was chosen without having to do an explict get_voltage(), which would be much more expensive as it will generally access hardware. Signed-off-by: Mark Brown <broonie@opensource.wolfsonmicro.com> Signed-off-by: Liam Girdwood <lrg@slimlogic.co.uk>
413 lines
11 KiB
C
413 lines
11 KiB
C
/*
|
|
* Regulator driver for TI TPS6586x
|
|
*
|
|
* Copyright (C) 2010 Compulab Ltd.
|
|
* Author: Mike Rapoport <mike@compulab.co.il>
|
|
*
|
|
* Based on da903x
|
|
* Copyright (C) 2006-2008 Marvell International Ltd.
|
|
* Copyright (C) 2008 Compulab Ltd.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/init.h>
|
|
#include <linux/err.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/regulator/driver.h>
|
|
#include <linux/regulator/machine.h>
|
|
#include <linux/mfd/tps6586x.h>
|
|
|
|
/* supply control and voltage setting */
|
|
#define TPS6586X_SUPPLYENA 0x10
|
|
#define TPS6586X_SUPPLYENB 0x11
|
|
#define TPS6586X_SUPPLYENC 0x12
|
|
#define TPS6586X_SUPPLYEND 0x13
|
|
#define TPS6586X_SUPPLYENE 0x14
|
|
#define TPS6586X_VCC1 0x20
|
|
#define TPS6586X_VCC2 0x21
|
|
#define TPS6586X_SM1V1 0x23
|
|
#define TPS6586X_SM1V2 0x24
|
|
#define TPS6586X_SM1SL 0x25
|
|
#define TPS6586X_SM0V1 0x26
|
|
#define TPS6586X_SM0V2 0x27
|
|
#define TPS6586X_SM0SL 0x28
|
|
#define TPS6586X_LDO2AV1 0x29
|
|
#define TPS6586X_LDO2AV2 0x2A
|
|
#define TPS6586X_LDO2BV1 0x2F
|
|
#define TPS6586X_LDO2BV2 0x30
|
|
#define TPS6586X_LDO4V1 0x32
|
|
#define TPS6586X_LDO4V2 0x33
|
|
|
|
/* converter settings */
|
|
#define TPS6586X_SUPPLYV1 0x41
|
|
#define TPS6586X_SUPPLYV2 0x42
|
|
#define TPS6586X_SUPPLYV3 0x43
|
|
#define TPS6586X_SUPPLYV4 0x44
|
|
#define TPS6586X_SUPPLYV5 0x45
|
|
#define TPS6586X_SUPPLYV6 0x46
|
|
#define TPS6586X_SMODE1 0x47
|
|
#define TPS6586X_SMODE2 0x48
|
|
|
|
struct tps6586x_regulator {
|
|
struct regulator_desc desc;
|
|
|
|
int volt_reg;
|
|
int volt_shift;
|
|
int volt_nbits;
|
|
int enable_bit[2];
|
|
int enable_reg[2];
|
|
|
|
int *voltages;
|
|
|
|
/* for DVM regulators */
|
|
int go_reg;
|
|
int go_bit;
|
|
};
|
|
|
|
static inline struct device *to_tps6586x_dev(struct regulator_dev *rdev)
|
|
{
|
|
return rdev_get_dev(rdev)->parent->parent;
|
|
}
|
|
|
|
static int tps6586x_ldo_list_voltage(struct regulator_dev *rdev,
|
|
unsigned selector)
|
|
{
|
|
struct tps6586x_regulator *info = rdev_get_drvdata(rdev);
|
|
|
|
return info->voltages[selector] * 1000;
|
|
}
|
|
|
|
|
|
static int __tps6586x_ldo_set_voltage(struct device *parent,
|
|
struct tps6586x_regulator *ri,
|
|
int min_uV, int max_uV,
|
|
unsigned *selector)
|
|
{
|
|
int val, uV;
|
|
uint8_t mask;
|
|
|
|
for (val = 0; val < ri->desc.n_voltages; val++) {
|
|
uV = ri->voltages[val] * 1000;
|
|
|
|
/* LDO0 has minimal voltage 1.2 rather than 1.25 */
|
|
if (ri->desc.id == TPS6586X_ID_LDO_0 && val == 0)
|
|
uV -= 50 * 1000;
|
|
|
|
/* use the first in-range value */
|
|
if (min_uV <= uV && uV <= max_uV) {
|
|
|
|
*selector = val;
|
|
|
|
val <<= ri->volt_shift;
|
|
mask = ((1 << ri->volt_nbits) - 1) << ri->volt_shift;
|
|
|
|
return tps6586x_update(parent, ri->volt_reg, val, mask);
|
|
}
|
|
}
|
|
|
|
return -EINVAL;
|
|
}
|
|
|
|
static int tps6586x_ldo_set_voltage(struct regulator_dev *rdev,
|
|
int min_uV, int max_uV, unsigned *selector)
|
|
{
|
|
struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
|
|
struct device *parent = to_tps6586x_dev(rdev);
|
|
|
|
return __tps6586x_ldo_set_voltage(parent, ri, min_uV, max_uV,
|
|
selector);
|
|
}
|
|
|
|
static int tps6586x_ldo_get_voltage(struct regulator_dev *rdev)
|
|
{
|
|
struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
|
|
struct device *parent = to_tps6586x_dev(rdev);
|
|
uint8_t val, mask;
|
|
int ret;
|
|
|
|
ret = tps6586x_read(parent, ri->volt_reg, &val);
|
|
if (ret)
|
|
return ret;
|
|
|
|
mask = ((1 << ri->volt_nbits) - 1) << ri->volt_shift;
|
|
val = (val & mask) >> ri->volt_shift;
|
|
|
|
if (val >= ri->desc.n_voltages)
|
|
BUG();
|
|
|
|
return ri->voltages[val] * 1000;
|
|
}
|
|
|
|
static int tps6586x_dvm_set_voltage(struct regulator_dev *rdev,
|
|
int min_uV, int max_uV, unsigned *selector)
|
|
{
|
|
struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
|
|
struct device *parent = to_tps6586x_dev(rdev);
|
|
int ret;
|
|
|
|
ret = __tps6586x_ldo_set_voltage(parent, ri, min_uV, max_uV,
|
|
selector);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return tps6586x_set_bits(parent, ri->go_reg, 1 << ri->go_bit);
|
|
}
|
|
|
|
static int tps6586x_regulator_enable(struct regulator_dev *rdev)
|
|
{
|
|
struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
|
|
struct device *parent = to_tps6586x_dev(rdev);
|
|
|
|
return tps6586x_set_bits(parent, ri->enable_reg[0],
|
|
1 << ri->enable_bit[0]);
|
|
}
|
|
|
|
static int tps6586x_regulator_disable(struct regulator_dev *rdev)
|
|
{
|
|
struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
|
|
struct device *parent = to_tps6586x_dev(rdev);
|
|
|
|
return tps6586x_clr_bits(parent, ri->enable_reg[0],
|
|
1 << ri->enable_bit[0]);
|
|
}
|
|
|
|
static int tps6586x_regulator_is_enabled(struct regulator_dev *rdev)
|
|
{
|
|
struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
|
|
struct device *parent = to_tps6586x_dev(rdev);
|
|
uint8_t reg_val;
|
|
int ret;
|
|
|
|
ret = tps6586x_read(parent, ri->enable_reg[0], ®_val);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return !!(reg_val & (1 << ri->enable_bit[0]));
|
|
}
|
|
|
|
static struct regulator_ops tps6586x_regulator_ldo_ops = {
|
|
.list_voltage = tps6586x_ldo_list_voltage,
|
|
.get_voltage = tps6586x_ldo_get_voltage,
|
|
.set_voltage = tps6586x_ldo_set_voltage,
|
|
|
|
.is_enabled = tps6586x_regulator_is_enabled,
|
|
.enable = tps6586x_regulator_enable,
|
|
.disable = tps6586x_regulator_disable,
|
|
};
|
|
|
|
static struct regulator_ops tps6586x_regulator_dvm_ops = {
|
|
.list_voltage = tps6586x_ldo_list_voltage,
|
|
.get_voltage = tps6586x_ldo_get_voltage,
|
|
.set_voltage = tps6586x_dvm_set_voltage,
|
|
|
|
.is_enabled = tps6586x_regulator_is_enabled,
|
|
.enable = tps6586x_regulator_enable,
|
|
.disable = tps6586x_regulator_disable,
|
|
};
|
|
|
|
static int tps6586x_ldo_voltages[] = {
|
|
1250, 1500, 1800, 2500, 2700, 2850, 3100, 3300,
|
|
};
|
|
|
|
static int tps6586x_ldo4_voltages[] = {
|
|
1700, 1725, 1750, 1775, 1800, 1825, 1850, 1875,
|
|
1900, 1925, 1950, 1975, 2000, 2025, 2050, 2075,
|
|
2100, 2125, 2150, 2175, 2200, 2225, 2250, 2275,
|
|
2300, 2325, 2350, 2375, 2400, 2425, 2450, 2475,
|
|
};
|
|
|
|
static int tps6586x_sm2_voltages[] = {
|
|
3000, 3050, 3100, 3150, 3200, 3250, 3300, 3350,
|
|
3400, 3450, 3500, 3550, 3600, 3650, 3700, 3750,
|
|
3800, 3850, 3900, 3950, 4000, 4050, 4100, 4150,
|
|
4200, 4250, 4300, 4350, 4400, 4450, 4500, 4550,
|
|
};
|
|
|
|
static int tps6586x_dvm_voltages[] = {
|
|
725, 750, 775, 800, 825, 850, 875, 900,
|
|
925, 950, 975, 1000, 1025, 1050, 1075, 1100,
|
|
1125, 1150, 1175, 1200, 1225, 1250, 1275, 1300,
|
|
1325, 1350, 1375, 1400, 1425, 1450, 1475, 1500,
|
|
};
|
|
|
|
#define TPS6586X_REGULATOR(_id, vdata, _ops, vreg, shift, nbits, \
|
|
ereg0, ebit0, ereg1, ebit1) \
|
|
.desc = { \
|
|
.name = "REG-" #_id, \
|
|
.ops = &tps6586x_regulator_##_ops, \
|
|
.type = REGULATOR_VOLTAGE, \
|
|
.id = TPS6586X_ID_##_id, \
|
|
.n_voltages = ARRAY_SIZE(tps6586x_##vdata##_voltages), \
|
|
.owner = THIS_MODULE, \
|
|
}, \
|
|
.volt_reg = TPS6586X_##vreg, \
|
|
.volt_shift = (shift), \
|
|
.volt_nbits = (nbits), \
|
|
.enable_reg[0] = TPS6586X_SUPPLY##ereg0, \
|
|
.enable_bit[0] = (ebit0), \
|
|
.enable_reg[1] = TPS6586X_SUPPLY##ereg1, \
|
|
.enable_bit[1] = (ebit1), \
|
|
.voltages = tps6586x_##vdata##_voltages,
|
|
|
|
#define TPS6586X_REGULATOR_DVM_GOREG(goreg, gobit) \
|
|
.go_reg = TPS6586X_##goreg, \
|
|
.go_bit = (gobit),
|
|
|
|
#define TPS6586X_LDO(_id, vdata, vreg, shift, nbits, \
|
|
ereg0, ebit0, ereg1, ebit1) \
|
|
{ \
|
|
TPS6586X_REGULATOR(_id, vdata, ldo_ops, vreg, shift, nbits, \
|
|
ereg0, ebit0, ereg1, ebit1) \
|
|
}
|
|
|
|
#define TPS6586X_DVM(_id, vdata, vreg, shift, nbits, \
|
|
ereg0, ebit0, ereg1, ebit1, goreg, gobit) \
|
|
{ \
|
|
TPS6586X_REGULATOR(_id, vdata, dvm_ops, vreg, shift, nbits, \
|
|
ereg0, ebit0, ereg1, ebit1) \
|
|
TPS6586X_REGULATOR_DVM_GOREG(goreg, gobit) \
|
|
}
|
|
|
|
static struct tps6586x_regulator tps6586x_regulator[] = {
|
|
TPS6586X_LDO(LDO_0, ldo, SUPPLYV1, 5, 3, ENC, 0, END, 0),
|
|
TPS6586X_LDO(LDO_3, ldo, SUPPLYV4, 0, 3, ENC, 2, END, 2),
|
|
TPS6586X_LDO(LDO_5, ldo, SUPPLYV6, 0, 3, ENE, 6, ENE, 6),
|
|
TPS6586X_LDO(LDO_6, ldo, SUPPLYV3, 0, 3, ENC, 4, END, 4),
|
|
TPS6586X_LDO(LDO_7, ldo, SUPPLYV3, 3, 3, ENC, 5, END, 5),
|
|
TPS6586X_LDO(LDO_8, ldo, SUPPLYV2, 5, 3, ENC, 6, END, 6),
|
|
TPS6586X_LDO(LDO_9, ldo, SUPPLYV6, 3, 3, ENE, 7, ENE, 7),
|
|
TPS6586X_LDO(LDO_RTC, ldo, SUPPLYV4, 3, 3, V4, 7, V4, 7),
|
|
TPS6586X_LDO(LDO_1, dvm, SUPPLYV1, 0, 5, ENC, 1, END, 1),
|
|
TPS6586X_LDO(SM_2, sm2, SUPPLYV2, 0, 5, ENC, 7, END, 7),
|
|
|
|
TPS6586X_DVM(LDO_2, dvm, LDO2BV1, 0, 5, ENA, 3, ENB, 3, VCC2, 6),
|
|
TPS6586X_DVM(LDO_4, ldo4, LDO4V1, 0, 5, ENC, 3, END, 3, VCC1, 6),
|
|
TPS6586X_DVM(SM_0, dvm, SM0V1, 0, 5, ENA, 1, ENB, 1, VCC1, 2),
|
|
TPS6586X_DVM(SM_1, dvm, SM1V1, 0, 5, ENA, 0, ENB, 0, VCC1, 0),
|
|
};
|
|
|
|
/*
|
|
* TPS6586X has 2 enable bits that are OR'ed to determine the actual
|
|
* regulator state. Clearing one of this bits allows switching
|
|
* regulator on and of with single register write.
|
|
*/
|
|
static inline int tps6586x_regulator_preinit(struct device *parent,
|
|
struct tps6586x_regulator *ri)
|
|
{
|
|
uint8_t val1, val2;
|
|
int ret;
|
|
|
|
if (ri->enable_reg[0] == ri->enable_reg[1] &&
|
|
ri->enable_bit[0] == ri->enable_bit[1])
|
|
return 0;
|
|
|
|
ret = tps6586x_read(parent, ri->enable_reg[0], &val1);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = tps6586x_read(parent, ri->enable_reg[1], &val2);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (!(val2 & (1 << ri->enable_bit[1])))
|
|
return 0;
|
|
|
|
/*
|
|
* The regulator is on, but it's enabled with the bit we don't
|
|
* want to use, so we switch the enable bits
|
|
*/
|
|
if (!(val1 & (1 << ri->enable_bit[0]))) {
|
|
ret = tps6586x_set_bits(parent, ri->enable_reg[0],
|
|
1 << ri->enable_bit[0]);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
return tps6586x_clr_bits(parent, ri->enable_reg[1],
|
|
1 << ri->enable_bit[1]);
|
|
}
|
|
|
|
static inline struct tps6586x_regulator *find_regulator_info(int id)
|
|
{
|
|
struct tps6586x_regulator *ri;
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(tps6586x_regulator); i++) {
|
|
ri = &tps6586x_regulator[i];
|
|
if (ri->desc.id == id)
|
|
return ri;
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
static int __devinit tps6586x_regulator_probe(struct platform_device *pdev)
|
|
{
|
|
struct tps6586x_regulator *ri = NULL;
|
|
struct regulator_dev *rdev;
|
|
int id = pdev->id;
|
|
int err;
|
|
|
|
dev_dbg(&pdev->dev, "Probing reulator %d\n", id);
|
|
|
|
ri = find_regulator_info(id);
|
|
if (ri == NULL) {
|
|
dev_err(&pdev->dev, "invalid regulator ID specified\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
err = tps6586x_regulator_preinit(pdev->dev.parent, ri);
|
|
if (err)
|
|
return err;
|
|
|
|
rdev = regulator_register(&ri->desc, &pdev->dev,
|
|
pdev->dev.platform_data, ri);
|
|
if (IS_ERR(rdev)) {
|
|
dev_err(&pdev->dev, "failed to register regulator %s\n",
|
|
ri->desc.name);
|
|
return PTR_ERR(rdev);
|
|
}
|
|
|
|
platform_set_drvdata(pdev, rdev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int __devexit tps6586x_regulator_remove(struct platform_device *pdev)
|
|
{
|
|
struct regulator_dev *rdev = platform_get_drvdata(pdev);
|
|
|
|
regulator_unregister(rdev);
|
|
return 0;
|
|
}
|
|
|
|
static struct platform_driver tps6586x_regulator_driver = {
|
|
.driver = {
|
|
.name = "tps6586x-regulator",
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.probe = tps6586x_regulator_probe,
|
|
.remove = __devexit_p(tps6586x_regulator_remove),
|
|
};
|
|
|
|
static int __init tps6586x_regulator_init(void)
|
|
{
|
|
return platform_driver_register(&tps6586x_regulator_driver);
|
|
}
|
|
subsys_initcall(tps6586x_regulator_init);
|
|
|
|
static void __exit tps6586x_regulator_exit(void)
|
|
{
|
|
platform_driver_unregister(&tps6586x_regulator_driver);
|
|
}
|
|
module_exit(tps6586x_regulator_exit);
|
|
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
|
|
MODULE_DESCRIPTION("Regulator Driver for TI TPS6586X PMIC");
|
|
MODULE_ALIAS("platform:tps6586x-regulator");
|