mirror of
https://github.com/torvalds/linux.git
synced 2026-06-08 14:42:37 +02:00
regulator: xz3216: add driver with xz3216 series of DCDC devices to compile.
Change-Id: I5883e142c17a60cbba7e37bd4a9303efb3c867bf Signed-off-by: Aiyoujun <ayj@rock-chips.com>
This commit is contained in:
parent
98827e305e
commit
9922764300
|
|
@ -819,5 +819,11 @@ config REGULATOR_WM8994
|
|||
This driver provides support for the voltage regulators on the
|
||||
WM8994 CODEC.
|
||||
|
||||
config REGULATOR_XZ3216
|
||||
tristate "Xizhuo XZ3216 voltage regulator"
|
||||
depends on I2C
|
||||
help
|
||||
Support the voltage and current regulators of the XZ321X series of DCDC devices.
|
||||
|
||||
endif
|
||||
|
||||
|
|
|
|||
|
|
@ -105,6 +105,7 @@ obj-$(CONFIG_REGULATOR_WM831X) += wm831x-ldo.o
|
|||
obj-$(CONFIG_REGULATOR_WM8350) += wm8350-regulator.o
|
||||
obj-$(CONFIG_REGULATOR_WM8400) += wm8400-regulator.o
|
||||
obj-$(CONFIG_REGULATOR_WM8994) += wm8994-regulator.o
|
||||
obj-$(CONFIG_REGULATOR_XZ3216) += xz3216.o
|
||||
|
||||
|
||||
ccflags-$(CONFIG_REGULATOR_DEBUG) += -DDEBUG
|
||||
|
|
|
|||
512
drivers/regulator/xz3216.c
Executable file → Normal file
512
drivers/regulator/xz3216.c
Executable file → Normal file
|
|
@ -38,25 +38,43 @@
|
|||
#define DBG(x...)
|
||||
#endif
|
||||
|
||||
#define DBG_ERR(x...) pr_err(x)
|
||||
|
||||
#define DBG_ERR(x...) pr_err(x)
|
||||
|
||||
#define PM_CONTROL
|
||||
#define XZ3216_SPEED (200 * 1000)
|
||||
#define XZ3216_NUM_REGULATORS 1
|
||||
|
||||
#define XZ3216_BUCK1_SET_VOL_BASE 0x00
|
||||
#define XZ3216_BUCK1_SLP_VOL_BASE 0x01
|
||||
#define XZ3216_CONTR_REG1 0x02
|
||||
#define XZ3216_ID1_REG 0x03
|
||||
#define BUCK_VOL_MASK 0x3f
|
||||
#define VOL_MIN_IDX 0x00
|
||||
#define VOL_MAX_IDX 0x3
|
||||
|
||||
/* VSEL bit definitions */
|
||||
#define VSEL_BUCK_EN BIT(7)
|
||||
#define VSEL_MODE BIT(6)
|
||||
#define VSEL_NSEL_MASK 0x3F
|
||||
|
||||
/* Control bit definitions */
|
||||
#define CTL_OUTPUT_DISCHG BIT(7)
|
||||
#define CTL_SLEW_MASK (0x7 << 4)
|
||||
#define CTL_SLEW_SHIFT 4
|
||||
#define CTL_RESET BIT(2)
|
||||
|
||||
struct xz3216 {
|
||||
struct device *dev;
|
||||
struct mutex io_lock;
|
||||
struct i2c_client *i2c;
|
||||
int num_regulators;
|
||||
struct regulator_dev **rdev;
|
||||
int irq_base;
|
||||
int chip_irq;
|
||||
int sleep_gpio;
|
||||
unsigned int dcdc_slp_voltage[3];
|
||||
bool pmic_sleep;
|
||||
struct regulator_dev *rdev;
|
||||
struct regulator_init_data *regulator;
|
||||
struct regmap *regmap;
|
||||
/* Voltage setting register */
|
||||
unsigned int vol_reg;
|
||||
unsigned int sleep_reg;
|
||||
/* Voltage range and step(linear) */
|
||||
unsigned int vsel_min;
|
||||
unsigned int vsel_step;
|
||||
unsigned int sleep_vol_cache;
|
||||
};
|
||||
|
||||
struct xz3216_regulator {
|
||||
|
|
@ -65,394 +83,168 @@ struct xz3216_regulator {
|
|||
struct regulator_dev *rdev;
|
||||
};
|
||||
|
||||
|
||||
struct xz3216_board {
|
||||
int irq;
|
||||
int irq_base;
|
||||
struct regulator_init_data *xz3216_init_data[XZ3216_NUM_REGULATORS];
|
||||
struct device_node *of_node[XZ3216_NUM_REGULATORS];
|
||||
int sleep_gpio; /* */
|
||||
unsigned int dcdc_slp_voltage[3]; /* buckx_voltage in uV */
|
||||
bool sleep;
|
||||
struct regulator_init_data *xz3216_init_data;
|
||||
struct device_node *of_node;
|
||||
};
|
||||
|
||||
struct xz3216_regulator_subdev {
|
||||
int id;
|
||||
struct regulator_init_data *initdata;
|
||||
struct device_node *reg_node;
|
||||
};
|
||||
|
||||
struct xz3216_platform_data {
|
||||
int ono;
|
||||
int num_regulators;
|
||||
struct xz3216_regulator_subdev *regulators;
|
||||
int sleep_gpio; /* */
|
||||
unsigned int dcdc_slp_voltage[3]; /* buckx_voltage in uV */
|
||||
bool sleep;
|
||||
};
|
||||
|
||||
static int xz3216_reg_read(struct xz3216 *xz3216, u8 reg);
|
||||
static int xz3216_set_bits(struct xz3216 *xz3216, u8 reg, u16 mask, u16 val);
|
||||
|
||||
|
||||
#define XZ3216_BUCK1_SET_VOL_BASE 0x00
|
||||
#define XZ3216_BUCK1_SLP_VOL_BASE 0x01
|
||||
#define XZ3216_CONTR_REG1 0x02
|
||||
/*#define XZ3216_ID1_REG 0x03*/
|
||||
/*#define XZ3216_ID2_REG 0x04*/
|
||||
#define XZ3216_CONTR_REG2 0x05
|
||||
#define BUCK_VOL_MASK 0x3f
|
||||
#define VOL_MIN_IDX 0x00
|
||||
#define VOL_MAX_IDX 0x3f
|
||||
|
||||
const static int buck_voltage_map[] = {
|
||||
603000, 615750, 628500, 641250, 654000, 666750, 679500, 692250,
|
||||
705000, 717750, 730500, 743250, 756000, 768750, 781500, 794250,
|
||||
807000, 819750, 832500, 845250, 858000, 870750, 883500, 896250,
|
||||
909000, 921750, 934500, 947250, 960000, 972750, 985500, 998250,
|
||||
1011000, 1023750, 1036500, 1049250, 1062000, 1074750, 1087500, 1100250,
|
||||
1113000, 1125750, 1138500, 1151250, 1164000, 1176750, 1189500, 1202250,
|
||||
1215000, 1227750, 1240500, 1253250, 1266000, 1278750, 1291500, 1304250,
|
||||
1317000, 1329750, 1342500, 1355250, 1368000, 1380750, 1393500, 1406250
|
||||
/*
|
||||
712500, 725000, 737500, 750000, 762500, 775000, 787500, 800000,
|
||||
812500, 825000, 837500,850000, 862500,875000,887500,900000,
|
||||
912500, 925000, 937500,950000, 962500,975000,987500,1000000,
|
||||
1012500, 1025000, 1037500,1050000, 1062500,1075000,1087500,1100000,
|
||||
1112500, 1125000, 1137500,1150000, 1162500,1175000,1187500,1200000,
|
||||
1212500, 1225000, 1237500,1250000, 1262500,1275000,1287500,1300000,
|
||||
1312500, 1325000, 1337500,1350000, 1362500,1375000,1387500,1400000,
|
||||
1412500, 1425000, 1437500,1450000, 1462500,1475000,1487500,1500000,
|
||||
*/
|
||||
};
|
||||
|
||||
static int xz3216_dcdc_list_voltage(struct regulator_dev *dev, unsigned index)
|
||||
{
|
||||
if (index >= ARRAY_SIZE(buck_voltage_map))
|
||||
return -EINVAL;
|
||||
return buck_voltage_map[index];
|
||||
}
|
||||
|
||||
|
||||
static int xz3216_dcdc_is_enabled(struct regulator_dev *dev)
|
||||
{
|
||||
struct xz3216 *xz3216 = rdev_get_drvdata(dev);
|
||||
u16 val;
|
||||
u16 mask = 0x80;
|
||||
|
||||
val = xz3216_reg_read(xz3216, XZ3216_BUCK1_SET_VOL_BASE);
|
||||
if (val < 0)
|
||||
return val;
|
||||
val = val&~0x7f;
|
||||
if (val & mask)
|
||||
return 1;
|
||||
else
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static int xz3216_dcdc_enable(struct regulator_dev *dev)
|
||||
{
|
||||
struct xz3216 *xz3216 = rdev_get_drvdata(dev);
|
||||
u16 mask = 0x80;
|
||||
|
||||
return xz3216_set_bits(xz3216, XZ3216_BUCK1_SET_VOL_BASE, mask,
|
||||
0x80);
|
||||
}
|
||||
|
||||
|
||||
static int xz3216_dcdc_disable(struct regulator_dev *dev)
|
||||
{
|
||||
struct xz3216 *xz3216 = rdev_get_drvdata(dev);
|
||||
u16 mask = 0x80;
|
||||
|
||||
return xz3216_set_bits(xz3216, XZ3216_BUCK1_SET_VOL_BASE, mask, 0);
|
||||
}
|
||||
|
||||
|
||||
static int xz3216_dcdc_get_voltage(struct regulator_dev *dev)
|
||||
{
|
||||
struct xz3216 *xz3216 = rdev_get_drvdata(dev);
|
||||
u16 reg = 0;
|
||||
int val;
|
||||
|
||||
reg = xz3216_reg_read(xz3216, XZ3216_BUCK1_SET_VOL_BASE);
|
||||
reg &= BUCK_VOL_MASK;
|
||||
val = buck_voltage_map[reg];
|
||||
return val;
|
||||
}
|
||||
|
||||
|
||||
static int xz3216_dcdc_set_voltage(struct regulator_dev *dev,
|
||||
int min_uV, int max_uV,
|
||||
unsigned *selector)
|
||||
{
|
||||
struct xz3216 *xz3216 = rdev_get_drvdata(dev);
|
||||
const int *vol_map = buck_voltage_map;
|
||||
u16 val;
|
||||
int ret = 0;
|
||||
|
||||
if (min_uV < vol_map[VOL_MIN_IDX] ||
|
||||
min_uV > vol_map[VOL_MAX_IDX])
|
||||
return -EINVAL;
|
||||
for (val = VOL_MIN_IDX; val <= VOL_MAX_IDX; val++) {
|
||||
if (vol_map[val] >= min_uV)
|
||||
break;
|
||||
}
|
||||
if (vol_map[val] > max_uV) {
|
||||
DBG_ERR("WARNING:this voltage is not support!voltage set");
|
||||
DBG_ERR(" is %d mv\n", vol_map[val]);
|
||||
}
|
||||
ret = xz3216_set_bits(xz3216, XZ3216_BUCK1_SET_VOL_BASE,
|
||||
BUCK_VOL_MASK, val);
|
||||
if (ret < 0) {
|
||||
DBG_ERR("###################WARNING:set voltage is error!");
|
||||
DBG_ERR("voltage set is %d mv %d\n", vol_map[val], ret);
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
static unsigned int xz3216_dcdc_get_mode(struct regulator_dev *dev)
|
||||
{
|
||||
struct xz3216 *xz3216 = rdev_get_drvdata(dev);
|
||||
u16 mask = 0x40;
|
||||
u16 val;
|
||||
unsigned int val;
|
||||
int ret = 0;
|
||||
|
||||
val = xz3216_reg_read(xz3216, XZ3216_BUCK1_SET_VOL_BASE);
|
||||
if (val < 0)
|
||||
return val;
|
||||
val = val & mask;
|
||||
if (val == mask)
|
||||
ret = regmap_read(xz3216->regmap, xz3216->vol_reg, &val);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
if (val & VSEL_MODE)
|
||||
return REGULATOR_MODE_FAST;
|
||||
else
|
||||
return REGULATOR_MODE_NORMAL;
|
||||
}
|
||||
|
||||
|
||||
static int xz3216_dcdc_set_mode(struct regulator_dev *dev, unsigned int mode)
|
||||
{
|
||||
struct xz3216 *xz3216 = rdev_get_drvdata(dev);
|
||||
u16 mask = 0x4;
|
||||
|
||||
switch (mode) {
|
||||
case REGULATOR_MODE_FAST:
|
||||
return xz3216_set_bits(xz3216, XZ3216_BUCK1_SET_VOL_BASE,
|
||||
mask, mask);
|
||||
regmap_update_bits(xz3216->regmap, xz3216->vol_reg,
|
||||
VSEL_MODE, VSEL_MODE);
|
||||
case REGULATOR_MODE_NORMAL:
|
||||
return xz3216_set_bits(xz3216, XZ3216_BUCK1_SET_VOL_BASE,
|
||||
mask, 0);
|
||||
regmap_update_bits(xz3216->regmap, xz3216->vol_reg,
|
||||
VSEL_MODE, 0);
|
||||
default:
|
||||
DBG("error:dcdc_xz3216 only auto and pwm mode\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static int xz3216_dcdc_set_voltage_time_sel(struct regulator_dev *dev,
|
||||
unsigned int old_selector,
|
||||
unsigned int new_selector)
|
||||
{
|
||||
int old_volt;
|
||||
int new_volt;
|
||||
|
||||
old_volt = xz3216_dcdc_list_voltage(dev, old_selector);
|
||||
if (old_volt < 0)
|
||||
return old_volt;
|
||||
new_volt = xz3216_dcdc_list_voltage(dev, new_selector);
|
||||
if (new_volt < 0)
|
||||
return new_volt;
|
||||
return DIV_ROUND_UP(abs(old_volt - new_volt)*4, 10000);
|
||||
}
|
||||
|
||||
|
||||
static int xz3216_dcdc_suspend_enable(struct regulator_dev *dev)
|
||||
{
|
||||
struct xz3216 *xz3216 = rdev_get_drvdata(dev);
|
||||
u16 mask = 0x80;
|
||||
|
||||
return xz3216_set_bits(xz3216, XZ3216_BUCK1_SLP_VOL_BASE,
|
||||
mask, 0x80);
|
||||
return regmap_update_bits(xz3216->regmap, XZ3216_BUCK1_SLP_VOL_BASE,
|
||||
VSEL_BUCK_EN, VSEL_BUCK_EN);
|
||||
}
|
||||
|
||||
|
||||
static int xz3216_dcdc_suspend_disable(struct regulator_dev *dev)
|
||||
{
|
||||
struct xz3216 *xz3216 = rdev_get_drvdata(dev);
|
||||
u16 mask = 0x80;
|
||||
return regmap_update_bits(xz3216->regmap, XZ3216_BUCK1_SLP_VOL_BASE,
|
||||
VSEL_BUCK_EN, 0);
|
||||
|
||||
return xz3216_set_bits(xz3216, XZ3216_BUCK1_SLP_VOL_BASE, mask,
|
||||
0);
|
||||
}
|
||||
|
||||
static int xz3216_dcdc_set_sleep_voltage(struct regulator_dev *dev,
|
||||
int uV)
|
||||
int uV)
|
||||
{
|
||||
struct xz3216 *xz3216 = rdev_get_drvdata(dev);
|
||||
const int *vol_map = buck_voltage_map;
|
||||
u16 val;
|
||||
int ret = 0;
|
||||
int ret;
|
||||
|
||||
if (xz3216->sleep_vol_cache == uV)
|
||||
return 0;
|
||||
ret = regulator_map_voltage_linear(dev, uV, uV);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
ret = regmap_update_bits(xz3216->regmap, XZ3216_BUCK1_SLP_VOL_BASE,
|
||||
VSEL_NSEL_MASK, ret);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
xz3216->sleep_vol_cache = uV;
|
||||
return 0;
|
||||
|
||||
if (uV < vol_map[VOL_MIN_IDX] ||
|
||||
uV > vol_map[VOL_MAX_IDX])
|
||||
return -EINVAL;
|
||||
for (val = VOL_MIN_IDX; val <= VOL_MAX_IDX; val++) {
|
||||
if (vol_map[val] >= uV)
|
||||
break;
|
||||
}
|
||||
if (vol_map[val] > uV) {
|
||||
DBG("WARNING:this voltage is not support!voltage set");
|
||||
DBG("is %d mv\n", vol_map[val]);
|
||||
}
|
||||
ret = xz3216_set_bits(xz3216, XZ3216_BUCK1_SLP_VOL_BASE,
|
||||
BUCK_VOL_MASK, val);
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
static int xz3216_dcdc_set_suspend_mode(struct regulator_dev *dev,
|
||||
unsigned int mode)
|
||||
{
|
||||
struct xz3216 *xz3216 = rdev_get_drvdata(dev);
|
||||
u16 mask = 0x40;
|
||||
|
||||
switch (mode) {
|
||||
case REGULATOR_MODE_FAST:
|
||||
return xz3216_set_bits(xz3216, XZ3216_BUCK1_SLP_VOL_BASE,
|
||||
mask, mask);
|
||||
regmap_update_bits(xz3216->regmap, xz3216->vol_reg,
|
||||
VSEL_MODE, VSEL_MODE);
|
||||
case REGULATOR_MODE_NORMAL:
|
||||
return xz3216_set_bits(xz3216, XZ3216_BUCK1_SLP_VOL_BASE,
|
||||
mask, 0);
|
||||
regmap_update_bits(xz3216->regmap, xz3216->vol_reg,
|
||||
VSEL_MODE, 0);
|
||||
default:
|
||||
DBG_ERR("error:dcdc_xz3216 only auto and pwm mode\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
static const int slew_rates[] = {
|
||||
64000,
|
||||
32000,
|
||||
16000,
|
||||
8000,
|
||||
4000,
|
||||
2000,
|
||||
1000,
|
||||
500,
|
||||
};
|
||||
|
||||
static int xz3216_set_ramp(struct regulator_dev *rdev, int ramp)
|
||||
{
|
||||
struct xz3216 *xz3216 = rdev_get_drvdata(rdev);
|
||||
int regval = -1, i;
|
||||
|
||||
for (i = 0; i < ARRAY_SIZE(slew_rates); i++) {
|
||||
if (ramp <= slew_rates[i])
|
||||
regval = i;
|
||||
else
|
||||
break;
|
||||
}
|
||||
if (regval < 0) {
|
||||
dev_err(xz3216->dev, "unsupported ramp value %d\n", ramp);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return regmap_update_bits(xz3216->regmap, XZ3216_CONTR_REG1,
|
||||
CTL_SLEW_MASK, regval << CTL_SLEW_SHIFT);
|
||||
}
|
||||
|
||||
static struct regulator_ops xz3216_dcdc_ops = {
|
||||
.set_voltage = xz3216_dcdc_set_voltage,
|
||||
.get_voltage = xz3216_dcdc_get_voltage,
|
||||
.list_voltage = xz3216_dcdc_list_voltage,
|
||||
.is_enabled = xz3216_dcdc_is_enabled,
|
||||
.enable = xz3216_dcdc_enable,
|
||||
.disable = xz3216_dcdc_disable,
|
||||
.set_voltage_sel = regulator_set_voltage_sel_regmap,
|
||||
.get_voltage_sel = regulator_get_voltage_sel_regmap,
|
||||
.list_voltage = regulator_list_voltage_linear,
|
||||
.map_voltage = regulator_map_voltage_linear,
|
||||
.is_enabled = regulator_is_enabled_regmap,
|
||||
.enable = regulator_enable_regmap,
|
||||
.disable = regulator_disable_regmap,
|
||||
.get_mode = xz3216_dcdc_get_mode,
|
||||
.set_mode = xz3216_dcdc_set_mode,
|
||||
.set_suspend_voltage = xz3216_dcdc_set_sleep_voltage,
|
||||
.set_suspend_enable = xz3216_dcdc_suspend_enable,
|
||||
.set_suspend_disable = xz3216_dcdc_suspend_disable,
|
||||
.set_suspend_mode = xz3216_dcdc_set_suspend_mode,
|
||||
.set_voltage_time_sel = xz3216_dcdc_set_voltage_time_sel,
|
||||
.set_ramp_delay = xz3216_set_ramp,
|
||||
.set_voltage_time_sel = regulator_set_voltage_time_sel,
|
||||
};
|
||||
|
||||
|
||||
static struct regulator_desc regulators[] = {
|
||||
{
|
||||
.name = "XZ_DCDC1",
|
||||
.supply_name = "vin",
|
||||
.id = 0,
|
||||
.ops = &xz3216_dcdc_ops,
|
||||
.n_voltages = ARRAY_SIZE(buck_voltage_map),
|
||||
.n_voltages = 64,
|
||||
.type = REGULATOR_VOLTAGE,
|
||||
.enable_time = 400,
|
||||
.enable_reg = XZ3216_BUCK1_SET_VOL_BASE,
|
||||
.enable_mask = VSEL_BUCK_EN,
|
||||
.min_uV = 600000,
|
||||
.uV_step = 12500,
|
||||
.vsel_reg = XZ3216_BUCK1_SET_VOL_BASE,
|
||||
.vsel_mask = VSEL_NSEL_MASK,
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
};
|
||||
|
||||
static int xz3216_i2c_read(struct i2c_client *i2c, char reg, int count,
|
||||
u16 *dest)
|
||||
{
|
||||
int ret;
|
||||
struct i2c_adapter *adap;
|
||||
struct i2c_msg msgs[2];
|
||||
|
||||
if (!i2c)
|
||||
return ret;
|
||||
if (count != 1)
|
||||
return -EIO;
|
||||
adap = i2c->adapter;
|
||||
msgs[0].addr = i2c->addr;
|
||||
msgs[0].buf = ®
|
||||
msgs[0].flags = i2c->flags;
|
||||
msgs[0].len = 1;
|
||||
msgs[0].scl_rate = XZ3216_SPEED;
|
||||
msgs[1].buf = (u8 *)dest;
|
||||
msgs[1].addr = i2c->addr;
|
||||
msgs[1].flags = i2c->flags | I2C_M_RD;
|
||||
msgs[1].len = 1;
|
||||
msgs[1].scl_rate = XZ3216_SPEED;
|
||||
ret = i2c_transfer(adap, msgs, 2);
|
||||
DBG("***run in %s %d msgs[1].buf = %d\n", __func__,
|
||||
__LINE__, *(msgs[1].buf));
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int xz3216_i2c_write(struct i2c_client *i2c, char reg,
|
||||
int count, const u16 src)
|
||||
{
|
||||
int ret = -1;
|
||||
struct i2c_adapter *adap;
|
||||
struct i2c_msg msg;
|
||||
char tx_buf[2];
|
||||
|
||||
if (!i2c)
|
||||
return ret;
|
||||
if (count != 1)
|
||||
return -EIO;
|
||||
adap = i2c->adapter;
|
||||
tx_buf[0] = reg;
|
||||
tx_buf[1] = src;
|
||||
msg.addr = i2c->addr;
|
||||
msg.buf = &tx_buf[0];
|
||||
msg.len = 1 + 1;
|
||||
msg.flags = i2c->flags;
|
||||
msg.scl_rate = XZ3216_SPEED;
|
||||
ret = i2c_transfer(adap, &msg, 1);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int xz3216_reg_read(struct xz3216 *xz3216, u8 reg)
|
||||
{
|
||||
u16 val = 0;
|
||||
int ret;
|
||||
|
||||
mutex_lock(&xz3216->io_lock);
|
||||
ret = xz3216_i2c_read(xz3216->i2c, reg, 1, &val);
|
||||
DBG("reg read 0x%02x -> 0x%02x\n", (int)reg, (unsigned)val&0xff);
|
||||
if (ret < 0) {
|
||||
mutex_unlock(&xz3216->io_lock);
|
||||
return ret;
|
||||
}
|
||||
mutex_unlock(&xz3216->io_lock);
|
||||
return val & 0xff;
|
||||
}
|
||||
|
||||
static int xz3216_set_bits(struct xz3216 *xz3216, u8 reg, u16 mask, u16 val)
|
||||
{
|
||||
u16 tmp;
|
||||
int ret;
|
||||
|
||||
mutex_lock(&xz3216->io_lock);
|
||||
ret = xz3216_i2c_read(xz3216->i2c, reg, 1, &tmp);
|
||||
DBG("1 reg read 0x%02x -> 0x%02x\n", (int)reg, (unsigned)tmp&0xff);
|
||||
if (ret < 0) {
|
||||
mutex_unlock(&xz3216->io_lock);
|
||||
return ret;
|
||||
}
|
||||
tmp = (tmp & ~mask) | val;
|
||||
ret = xz3216_i2c_write(xz3216->i2c, reg, 1, tmp);
|
||||
DBG("reg write 0x%02x -> 0x%02x\n", (int)reg, (unsigned)val & 0xff);
|
||||
if (ret < 0) {
|
||||
mutex_unlock(&xz3216->io_lock);
|
||||
return ret;
|
||||
}
|
||||
ret = xz3216_i2c_read(xz3216->i2c, reg, 1, &tmp);
|
||||
DBG("2 reg read 0x%02x -> 0x%02x\n", (int)reg, (unsigned)tmp & 0xff);
|
||||
if (ret < 0) {
|
||||
mutex_unlock(&xz3216->io_lock);
|
||||
return ret;
|
||||
}
|
||||
mutex_unlock(&xz3216->io_lock);
|
||||
return 0;
|
||||
}
|
||||
static const struct regmap_config xz3216_regmap_config = {
|
||||
.reg_bits = 8,
|
||||
.val_bits = 8,
|
||||
};
|
||||
|
||||
#ifdef CONFIG_OF
|
||||
static struct of_device_id xz3216_of_match[] = {
|
||||
|
|
@ -461,6 +253,7 @@ static struct of_device_id xz3216_of_match[] = {
|
|||
};
|
||||
MODULE_DEVICE_TABLE(of, xz3216_of_match);
|
||||
#endif
|
||||
|
||||
#ifdef CONFIG_OF
|
||||
static struct of_regulator_match xz3216_reg_matches[] = {
|
||||
{ .name = "xz_dcdc1", .driver_data = (void *)0},
|
||||
|
|
@ -473,7 +266,6 @@ static struct xz3216_board *xz3216_parse_dt(struct xz3216 *xz3216)
|
|||
struct device_node *xz3216_np;
|
||||
int count;
|
||||
|
||||
DBG("%s,line=%d\n", __func__, __LINE__);
|
||||
xz3216_np = of_node_get(xz3216->dev->of_node);
|
||||
if (!xz3216_np) {
|
||||
DBG_ERR("could not find pmic sub-node\n");
|
||||
|
|
@ -488,8 +280,8 @@ static struct xz3216_board *xz3216_parse_dt(struct xz3216 *xz3216)
|
|||
pdata = devm_kzalloc(xz3216->dev, sizeof(*pdata), GFP_KERNEL);
|
||||
if (!pdata)
|
||||
return NULL;
|
||||
pdata->xz3216_init_data[0] = xz3216_reg_matches[0].init_data;
|
||||
pdata->of_node[0] = xz3216_reg_matches[0].of_node;
|
||||
pdata->xz3216_init_data = xz3216_reg_matches[0].init_data;
|
||||
pdata->of_node = xz3216_reg_matches[0].of_node;
|
||||
return pdata;
|
||||
}
|
||||
|
||||
|
|
@ -501,18 +293,21 @@ static struct xz3216_board *xz3216_parse_dt(struct i2c_client *i2c)
|
|||
#endif
|
||||
|
||||
static int xz3216_i2c_probe(struct i2c_client *i2c,
|
||||
const struct i2c_device_id *id)
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct xz3216 *xz3216;
|
||||
struct xz3216_board *pdev;
|
||||
const struct of_device_id *match;
|
||||
struct regulator_config config = { };
|
||||
struct regulator_dev *xz_rdev;
|
||||
struct regulator_init_data *reg_data;
|
||||
const char *rail_name = NULL;
|
||||
int ret;
|
||||
DBG("%s, line=%d\n", __func__, __LINE__);
|
||||
xz3216 = devm_kzalloc(&i2c->dev, sizeof(struct xz3216),
|
||||
GFP_KERNEL);
|
||||
if (!xz3216) {
|
||||
ret = -ENOMEM;
|
||||
goto err;
|
||||
}
|
||||
|
||||
DBG("%s, line=%d\n", __func__, __LINE__);
|
||||
if (i2c->dev.of_node) {
|
||||
match = of_match_device(xz3216_of_match, &i2c->dev);
|
||||
if (!match) {
|
||||
|
|
@ -521,57 +316,50 @@ static int xz3216_i2c_probe(struct i2c_client *i2c,
|
|||
}
|
||||
}
|
||||
|
||||
xz3216 = devm_kzalloc(&i2c->dev, sizeof(struct xz3216),
|
||||
GFP_KERNEL);
|
||||
if (xz3216 == NULL) {
|
||||
ret = -ENOMEM;
|
||||
goto err;
|
||||
xz3216->regmap = devm_regmap_init_i2c(i2c, &xz3216_regmap_config);
|
||||
if (IS_ERR(xz3216->regmap)) {
|
||||
dev_err(&i2c->dev, "Failed to allocate regmap!\n");
|
||||
return PTR_ERR(xz3216->regmap);
|
||||
}
|
||||
|
||||
xz3216->i2c = i2c;
|
||||
xz3216->dev = &i2c->dev;
|
||||
i2c_set_clientdata(i2c, xz3216);
|
||||
mutex_init(&xz3216->io_lock);
|
||||
if (xz3216->dev->of_node)
|
||||
pdev = dev_get_platdata(&i2c->dev);
|
||||
if (!pdev)
|
||||
pdev = xz3216_parse_dt(xz3216);
|
||||
|
||||
if (pdev) {
|
||||
xz3216->num_regulators = XZ3216_NUM_REGULATORS;
|
||||
xz3216->rdev = kcalloc(XZ3216_NUM_REGULATORS,
|
||||
sizeof(struct regulator_dev *),
|
||||
sizeof(struct regulator_dev),
|
||||
GFP_KERNEL);
|
||||
if (!xz3216->rdev)
|
||||
return -ENOMEM;
|
||||
/* Instantiate the regulators */
|
||||
reg_data = pdev->xz3216_init_data[0];
|
||||
xz3216->regulator = pdev->xz3216_init_data;
|
||||
if (xz3216->dev->of_node)
|
||||
config.of_node = pdev->of_node;
|
||||
config.dev = xz3216->dev;
|
||||
config.driver_data = xz3216;
|
||||
if (xz3216->dev->of_node)
|
||||
config.of_node = pdev->of_node[0];
|
||||
if (reg_data && reg_data->constraints.name)
|
||||
rail_name = reg_data->constraints.name;
|
||||
else
|
||||
rail_name = regulators[0].name;
|
||||
reg_data->supply_regulator = rail_name;
|
||||
|
||||
config.init_data = reg_data;
|
||||
xz_rdev = regulator_register(®ulators[0], &config);
|
||||
if (IS_ERR(xz_rdev)) {
|
||||
DBG_ERR("failed to register xz3216\n");
|
||||
goto err;
|
||||
}
|
||||
xz3216->rdev[0] = xz_rdev;
|
||||
config.init_data = xz3216->regulator;
|
||||
xz3216->rdev = devm_regulator_register(xz3216->dev,
|
||||
®ulators[0], &config);
|
||||
ret = PTR_ERR_OR_ZERO(xz3216->rdev);
|
||||
if (ret < 0)
|
||||
dev_err(&i2c->dev, "Failed to register regulator!\n");
|
||||
return ret;
|
||||
}
|
||||
return 0;
|
||||
err:
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int xz3216_i2c_remove(struct i2c_client *i2c)
|
||||
static int xz3216_i2c_remove(struct i2c_client *i2c)
|
||||
{
|
||||
struct xz3216 *xz3216 = i2c_get_clientdata(i2c);
|
||||
|
||||
if (xz3216->rdev[0])
|
||||
regulator_unregister(xz3216->rdev[0]);
|
||||
if (xz3216->rdev)
|
||||
regulator_unregister(xz3216->rdev);
|
||||
i2c_set_clientdata(i2c, NULL);
|
||||
return 0;
|
||||
}
|
||||
|
|
@ -588,8 +376,8 @@ static struct i2c_driver xz3216_i2c_driver = {
|
|||
.owner = THIS_MODULE,
|
||||
.of_match_table = of_match_ptr(xz3216_of_match),
|
||||
},
|
||||
.probe = xz3216_i2c_probe,
|
||||
.remove = xz3216_i2c_remove,
|
||||
.probe = xz3216_i2c_probe,
|
||||
.remove = xz3216_i2c_remove,
|
||||
.id_table = xz3216_i2c_id,
|
||||
};
|
||||
|
||||
|
|
|
|||
Loading…
Reference in New Issue
Block a user