Tom Rini
6 years ago
commit
fb4413295c
@ -0,0 +1,597 @@ |
||||
/*
|
||||
* Copyright (C) 2018 Samsung Electronics |
||||
* Jaehoon Chung <jh80.chung@samsung.com> |
||||
* |
||||
* SPDX-License-Identifier: GPL-2.0 |
||||
*/ |
||||
|
||||
#include <common.h> |
||||
#include <fdtdec.h> |
||||
#include <errno.h> |
||||
#include <dm.h> |
||||
#include <i2c.h> |
||||
#include <power/pmic.h> |
||||
#include <power/regulator.h> |
||||
#include <power/s2mps11.h> |
||||
|
||||
DECLARE_GLOBAL_DATA_PTR; |
||||
|
||||
#define MODE(_id, _val, _name) { \ |
||||
.id = _id, \
|
||||
.register_value = _val, \
|
||||
.name = _name, \
|
||||
} |
||||
|
||||
/* BUCK : 1, 2, 3, 4, 5, 6, 7, 8, 9, 10 */ |
||||
static struct dm_regulator_mode s2mps11_buck_modes[] = { |
||||
MODE(OP_OFF, S2MPS11_BUCK_MODE_OFF, "OFF"), |
||||
MODE(OP_STANDBY, S2MPS11_BUCK_MODE_STANDBY, "ON/OFF"), |
||||
MODE(OP_ON, S2MPS11_BUCK_MODE_STANDBY, "ON"), |
||||
}; |
||||
|
||||
static struct dm_regulator_mode s2mps11_ldo_modes[] = { |
||||
MODE(OP_OFF, S2MPS11_LDO_MODE_OFF, "OFF"), |
||||
MODE(OP_STANDBY, S2MPS11_LDO_MODE_STANDBY, "ON/OFF"), |
||||
MODE(OP_STANDBY_LPM, S2MPS11_LDO_MODE_STANDBY_LPM, "ON/LPM"), |
||||
MODE(OP_ON, S2MPS11_LDO_MODE_ON, "ON"), |
||||
}; |
||||
|
||||
static const char s2mps11_buck_ctrl[] = { |
||||
0xff, 0x25, 0x27, 0x29, 0x2b, 0x2d, 0x33, 0x35, 0x37, 0x39, 0x3b |
||||
}; |
||||
|
||||
static const char s2mps11_buck_out[] = { |
||||
0xff, 0x26, 0x28, 0x2a, 0x2c, 0x2f, 0x34, 0x36, 0x38, 0x3a, 0x3c |
||||
}; |
||||
|
||||
static int s2mps11_buck_hex2volt(int buck, int hex) |
||||
{ |
||||
unsigned int uV = 0; |
||||
|
||||
if (hex < 0) |
||||
goto bad; |
||||
|
||||
switch (buck) { |
||||
case 7: |
||||
case 8: |
||||
case 10: |
||||
if (hex > S2MPS11_BUCK7_8_10_VOLT_MAX_HEX) |
||||
goto bad; |
||||
|
||||
uV = hex * S2MPS11_BUCK_HSTEP + S2MPS11_BUCK_UV_HMIN; |
||||
break; |
||||
case 9: |
||||
if (hex > S2MPS11_BUCK9_VOLT_MAX_HEX) |
||||
goto bad; |
||||
uV = hex * S2MPS11_BUCK9_STEP * 2 + S2MPS11_BUCK9_UV_MIN; |
||||
break; |
||||
default: |
||||
if (buck == 5 && hex > S2MPS11_BUCK5_VOLT_MAX_HEX) |
||||
goto bad; |
||||
else if (buck != 5 && hex > S2MPS11_BUCK_VOLT_MAX_HEX) |
||||
goto bad; |
||||
|
||||
uV = hex * S2MPS11_BUCK_LSTEP + S2MPS11_BUCK_UV_MIN; |
||||
break; |
||||
} |
||||
|
||||
return uV; |
||||
bad: |
||||
pr_err("Value: %#x is wrong for BUCK%d", hex, buck); |
||||
return -EINVAL; |
||||
} |
||||
|
||||
static int s2mps11_buck_volt2hex(int buck, int uV) |
||||
{ |
||||
int hex; |
||||
|
||||
switch (buck) { |
||||
case 7: |
||||
case 8: |
||||
case 10: |
||||
hex = (uV - S2MPS11_BUCK_UV_HMIN) / S2MPS11_BUCK_HSTEP; |
||||
if (hex > S2MPS11_BUCK7_8_10_VOLT_MAX_HEX) |
||||
goto bad; |
||||
|
||||
break; |
||||
case 9: |
||||
hex = (uV - S2MPS11_BUCK9_UV_MIN) / S2MPS11_BUCK9_STEP; |
||||
if (hex > S2MPS11_BUCK9_VOLT_MAX_HEX) |
||||
goto bad; |
||||
break; |
||||
default: |
||||
hex = (uV - S2MPS11_BUCK_UV_MIN) / S2MPS11_BUCK_LSTEP; |
||||
if (buck == 5 && hex > S2MPS11_BUCK5_VOLT_MAX_HEX) |
||||
goto bad; |
||||
else if (buck != 5 && hex > S2MPS11_BUCK_VOLT_MAX_HEX) |
||||
goto bad; |
||||
break; |
||||
}; |
||||
|
||||
if (hex >= 0) |
||||
return hex; |
||||
|
||||
bad: |
||||
pr_err("Value: %d uV is wrong for BUCK%d", uV, buck); |
||||
return -EINVAL; |
||||
} |
||||
|
||||
static int s2mps11_buck_val(struct udevice *dev, int op, int *uV) |
||||
{ |
||||
int hex, buck, ret; |
||||
u32 mask, addr; |
||||
u8 val; |
||||
|
||||
buck = dev->driver_data; |
||||
if (buck < 1 || buck > S2MPS11_BUCK_NUM) { |
||||
pr_err("Wrong buck number: %d\n", buck); |
||||
return -EINVAL; |
||||
} |
||||
|
||||
if (op == PMIC_OP_GET) |
||||
*uV = 0; |
||||
|
||||
addr = s2mps11_buck_out[buck]; |
||||
|
||||
switch (buck) { |
||||
case 9: |
||||
mask = S2MPS11_BUCK9_VOLT_MASK; |
||||
break; |
||||
default: |
||||
mask = S2MPS11_BUCK_VOLT_MASK; |
||||
break; |
||||
} |
||||
|
||||
ret = pmic_read(dev->parent, addr, &val, 1); |
||||
if (ret) |
||||
return ret; |
||||
|
||||
if (op == PMIC_OP_GET) { |
||||
val &= mask; |
||||
ret = s2mps11_buck_hex2volt(buck, val); |
||||
if (ret < 0) |
||||
return ret; |
||||
*uV = ret; |
||||
return 0; |
||||
} |
||||
|
||||
hex = s2mps11_buck_volt2hex(buck, *uV); |
||||
if (hex < 0) |
||||
return hex; |
||||
|
||||
val &= ~mask; |
||||
val |= hex; |
||||
ret = pmic_write(dev->parent, addr, &val, 1); |
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static int s2mps11_buck_mode(struct udevice *dev, int op, int *opmode) |
||||
{ |
||||
unsigned int addr, mode; |
||||
unsigned char val; |
||||
int buck, ret; |
||||
|
||||
buck = dev->driver_data; |
||||
if (buck < 1 || buck > S2MPS11_BUCK_NUM) { |
||||
pr_err("Wrong buck number: %d\n", buck); |
||||
return -EINVAL; |
||||
} |
||||
|
||||
addr = s2mps11_buck_ctrl[buck]; |
||||
|
||||
ret = pmic_read(dev->parent, addr, &val, 1); |
||||
if (ret) |
||||
return ret; |
||||
|
||||
if (op == PMIC_OP_GET) { |
||||
val &= (S2MPS11_BUCK_MODE_MASK << S2MPS11_BUCK_MODE_SHIFT); |
||||
switch (val) { |
||||
case S2MPS11_BUCK_MODE_OFF: |
||||
*opmode = OP_OFF; |
||||
break; |
||||
case S2MPS11_BUCK_MODE_STANDBY: |
||||
*opmode = OP_STANDBY; |
||||
break; |
||||
case S2MPS11_BUCK_MODE_ON: |
||||
*opmode = OP_ON; |
||||
break; |
||||
default: |
||||
return -EINVAL; |
||||
} |
||||
return 0; |
||||
} |
||||
|
||||
switch (*opmode) { |
||||
case OP_OFF: |
||||
mode = S2MPS11_BUCK_MODE_OFF; |
||||
break; |
||||
case OP_STANDBY: |
||||
mode = S2MPS11_BUCK_MODE_STANDBY; |
||||
break; |
||||
case OP_ON: |
||||
mode = S2MPS11_BUCK_MODE_ON; |
||||
break; |
||||
default: |
||||
pr_err("Wrong mode: %d for buck: %d\n", *opmode, buck); |
||||
return -EINVAL; |
||||
} |
||||
|
||||
val &= ~(S2MPS11_BUCK_MODE_MASK << S2MPS11_BUCK_MODE_SHIFT); |
||||
val |= mode; |
||||
ret = pmic_write(dev->parent, addr, &val, 1); |
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static int s2mps11_buck_enable(struct udevice *dev, int op, bool *enable) |
||||
{ |
||||
int ret, on_off; |
||||
|
||||
if (op == PMIC_OP_GET) { |
||||
ret = s2mps11_buck_mode(dev, op, &on_off); |
||||
if (ret) |
||||
return ret; |
||||
switch (on_off) { |
||||
case OP_OFF: |
||||
*enable = false; |
||||
break; |
||||
case OP_ON: |
||||
*enable = true; |
||||
break; |
||||
default: |
||||
return -EINVAL; |
||||
} |
||||
} else if (op == PMIC_OP_SET) { |
||||
if (*enable) |
||||
on_off = OP_ON; |
||||
else |
||||
on_off = OP_OFF; |
||||
|
||||
ret = s2mps11_buck_mode(dev, op, &on_off); |
||||
if (ret) |
||||
return ret; |
||||
} |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int buck_get_value(struct udevice *dev) |
||||
{ |
||||
int uV; |
||||
int ret; |
||||
|
||||
ret = s2mps11_buck_val(dev, PMIC_OP_GET, &uV); |
||||
if (ret) |
||||
return ret; |
||||
return uV; |
||||
} |
||||
|
||||
static int buck_set_value(struct udevice *dev, int uV) |
||||
{ |
||||
return s2mps11_buck_val(dev, PMIC_OP_SET, &uV); |
||||
} |
||||
|
||||
static int buck_get_enable(struct udevice *dev) |
||||
{ |
||||
bool enable = false; |
||||
int ret; |
||||
|
||||
ret = s2mps11_buck_enable(dev, PMIC_OP_GET, &enable); |
||||
if (ret) |
||||
return ret; |
||||
return enable; |
||||
} |
||||
|
||||
static int buck_set_enable(struct udevice *dev, bool enable) |
||||
{ |
||||
return s2mps11_buck_enable(dev, PMIC_OP_SET, &enable); |
||||
} |
||||
|
||||
static int buck_get_mode(struct udevice *dev) |
||||
{ |
||||
int mode; |
||||
int ret; |
||||
|
||||
ret = s2mps11_buck_mode(dev, PMIC_OP_GET, &mode); |
||||
if (ret) |
||||
return ret; |
||||
|
||||
return mode; |
||||
} |
||||
|
||||
static int buck_set_mode(struct udevice *dev, int mode) |
||||
{ |
||||
return s2mps11_buck_mode(dev, PMIC_OP_SET, &mode); |
||||
} |
||||
|
||||
static int s2mps11_buck_probe(struct udevice *dev) |
||||
{ |
||||
struct dm_regulator_uclass_platdata *uc_pdata; |
||||
|
||||
uc_pdata = dev_get_uclass_platdata(dev); |
||||
|
||||
uc_pdata->type = REGULATOR_TYPE_BUCK; |
||||
uc_pdata->mode = s2mps11_buck_modes; |
||||
uc_pdata->mode_count = ARRAY_SIZE(s2mps11_buck_modes); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static const struct dm_regulator_ops s2mps11_buck_ops = { |
||||
.get_value = buck_get_value, |
||||
.set_value = buck_set_value, |
||||
.get_enable = buck_get_enable, |
||||
.set_enable = buck_set_enable, |
||||
.get_mode = buck_get_mode, |
||||
.set_mode = buck_set_mode, |
||||
}; |
||||
|
||||
U_BOOT_DRIVER(s2mps11_buck) = { |
||||
.name = S2MPS11_BUCK_DRIVER, |
||||
.id = UCLASS_REGULATOR, |
||||
.ops = &s2mps11_buck_ops, |
||||
.probe = s2mps11_buck_probe, |
||||
}; |
||||
|
||||
static int s2mps11_ldo_hex2volt(int ldo, int hex) |
||||
{ |
||||
unsigned int uV = 0; |
||||
|
||||
if (hex > S2MPS11_LDO_VOLT_MAX_HEX) { |
||||
pr_err("Value: %#x is wrong for LDO%d", hex, ldo); |
||||
return -EINVAL; |
||||
} |
||||
|
||||
switch (ldo) { |
||||
case 1: |
||||
case 6: |
||||
case 11: |
||||
case 22: |
||||
case 23: |
||||
uV = hex * S2MPS11_LDO_STEP + S2MPS11_LDO_UV_MIN; |
||||
break; |
||||
default: |
||||
uV = hex * S2MPS11_LDO_STEP * 2 + S2MPS11_LDO_UV_MIN; |
||||
break; |
||||
} |
||||
|
||||
return uV; |
||||
} |
||||
|
||||
static int s2mps11_ldo_volt2hex(int ldo, int uV) |
||||
{ |
||||
int hex = 0; |
||||
|
||||
switch (ldo) { |
||||
case 1: |
||||
case 6: |
||||
case 11: |
||||
case 22: |
||||
case 23: |
||||
hex = (uV - S2MPS11_LDO_UV_MIN) / S2MPS11_LDO_STEP; |
||||
break; |
||||
default: |
||||
hex = (uV - S2MPS11_LDO_UV_MIN) / (S2MPS11_LDO_STEP * 2); |
||||
break; |
||||
} |
||||
|
||||
if (hex >= 0 && hex <= S2MPS11_LDO_VOLT_MAX_HEX) |
||||
return hex; |
||||
|
||||
pr_err("Value: %d uV is wrong for LDO%d", uV, ldo); |
||||
return -EINVAL; |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int s2mps11_ldo_val(struct udevice *dev, int op, int *uV) |
||||
{ |
||||
unsigned int addr; |
||||
unsigned char val; |
||||
int hex, ldo, ret; |
||||
|
||||
ldo = dev->driver_data; |
||||
if (ldo < 1 || ldo > S2MPS11_LDO_NUM) { |
||||
pr_err("Wrong ldo number: %d\n", ldo); |
||||
return -EINVAL; |
||||
} |
||||
|
||||
addr = S2MPS11_REG_L1CTRL + ldo - 1; |
||||
|
||||
ret = pmic_read(dev->parent, addr, &val, 1); |
||||
if (ret) |
||||
return ret; |
||||
|
||||
if (op == PMIC_OP_GET) { |
||||
*uV = 0; |
||||
val &= S2MPS11_LDO_VOLT_MASK; |
||||
ret = s2mps11_ldo_hex2volt(ldo, val); |
||||
if (ret < 0) |
||||
return ret; |
||||
|
||||
*uV = ret; |
||||
return 0; |
||||
} |
||||
|
||||
hex = s2mps11_ldo_volt2hex(ldo, *uV); |
||||
if (hex < 0) |
||||
return hex; |
||||
|
||||
val &= ~S2MPS11_LDO_VOLT_MASK; |
||||
val |= hex; |
||||
ret = pmic_write(dev->parent, addr, &val, 1); |
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static int s2mps11_ldo_mode(struct udevice *dev, int op, int *opmode) |
||||
{ |
||||
unsigned int addr, mode; |
||||
unsigned char val; |
||||
int ldo, ret; |
||||
|
||||
ldo = dev->driver_data; |
||||
if (ldo < 1 || ldo > S2MPS11_LDO_NUM) { |
||||
pr_err("Wrong ldo number: %d\n", ldo); |
||||
return -EINVAL; |
||||
} |
||||
addr = S2MPS11_REG_L1CTRL + ldo - 1; |
||||
|
||||
ret = pmic_read(dev->parent, addr, &val, 1); |
||||
if (ret) |
||||
return ret; |
||||
|
||||
if (op == PMIC_OP_GET) { |
||||
val &= (S2MPS11_LDO_MODE_MASK << S2MPS11_LDO_MODE_SHIFT); |
||||
switch (val) { |
||||
case S2MPS11_LDO_MODE_OFF: |
||||
*opmode = OP_OFF; |
||||
break; |
||||
case S2MPS11_LDO_MODE_STANDBY: |
||||
*opmode = OP_STANDBY; |
||||
break; |
||||
case S2MPS11_LDO_MODE_STANDBY_LPM: |
||||
*opmode = OP_STANDBY_LPM; |
||||
break; |
||||
case S2MPS11_LDO_MODE_ON: |
||||
*opmode = OP_ON; |
||||
break; |
||||
default: |
||||
return -EINVAL; |
||||
} |
||||
return 0; |
||||
} |
||||
|
||||
switch (*opmode) { |
||||
case OP_OFF: |
||||
mode = S2MPS11_LDO_MODE_OFF; |
||||
break; |
||||
case OP_STANDBY: |
||||
mode = S2MPS11_LDO_MODE_STANDBY; |
||||
break; |
||||
case OP_STANDBY_LPM: |
||||
mode = S2MPS11_LDO_MODE_STANDBY_LPM; |
||||
break; |
||||
case OP_ON: |
||||
mode = S2MPS11_LDO_MODE_ON; |
||||
break; |
||||
default: |
||||
pr_err("Wrong mode: %d for ldo: %d\n", *opmode, ldo); |
||||
return -EINVAL; |
||||
} |
||||
|
||||
val &= ~(S2MPS11_LDO_MODE_MASK << S2MPS11_LDO_MODE_SHIFT); |
||||
val |= mode; |
||||
ret = pmic_write(dev->parent, addr, &val, 1); |
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static int s2mps11_ldo_enable(struct udevice *dev, int op, bool *enable) |
||||
{ |
||||
int ret, on_off; |
||||
|
||||
if (op == PMIC_OP_GET) { |
||||
ret = s2mps11_ldo_mode(dev, op, &on_off); |
||||
if (ret) |
||||
return ret; |
||||
switch (on_off) { |
||||
case OP_OFF: |
||||
*enable = false; |
||||
break; |
||||
case OP_ON: |
||||
*enable = true; |
||||
break; |
||||
default: |
||||
return -EINVAL; |
||||
} |
||||
} else if (op == PMIC_OP_SET) { |
||||
if (*enable) |
||||
on_off = OP_ON; |
||||
else |
||||
on_off = OP_OFF; |
||||
|
||||
ret = s2mps11_ldo_mode(dev, op, &on_off); |
||||
if (ret) |
||||
return ret; |
||||
} |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int ldo_get_value(struct udevice *dev) |
||||
{ |
||||
int uV; |
||||
int ret; |
||||
|
||||
ret = s2mps11_ldo_val(dev, PMIC_OP_GET, &uV); |
||||
if (ret) |
||||
return ret; |
||||
|
||||
return uV; |
||||
} |
||||
|
||||
static int ldo_set_value(struct udevice *dev, int uV) |
||||
{ |
||||
return s2mps11_ldo_val(dev, PMIC_OP_SET, &uV); |
||||
} |
||||
|
||||
static int ldo_get_enable(struct udevice *dev) |
||||
{ |
||||
bool enable = false; |
||||
int ret; |
||||
|
||||
ret = s2mps11_ldo_enable(dev, PMIC_OP_GET, &enable); |
||||
if (ret) |
||||
return ret; |
||||
return enable; |
||||
} |
||||
|
||||
static int ldo_set_enable(struct udevice *dev, bool enable) |
||||
{ |
||||
return s2mps11_ldo_enable(dev, PMIC_OP_SET, &enable); |
||||
} |
||||
|
||||
static int ldo_get_mode(struct udevice *dev) |
||||
{ |
||||
int mode, ret; |
||||
|
||||
ret = s2mps11_ldo_mode(dev, PMIC_OP_GET, &mode); |
||||
if (ret) |
||||
return ret; |
||||
return mode; |
||||
} |
||||
|
||||
static int ldo_set_mode(struct udevice *dev, int mode) |
||||
{ |
||||
return s2mps11_ldo_mode(dev, PMIC_OP_SET, &mode); |
||||
} |
||||
|
||||
static int s2mps11_ldo_probe(struct udevice *dev) |
||||
{ |
||||
struct dm_regulator_uclass_platdata *uc_pdata; |
||||
|
||||
uc_pdata = dev_get_uclass_platdata(dev); |
||||
uc_pdata->type = REGULATOR_TYPE_LDO; |
||||
uc_pdata->mode = s2mps11_ldo_modes; |
||||
uc_pdata->mode_count = ARRAY_SIZE(s2mps11_ldo_modes); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static const struct dm_regulator_ops s2mps11_ldo_ops = { |
||||
.get_value = ldo_get_value, |
||||
.set_value = ldo_set_value, |
||||
.get_enable = ldo_get_enable, |
||||
.set_enable = ldo_set_enable, |
||||
.get_mode = ldo_get_mode, |
||||
.set_mode = ldo_set_mode, |
||||
}; |
||||
|
||||
U_BOOT_DRIVER(s2mps11_ldo) = { |
||||
.name = S2MPS11_LDO_DRIVER, |
||||
.id = UCLASS_REGULATOR, |
||||
.ops = &s2mps11_ldo_ops, |
||||
.probe = s2mps11_ldo_probe, |
||||
}; |
||||
Loading…
Reference in new issue