1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
|
/* SPDX-License-Identifier: GPL-2.0-only */
#include <console/console.h>
#include <delay.h>
#include <device/i2c_simple.h>
#include <soc/gpio.h>
#include <soc/i2c.h>
#include <soc/tps65132s.h>
static int tps65132s_reg_mask(unsigned int bus, uint8_t chip, uint8_t addr,
uint8_t val, uint8_t mask)
{
uint8_t msg = 0;
if (i2c_read_field(bus, chip, addr, &msg, 0xFF, 0) < 0) {
printk(BIOS_ERR, "%s: Failed to read i2c(%u): addr(%u)\n",
__func__, bus, addr);
return -1;
}
msg &= ~mask;
msg |= val;
return i2c_write_field(bus, chip, addr, msg, 0xFF, 0);
}
enum cb_err tps65132s_setup(const struct tps65132s_cfg *cfg)
{
bool write_to_eeprom = false;
u8 val;
int i;
/* Initialize I2C bus for PMIC TPS65132 */
mtk_i2c_bus_init(cfg->i2c_bus, I2C_SPEED_FAST);
mdelay(10);
gpio_output(cfg->en, 1);
gpio_output(cfg->sync, 1);
mdelay(10);
for (i = 0; i < cfg->setting_counts; i++) {
i2c_read_field(cfg->i2c_bus, PMIC_TPS65132_SLAVE,
cfg->settings[i].addr, &val, 0xFF, 0);
if (val != cfg->settings[i].val) {
if (tps65132s_reg_mask(cfg->i2c_bus, PMIC_TPS65132_SLAVE,
cfg->settings[i].addr,
cfg->settings[i].val,
cfg->settings[i].mask) < 0) {
printk(BIOS_ERR, "Failed to program TPS65132S at %x\n",
cfg->settings[i].addr);
return CB_ERR;
}
write_to_eeprom = true;
}
}
if (write_to_eeprom) {
if (tps65132s_reg_mask(cfg->i2c_bus, PMIC_TPS65132_SLAVE,
PMIC_TPS65132_CONTROL, 0x80, 0xFC) < 0)
return CB_ERR;
printk(BIOS_INFO, "Program TPS65132S EEPROM at first boot\n");
mdelay(50);
}
return CB_SUCCESS;
}
|
