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
67
68
69
70
71
72
73
74
|
/* SPDX-License-Identifier: GPL-2.0-only */
#include <console/console.h>
#include <device/i2c_simple.h>
#include <soc/mt6691.h>
#define MT6691_MIN_VOLTAGE 300000
#define MT6691_MAX_VOLTAGE 1300000
#define MT6691_STEP_UV 5000
enum {
MT6691_SLAVE_ADDR = 0x51,
};
int mt6691_set_voltage(uint8_t i2c_num, unsigned int volt_uv)
{
uint8_t selector;
if (volt_uv > MT6691_MAX_VOLTAGE || volt_uv < MT6691_MIN_VOLTAGE) {
printk(BIOS_ERR, "%s: voltage out of range\n", __func__);
return -1;
}
selector = DIV_ROUND_UP(volt_uv - MT6691_MIN_VOLTAGE, MT6691_STEP_UV);
return i2c_write_field(i2c_num, MT6691_SLAVE_ADDR,
MT6691_VSEL0, selector, 0xFF, 0);
}
int mt6691_get_voltage(uint8_t i2c_num)
{
uint8_t selector = 0;
unsigned int volt;
if (i2c_read_field(i2c_num, MT6691_SLAVE_ADDR, MT6691_VSEL0,
&selector, 0xFF, 0) < 0) {
printk(BIOS_ERR, "%s: failed to get voltage from i2c\n", __func__);
return -1;
}
volt = (selector * MT6691_STEP_UV) + MT6691_MIN_VOLTAGE;
if (volt > MT6691_MAX_VOLTAGE) {
printk(BIOS_ERR, "%s: voltage out of range\n", __func__);
return -1;
}
return volt;
}
static uint8_t get_mt6691_chip_id(uint8_t i2c_num)
{
uint8_t id;
if (i2c_read_field(i2c_num, MT6691_SLAVE_ADDR, MT6691_MONITOR,
&id, 0x1, MT6691_PGOOD_SHIFT) < 0) {
printk(BIOS_ERR, "%s: failed to read from i2c", __func__);
return 0;
}
return id;
}
void mt6691_probe(uint8_t i2c_num)
{
/* Check device ID is MT6691 */
if (!get_mt6691_chip_id(i2c_num)) {
printk(BIOS_ERR, "unknown MT6691 chip_id\n");
return;
}
/* Slew rate 12mV */
i2c_write_field(i2c_num, MT6691_SLAVE_ADDR, MT6691_CTRL2, 0x1,
MT6691_DN_SR_MASK, MT6691_DN_SR_SHIFT);
}
|
