1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * OMAP and TWL PMIC specific initializations.
4  *
5  * Copyright (C) 2010 Texas Instruments Incorporated.
6  * Thara Gopinath
7  * Copyright (C) 2009 Texas Instruments Incorporated.
8  * Nishanth Menon
9  * Copyright (C) 2009 Nokia Corporation
10  * Paul Walmsley
11  */
12 
13 #include <linux/err.h>
14 #include <linux/io.h>
15 #include <linux/kernel.h>
16 #include <linux/mfd/twl.h>
17 
18 #include "soc.h"
19 #include "voltage.h"
20 
21 #include "pm.h"
22 
23 #define OMAP3_SRI2C_SLAVE_ADDR		0x12
24 #define OMAP3_VDD_MPU_SR_CONTROL_REG	0x00
25 #define OMAP3_VDD_CORE_SR_CONTROL_REG	0x01
26 #define OMAP3_VP_CONFIG_ERROROFFSET	0x00
27 #define OMAP3_VP_VSTEPMIN_VSTEPMIN	0x1
28 #define OMAP3_VP_VSTEPMAX_VSTEPMAX	0x04
29 #define OMAP3_VP_VLIMITTO_TIMEOUT_US	200
30 
31 #define OMAP4_SRI2C_SLAVE_ADDR		0x12
32 #define OMAP4_VDD_MPU_SR_VOLT_REG	0x55
33 #define OMAP4_VDD_MPU_SR_CMD_REG	0x56
34 #define OMAP4_VDD_IVA_SR_VOLT_REG	0x5B
35 #define OMAP4_VDD_IVA_SR_CMD_REG	0x5C
36 #define OMAP4_VDD_CORE_SR_VOLT_REG	0x61
37 #define OMAP4_VDD_CORE_SR_CMD_REG	0x62
38 
39 static bool is_offset_valid;
40 static u8 smps_offset;
41 
42 #define REG_SMPS_OFFSET         0xE0
43 
twl4030_vsel_to_uv(const u8 vsel)44 static unsigned long twl4030_vsel_to_uv(const u8 vsel)
45 {
46 	return (((vsel * 125) + 6000)) * 100;
47 }
48 
twl4030_uv_to_vsel(unsigned long uv)49 static u8 twl4030_uv_to_vsel(unsigned long uv)
50 {
51 	return DIV_ROUND_UP(uv - 600000, 12500);
52 }
53 
twl6030_vsel_to_uv(const u8 vsel)54 static unsigned long twl6030_vsel_to_uv(const u8 vsel)
55 {
56 	/*
57 	 * In TWL6030 depending on the value of SMPS_OFFSET
58 	 * efuse register the voltage range supported in
59 	 * standard mode can be either between 0.6V - 1.3V or
60 	 * 0.7V - 1.4V. In TWL6030 ES1.0 SMPS_OFFSET efuse
61 	 * is programmed to all 0's where as starting from
62 	 * TWL6030 ES1.1 the efuse is programmed to 1
63 	 */
64 	if (!is_offset_valid) {
65 		twl_i2c_read_u8(TWL6030_MODULE_ID0, &smps_offset,
66 				REG_SMPS_OFFSET);
67 		is_offset_valid = true;
68 	}
69 
70 	if (!vsel)
71 		return 0;
72 	/*
73 	 * There is no specific formula for voltage to vsel
74 	 * conversion above 1.3V. There are special hardcoded
75 	 * values for voltages above 1.3V. Currently we are
76 	 * hardcoding only for 1.35 V which is used for 1GH OPP for
77 	 * OMAP4430.
78 	 */
79 	if (vsel == 0x3A)
80 		return 1350000;
81 
82 	if (smps_offset & 0x8)
83 		return ((((vsel - 1) * 1266) + 70900)) * 10;
84 	else
85 		return ((((vsel - 1) * 1266) + 60770)) * 10;
86 }
87 
twl6030_uv_to_vsel(unsigned long uv)88 static u8 twl6030_uv_to_vsel(unsigned long uv)
89 {
90 	/*
91 	 * In TWL6030 depending on the value of SMPS_OFFSET
92 	 * efuse register the voltage range supported in
93 	 * standard mode can be either between 0.6V - 1.3V or
94 	 * 0.7V - 1.4V. In TWL6030 ES1.0 SMPS_OFFSET efuse
95 	 * is programmed to all 0's where as starting from
96 	 * TWL6030 ES1.1 the efuse is programmed to 1
97 	 */
98 	if (!is_offset_valid) {
99 		twl_i2c_read_u8(TWL6030_MODULE_ID0, &smps_offset,
100 				REG_SMPS_OFFSET);
101 		is_offset_valid = true;
102 	}
103 
104 	if (!uv)
105 		return 0x00;
106 	/*
107 	 * There is no specific formula for voltage to vsel
108 	 * conversion above 1.3V. There are special hardcoded
109 	 * values for voltages above 1.3V. Currently we are
110 	 * hardcoding only for 1.35 V which is used for 1GH OPP for
111 	 * OMAP4430.
112 	 */
113 	if (uv > twl6030_vsel_to_uv(0x39)) {
114 		if (uv == 1350000)
115 			return 0x3A;
116 		pr_err("%s:OUT OF RANGE! non mapped vsel for %ld Vs max %ld\n",
117 			__func__, uv, twl6030_vsel_to_uv(0x39));
118 		return 0x3A;
119 	}
120 
121 	if (smps_offset & 0x8)
122 		return DIV_ROUND_UP(uv - 709000, 12660) + 1;
123 	else
124 		return DIV_ROUND_UP(uv - 607700, 12660) + 1;
125 }
126 
127 static struct omap_voltdm_pmic omap3_mpu_pmic = {
128 	.slew_rate		= 4000,
129 	.step_size		= 12500,
130 	.vp_erroroffset		= OMAP3_VP_CONFIG_ERROROFFSET,
131 	.vp_vstepmin		= OMAP3_VP_VSTEPMIN_VSTEPMIN,
132 	.vp_vstepmax		= OMAP3_VP_VSTEPMAX_VSTEPMAX,
133 	.vddmin			= 600000,
134 	.vddmax			= 1450000,
135 	.vp_timeout_us		= OMAP3_VP_VLIMITTO_TIMEOUT_US,
136 	.i2c_slave_addr		= OMAP3_SRI2C_SLAVE_ADDR,
137 	.volt_reg_addr		= OMAP3_VDD_MPU_SR_CONTROL_REG,
138 	.i2c_high_speed		= true,
139 	.vsel_to_uv		= twl4030_vsel_to_uv,
140 	.uv_to_vsel		= twl4030_uv_to_vsel,
141 };
142 
143 static struct omap_voltdm_pmic omap3_core_pmic = {
144 	.slew_rate		= 4000,
145 	.step_size		= 12500,
146 	.vp_erroroffset		= OMAP3_VP_CONFIG_ERROROFFSET,
147 	.vp_vstepmin		= OMAP3_VP_VSTEPMIN_VSTEPMIN,
148 	.vp_vstepmax		= OMAP3_VP_VSTEPMAX_VSTEPMAX,
149 	.vddmin			= 600000,
150 	.vddmax			= 1450000,
151 	.vp_timeout_us		= OMAP3_VP_VLIMITTO_TIMEOUT_US,
152 	.i2c_slave_addr		= OMAP3_SRI2C_SLAVE_ADDR,
153 	.volt_reg_addr		= OMAP3_VDD_CORE_SR_CONTROL_REG,
154 	.i2c_high_speed		= true,
155 	.vsel_to_uv		= twl4030_vsel_to_uv,
156 	.uv_to_vsel		= twl4030_uv_to_vsel,
157 };
158 
159 static struct omap_voltdm_pmic omap4_mpu_pmic = {
160 	.slew_rate		= 4000,
161 	.step_size		= 12660,
162 	.vp_erroroffset		= OMAP4_VP_CONFIG_ERROROFFSET,
163 	.vp_vstepmin		= OMAP4_VP_VSTEPMIN_VSTEPMIN,
164 	.vp_vstepmax		= OMAP4_VP_VSTEPMAX_VSTEPMAX,
165 	.vddmin			= 0,
166 	.vddmax			= 2100000,
167 	.vp_timeout_us		= OMAP4_VP_VLIMITTO_TIMEOUT_US,
168 	.i2c_slave_addr		= OMAP4_SRI2C_SLAVE_ADDR,
169 	.volt_reg_addr		= OMAP4_VDD_MPU_SR_VOLT_REG,
170 	.cmd_reg_addr		= OMAP4_VDD_MPU_SR_CMD_REG,
171 	.i2c_high_speed		= true,
172 	.i2c_pad_load		= 3,
173 	.vsel_to_uv		= twl6030_vsel_to_uv,
174 	.uv_to_vsel		= twl6030_uv_to_vsel,
175 };
176 
177 static struct omap_voltdm_pmic omap4_iva_pmic = {
178 	.slew_rate		= 4000,
179 	.step_size		= 12660,
180 	.vp_erroroffset		= OMAP4_VP_CONFIG_ERROROFFSET,
181 	.vp_vstepmin		= OMAP4_VP_VSTEPMIN_VSTEPMIN,
182 	.vp_vstepmax		= OMAP4_VP_VSTEPMAX_VSTEPMAX,
183 	.vddmin			= 0,
184 	.vddmax			= 2100000,
185 	.vp_timeout_us		= OMAP4_VP_VLIMITTO_TIMEOUT_US,
186 	.i2c_slave_addr		= OMAP4_SRI2C_SLAVE_ADDR,
187 	.volt_reg_addr		= OMAP4_VDD_IVA_SR_VOLT_REG,
188 	.cmd_reg_addr		= OMAP4_VDD_IVA_SR_CMD_REG,
189 	.i2c_high_speed		= true,
190 	.i2c_pad_load		= 3,
191 	.vsel_to_uv		= twl6030_vsel_to_uv,
192 	.uv_to_vsel		= twl6030_uv_to_vsel,
193 };
194 
195 static struct omap_voltdm_pmic omap4_core_pmic = {
196 	.slew_rate		= 4000,
197 	.step_size		= 12660,
198 	.vp_erroroffset		= OMAP4_VP_CONFIG_ERROROFFSET,
199 	.vp_vstepmin		= OMAP4_VP_VSTEPMIN_VSTEPMIN,
200 	.vp_vstepmax		= OMAP4_VP_VSTEPMAX_VSTEPMAX,
201 	.vddmin			= 0,
202 	.vddmax			= 2100000,
203 	.vp_timeout_us		= OMAP4_VP_VLIMITTO_TIMEOUT_US,
204 	.i2c_slave_addr		= OMAP4_SRI2C_SLAVE_ADDR,
205 	.volt_reg_addr		= OMAP4_VDD_CORE_SR_VOLT_REG,
206 	.cmd_reg_addr		= OMAP4_VDD_CORE_SR_CMD_REG,
207 	.i2c_high_speed		= true,
208 	.i2c_pad_load		= 3,
209 	.vsel_to_uv		= twl6030_vsel_to_uv,
210 	.uv_to_vsel		= twl6030_uv_to_vsel,
211 };
212 
omap4_twl_init(void)213 int __init omap4_twl_init(void)
214 {
215 	struct voltagedomain *voltdm;
216 
217 	if (!cpu_is_omap44xx() ||
218 	    of_find_compatible_node(NULL, NULL, "motorola,cpcap"))
219 		return -ENODEV;
220 
221 	voltdm = voltdm_lookup("mpu");
222 	omap_voltage_register_pmic(voltdm, &omap4_mpu_pmic);
223 
224 	voltdm = voltdm_lookup("iva");
225 	omap_voltage_register_pmic(voltdm, &omap4_iva_pmic);
226 
227 	voltdm = voltdm_lookup("core");
228 	omap_voltage_register_pmic(voltdm, &omap4_core_pmic);
229 
230 	return 0;
231 }
232 
omap3_twl_init(void)233 int __init omap3_twl_init(void)
234 {
235 	struct voltagedomain *voltdm;
236 
237 	if (!cpu_is_omap34xx())
238 		return -ENODEV;
239 
240 	voltdm = voltdm_lookup("mpu_iva");
241 	omap_voltage_register_pmic(voltdm, &omap3_mpu_pmic);
242 
243 	voltdm = voltdm_lookup("core");
244 	omap_voltage_register_pmic(voltdm, &omap3_core_pmic);
245 
246 	return 0;
247 }
248