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
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
|
/* SPDX-License-Identifier: GPL-2.0-only */
#include <console/console.h>
#include <device/i2c_simple.h>
#include <soc/mt6311.h>
enum {
MT6311_SLAVE_ADDR = 0x6B,
};
static u32 get_mt6311_chip_id(uint8_t i2c_num)
{
unsigned char id[2] = {0};
i2c_read_field(i2c_num, MT6311_SLAVE_ADDR, MT6311_CID,
&id[0], 0xFF, 0);
i2c_read_field(i2c_num, MT6311_SLAVE_ADDR, MT6311_SWCID,
&id[1], 0xFF, 0);
return (u32)(id[0] << 8 | id[1]);
}
static void mt6311_hw_init(uint8_t i2c_num)
{
int ret = 0;
unsigned char var[3] = {0};
/*
* Phase Shedding Trim Software Setting
* The phase 2 of MT6311 will enter PWM mode if the threshold is
* reached.
* The threshold is set according to EFUSE value.
*/
ret |= i2c_read_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_EFUSE_DOUT_56_63, &var[0],
0x3, 1);
ret |= i2c_read_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_EFUSE_DOUT_56_63, &var[1],
0x1, 7);
ret |= i2c_read_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_EFUSE_DOUT_64_71, &var[2],
0x1, 0);
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_VDVFS1_ANA_CON10,
var[0] | var[1] << 2 | var[2] << 3, 0xf, 0);
/* I2C_CONFIG; pushpull setting, Opendrain is '0' */
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR, MT6311_TOP_INT_CON,
0x1, 0x1, 2);
/* RG_WDTRSTB_EN; CC, initial WDRSTB setting. */
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR, MT6311_TOP_RST_CON,
0x1, 0x1, 5);
/* initial INT function */
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR, MT6311_GPIO_MODE,
0x1, 0x7, 3);
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR, MT6311_STRUP_CON5,
0, 1 << 2 | 1 << 1 | 1 << 0, 0);
/* Vo max is 1.15V */
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_STRUP_ANA_CON1, 0x3, 0x3, 5);
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_BUCK_ALL_CON23, 0x1, 0x1, 0);
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_STRUP_ANA_CON2, 0x3, 0x3, 0);
/* Suspend HW control from SPM */
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_TOP_CON, 0x1, 0x1, 0);
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_VDVFS11_CON7, 0x1, 0x1, 0);
/* default VDVFS power on */
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_VDVFS11_CON9, 0x1, 0x1, 0);
/* for DVFS slew rate rising=0.67us */
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_VDVFS11_CON10, 0x1, 0x7f, 0);
/* for DVFS slew rate, falling 2.0us */
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_VDVFS11_CON11, 0x5, 0x7f, 0);
/* default VDVFS11_VOSEL 1.0V, SW control */
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_VDVFS11_CON12, 0x40, 0x7f, 0);
/* default VDVFS11_VOSEL_ON 1.0V, HW control */
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_VDVFS11_CON13, 0x40, 0x7f, 0);
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_VDVFS11_CON14, 0x40, 0x7f, 0);
/* for DVFS sof change, falling 50us */
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_VDVFS11_CON19, 0x3, 0x3, 0);
/* for DVFS sof change, falling only */
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_VDVFS11_CON19, 0x1, 0x3, 4);
/* OFF LDO */
ret |= i2c_write_field(i2c_num, MT6311_SLAVE_ADDR,
MT6311_LDO_CON3, 0, 0x1, 0);
if (ret)
printk(BIOS_ERR, "ERROR: %s failed\n", __func__);
}
void mt6311_probe(uint8_t i2c_num)
{
u32 val = 0;
/* Check device ID is MT6311 */
val = get_mt6311_chip_id(i2c_num);
printk(BIOS_INFO, "%s: device ID = %#x\n", __func__, val);
if (val < MT6311_E1_CID_CODE) {
printk(BIOS_ERR, "ERROR: unknown MT6311 device_id\n");
return;
}
mt6311_hw_init(i2c_num);
}
|
