GK SDK 源码库: XMIPCLinuxV100R005C00SPC030 (kernel/tools/open_source excluded)
This commit is contained in:
@@ -0,0 +1,937 @@
|
||||
/*
|
||||
* Copyright (c) 2016-2021, STMicroelectronics - All Rights Reserved
|
||||
*
|
||||
* SPDX-License-Identifier: BSD-3-Clause
|
||||
*/
|
||||
|
||||
#include <errno.h>
|
||||
#include <string.h>
|
||||
|
||||
#include <common/debug.h>
|
||||
#include <drivers/st/stpmic1.h>
|
||||
|
||||
#define I2C_TIMEOUT_MS 25
|
||||
|
||||
struct regul_struct {
|
||||
const char *dt_node_name;
|
||||
const uint16_t *voltage_table;
|
||||
uint8_t voltage_table_size;
|
||||
uint8_t control_reg;
|
||||
uint8_t enable_mask;
|
||||
uint8_t low_power_reg;
|
||||
uint8_t pull_down_reg;
|
||||
uint8_t pull_down;
|
||||
uint8_t mask_reset_reg;
|
||||
uint8_t mask_reset;
|
||||
uint8_t icc_reg;
|
||||
uint8_t icc_mask;
|
||||
};
|
||||
|
||||
static struct i2c_handle_s *pmic_i2c_handle;
|
||||
static uint16_t pmic_i2c_addr;
|
||||
/*
|
||||
* Special mode corresponds to LDO3 in sink source mode or in bypass mode.
|
||||
* LDO3 doesn't switch back from special to normal mode.
|
||||
*/
|
||||
static bool ldo3_special_mode;
|
||||
|
||||
/* Voltage tables in mV */
|
||||
static const uint16_t buck1_voltage_table[] = {
|
||||
725,
|
||||
725,
|
||||
725,
|
||||
725,
|
||||
725,
|
||||
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,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
1500,
|
||||
};
|
||||
|
||||
static const uint16_t buck2_voltage_table[] = {
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1050,
|
||||
1050,
|
||||
1100,
|
||||
1100,
|
||||
1150,
|
||||
1150,
|
||||
1200,
|
||||
1200,
|
||||
1250,
|
||||
1250,
|
||||
1300,
|
||||
1300,
|
||||
1350,
|
||||
1350,
|
||||
1400,
|
||||
1400,
|
||||
1450,
|
||||
1450,
|
||||
1500,
|
||||
};
|
||||
|
||||
static const uint16_t buck3_voltage_table[] = {
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1000,
|
||||
1100,
|
||||
1100,
|
||||
1100,
|
||||
1100,
|
||||
1200,
|
||||
1200,
|
||||
1200,
|
||||
1200,
|
||||
1300,
|
||||
1300,
|
||||
1300,
|
||||
1300,
|
||||
1400,
|
||||
1400,
|
||||
1400,
|
||||
1400,
|
||||
1500,
|
||||
1600,
|
||||
1700,
|
||||
1800,
|
||||
1900,
|
||||
2000,
|
||||
2100,
|
||||
2200,
|
||||
2300,
|
||||
2400,
|
||||
2500,
|
||||
2600,
|
||||
2700,
|
||||
2800,
|
||||
2900,
|
||||
3000,
|
||||
3100,
|
||||
3200,
|
||||
3300,
|
||||
3400,
|
||||
};
|
||||
|
||||
static const uint16_t buck4_voltage_table[] = {
|
||||
600,
|
||||
625,
|
||||
650,
|
||||
675,
|
||||
700,
|
||||
725,
|
||||
750,
|
||||
775,
|
||||
800,
|
||||
825,
|
||||
850,
|
||||
875,
|
||||
900,
|
||||
925,
|
||||
950,
|
||||
975,
|
||||
1000,
|
||||
1025,
|
||||
1050,
|
||||
1075,
|
||||
1100,
|
||||
1125,
|
||||
1150,
|
||||
1175,
|
||||
1200,
|
||||
1225,
|
||||
1250,
|
||||
1275,
|
||||
1300,
|
||||
1300,
|
||||
1350,
|
||||
1350,
|
||||
1400,
|
||||
1400,
|
||||
1450,
|
||||
1450,
|
||||
1500,
|
||||
1600,
|
||||
1700,
|
||||
1800,
|
||||
1900,
|
||||
2000,
|
||||
2100,
|
||||
2200,
|
||||
2300,
|
||||
2400,
|
||||
2500,
|
||||
2600,
|
||||
2700,
|
||||
2800,
|
||||
2900,
|
||||
3000,
|
||||
3100,
|
||||
3200,
|
||||
3300,
|
||||
3400,
|
||||
3500,
|
||||
3600,
|
||||
3700,
|
||||
3800,
|
||||
3900,
|
||||
};
|
||||
|
||||
static const uint16_t ldo1_voltage_table[] = {
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1800,
|
||||
1900,
|
||||
2000,
|
||||
2100,
|
||||
2200,
|
||||
2300,
|
||||
2400,
|
||||
2500,
|
||||
2600,
|
||||
2700,
|
||||
2800,
|
||||
2900,
|
||||
3000,
|
||||
3100,
|
||||
3200,
|
||||
3300,
|
||||
};
|
||||
|
||||
static const uint16_t ldo2_voltage_table[] = {
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1800,
|
||||
1900,
|
||||
2000,
|
||||
2100,
|
||||
2200,
|
||||
2300,
|
||||
2400,
|
||||
2500,
|
||||
2600,
|
||||
2700,
|
||||
2800,
|
||||
2900,
|
||||
3000,
|
||||
3100,
|
||||
3200,
|
||||
3300,
|
||||
};
|
||||
|
||||
static const uint16_t ldo3_voltage_table[] = {
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1800,
|
||||
1900,
|
||||
2000,
|
||||
2100,
|
||||
2200,
|
||||
2300,
|
||||
2400,
|
||||
2500,
|
||||
2600,
|
||||
2700,
|
||||
2800,
|
||||
2900,
|
||||
3000,
|
||||
3100,
|
||||
3200,
|
||||
3300,
|
||||
3300,
|
||||
3300,
|
||||
3300,
|
||||
3300,
|
||||
3300,
|
||||
3300,
|
||||
};
|
||||
|
||||
/* Special mode table is used for sink source OR bypass mode */
|
||||
static const uint16_t ldo3_special_mode_table[] = {
|
||||
0,
|
||||
};
|
||||
|
||||
static const uint16_t ldo5_voltage_table[] = {
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1700,
|
||||
1800,
|
||||
1900,
|
||||
2000,
|
||||
2100,
|
||||
2200,
|
||||
2300,
|
||||
2400,
|
||||
2500,
|
||||
2600,
|
||||
2700,
|
||||
2800,
|
||||
2900,
|
||||
3000,
|
||||
3100,
|
||||
3200,
|
||||
3300,
|
||||
3400,
|
||||
3500,
|
||||
3600,
|
||||
3700,
|
||||
3800,
|
||||
3900,
|
||||
};
|
||||
|
||||
static const uint16_t ldo6_voltage_table[] = {
|
||||
900,
|
||||
1000,
|
||||
1100,
|
||||
1200,
|
||||
1300,
|
||||
1400,
|
||||
1500,
|
||||
1600,
|
||||
1700,
|
||||
1800,
|
||||
1900,
|
||||
2000,
|
||||
2100,
|
||||
2200,
|
||||
2300,
|
||||
2400,
|
||||
2500,
|
||||
2600,
|
||||
2700,
|
||||
2800,
|
||||
2900,
|
||||
3000,
|
||||
3100,
|
||||
3200,
|
||||
3300,
|
||||
};
|
||||
|
||||
static const uint16_t ldo4_voltage_table[] = {
|
||||
3300,
|
||||
};
|
||||
|
||||
static const uint16_t vref_ddr_voltage_table[] = {
|
||||
3300,
|
||||
};
|
||||
|
||||
static const uint16_t fixed_5v_voltage_table[] = {
|
||||
5000,
|
||||
};
|
||||
|
||||
/* Table of Regulators in PMIC SoC */
|
||||
static const struct regul_struct regulators_table[] = {
|
||||
{
|
||||
.dt_node_name = "buck1",
|
||||
.voltage_table = buck1_voltage_table,
|
||||
.voltage_table_size = ARRAY_SIZE(buck1_voltage_table),
|
||||
.control_reg = BUCK1_CONTROL_REG,
|
||||
.enable_mask = LDO_BUCK_ENABLE_MASK,
|
||||
.low_power_reg = BUCK1_PWRCTRL_REG,
|
||||
.pull_down_reg = BUCK_PULL_DOWN_REG,
|
||||
.pull_down = BUCK1_PULL_DOWN_SHIFT,
|
||||
.mask_reset_reg = MASK_RESET_BUCK_REG,
|
||||
.mask_reset = BUCK1_MASK_RESET,
|
||||
.icc_reg = BUCK_ICC_TURNOFF_REG,
|
||||
.icc_mask = BUCK1_ICC_SHIFT,
|
||||
},
|
||||
{
|
||||
.dt_node_name = "buck2",
|
||||
.voltage_table = buck2_voltage_table,
|
||||
.voltage_table_size = ARRAY_SIZE(buck2_voltage_table),
|
||||
.control_reg = BUCK2_CONTROL_REG,
|
||||
.enable_mask = LDO_BUCK_ENABLE_MASK,
|
||||
.low_power_reg = BUCK2_PWRCTRL_REG,
|
||||
.pull_down_reg = BUCK_PULL_DOWN_REG,
|
||||
.pull_down = BUCK2_PULL_DOWN_SHIFT,
|
||||
.mask_reset_reg = MASK_RESET_BUCK_REG,
|
||||
.mask_reset = BUCK2_MASK_RESET,
|
||||
.icc_reg = BUCK_ICC_TURNOFF_REG,
|
||||
.icc_mask = BUCK2_ICC_SHIFT,
|
||||
},
|
||||
{
|
||||
.dt_node_name = "buck3",
|
||||
.voltage_table = buck3_voltage_table,
|
||||
.voltage_table_size = ARRAY_SIZE(buck3_voltage_table),
|
||||
.control_reg = BUCK3_CONTROL_REG,
|
||||
.enable_mask = LDO_BUCK_ENABLE_MASK,
|
||||
.low_power_reg = BUCK3_PWRCTRL_REG,
|
||||
.pull_down_reg = BUCK_PULL_DOWN_REG,
|
||||
.pull_down = BUCK3_PULL_DOWN_SHIFT,
|
||||
.mask_reset_reg = MASK_RESET_BUCK_REG,
|
||||
.mask_reset = BUCK3_MASK_RESET,
|
||||
.icc_reg = BUCK_ICC_TURNOFF_REG,
|
||||
.icc_mask = BUCK3_ICC_SHIFT,
|
||||
},
|
||||
{
|
||||
.dt_node_name = "buck4",
|
||||
.voltage_table = buck4_voltage_table,
|
||||
.voltage_table_size = ARRAY_SIZE(buck4_voltage_table),
|
||||
.control_reg = BUCK4_CONTROL_REG,
|
||||
.enable_mask = LDO_BUCK_ENABLE_MASK,
|
||||
.low_power_reg = BUCK4_PWRCTRL_REG,
|
||||
.pull_down_reg = BUCK_PULL_DOWN_REG,
|
||||
.pull_down = BUCK4_PULL_DOWN_SHIFT,
|
||||
.mask_reset_reg = MASK_RESET_BUCK_REG,
|
||||
.mask_reset = BUCK4_MASK_RESET,
|
||||
.icc_reg = BUCK_ICC_TURNOFF_REG,
|
||||
.icc_mask = BUCK4_ICC_SHIFT,
|
||||
},
|
||||
{
|
||||
.dt_node_name = "ldo1",
|
||||
.voltage_table = ldo1_voltage_table,
|
||||
.voltage_table_size = ARRAY_SIZE(ldo1_voltage_table),
|
||||
.control_reg = LDO1_CONTROL_REG,
|
||||
.enable_mask = LDO_BUCK_ENABLE_MASK,
|
||||
.low_power_reg = LDO1_PWRCTRL_REG,
|
||||
.mask_reset_reg = MASK_RESET_LDO_REG,
|
||||
.mask_reset = LDO1_MASK_RESET,
|
||||
.icc_reg = LDO_ICC_TURNOFF_REG,
|
||||
.icc_mask = LDO1_ICC_SHIFT,
|
||||
},
|
||||
{
|
||||
.dt_node_name = "ldo2",
|
||||
.voltage_table = ldo2_voltage_table,
|
||||
.voltage_table_size = ARRAY_SIZE(ldo2_voltage_table),
|
||||
.control_reg = LDO2_CONTROL_REG,
|
||||
.enable_mask = LDO_BUCK_ENABLE_MASK,
|
||||
.low_power_reg = LDO2_PWRCTRL_REG,
|
||||
.mask_reset_reg = MASK_RESET_LDO_REG,
|
||||
.mask_reset = LDO2_MASK_RESET,
|
||||
.icc_reg = LDO_ICC_TURNOFF_REG,
|
||||
.icc_mask = LDO2_ICC_SHIFT,
|
||||
},
|
||||
{
|
||||
.dt_node_name = "ldo3",
|
||||
.voltage_table = ldo3_voltage_table,
|
||||
.voltage_table_size = ARRAY_SIZE(ldo3_voltage_table),
|
||||
.control_reg = LDO3_CONTROL_REG,
|
||||
.enable_mask = LDO_BUCK_ENABLE_MASK,
|
||||
.low_power_reg = LDO3_PWRCTRL_REG,
|
||||
.mask_reset_reg = MASK_RESET_LDO_REG,
|
||||
.mask_reset = LDO3_MASK_RESET,
|
||||
.icc_reg = LDO_ICC_TURNOFF_REG,
|
||||
.icc_mask = LDO3_ICC_SHIFT,
|
||||
},
|
||||
{
|
||||
.dt_node_name = "ldo4",
|
||||
.voltage_table = ldo4_voltage_table,
|
||||
.voltage_table_size = ARRAY_SIZE(ldo4_voltage_table),
|
||||
.control_reg = LDO4_CONTROL_REG,
|
||||
.enable_mask = LDO_BUCK_ENABLE_MASK,
|
||||
.low_power_reg = LDO4_PWRCTRL_REG,
|
||||
.mask_reset_reg = MASK_RESET_LDO_REG,
|
||||
.mask_reset = LDO4_MASK_RESET,
|
||||
.icc_reg = LDO_ICC_TURNOFF_REG,
|
||||
.icc_mask = LDO4_ICC_SHIFT,
|
||||
},
|
||||
{
|
||||
.dt_node_name = "ldo5",
|
||||
.voltage_table = ldo5_voltage_table,
|
||||
.voltage_table_size = ARRAY_SIZE(ldo5_voltage_table),
|
||||
.control_reg = LDO5_CONTROL_REG,
|
||||
.enable_mask = LDO_BUCK_ENABLE_MASK,
|
||||
.low_power_reg = LDO5_PWRCTRL_REG,
|
||||
.mask_reset_reg = MASK_RESET_LDO_REG,
|
||||
.mask_reset = LDO5_MASK_RESET,
|
||||
.icc_reg = LDO_ICC_TURNOFF_REG,
|
||||
.icc_mask = LDO5_ICC_SHIFT,
|
||||
},
|
||||
{
|
||||
.dt_node_name = "ldo6",
|
||||
.voltage_table = ldo6_voltage_table,
|
||||
.voltage_table_size = ARRAY_SIZE(ldo6_voltage_table),
|
||||
.control_reg = LDO6_CONTROL_REG,
|
||||
.enable_mask = LDO_BUCK_ENABLE_MASK,
|
||||
.low_power_reg = LDO6_PWRCTRL_REG,
|
||||
.mask_reset_reg = MASK_RESET_LDO_REG,
|
||||
.mask_reset = LDO6_MASK_RESET,
|
||||
.icc_reg = LDO_ICC_TURNOFF_REG,
|
||||
.icc_mask = LDO6_ICC_SHIFT,
|
||||
},
|
||||
{
|
||||
.dt_node_name = "vref_ddr",
|
||||
.voltage_table = vref_ddr_voltage_table,
|
||||
.voltage_table_size = ARRAY_SIZE(vref_ddr_voltage_table),
|
||||
.control_reg = VREF_DDR_CONTROL_REG,
|
||||
.enable_mask = LDO_BUCK_ENABLE_MASK,
|
||||
.low_power_reg = VREF_DDR_PWRCTRL_REG,
|
||||
.mask_reset_reg = MASK_RESET_LDO_REG,
|
||||
.mask_reset = VREF_DDR_MASK_RESET,
|
||||
},
|
||||
{
|
||||
.dt_node_name = "boost",
|
||||
.voltage_table = fixed_5v_voltage_table,
|
||||
.voltage_table_size = ARRAY_SIZE(fixed_5v_voltage_table),
|
||||
.control_reg = USB_CONTROL_REG,
|
||||
.enable_mask = BOOST_ENABLED,
|
||||
.icc_reg = BUCK_ICC_TURNOFF_REG,
|
||||
.icc_mask = BOOST_ICC_SHIFT,
|
||||
},
|
||||
{
|
||||
.dt_node_name = "pwr_sw1",
|
||||
.voltage_table = fixed_5v_voltage_table,
|
||||
.voltage_table_size = ARRAY_SIZE(fixed_5v_voltage_table),
|
||||
.control_reg = USB_CONTROL_REG,
|
||||
.enable_mask = USBSW_OTG_SWITCH_ENABLED,
|
||||
.icc_reg = BUCK_ICC_TURNOFF_REG,
|
||||
.icc_mask = PWR_SW1_ICC_SHIFT,
|
||||
},
|
||||
{
|
||||
.dt_node_name = "pwr_sw2",
|
||||
.voltage_table = fixed_5v_voltage_table,
|
||||
.voltage_table_size = ARRAY_SIZE(fixed_5v_voltage_table),
|
||||
.control_reg = USB_CONTROL_REG,
|
||||
.enable_mask = SWIN_SWOUT_ENABLED,
|
||||
.icc_reg = BUCK_ICC_TURNOFF_REG,
|
||||
.icc_mask = PWR_SW2_ICC_SHIFT,
|
||||
},
|
||||
};
|
||||
|
||||
#define MAX_REGUL ARRAY_SIZE(regulators_table)
|
||||
|
||||
static const struct regul_struct *get_regulator_data(const char *name)
|
||||
{
|
||||
uint8_t i;
|
||||
|
||||
for (i = 0 ; i < MAX_REGUL ; i++) {
|
||||
if (strncmp(name, regulators_table[i].dt_node_name,
|
||||
strlen(regulators_table[i].dt_node_name)) == 0) {
|
||||
return ®ulators_table[i];
|
||||
}
|
||||
}
|
||||
|
||||
/* Regulator not found */
|
||||
panic();
|
||||
return NULL;
|
||||
}
|
||||
|
||||
static uint8_t voltage_to_index(const char *name, uint16_t millivolts)
|
||||
{
|
||||
const struct regul_struct *regul = get_regulator_data(name);
|
||||
uint8_t i;
|
||||
|
||||
for (i = 0 ; i < regul->voltage_table_size ; i++) {
|
||||
if (regul->voltage_table[i] == millivolts) {
|
||||
return i;
|
||||
}
|
||||
}
|
||||
|
||||
/* Voltage not found */
|
||||
panic();
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int stpmic1_powerctrl_on(void)
|
||||
{
|
||||
return stpmic1_register_update(MAIN_CONTROL_REG, PWRCTRL_PIN_VALID,
|
||||
PWRCTRL_PIN_VALID);
|
||||
}
|
||||
|
||||
int stpmic1_switch_off(void)
|
||||
{
|
||||
return stpmic1_register_update(MAIN_CONTROL_REG, 1,
|
||||
SOFTWARE_SWITCH_OFF_ENABLED);
|
||||
}
|
||||
|
||||
int stpmic1_regulator_enable(const char *name)
|
||||
{
|
||||
const struct regul_struct *regul = get_regulator_data(name);
|
||||
|
||||
return stpmic1_register_update(regul->control_reg, regul->enable_mask,
|
||||
regul->enable_mask);
|
||||
}
|
||||
|
||||
int stpmic1_regulator_disable(const char *name)
|
||||
{
|
||||
const struct regul_struct *regul = get_regulator_data(name);
|
||||
|
||||
return stpmic1_register_update(regul->control_reg, 0,
|
||||
regul->enable_mask);
|
||||
}
|
||||
|
||||
bool stpmic1_is_regulator_enabled(const char *name)
|
||||
{
|
||||
uint8_t val;
|
||||
const struct regul_struct *regul = get_regulator_data(name);
|
||||
|
||||
if (stpmic1_register_read(regul->control_reg, &val) != 0) {
|
||||
panic();
|
||||
}
|
||||
|
||||
return (val & regul->enable_mask) == regul->enable_mask;
|
||||
}
|
||||
|
||||
int stpmic1_regulator_voltage_set(const char *name, uint16_t millivolts)
|
||||
{
|
||||
uint8_t voltage_index = voltage_to_index(name, millivolts);
|
||||
const struct regul_struct *regul = get_regulator_data(name);
|
||||
uint8_t mask;
|
||||
|
||||
if ((strncmp(name, "ldo3", 5) == 0) && ldo3_special_mode) {
|
||||
/*
|
||||
* when the LDO3 is in special mode, we do not change voltage,
|
||||
* because by setting voltage, the LDO would leaves sink-source
|
||||
* mode. There is obviously no reason to leave sink-source mode
|
||||
* at runtime.
|
||||
*/
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Voltage can be set for buck<N> or ldo<N> (except ldo4) regulators */
|
||||
if (strncmp(name, "buck", 4) == 0) {
|
||||
mask = BUCK_VOLTAGE_MASK;
|
||||
} else if ((strncmp(name, "ldo", 3) == 0) &&
|
||||
(strncmp(name, "ldo4", 5) != 0)) {
|
||||
mask = LDO_VOLTAGE_MASK;
|
||||
} else {
|
||||
return 0;
|
||||
}
|
||||
|
||||
return stpmic1_register_update(regul->control_reg,
|
||||
voltage_index << LDO_BUCK_VOLTAGE_SHIFT,
|
||||
mask);
|
||||
}
|
||||
|
||||
int stpmic1_regulator_pull_down_set(const char *name)
|
||||
{
|
||||
const struct regul_struct *regul = get_regulator_data(name);
|
||||
|
||||
if (regul->pull_down_reg != 0) {
|
||||
return stpmic1_register_update(regul->pull_down_reg,
|
||||
BIT(regul->pull_down),
|
||||
LDO_BUCK_PULL_DOWN_MASK <<
|
||||
regul->pull_down);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int stpmic1_regulator_mask_reset_set(const char *name)
|
||||
{
|
||||
const struct regul_struct *regul = get_regulator_data(name);
|
||||
|
||||
if (regul->mask_reset_reg == 0U) {
|
||||
return -EPERM;
|
||||
}
|
||||
|
||||
return stpmic1_register_update(regul->mask_reset_reg,
|
||||
BIT(regul->mask_reset),
|
||||
LDO_BUCK_RESET_MASK <<
|
||||
regul->mask_reset);
|
||||
}
|
||||
|
||||
int stpmic1_regulator_icc_set(const char *name)
|
||||
{
|
||||
const struct regul_struct *regul = get_regulator_data(name);
|
||||
|
||||
if (regul->mask_reset_reg == 0U) {
|
||||
return -EPERM;
|
||||
}
|
||||
|
||||
return stpmic1_register_update(regul->icc_reg,
|
||||
BIT(regul->icc_mask),
|
||||
BIT(regul->icc_mask));
|
||||
}
|
||||
|
||||
int stpmic1_regulator_sink_mode_set(const char *name)
|
||||
{
|
||||
if (strncmp(name, "ldo3", 5) != 0) {
|
||||
return -EPERM;
|
||||
}
|
||||
|
||||
ldo3_special_mode = true;
|
||||
|
||||
/* disable bypass mode, enable sink mode */
|
||||
return stpmic1_register_update(LDO3_CONTROL_REG,
|
||||
LDO3_DDR_SEL << LDO_BUCK_VOLTAGE_SHIFT,
|
||||
LDO3_BYPASS | LDO_VOLTAGE_MASK);
|
||||
}
|
||||
|
||||
int stpmic1_regulator_bypass_mode_set(const char *name)
|
||||
{
|
||||
if (strncmp(name, "ldo3", 5) != 0) {
|
||||
return -EPERM;
|
||||
}
|
||||
|
||||
ldo3_special_mode = true;
|
||||
|
||||
/* enable bypass mode, disable sink mode */
|
||||
return stpmic1_register_update(LDO3_CONTROL_REG,
|
||||
LDO3_BYPASS,
|
||||
LDO3_BYPASS | LDO_VOLTAGE_MASK);
|
||||
}
|
||||
|
||||
int stpmic1_active_discharge_mode_set(const char *name)
|
||||
{
|
||||
if (strncmp(name, "pwr_sw1", 8) == 0) {
|
||||
return stpmic1_register_update(USB_CONTROL_REG,
|
||||
VBUS_OTG_DISCHARGE,
|
||||
VBUS_OTG_DISCHARGE);
|
||||
}
|
||||
|
||||
if (strncmp(name, "pwr_sw2", 8) == 0) {
|
||||
return stpmic1_register_update(USB_CONTROL_REG,
|
||||
SW_OUT_DISCHARGE,
|
||||
SW_OUT_DISCHARGE);
|
||||
}
|
||||
|
||||
return -EPERM;
|
||||
}
|
||||
|
||||
int stpmic1_regulator_levels_mv(const char *name, const uint16_t **levels,
|
||||
size_t *levels_count)
|
||||
{
|
||||
const struct regul_struct *regul = get_regulator_data(name);
|
||||
|
||||
if ((strncmp(name, "ldo3", 5) == 0) && ldo3_special_mode) {
|
||||
*levels_count = ARRAY_SIZE(ldo3_special_mode_table);
|
||||
*levels = ldo3_special_mode_table;
|
||||
} else {
|
||||
*levels_count = regul->voltage_table_size;
|
||||
*levels = regul->voltage_table;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int stpmic1_regulator_voltage_get(const char *name)
|
||||
{
|
||||
const struct regul_struct *regul = get_regulator_data(name);
|
||||
uint8_t value;
|
||||
uint8_t mask;
|
||||
int status;
|
||||
|
||||
if ((strncmp(name, "ldo3", 5) == 0) && ldo3_special_mode) {
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Voltage can be set for buck<N> or ldo<N> (except ldo4) regulators */
|
||||
if (strncmp(name, "buck", 4) == 0) {
|
||||
mask = BUCK_VOLTAGE_MASK;
|
||||
} else if ((strncmp(name, "ldo", 3) == 0) &&
|
||||
(strncmp(name, "ldo4", 5) != 0)) {
|
||||
mask = LDO_VOLTAGE_MASK;
|
||||
} else {
|
||||
return 0;
|
||||
}
|
||||
|
||||
status = stpmic1_register_read(regul->control_reg, &value);
|
||||
if (status < 0) {
|
||||
return status;
|
||||
}
|
||||
|
||||
value = (value & mask) >> LDO_BUCK_VOLTAGE_SHIFT;
|
||||
|
||||
if (value > regul->voltage_table_size) {
|
||||
return -ERANGE;
|
||||
}
|
||||
|
||||
return (int)regul->voltage_table[value];
|
||||
}
|
||||
|
||||
int stpmic1_register_read(uint8_t register_id, uint8_t *value)
|
||||
{
|
||||
return stm32_i2c_mem_read(pmic_i2c_handle, pmic_i2c_addr,
|
||||
(uint16_t)register_id,
|
||||
I2C_MEMADD_SIZE_8BIT, value,
|
||||
1, I2C_TIMEOUT_MS);
|
||||
}
|
||||
|
||||
int stpmic1_register_write(uint8_t register_id, uint8_t value)
|
||||
{
|
||||
int status;
|
||||
|
||||
status = stm32_i2c_mem_write(pmic_i2c_handle, pmic_i2c_addr,
|
||||
(uint16_t)register_id,
|
||||
I2C_MEMADD_SIZE_8BIT, &value,
|
||||
1, I2C_TIMEOUT_MS);
|
||||
|
||||
#if ENABLE_ASSERTIONS
|
||||
if (status != 0) {
|
||||
return status;
|
||||
}
|
||||
|
||||
if ((register_id != WATCHDOG_CONTROL_REG) && (register_id <= 0x40U)) {
|
||||
uint8_t readval;
|
||||
|
||||
status = stpmic1_register_read(register_id, &readval);
|
||||
if (status != 0) {
|
||||
return status;
|
||||
}
|
||||
|
||||
if (readval != value) {
|
||||
return -EIO;
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
int stpmic1_register_update(uint8_t register_id, uint8_t value, uint8_t mask)
|
||||
{
|
||||
int status;
|
||||
uint8_t val;
|
||||
|
||||
status = stpmic1_register_read(register_id, &val);
|
||||
if (status != 0) {
|
||||
return status;
|
||||
}
|
||||
|
||||
val = (val & ~mask) | (value & mask);
|
||||
|
||||
return stpmic1_register_write(register_id, val);
|
||||
}
|
||||
|
||||
void stpmic1_bind_i2c(struct i2c_handle_s *i2c_handle, uint16_t i2c_addr)
|
||||
{
|
||||
pmic_i2c_handle = i2c_handle;
|
||||
pmic_i2c_addr = i2c_addr;
|
||||
}
|
||||
|
||||
void stpmic1_dump_regulators(void)
|
||||
{
|
||||
uint32_t i;
|
||||
|
||||
for (i = 0U; i < MAX_REGUL; i++) {
|
||||
const char *name __unused = regulators_table[i].dt_node_name;
|
||||
|
||||
VERBOSE("PMIC regul %s: %sable, %dmV",
|
||||
name,
|
||||
stpmic1_is_regulator_enabled(name) ? "en" : "dis",
|
||||
stpmic1_regulator_voltage_get(name));
|
||||
}
|
||||
}
|
||||
|
||||
int stpmic1_get_version(unsigned long *version)
|
||||
{
|
||||
uint8_t read_val;
|
||||
int status;
|
||||
|
||||
status = stpmic1_register_read(VERSION_STATUS_REG, &read_val);
|
||||
if (status < 0) {
|
||||
return status;
|
||||
}
|
||||
|
||||
*version = (unsigned long)read_val;
|
||||
|
||||
return 0;
|
||||
}
|
||||
Reference in New Issue
Block a user