#include <common.h>
#include <i2c.h>
+#include "../common/karo.h"
#include "pmic.h"
#define RN5T618_NOETIMSET 0x11
#define RN5T618_DC2DAC_SLP 0x3c
#define RN5T618_DC3DAC_SLP 0x3d
#define RN5T618_LDOEN1 0x44
+#define RN5T618_LDOEN2 0x45
#define RN5T618_LDODIS 0x46
-#define RN5T618_LDOEN2 0x48
#define RN5T618_LDO3DAC 0x4e /* IO */
#define RN5T618_LDORTCDAC 0x56 /* VBACKUP */
-#define VDD_RTC_VAL mV_to_regval_rtc(3000 * 10)
-#define VDD_HIGH_VAL mV_to_regval3(3000 * 10)
-#define VDD_HIGH_VAL_LP mV_to_regval3(3000 * 10)
-#define VDD_CORE_VAL mV_to_regval(1425 * 10)
-#define VDD_CORE_VAL_LP mV_to_regval(900 * 10)
-#define VDD_SOC_VAL mV_to_regval(1425 * 10)
-#define VDD_SOC_VAL_LP mV_to_regval(900 * 10)
-#define VDD_DDR_VAL mV_to_regval(1500 * 10)
-#define VDD_DDR_VAL_LP mV_to_regval(1500 * 10)
+#define VDD_RTC_VAL mV_to_regval_rtc(3000)
+#define VDD_HIGH_VAL mV_to_regval3(3000)
+#define VDD_HIGH_VAL_LP mV_to_regval3(3000)
+#define VDD_CORE_VAL mV_to_regval(1425) /* DCDC1 */
+#define VDD_CORE_VAL_LP mV_to_regval(900)
+#define VDD_SOC_VAL mV_to_regval(1425) /* DCDC2 */
+#define VDD_SOC_VAL_LP mV_to_regval(900)
+#define VDD_DDR_VAL mV_to_regval(1500) /* DCDC3 */
+#define VDD_DDR_VAL_LP mV_to_regval(1500)
/* calculate voltages in 10mV */
+#define v2r(v,n,m) DIV_ROUND(((((v) < (n)) ? (n) : (v)) - (n)), (m))
+#define r2v(r,n,m) (((r) * (m) + (n)) / 10)
+
/* DCDC1-3 */
-#define mV_to_regval(mV) DIV_ROUND(((((mV) < 6000) ? 6000 : (mV)) - 6000), 125)
-#define regval_to_mV(v) (((v) * 125 + 6000))
+#define mV_to_regval(mV) v2r((mV) * 10, 6000, 125)
+#define regval_to_mV(r) r2v(r, 6000, 125)
/* LDO1-2 */
-#define mV_to_regval2(mV) DIV_ROUND(((((mV) < 9000) ? 9000 : (mV)) - 9000), 250)
-#define regval2_to_mV(v) (((v) * 250 + 9000))
+#define mV_to_regval2(mV) v2r((mV) * 10, 9000, 250)
+#define regval2_to_mV(r) r2v(r, 9000, 250)
/* LDO3 */
-#define mV_to_regval3(mV) DIV_ROUND(((((mV) < 6000) ? 6000 : (mV)) - 6000), 250)
-#define regval3_to_mV(v) (((v) * 250 + 6000))
+#define mV_to_regval3(mV) v2r((mV) * 10, 6000, 250)
+#define regval3_to_mV(r) r2v(r, 6000, 250)
/* LDORTC */
-#define mV_to_regval_rtc(mV) DIV_ROUND(((((mV) < 17000) ? 17000 : (mV)) - 17000), 250)
-#define regval_rtc_to_mV(v) (((v) * 250 + 17000))
-
-static struct rn5t618_regs {
- u8 addr;
- u8 val;
- u8 mask;
-} rn5t618_regs[] = {
+#define mV_to_regval_rtc(mV) v2r((mV) * 10, 17000, 250)
+#define regval_rtc_to_mV(r) r2v(r, 17000, 250)
+
+static struct pmic_regs rn5t618_regs[] = {
{ RN5T618_NOETIMSET, 0, },
{ RN5T618_DC1DAC, VDD_CORE_VAL, },
{ RN5T618_DC2DAC, VDD_SOC_VAL, },
{ RN5T618_LDORTC1_SLOT, 0x0f, ~0x3f, },
};
-static int rn5t618_setup_regs(struct rn5t618_regs *r, size_t count)
+static int rn5t618_setup_regs(uchar slave_addr, struct pmic_regs *r,
+ size_t count)
{
int ret;
int i;
- for (i = 0; i < count; i++, r++) {
- unsigned char value;
-
- ret = i2c_read(CONFIG_SYS_I2C_SLAVE, r->addr, 1, &value, 1);
- printf("PMIC reg %02x = %02x\n",
- r->addr, value);
- }
for (i = 0; i < count; i++, r++) {
#ifdef DEBUG
unsigned char value;
- ret = i2c_read(CONFIG_SYS_I2C_SLAVE, r->addr, 1, &value, 1);
- if ((value & ~r->mask) != r->val) {
- printf("Changing PMIC reg %02x from %02x to %02x\n",
- r->addr, value, r->val);
- }
+ ret = i2c_read(slave_addr, r->addr, 1, &value, 1);
if (ret) {
printf("%s: failed to read PMIC register %02x: %d\n",
__func__, r->addr, ret);
return ret;
}
+ if ((value & ~r->mask) != r->val) {
+ printf("Changing PMIC reg %02x from %02x to %02x\n",
+ r->addr, value, r->val);
+ }
#endif
- ret = i2c_write(CONFIG_SYS_I2C_SLAVE,
- r->addr, 1, &r->val, 1);
+ ret = i2c_write(slave_addr, r->addr, 1, &r->val, 1);
if (ret) {
printf("%s: failed to write PMIC register %02x: %d\n",
__func__, r->addr, ret);
return ret;
}
#ifdef DEBUG
- ret = i2c_read(CONFIG_SYS_I2C_SLAVE, r->addr, 1, &value, 1);
- printf("PMIC reg %02x is %02x\n", r->addr, value);
+ ret = i2c_read(slave_addr, r->addr, 1, &value, 1);
+ if (ret) {
+ printf("%s: failed to read PMIC register %02x: %d\n",
+ __func__, r->addr, ret);
+ return ret;
+ }
+ if (value != r->val) {
+ printf("Failed to set PMIC reg %02x to %02x; actual value: %02x\n",
+ r->addr, r->val, value);
+ }
#endif
}
return 0;
}
-int setup_pmic_voltages(void)
+int rn5t618_pmic_setup(uchar slave_addr, struct pmic_regs *regs,
+ size_t count)
{
int ret;
unsigned char value;
- ret = i2c_probe(CONFIG_SYS_I2C_SLAVE);
- if (ret != 0) {
- printf("Failed to initialize I2C\n");
- return ret;
- }
-
- ret = i2c_read(CONFIG_SYS_I2C_SLAVE, 0x11, 1, &value, 1);
+ ret = i2c_read(slave_addr, 0x11, 1, &value, 1);
if (ret) {
printf("%s: i2c_read error: %d\n", __func__, ret);
return ret;
}
- ret = rn5t618_setup_regs(rn5t618_regs, ARRAY_SIZE(rn5t618_regs));
+ ret = rn5t618_setup_regs(slave_addr, rn5t618_regs,
+ ARRAY_SIZE(rn5t618_regs));
if (ret)
return ret;
- printf("VDDCORE set to %umV\n",
- DIV_ROUND(regval_to_mV(VDD_CORE_VAL), 10));
- printf("VDDSOC set to %umV\n",
- DIV_ROUND(regval_to_mV(VDD_SOC_VAL), 10));
+ ret = i2c_read(slave_addr, RN5T618_DC1DAC, 1, &value, 1);
+ if (ret == 0) {
+ printf("VDDCORE set to %umV\n", regval_to_mV(value));
+ } else {
+ printf("Failed to read VDDCORE register setting\n");
+ }
+
+ ret = i2c_read(slave_addr, RN5T618_DC2DAC, 1, &value, 1);
+ if (ret == 0) {
+ printf("VDDSOC set to %umV\n", regval_to_mV(value));
+ } else {
+ printf("Failed to read VDDSOC register setting\n");
+ }
return ret;
}
projects / karo-tx-uboot.git / blobdiff