]>
git.ipfire.org Git - people/ms/u-boot.git/blob - drivers/power/tps6586x.c
2 * Copyright (c) 2011 The Chromium OS Authors.
3 * (C) Copyright 2010,2011 NVIDIA Corporation <www.nvidia.com>
5 * SPDX-License-Identifier: GPL-2.0+
13 static struct udevice
*tps6586x_dev
;
16 /* Registers that we access */
17 SUPPLY_CONTROL1
= 0x20,
19 SM1_VOLTAGE_V1
= 0x23,
21 SM0_VOLTAGE_V1
= 0x26,
25 /* Bits in the supply control registers */
27 CTRL_SM1_SUPPLY2
= 0x02,
29 CTRL_SM0_SUPPLY2
= 0x08,
32 #define MAX_I2C_RETRY 3
33 static int tps6586x_read(int reg
)
39 for (i
= 0; i
< MAX_I2C_RETRY
; ++i
) {
40 if (!dm_i2c_read(tps6586x_dev
, reg
, &data
, 1)) {
45 /* i2c access failed, retry */
50 debug("pmu_read %x=%x\n", reg
, retval
);
52 debug("%s: failed to read register %#x: %d\n", __func__
, reg
,
57 static int tps6586x_write(int reg
, uchar
*data
, uint len
)
62 for (i
= 0; i
< MAX_I2C_RETRY
; ++i
) {
63 if (!dm_i2c_write(tps6586x_dev
, reg
, data
, len
)) {
68 /* i2c access failed, retry */
73 debug("pmu_write %x=%x: ", reg
, retval
);
74 for (i
= 0; i
< len
; i
++)
75 debug("%x ", data
[i
]);
77 debug("%s: failed to write register %#x\n", __func__
, reg
);
82 * Get current voltage of SM0 and SM1
84 * @param sm0 Place to put SM0 voltage
85 * @param sm1 Place to put SM1 voltage
86 * @return 0 if ok, -1 on error
88 static int read_voltages(int *sm0
, int *sm1
)
94 * Each vdd has two supply sources, ie, v1 and v2.
95 * The supply control reg1 and reg2 determine the current selection.
97 ctrl1
= tps6586x_read(SUPPLY_CONTROL1
);
98 ctrl2
= tps6586x_read(SUPPLY_CONTROL2
);
99 if (ctrl1
== -1 || ctrl2
== -1)
102 /* Figure out whether V1 or V2 is selected */
103 is_v2
= (ctrl1
| ctrl2
) & CTRL_SM0_SUPPLY2
;
104 *sm0
= tps6586x_read(is_v2
? SM0_VOLTAGE_V2
: SM0_VOLTAGE_V1
);
105 *sm1
= tps6586x_read(is_v2
? SM1_VOLTAGE_V2
: SM1_VOLTAGE_V1
);
106 if (*sm0
== -1 || *sm1
== -1)
112 static int set_voltage(int reg
, int data
, int rate
)
117 control_bit
= (reg
== SM0_VOLTAGE_V1
? CTRL_SM0_RAMP
: CTRL_SM1_RAMP
);
120 * Only one supply is needed in u-boot. set both v1 and v2 to
123 * When both v1 and v2 are set to same value, we just need to set
124 * control1 reg to trigger the supply selection.
126 buff
[0] = buff
[1] = (uchar
)data
;
129 /* write v1, v2 and rate, then trigger */
130 if (tps6586x_write(reg
, buff
, 3) ||
131 tps6586x_write(SUPPLY_CONTROL1
, &control_bit
, 1))
137 static int calculate_next_voltage(int voltage
, int target
, int step
)
139 int diff
= voltage
< target
? step
: -step
;
141 if (abs(target
- voltage
) > step
)
149 int tps6586x_set_pwm_mode(int mask
)
154 assert(tps6586x_dev
);
155 ret
= tps6586x_read(PFM_MODE
);
160 ret
= tps6586x_write(PFM_MODE
, &val
, 1);
164 debug("%s: Failed to read/write PWM mode reg\n", __func__
);
169 int tps6586x_adjust_sm0_sm1(int sm0_target
, int sm1_target
, int step
, int rate
,
170 int min_sm0_over_sm1
)
175 assert(tps6586x_dev
);
177 /* get current voltage settings */
178 if (read_voltages(&sm0
, &sm1
)) {
179 debug("%s: Cannot read voltage settings\n", __func__
);
184 * if vdd_core < vdd_cpu + rel
187 * This condition may happen when system reboots due to kernel crash.
189 if (min_sm0_over_sm1
!= -1 && sm0
< sm1
+ min_sm0_over_sm1
) {
190 debug("%s: SM0 is %d, SM1 is %d, but min_sm0_over_sm1 is %d\n",
191 __func__
, sm0
, sm1
, min_sm0_over_sm1
);
196 * Since vdd_core and vdd_cpu may both stand at either greater or less
197 * than their nominal voltage, the adjustment may go either directions.
199 * Make sure vdd_core is always higher than vdd_cpu with certain margin.
200 * So, find out which vdd to adjust first in each step.
202 * case 1: both sm0 and sm1 need to move up
203 * adjust sm0 before sm1
205 * case 2: both sm0 and sm1 need to move down
206 * adjust sm1 before sm0
208 * case 3: sm0 moves down and sm1 moves up
209 * adjusting either one first is fine.
211 * Adjust vdd_core and vdd_cpu one step at a time until they reach
212 * their nominal values.
215 while (!bad
&& (sm0
!= sm0_target
|| sm1
!= sm1_target
)) {
216 int adjust_sm0_late
= 0; /* flag to adjust vdd_core later */
218 debug("%d-%d %d-%d ", sm0
, sm0_target
, sm1
, sm1_target
);
220 if (sm0
!= sm0_target
) {
222 * if case 1 and case 3, set new sm0 first.
223 * otherwise, hold down until new sm1 is set.
225 sm0
= calculate_next_voltage(sm0
, sm0_target
, step
);
226 if (sm1
< sm1_target
)
227 bad
|= set_voltage(SM0_VOLTAGE_V1
, sm0
, rate
);
232 if (sm1
!= sm1_target
) {
233 sm1
= calculate_next_voltage(sm1
, sm1_target
, step
);
234 bad
|= set_voltage(SM1_VOLTAGE_V1
, sm1
, rate
);
238 bad
|= set_voltage(SM0_VOLTAGE_V1
, sm0
, rate
);
239 debug("%d\n", adjust_sm0_late
);
241 debug("%d-%d %d-%d done\n", sm0
, sm0_target
, sm1
, sm1_target
);
246 int tps6586x_init(struct udevice
*dev
)