]>
Commit | Line | Data |
---|---|---|
1aa7e23e SG |
1 | /* |
2 | * Copyright (c) 2011 The Chromium OS Authors. | |
3 | * (C) Copyright 2010,2011 NVIDIA Corporation <www.nvidia.com> | |
4 | * | |
1a459660 | 5 | * SPDX-License-Identifier: GPL-2.0+ |
1aa7e23e SG |
6 | */ |
7 | ||
8 | #include <common.h> | |
9 | #include <tps6586x.h> | |
10 | #include <asm/io.h> | |
11 | #include <i2c.h> | |
12 | ||
13 | static int bus_num; /* I2C bus we are on */ | |
14 | #define I2C_ADDRESS 0x34 /* chip requires this address */ | |
15 | static char inited; /* 1 if we have been inited */ | |
16 | ||
17 | enum { | |
18 | /* Registers that we access */ | |
19 | SUPPLY_CONTROL1 = 0x20, | |
20 | SUPPLY_CONTROL2, | |
21 | SM1_VOLTAGE_V1 = 0x23, | |
22 | SM1_VOLTAGE_V2, | |
23 | SM0_VOLTAGE_V1 = 0x26, | |
24 | SM0_VOLTAGE_V2, | |
25 | PFM_MODE = 0x47, | |
26 | ||
27 | /* Bits in the supply control registers */ | |
28 | CTRL_SM1_RAMP = 0x01, | |
29 | CTRL_SM1_SUPPLY2 = 0x02, | |
30 | CTRL_SM0_RAMP = 0x04, | |
31 | CTRL_SM0_SUPPLY2 = 0x08, | |
32 | }; | |
33 | ||
34 | #define MAX_I2C_RETRY 3 | |
35 | int tps6586x_read(int reg) | |
36 | { | |
37 | int i; | |
38 | uchar data; | |
39 | int retval = -1; | |
40 | int old_bus_num; | |
41 | ||
42 | old_bus_num = i2c_get_bus_num(); | |
43 | i2c_set_bus_num(bus_num); | |
44 | ||
45 | for (i = 0; i < MAX_I2C_RETRY; ++i) { | |
46 | if (!i2c_read(I2C_ADDRESS, reg, 1, &data, 1)) { | |
47 | retval = (int)data; | |
48 | goto exit; | |
49 | } | |
50 | ||
51 | /* i2c access failed, retry */ | |
52 | udelay(100); | |
53 | } | |
54 | ||
55 | exit: | |
56 | i2c_set_bus_num(old_bus_num); | |
57 | debug("pmu_read %x=%x\n", reg, retval); | |
58 | if (retval < 0) | |
59 | debug("%s: failed to read register %#x: %d\n", __func__, reg, | |
60 | retval); | |
61 | return retval; | |
62 | } | |
63 | ||
64 | int tps6586x_write(int reg, uchar *data, uint len) | |
65 | { | |
66 | int i; | |
67 | int retval = -1; | |
68 | int old_bus_num; | |
69 | ||
70 | old_bus_num = i2c_get_bus_num(); | |
71 | i2c_set_bus_num(bus_num); | |
72 | ||
73 | for (i = 0; i < MAX_I2C_RETRY; ++i) { | |
74 | if (!i2c_write(I2C_ADDRESS, reg, 1, data, len)) { | |
75 | retval = 0; | |
76 | goto exit; | |
77 | } | |
78 | ||
79 | /* i2c access failed, retry */ | |
80 | udelay(100); | |
81 | } | |
82 | ||
83 | exit: | |
84 | i2c_set_bus_num(old_bus_num); | |
85 | debug("pmu_write %x=%x: ", reg, retval); | |
86 | for (i = 0; i < len; i++) | |
87 | debug("%x ", data[i]); | |
88 | if (retval) | |
89 | debug("%s: failed to write register %#x\n", __func__, reg); | |
90 | return retval; | |
91 | } | |
92 | ||
93 | /* | |
94 | * Get current voltage of SM0 and SM1 | |
95 | * | |
96 | * @param sm0 Place to put SM0 voltage | |
97 | * @param sm1 Place to put SM1 voltage | |
98 | * @return 0 if ok, -1 on error | |
99 | */ | |
100 | static int read_voltages(int *sm0, int *sm1) | |
101 | { | |
102 | int ctrl1, ctrl2; | |
103 | int is_v2; | |
104 | ||
105 | /* | |
106 | * Each vdd has two supply sources, ie, v1 and v2. | |
107 | * The supply control reg1 and reg2 determine the current selection. | |
108 | */ | |
109 | ctrl1 = tps6586x_read(SUPPLY_CONTROL1); | |
110 | ctrl2 = tps6586x_read(SUPPLY_CONTROL2); | |
111 | if (ctrl1 == -1 || ctrl2 == -1) | |
112 | return -1; | |
113 | ||
114 | /* Figure out whether V1 or V2 is selected */ | |
115 | is_v2 = (ctrl1 | ctrl2) & CTRL_SM0_SUPPLY2; | |
116 | *sm0 = tps6586x_read(is_v2 ? SM0_VOLTAGE_V2 : SM0_VOLTAGE_V1); | |
117 | *sm1 = tps6586x_read(is_v2 ? SM1_VOLTAGE_V2 : SM1_VOLTAGE_V1); | |
118 | if (*sm0 == -1 || *sm1 == -1) | |
119 | return -1; | |
120 | ||
121 | return 0; | |
122 | } | |
123 | ||
124 | static int set_voltage(int reg, int data, int rate) | |
125 | { | |
126 | uchar control_bit; | |
127 | uchar buff[3]; | |
128 | ||
129 | control_bit = (reg == SM0_VOLTAGE_V1 ? CTRL_SM0_RAMP : CTRL_SM1_RAMP); | |
130 | ||
131 | /* | |
132 | * Only one supply is needed in u-boot. set both v1 and v2 to | |
133 | * same value. | |
134 | * | |
135 | * When both v1 and v2 are set to same value, we just need to set | |
136 | * control1 reg to trigger the supply selection. | |
137 | */ | |
138 | buff[0] = buff[1] = (uchar)data; | |
139 | buff[2] = rate; | |
140 | ||
141 | /* write v1, v2 and rate, then trigger */ | |
142 | if (tps6586x_write(reg, buff, 3) || | |
143 | tps6586x_write(SUPPLY_CONTROL1, &control_bit, 1)) | |
144 | return -1; | |
145 | ||
146 | return 0; | |
147 | } | |
148 | ||
149 | static int calculate_next_voltage(int voltage, int target, int step) | |
150 | { | |
151 | int diff = voltage < target ? step : -step; | |
152 | ||
153 | if (abs(target - voltage) > step) | |
154 | voltage += diff; | |
155 | else | |
156 | voltage = target; | |
157 | ||
158 | return voltage; | |
159 | } | |
160 | ||
161 | int tps6586x_set_pwm_mode(int mask) | |
162 | { | |
163 | uchar val; | |
164 | int ret; | |
165 | ||
166 | assert(inited); | |
167 | ret = tps6586x_read(PFM_MODE); | |
168 | if (ret != -1) { | |
169 | val = (uchar)ret; | |
170 | val |= mask; | |
171 | ||
172 | ret = tps6586x_write(PFM_MODE, &val, 1); | |
173 | } | |
174 | ||
175 | if (ret == -1) | |
176 | debug("%s: Failed to read/write PWM mode reg\n", __func__); | |
177 | ||
178 | return ret; | |
179 | } | |
180 | ||
181 | int tps6586x_adjust_sm0_sm1(int sm0_target, int sm1_target, int step, int rate, | |
182 | int min_sm0_over_sm1) | |
183 | { | |
184 | int sm0, sm1; | |
185 | int bad; | |
186 | ||
187 | assert(inited); | |
188 | ||
189 | /* get current voltage settings */ | |
190 | if (read_voltages(&sm0, &sm1)) { | |
191 | debug("%s: Cannot read voltage settings\n", __func__); | |
192 | return -1; | |
193 | } | |
194 | ||
195 | /* | |
196 | * if vdd_core < vdd_cpu + rel | |
197 | * skip | |
198 | * | |
199 | * This condition may happen when system reboots due to kernel crash. | |
200 | */ | |
201 | if (min_sm0_over_sm1 != -1 && sm0 < sm1 + min_sm0_over_sm1) { | |
202 | debug("%s: SM0 is %d, SM1 is %d, but min_sm0_over_sm1 is %d\n", | |
203 | __func__, sm0, sm1, min_sm0_over_sm1); | |
204 | return -1; | |
205 | } | |
206 | ||
207 | /* | |
208 | * Since vdd_core and vdd_cpu may both stand at either greater or less | |
209 | * than their nominal voltage, the adjustment may go either directions. | |
210 | * | |
211 | * Make sure vdd_core is always higher than vdd_cpu with certain margin. | |
212 | * So, find out which vdd to adjust first in each step. | |
213 | * | |
214 | * case 1: both sm0 and sm1 need to move up | |
215 | * adjust sm0 before sm1 | |
216 | * | |
217 | * case 2: both sm0 and sm1 need to move down | |
218 | * adjust sm1 before sm0 | |
219 | * | |
220 | * case 3: sm0 moves down and sm1 moves up | |
221 | * adjusting either one first is fine. | |
222 | * | |
223 | * Adjust vdd_core and vdd_cpu one step at a time until they reach | |
224 | * their nominal values. | |
225 | */ | |
226 | bad = 0; | |
227 | while (!bad && (sm0 != sm0_target || sm1 != sm1_target)) { | |
228 | int adjust_sm0_late = 0; /* flag to adjust vdd_core later */ | |
229 | ||
230 | debug("%d-%d %d-%d ", sm0, sm0_target, sm1, sm1_target); | |
231 | ||
232 | if (sm0 != sm0_target) { | |
233 | /* | |
234 | * if case 1 and case 3, set new sm0 first. | |
235 | * otherwise, hold down until new sm1 is set. | |
236 | */ | |
237 | sm0 = calculate_next_voltage(sm0, sm0_target, step); | |
238 | if (sm1 < sm1_target) | |
239 | bad |= set_voltage(SM0_VOLTAGE_V1, sm0, rate); | |
240 | else | |
241 | adjust_sm0_late = 1; | |
242 | } | |
243 | ||
244 | if (sm1 != sm1_target) { | |
245 | sm1 = calculate_next_voltage(sm1, sm1_target, step); | |
246 | bad |= set_voltage(SM1_VOLTAGE_V1, sm1, rate); | |
247 | } | |
248 | ||
249 | if (adjust_sm0_late) | |
250 | bad |= set_voltage(SM0_VOLTAGE_V1, sm0, rate); | |
251 | debug("%d\n", adjust_sm0_late); | |
252 | } | |
253 | debug("%d-%d %d-%d done\n", sm0, sm0_target, sm1, sm1_target); | |
254 | ||
255 | return bad ? -1 : 0; | |
256 | } | |
257 | ||
258 | int tps6586x_init(int bus) | |
259 | { | |
260 | bus_num = bus; | |
261 | inited = 1; | |
262 | ||
263 | return 0; | |
264 | } |