1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * (C) Copyright 2011-2013
4 * Texas Instruments, <www.ti.com>
5 */
6
7 #include <common.h>
8 #include <i2c.h>
9 #include <power/tps65910.h>
10
11 struct udevice *tps65910_dev __attribute__((section(".data"))) = NULL;
12
tps65910_read_reg(int addr,uchar * buf)13 static inline int tps65910_read_reg(int addr, uchar *buf)
14 {
15 #ifndef CONFIG_DM_I2C
16 return i2c_read(TPS65910_CTRL_I2C_ADDR, addr, 1, buf, 1);
17 #else
18 int rc;
19
20 rc = dm_i2c_reg_read(tps65910_dev, addr);
21 if (rc < 0)
22 return rc;
23 *buf = (uchar)rc;
24 return 0;
25 #endif
26 }
27
tps65910_write_reg(int addr,uchar * buf)28 static inline int tps65910_write_reg(int addr, uchar *buf)
29 {
30 #ifndef CONFIG_DM_I2C
31 return i2c_write(TPS65910_CTRL_I2C_ADDR, addr, 1, buf, 1);
32 #else
33 return dm_i2c_reg_write(tps65910_dev, addr, *buf);
34 #endif
35 }
36
power_tps65910_init(unsigned char bus)37 int power_tps65910_init(unsigned char bus)
38 {
39 #ifdef CONFIG_DM_I2C
40 struct udevice *dev = NULL;
41 int rc;
42
43 rc = i2c_get_chip_for_busnum(bus, TPS65910_CTRL_I2C_ADDR, 1, &dev);
44
45 if (rc)
46 return rc;
47 tps65910_dev = dev;
48 #endif
49 return 0;
50 }
51
52 /*
53 * tps65910_set_i2c_control() - Set the TPS65910 to be controlled via the I2C
54 * interface.
55 * @return: 0 on success, not 0 on failure
56 */
tps65910_set_i2c_control(void)57 int tps65910_set_i2c_control(void)
58 {
59 int ret;
60 uchar buf;
61
62 /* VDD1/2 voltage selection register access by control i/f */
63 ret = tps65910_read_reg(TPS65910_DEVCTRL_REG, &buf);
64
65 if (ret)
66 return ret;
67
68 buf |= TPS65910_DEVCTRL_REG_SR_CTL_I2C_SEL_CTL_I2C;
69
70 return tps65910_write_reg(TPS65910_DEVCTRL_REG, &buf);
71 }
72
73 /*
74 * tps65910_voltage_update() - Voltage switching for MPU frequency switching.
75 * @module: mpu - 0, core - 1
76 * @vddx_op_vol_sel: vdd voltage to set
77 * @return: 0 on success, not 0 on failure
78 */
tps65910_voltage_update(unsigned int module,unsigned char vddx_op_vol_sel)79 int tps65910_voltage_update(unsigned int module, unsigned char vddx_op_vol_sel)
80 {
81 uchar buf;
82 unsigned int reg_offset;
83 int ret;
84
85 if (module == MPU)
86 reg_offset = TPS65910_VDD1_OP_REG;
87 else
88 reg_offset = TPS65910_VDD2_OP_REG;
89
90 /* Select VDDx OP */
91 ret = tps65910_read_reg(reg_offset, &buf);
92 if (ret)
93 return ret;
94
95 buf &= ~TPS65910_OP_REG_CMD_MASK;
96
97 ret = tps65910_write_reg(reg_offset, &buf);
98 if (ret)
99 return ret;
100
101 /* Configure VDDx OP Voltage */
102 ret = tps65910_read_reg(reg_offset, &buf);
103 if (ret)
104 return ret;
105
106 buf &= ~TPS65910_OP_REG_SEL_MASK;
107 buf |= vddx_op_vol_sel;
108
109 ret = tps65910_write_reg(reg_offset, &buf);
110 if (ret)
111 return ret;
112
113 ret = tps65910_read_reg(reg_offset, &buf);
114 if (ret)
115 return ret;
116
117 if ((buf & TPS65910_OP_REG_SEL_MASK) != vddx_op_vol_sel)
118 return 1;
119
120 return 0;
121 }
122