6daa663dc4
get_ctrl_reg() returns -EINVAL so the error handling won't work here if reg is a u8. Signed-off-by: Dan Carpenter <error27@gmail.com> Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
801 lines
18 KiB
C
801 lines
18 KiB
C
/*
|
|
* tps65912.c -- TI tps65912
|
|
*
|
|
* Copyright 2011 Texas Instruments Inc.
|
|
*
|
|
* Author: Margarita Olaya Cabrera <magi@slimlogic.co.uk>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of the GNU General Public License as published by the
|
|
* Free Software Foundation; either version 2 of the License, or (at your
|
|
* option) any later version.
|
|
*
|
|
* This driver is based on wm8350 implementation.
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/init.h>
|
|
#include <linux/err.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/regulator/driver.h>
|
|
#include <linux/regulator/machine.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/mfd/tps65912.h>
|
|
|
|
/* DCDC's */
|
|
#define TPS65912_REG_DCDC1 0
|
|
#define TPS65912_REG_DCDC2 1
|
|
#define TPS65912_REG_DCDC3 2
|
|
#define TPS65912_REG_DCDC4 3
|
|
|
|
/* LDOs */
|
|
#define TPS65912_REG_LDO1 4
|
|
#define TPS65912_REG_LDO2 5
|
|
#define TPS65912_REG_LDO3 6
|
|
#define TPS65912_REG_LDO4 7
|
|
#define TPS65912_REG_LDO5 8
|
|
#define TPS65912_REG_LDO6 9
|
|
#define TPS65912_REG_LDO7 10
|
|
#define TPS65912_REG_LDO8 11
|
|
#define TPS65912_REG_LDO9 12
|
|
#define TPS65912_REG_LDO10 13
|
|
|
|
#define TPS65912_MAX_REG_ID TPS65912_REG_LDO_10
|
|
|
|
/* Number of step-down converters available */
|
|
#define TPS65912_NUM_DCDC 4
|
|
|
|
/* Number of LDO voltage regulators available */
|
|
#define TPS65912_NUM_LDO 10
|
|
|
|
/* Number of total regulators available */
|
|
#define TPS65912_NUM_REGULATOR (TPS65912_NUM_DCDC + TPS65912_NUM_LDO)
|
|
|
|
#define TPS65912_REG_ENABLED 0x80
|
|
#define OP_SELREG_MASK 0x40
|
|
#define OP_SELREG_SHIFT 6
|
|
|
|
struct tps_info {
|
|
const char *name;
|
|
};
|
|
|
|
static struct tps_info tps65912_regs[] = {
|
|
{
|
|
.name = "DCDC1",
|
|
},
|
|
{
|
|
.name = "DCDC2",
|
|
},
|
|
{
|
|
.name = "DCDC3",
|
|
},
|
|
{
|
|
.name = "DCDC4",
|
|
},
|
|
{
|
|
.name = "LDO1",
|
|
},
|
|
{
|
|
.name = "LDO2",
|
|
},
|
|
{
|
|
.name = "LDO3",
|
|
},
|
|
{
|
|
.name = "LDO4",
|
|
},
|
|
{
|
|
.name = "LDO5",
|
|
},
|
|
{
|
|
.name = "LDO6",
|
|
},
|
|
{
|
|
.name = "LDO7",
|
|
},
|
|
{
|
|
.name = "LDO8",
|
|
},
|
|
{
|
|
.name = "LDO9",
|
|
},
|
|
{
|
|
.name = "LDO10",
|
|
},
|
|
};
|
|
|
|
struct tps65912_reg {
|
|
struct regulator_desc desc[TPS65912_NUM_REGULATOR];
|
|
struct tps65912 *mfd;
|
|
struct regulator_dev *rdev[TPS65912_NUM_REGULATOR];
|
|
struct tps_info *info[TPS65912_NUM_REGULATOR];
|
|
/* for read/write access */
|
|
struct mutex io_lock;
|
|
int mode;
|
|
int (*get_ctrl_reg)(int);
|
|
int dcdc1_range;
|
|
int dcdc2_range;
|
|
int dcdc3_range;
|
|
int dcdc4_range;
|
|
int pwm_mode_reg;
|
|
int eco_reg;
|
|
};
|
|
|
|
static int tps65912_get_range(struct tps65912_reg *pmic, int id)
|
|
{
|
|
struct tps65912 *mfd = pmic->mfd;
|
|
|
|
if (id > TPS65912_REG_DCDC4)
|
|
return 0;
|
|
|
|
switch (id) {
|
|
case TPS65912_REG_DCDC1:
|
|
pmic->dcdc1_range = tps65912_reg_read(mfd,
|
|
TPS65912_DCDC1_LIMIT);
|
|
if (pmic->dcdc1_range < 0)
|
|
return pmic->dcdc1_range;
|
|
pmic->dcdc1_range = (pmic->dcdc1_range &
|
|
DCDC_LIMIT_RANGE_MASK) >> DCDC_LIMIT_RANGE_SHIFT;
|
|
return pmic->dcdc1_range;
|
|
case TPS65912_REG_DCDC2:
|
|
pmic->dcdc2_range = tps65912_reg_read(mfd,
|
|
TPS65912_DCDC2_LIMIT);
|
|
if (pmic->dcdc2_range < 0)
|
|
return pmic->dcdc2_range;
|
|
pmic->dcdc2_range = (pmic->dcdc2_range &
|
|
DCDC_LIMIT_RANGE_MASK) >> DCDC_LIMIT_RANGE_SHIFT;
|
|
return pmic->dcdc2_range;
|
|
case TPS65912_REG_DCDC3:
|
|
pmic->dcdc3_range = tps65912_reg_read(mfd,
|
|
TPS65912_DCDC3_LIMIT);
|
|
if (pmic->dcdc3_range < 0)
|
|
return pmic->dcdc3_range;
|
|
pmic->dcdc3_range = (pmic->dcdc3_range &
|
|
DCDC_LIMIT_RANGE_MASK) >> DCDC_LIMIT_RANGE_SHIFT;
|
|
return pmic->dcdc3_range;
|
|
case TPS65912_REG_DCDC4:
|
|
pmic->dcdc4_range = tps65912_reg_read(mfd,
|
|
TPS65912_DCDC4_LIMIT);
|
|
if (pmic->dcdc4_range < 0)
|
|
return pmic->dcdc4_range;
|
|
pmic->dcdc4_range = (pmic->dcdc4_range &
|
|
DCDC_LIMIT_RANGE_MASK) >> DCDC_LIMIT_RANGE_SHIFT;
|
|
return pmic->dcdc4_range;
|
|
default:
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
static unsigned long tps65912_vsel_to_uv_range0(u8 vsel)
|
|
{
|
|
unsigned long uv;
|
|
|
|
uv = ((vsel * 12500) + 500000);
|
|
return uv;
|
|
}
|
|
|
|
static unsigned long tps65912_vsel_to_uv_range1(u8 vsel)
|
|
{
|
|
unsigned long uv;
|
|
|
|
uv = ((vsel * 12500) + 700000);
|
|
return uv;
|
|
}
|
|
|
|
static unsigned long tps65912_vsel_to_uv_range2(u8 vsel)
|
|
{
|
|
unsigned long uv;
|
|
|
|
uv = ((vsel * 25000) + 500000);
|
|
return uv;
|
|
}
|
|
|
|
static unsigned long tps65912_vsel_to_uv_range3(u8 vsel)
|
|
{
|
|
unsigned long uv;
|
|
|
|
if (vsel == 0x3f)
|
|
uv = 3800000;
|
|
else
|
|
uv = ((vsel * 50000) + 500000);
|
|
|
|
return uv;
|
|
}
|
|
|
|
static unsigned long tps65912_vsel_to_uv_ldo(u8 vsel)
|
|
{
|
|
unsigned long uv = 0;
|
|
|
|
if (vsel <= 32)
|
|
uv = ((vsel * 25000) + 800000);
|
|
else if (vsel > 32 && vsel <= 60)
|
|
uv = (((vsel - 32) * 50000) + 1600000);
|
|
else if (vsel > 60)
|
|
uv = (((vsel - 60) * 100000) + 3000000);
|
|
|
|
return uv;
|
|
}
|
|
|
|
static int tps65912_get_ctrl_register(int id)
|
|
{
|
|
switch (id) {
|
|
case TPS65912_REG_DCDC1:
|
|
return TPS65912_DCDC1_AVS;
|
|
case TPS65912_REG_DCDC2:
|
|
return TPS65912_DCDC2_AVS;
|
|
case TPS65912_REG_DCDC3:
|
|
return TPS65912_DCDC3_AVS;
|
|
case TPS65912_REG_DCDC4:
|
|
return TPS65912_DCDC4_AVS;
|
|
case TPS65912_REG_LDO1:
|
|
return TPS65912_LDO1_AVS;
|
|
case TPS65912_REG_LDO2:
|
|
return TPS65912_LDO2_AVS;
|
|
case TPS65912_REG_LDO3:
|
|
return TPS65912_LDO3_AVS;
|
|
case TPS65912_REG_LDO4:
|
|
return TPS65912_LDO4_AVS;
|
|
case TPS65912_REG_LDO5:
|
|
return TPS65912_LDO5;
|
|
case TPS65912_REG_LDO6:
|
|
return TPS65912_LDO6;
|
|
case TPS65912_REG_LDO7:
|
|
return TPS65912_LDO7;
|
|
case TPS65912_REG_LDO8:
|
|
return TPS65912_LDO8;
|
|
case TPS65912_REG_LDO9:
|
|
return TPS65912_LDO9;
|
|
case TPS65912_REG_LDO10:
|
|
return TPS65912_LDO10;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
static int tps65912_get_dcdc_sel_register(struct tps65912_reg *pmic, int id)
|
|
{
|
|
struct tps65912 *mfd = pmic->mfd;
|
|
int opvsel = 0, sr = 0;
|
|
u8 reg = 0;
|
|
|
|
if (id < TPS65912_REG_DCDC1 || id > TPS65912_REG_DCDC4)
|
|
return -EINVAL;
|
|
|
|
switch (id) {
|
|
case TPS65912_REG_DCDC1:
|
|
opvsel = tps65912_reg_read(mfd, TPS65912_DCDC1_OP);
|
|
sr = ((opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT);
|
|
if (sr)
|
|
reg = TPS65912_DCDC1_AVS;
|
|
else
|
|
reg = TPS65912_DCDC1_OP;
|
|
break;
|
|
case TPS65912_REG_DCDC2:
|
|
opvsel = tps65912_reg_read(mfd, TPS65912_DCDC2_OP);
|
|
sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
|
|
if (sr)
|
|
reg = TPS65912_DCDC2_AVS;
|
|
else
|
|
reg = TPS65912_DCDC2_OP;
|
|
break;
|
|
case TPS65912_REG_DCDC3:
|
|
opvsel = tps65912_reg_read(mfd, TPS65912_DCDC3_OP);
|
|
sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
|
|
if (sr)
|
|
reg = TPS65912_DCDC3_AVS;
|
|
else
|
|
reg = TPS65912_DCDC3_OP;
|
|
break;
|
|
case TPS65912_REG_DCDC4:
|
|
opvsel = tps65912_reg_read(mfd, TPS65912_DCDC4_OP);
|
|
sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
|
|
if (sr)
|
|
reg = TPS65912_DCDC4_AVS;
|
|
else
|
|
reg = TPS65912_DCDC4_OP;
|
|
break;
|
|
}
|
|
return reg;
|
|
}
|
|
|
|
static int tps65912_get_ldo_sel_register(struct tps65912_reg *pmic, int id)
|
|
{
|
|
struct tps65912 *mfd = pmic->mfd;
|
|
int opvsel = 0, sr = 0;
|
|
u8 reg = 0;
|
|
|
|
if (id < TPS65912_REG_LDO1 || id > TPS65912_REG_LDO10)
|
|
return -EINVAL;
|
|
|
|
switch (id) {
|
|
case TPS65912_REG_LDO1:
|
|
opvsel = tps65912_reg_read(mfd, TPS65912_LDO1_OP);
|
|
sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
|
|
if (sr)
|
|
reg = TPS65912_LDO1_AVS;
|
|
else
|
|
reg = TPS65912_LDO1_OP;
|
|
break;
|
|
case TPS65912_REG_LDO2:
|
|
opvsel = tps65912_reg_read(mfd, TPS65912_LDO2_OP);
|
|
sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
|
|
if (sr)
|
|
reg = TPS65912_LDO2_AVS;
|
|
else
|
|
reg = TPS65912_LDO2_OP;
|
|
break;
|
|
case TPS65912_REG_LDO3:
|
|
opvsel = tps65912_reg_read(mfd, TPS65912_LDO3_OP);
|
|
sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
|
|
if (sr)
|
|
reg = TPS65912_LDO3_AVS;
|
|
else
|
|
reg = TPS65912_LDO3_OP;
|
|
break;
|
|
case TPS65912_REG_LDO4:
|
|
opvsel = tps65912_reg_read(mfd, TPS65912_LDO4_OP);
|
|
sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
|
|
if (sr)
|
|
reg = TPS65912_LDO4_AVS;
|
|
else
|
|
reg = TPS65912_LDO4_OP;
|
|
break;
|
|
case TPS65912_REG_LDO5:
|
|
reg = TPS65912_LDO5;
|
|
break;
|
|
case TPS65912_REG_LDO6:
|
|
reg = TPS65912_LDO6;
|
|
break;
|
|
case TPS65912_REG_LDO7:
|
|
reg = TPS65912_LDO7;
|
|
break;
|
|
case TPS65912_REG_LDO8:
|
|
reg = TPS65912_LDO8;
|
|
break;
|
|
case TPS65912_REG_LDO9:
|
|
reg = TPS65912_LDO9;
|
|
break;
|
|
case TPS65912_REG_LDO10:
|
|
reg = TPS65912_LDO10;
|
|
break;
|
|
}
|
|
|
|
return reg;
|
|
}
|
|
|
|
static int tps65912_get_mode_regiters(struct tps65912_reg *pmic, int id)
|
|
{
|
|
switch (id) {
|
|
case TPS65912_REG_DCDC1:
|
|
pmic->pwm_mode_reg = TPS65912_DCDC1_CTRL;
|
|
pmic->eco_reg = TPS65912_DCDC1_AVS;
|
|
break;
|
|
case TPS65912_REG_DCDC2:
|
|
pmic->pwm_mode_reg = TPS65912_DCDC2_CTRL;
|
|
pmic->eco_reg = TPS65912_DCDC2_AVS;
|
|
break;
|
|
case TPS65912_REG_DCDC3:
|
|
pmic->pwm_mode_reg = TPS65912_DCDC3_CTRL;
|
|
pmic->eco_reg = TPS65912_DCDC3_AVS;
|
|
break;
|
|
case TPS65912_REG_DCDC4:
|
|
pmic->pwm_mode_reg = TPS65912_DCDC4_CTRL;
|
|
pmic->eco_reg = TPS65912_DCDC4_AVS;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tps65912_reg_is_enabled(struct regulator_dev *dev)
|
|
{
|
|
struct tps65912_reg *pmic = rdev_get_drvdata(dev);
|
|
struct tps65912 *mfd = pmic->mfd;
|
|
int reg, value, id = rdev_get_id(dev);
|
|
|
|
if (id < TPS65912_REG_DCDC1 || id > TPS65912_REG_LDO10)
|
|
return -EINVAL;
|
|
|
|
reg = pmic->get_ctrl_reg(id);
|
|
if (reg < 0)
|
|
return reg;
|
|
|
|
value = tps65912_reg_read(mfd, reg);
|
|
if (value < 0)
|
|
return value;
|
|
|
|
return value & TPS65912_REG_ENABLED;
|
|
}
|
|
|
|
static int tps65912_reg_enable(struct regulator_dev *dev)
|
|
{
|
|
struct tps65912_reg *pmic = rdev_get_drvdata(dev);
|
|
struct tps65912 *mfd = pmic->mfd;
|
|
int id = rdev_get_id(dev);
|
|
int reg;
|
|
|
|
if (id < TPS65912_REG_DCDC1 || id > TPS65912_REG_LDO10)
|
|
return -EINVAL;
|
|
|
|
reg = pmic->get_ctrl_reg(id);
|
|
if (reg < 0)
|
|
return reg;
|
|
|
|
return tps65912_set_bits(mfd, reg, TPS65912_REG_ENABLED);
|
|
}
|
|
|
|
static int tps65912_reg_disable(struct regulator_dev *dev)
|
|
{
|
|
struct tps65912_reg *pmic = rdev_get_drvdata(dev);
|
|
struct tps65912 *mfd = pmic->mfd;
|
|
int id = rdev_get_id(dev), reg;
|
|
|
|
reg = pmic->get_ctrl_reg(id);
|
|
if (reg < 0)
|
|
return reg;
|
|
|
|
return tps65912_clear_bits(mfd, reg, TPS65912_REG_ENABLED);
|
|
}
|
|
|
|
static int tps65912_set_mode(struct regulator_dev *dev, unsigned int mode)
|
|
{
|
|
struct tps65912_reg *pmic = rdev_get_drvdata(dev);
|
|
struct tps65912 *mfd = pmic->mfd;
|
|
int pwm_mode, eco, id = rdev_get_id(dev);
|
|
|
|
tps65912_get_mode_regiters(pmic, id);
|
|
|
|
pwm_mode = tps65912_reg_read(mfd, pmic->pwm_mode_reg);
|
|
eco = tps65912_reg_read(mfd, pmic->eco_reg);
|
|
|
|
pwm_mode &= DCDCCTRL_DCDC_MODE_MASK;
|
|
eco &= DCDC_AVS_ECO_MASK;
|
|
|
|
switch (mode) {
|
|
case REGULATOR_MODE_FAST:
|
|
/* Verify if mode alredy set */
|
|
if (pwm_mode && !eco)
|
|
break;
|
|
tps65912_set_bits(mfd, pmic->pwm_mode_reg, DCDCCTRL_DCDC_MODE_MASK);
|
|
tps65912_clear_bits(mfd, pmic->eco_reg, DCDC_AVS_ECO_MASK);
|
|
break;
|
|
case REGULATOR_MODE_NORMAL:
|
|
case REGULATOR_MODE_IDLE:
|
|
if (!pwm_mode && !eco)
|
|
break;
|
|
tps65912_clear_bits(mfd, pmic->pwm_mode_reg, DCDCCTRL_DCDC_MODE_MASK);
|
|
tps65912_clear_bits(mfd, pmic->eco_reg, DCDC_AVS_ECO_MASK);
|
|
break;
|
|
case REGULATOR_MODE_STANDBY:
|
|
if (!pwm_mode && eco)
|
|
break;
|
|
tps65912_clear_bits(mfd, pmic->pwm_mode_reg, DCDCCTRL_DCDC_MODE_MASK);
|
|
tps65912_set_bits(mfd, pmic->eco_reg, DCDC_AVS_ECO_MASK);
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static unsigned int tps65912_get_mode(struct regulator_dev *dev)
|
|
{
|
|
struct tps65912_reg *pmic = rdev_get_drvdata(dev);
|
|
struct tps65912 *mfd = pmic->mfd;
|
|
int pwm_mode, eco, mode = 0, id = rdev_get_id(dev);
|
|
|
|
tps65912_get_mode_regiters(pmic, id);
|
|
|
|
pwm_mode = tps65912_reg_read(mfd, pmic->pwm_mode_reg);
|
|
eco = tps65912_reg_read(mfd, pmic->eco_reg);
|
|
|
|
pwm_mode &= DCDCCTRL_DCDC_MODE_MASK;
|
|
eco &= DCDC_AVS_ECO_MASK;
|
|
|
|
if (pwm_mode && !eco)
|
|
mode = REGULATOR_MODE_FAST;
|
|
else if (!pwm_mode && !eco)
|
|
mode = REGULATOR_MODE_NORMAL;
|
|
else if (!pwm_mode && eco)
|
|
mode = REGULATOR_MODE_STANDBY;
|
|
|
|
return mode;
|
|
}
|
|
|
|
static int tps65912_get_voltage_dcdc(struct regulator_dev *dev)
|
|
{
|
|
struct tps65912_reg *pmic = rdev_get_drvdata(dev);
|
|
struct tps65912 *mfd = pmic->mfd;
|
|
int id = rdev_get_id(dev), voltage = 0, range;
|
|
int opvsel = 0, avsel = 0, sr, vsel;
|
|
|
|
switch (id) {
|
|
case TPS65912_REG_DCDC1:
|
|
opvsel = tps65912_reg_read(mfd, TPS65912_DCDC1_OP);
|
|
avsel = tps65912_reg_read(mfd, TPS65912_DCDC1_AVS);
|
|
range = pmic->dcdc1_range;
|
|
break;
|
|
case TPS65912_REG_DCDC2:
|
|
opvsel = tps65912_reg_read(mfd, TPS65912_DCDC2_OP);
|
|
avsel = tps65912_reg_read(mfd, TPS65912_DCDC2_AVS);
|
|
range = pmic->dcdc2_range;
|
|
break;
|
|
case TPS65912_REG_DCDC3:
|
|
opvsel = tps65912_reg_read(mfd, TPS65912_DCDC3_OP);
|
|
avsel = tps65912_reg_read(mfd, TPS65912_DCDC3_AVS);
|
|
range = pmic->dcdc3_range;
|
|
break;
|
|
case TPS65912_REG_DCDC4:
|
|
opvsel = tps65912_reg_read(mfd, TPS65912_DCDC4_OP);
|
|
avsel = tps65912_reg_read(mfd, TPS65912_DCDC4_AVS);
|
|
range = pmic->dcdc4_range;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
|
|
if (sr)
|
|
vsel = avsel;
|
|
else
|
|
vsel = opvsel;
|
|
vsel &= 0x3F;
|
|
|
|
switch (range) {
|
|
case 0:
|
|
/* 0.5 - 1.2875V in 12.5mV steps */
|
|
voltage = tps65912_vsel_to_uv_range0(vsel);
|
|
break;
|
|
case 1:
|
|
/* 0.7 - 1.4875V in 12.5mV steps */
|
|
voltage = tps65912_vsel_to_uv_range1(vsel);
|
|
break;
|
|
case 2:
|
|
/* 0.5 - 2.075V in 25mV steps */
|
|
voltage = tps65912_vsel_to_uv_range2(vsel);
|
|
break;
|
|
case 3:
|
|
/* 0.5 - 3.8V in 50mV steps */
|
|
voltage = tps65912_vsel_to_uv_range3(vsel);
|
|
break;
|
|
}
|
|
return voltage;
|
|
}
|
|
|
|
static int tps65912_set_voltage_dcdc(struct regulator_dev *dev,
|
|
unsigned selector)
|
|
{
|
|
struct tps65912_reg *pmic = rdev_get_drvdata(dev);
|
|
struct tps65912 *mfd = pmic->mfd;
|
|
int id = rdev_get_id(dev);
|
|
int value;
|
|
u8 reg;
|
|
|
|
reg = tps65912_get_dcdc_sel_register(pmic, id);
|
|
value = tps65912_reg_read(mfd, reg);
|
|
value &= 0xC0;
|
|
return tps65912_reg_write(mfd, reg, selector | value);
|
|
}
|
|
|
|
static int tps65912_get_voltage_ldo(struct regulator_dev *dev)
|
|
{
|
|
struct tps65912_reg *pmic = rdev_get_drvdata(dev);
|
|
struct tps65912 *mfd = pmic->mfd;
|
|
int id = rdev_get_id(dev);
|
|
int vsel = 0;
|
|
u8 reg;
|
|
|
|
reg = tps65912_get_ldo_sel_register(pmic, id);
|
|
vsel = tps65912_reg_read(mfd, reg);
|
|
vsel &= 0x3F;
|
|
|
|
return tps65912_vsel_to_uv_ldo(vsel);
|
|
}
|
|
|
|
static int tps65912_set_voltage_ldo(struct regulator_dev *dev,
|
|
unsigned selector)
|
|
{
|
|
struct tps65912_reg *pmic = rdev_get_drvdata(dev);
|
|
struct tps65912 *mfd = pmic->mfd;
|
|
int id = rdev_get_id(dev), reg, value;
|
|
|
|
reg = tps65912_get_ldo_sel_register(pmic, id);
|
|
value = tps65912_reg_read(mfd, reg);
|
|
value &= 0xC0;
|
|
return tps65912_reg_write(mfd, reg, selector | value);
|
|
}
|
|
|
|
static int tps65912_list_voltage_dcdc(struct regulator_dev *dev,
|
|
unsigned selector)
|
|
{
|
|
struct tps65912_reg *pmic = rdev_get_drvdata(dev);
|
|
int range, voltage = 0, id = rdev_get_id(dev);
|
|
|
|
switch (id) {
|
|
case TPS65912_REG_DCDC1:
|
|
range = pmic->dcdc1_range;
|
|
break;
|
|
case TPS65912_REG_DCDC2:
|
|
range = pmic->dcdc2_range;
|
|
break;
|
|
case TPS65912_REG_DCDC3:
|
|
range = pmic->dcdc3_range;
|
|
break;
|
|
case TPS65912_REG_DCDC4:
|
|
range = pmic->dcdc4_range;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
switch (range) {
|
|
case 0:
|
|
/* 0.5 - 1.2875V in 12.5mV steps */
|
|
voltage = tps65912_vsel_to_uv_range0(selector);
|
|
break;
|
|
case 1:
|
|
/* 0.7 - 1.4875V in 12.5mV steps */
|
|
voltage = tps65912_vsel_to_uv_range1(selector);
|
|
break;
|
|
case 2:
|
|
/* 0.5 - 2.075V in 25mV steps */
|
|
voltage = tps65912_vsel_to_uv_range2(selector);
|
|
break;
|
|
case 3:
|
|
/* 0.5 - 3.8V in 50mV steps */
|
|
voltage = tps65912_vsel_to_uv_range3(selector);
|
|
break;
|
|
}
|
|
return voltage;
|
|
}
|
|
|
|
static int tps65912_list_voltage_ldo(struct regulator_dev *dev,
|
|
unsigned selector)
|
|
{
|
|
int ldo = rdev_get_id(dev);
|
|
|
|
if (ldo < TPS65912_REG_LDO1 || ldo > TPS65912_REG_LDO10)
|
|
return -EINVAL;
|
|
|
|
return tps65912_vsel_to_uv_ldo(selector);
|
|
}
|
|
|
|
/* Operations permitted on DCDCx */
|
|
static struct regulator_ops tps65912_ops_dcdc = {
|
|
.is_enabled = tps65912_reg_is_enabled,
|
|
.enable = tps65912_reg_enable,
|
|
.disable = tps65912_reg_disable,
|
|
.set_mode = tps65912_set_mode,
|
|
.get_mode = tps65912_get_mode,
|
|
.get_voltage = tps65912_get_voltage_dcdc,
|
|
.set_voltage_sel = tps65912_set_voltage_dcdc,
|
|
.list_voltage = tps65912_list_voltage_dcdc,
|
|
};
|
|
|
|
/* Operations permitted on LDOx */
|
|
static struct regulator_ops tps65912_ops_ldo = {
|
|
.is_enabled = tps65912_reg_is_enabled,
|
|
.enable = tps65912_reg_enable,
|
|
.disable = tps65912_reg_disable,
|
|
.get_voltage = tps65912_get_voltage_ldo,
|
|
.set_voltage_sel = tps65912_set_voltage_ldo,
|
|
.list_voltage = tps65912_list_voltage_ldo,
|
|
};
|
|
|
|
static __devinit int tps65912_probe(struct platform_device *pdev)
|
|
{
|
|
struct tps65912 *tps65912 = dev_get_drvdata(pdev->dev.parent);
|
|
struct tps_info *info;
|
|
struct regulator_init_data *reg_data;
|
|
struct regulator_dev *rdev;
|
|
struct tps65912_reg *pmic;
|
|
struct tps65912_board *pmic_plat_data;
|
|
int i, err;
|
|
|
|
pmic_plat_data = dev_get_platdata(tps65912->dev);
|
|
if (!pmic_plat_data)
|
|
return -EINVAL;
|
|
|
|
reg_data = pmic_plat_data->tps65912_pmic_init_data;
|
|
|
|
pmic = kzalloc(sizeof(*pmic), GFP_KERNEL);
|
|
if (!pmic)
|
|
return -ENOMEM;
|
|
|
|
mutex_init(&pmic->io_lock);
|
|
pmic->mfd = tps65912;
|
|
platform_set_drvdata(pdev, pmic);
|
|
|
|
pmic->get_ctrl_reg = &tps65912_get_ctrl_register;
|
|
info = tps65912_regs;
|
|
|
|
for (i = 0; i < TPS65912_NUM_REGULATOR; i++, info++, reg_data++) {
|
|
int range = 0;
|
|
/* Register the regulators */
|
|
pmic->info[i] = info;
|
|
|
|
pmic->desc[i].name = info->name;
|
|
pmic->desc[i].id = i;
|
|
pmic->desc[i].n_voltages = 64;
|
|
pmic->desc[i].ops = (i > TPS65912_REG_DCDC4 ?
|
|
&tps65912_ops_ldo : &tps65912_ops_dcdc);
|
|
pmic->desc[i].type = REGULATOR_VOLTAGE;
|
|
pmic->desc[i].owner = THIS_MODULE;
|
|
range = tps65912_get_range(pmic, i);
|
|
rdev = regulator_register(&pmic->desc[i],
|
|
tps65912->dev, reg_data, pmic);
|
|
if (IS_ERR(rdev)) {
|
|
dev_err(tps65912->dev,
|
|
"failed to register %s regulator\n",
|
|
pdev->name);
|
|
err = PTR_ERR(rdev);
|
|
goto err;
|
|
}
|
|
|
|
/* Save regulator for cleanup */
|
|
pmic->rdev[i] = rdev;
|
|
}
|
|
return 0;
|
|
|
|
err:
|
|
while (--i >= 0)
|
|
regulator_unregister(pmic->rdev[i]);
|
|
|
|
kfree(pmic);
|
|
return err;
|
|
}
|
|
|
|
static int __devexit tps65912_remove(struct platform_device *pdev)
|
|
{
|
|
struct tps65912_reg *tps65912_reg = platform_get_drvdata(pdev);
|
|
int i;
|
|
|
|
for (i = 0; i < TPS65912_NUM_REGULATOR; i++)
|
|
regulator_unregister(tps65912_reg->rdev[i]);
|
|
|
|
kfree(tps65912_reg);
|
|
return 0;
|
|
}
|
|
|
|
static struct platform_driver tps65912_driver = {
|
|
.driver = {
|
|
.name = "tps65912-pmic",
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.probe = tps65912_probe,
|
|
.remove = __devexit_p(tps65912_remove),
|
|
};
|
|
|
|
/**
|
|
* tps65912_init
|
|
*
|
|
* Module init function
|
|
*/
|
|
static int __init tps65912_init(void)
|
|
{
|
|
return platform_driver_register(&tps65912_driver);
|
|
}
|
|
subsys_initcall(tps65912_init);
|
|
|
|
/**
|
|
* tps65912_cleanup
|
|
*
|
|
* Module exit function
|
|
*/
|
|
static void __exit tps65912_cleanup(void)
|
|
{
|
|
platform_driver_unregister(&tps65912_driver);
|
|
}
|
|
module_exit(tps65912_cleanup);
|
|
|
|
MODULE_AUTHOR("Margarita Olaya Cabrera <magi@slimlogic.co.uk>");
|
|
MODULE_DESCRIPTION("TPS65912 voltage regulator driver");
|
|
MODULE_LICENSE("GPL v2");
|
|
MODULE_ALIAS("platform:tps65912-pmic");
|