]>
Commit | Line | Data |
---|---|---|
e3568d2e YL |
1 | /* |
2 | * (C) Copyright 2014 Freescale Semiconductor, Inc. | |
3 | * Author: Nitin Garg <nitin.garg@freescale.com> | |
4 | * Ye Li <Ye.Li@freescale.com> | |
5 | * | |
6 | * SPDX-License-Identifier: GPL-2.0+ | |
7 | */ | |
8 | ||
9 | #include <config.h> | |
10 | #include <common.h> | |
11 | #include <div64.h> | |
12 | #include <fuse.h> | |
13 | #include <asm/io.h> | |
14 | #include <asm/arch/clock.h> | |
a91db954 | 15 | #include <asm/arch/sys_proto.h> |
e3568d2e YL |
16 | #include <dm.h> |
17 | #include <errno.h> | |
18 | #include <malloc.h> | |
80512547 | 19 | #include <linux/math64.h> |
e3568d2e YL |
20 | #include <thermal.h> |
21 | #include <imx_thermal.h> | |
22 | ||
be56de6f TH |
23 | /* board will busyloop until this many degrees C below CPU max temperature */ |
24 | #define TEMPERATURE_HOT_DELTA 5 /* CPU maxT - 5C */ | |
e3568d2e | 25 | #define FACTOR0 10000000 |
4fac4171 PF |
26 | #define FACTOR1 15423 |
27 | #define FACTOR2 4148468 | |
28 | #define OFFSET 3580661 | |
e3568d2e | 29 | #define MEASURE_FREQ 327 |
d1aa6f2d AA |
30 | #define TEMPERATURE_MIN -40 |
31 | #define TEMPERATURE_HOT 85 | |
32 | #define TEMPERATURE_MAX 125 | |
e3568d2e YL |
33 | |
34 | #define TEMPSENSE0_TEMP_CNT_SHIFT 8 | |
35 | #define TEMPSENSE0_TEMP_CNT_MASK (0xfff << TEMPSENSE0_TEMP_CNT_SHIFT) | |
36 | #define TEMPSENSE0_FINISHED (1 << 2) | |
37 | #define TEMPSENSE0_MEASURE_TEMP (1 << 1) | |
38 | #define TEMPSENSE0_POWER_DOWN (1 << 0) | |
39 | #define MISC0_REFTOP_SELBIASOFF (1 << 3) | |
40 | #define TEMPSENSE1_MEASURE_FREQ 0xffff | |
41 | ||
a91db954 TH |
42 | struct thermal_data { |
43 | unsigned int fuse; | |
be56de6f | 44 | int critical; |
a91db954 TH |
45 | int minc; |
46 | int maxc; | |
47 | }; | |
48 | ||
d1aa6f2d AA |
49 | #if defined(CONFIG_MX6) |
50 | static int read_cpu_temperature(struct udevice *dev) | |
e3568d2e YL |
51 | { |
52 | int temperature; | |
53 | unsigned int reg, n_meas; | |
54 | const struct imx_thermal_plat *pdata = dev_get_platdata(dev); | |
55 | struct anatop_regs *anatop = (struct anatop_regs *)pdata->regs; | |
a91db954 TH |
56 | struct thermal_data *priv = dev_get_priv(dev); |
57 | u32 fuse = priv->fuse; | |
e3568d2e | 58 | int t1, n1; |
80512547 PF |
59 | s64 c1, c2; |
60 | s64 temp64; | |
61 | s32 rem; | |
e3568d2e YL |
62 | |
63 | /* | |
64 | * Sensor data layout: | |
65 | * [31:20] - sensor value @ 25C | |
66 | * We use universal formula now and only need sensor value @ 25C | |
4fac4171 | 67 | * slope = 0.4445388 - (0.0016549 * 25C fuse) |
e3568d2e YL |
68 | */ |
69 | n1 = fuse >> 20; | |
70 | t1 = 25; /* t1 always 25C */ | |
71 | ||
72 | /* | |
73 | * Derived from linear interpolation: | |
4fac4171 | 74 | * slope = 0.4445388 - (0.0016549 * 25C fuse) |
e3568d2e | 75 | * slope = (FACTOR2 - FACTOR1 * n1) / FACTOR0 |
4fac4171 PF |
76 | * offset = 3.580661 |
77 | * offset = OFFSET / 1000000 | |
78 | * (Nmeas - n1) / (Tmeas - t1 - offset) = slope | |
e3568d2e YL |
79 | * We want to reduce this down to the minimum computation necessary |
80 | * for each temperature read. Also, we want Tmeas in millicelsius | |
81 | * and we don't want to lose precision from integer division. So... | |
4fac4171 PF |
82 | * Tmeas = (Nmeas - n1) / slope + t1 + offset |
83 | * milli_Tmeas = 1000000 * (Nmeas - n1) / slope + 1000000 * t1 + OFFSET | |
84 | * milli_Tmeas = -1000000 * (n1 - Nmeas) / slope + 1000000 * t1 + OFFSET | |
85 | * Let constant c1 = (-1000000 / slope) | |
86 | * milli_Tmeas = (n1 - Nmeas) * c1 + 1000000 * t1 + OFFSET | |
87 | * Let constant c2 = n1 *c1 + 1000000 * t1 | |
88 | * milli_Tmeas = (c2 - Nmeas * c1) + OFFSET | |
89 | * Tmeas = ((c2 - Nmeas * c1) + OFFSET) / 1000000 | |
e3568d2e YL |
90 | */ |
91 | temp64 = FACTOR0; | |
4fac4171 | 92 | temp64 *= 1000000; |
80512547 | 93 | temp64 = div_s64_rem(temp64, FACTOR1 * n1 - FACTOR2, &rem); |
e3568d2e | 94 | c1 = temp64; |
4fac4171 | 95 | c2 = n1 * c1 + 1000000 * t1; |
e3568d2e YL |
96 | |
97 | /* | |
98 | * now we only use single measure, every time we read | |
99 | * the temperature, we will power on/down anadig thermal | |
100 | * module | |
101 | */ | |
102 | writel(TEMPSENSE0_POWER_DOWN, &anatop->tempsense0_clr); | |
103 | writel(MISC0_REFTOP_SELBIASOFF, &anatop->ana_misc0_set); | |
104 | ||
105 | /* setup measure freq */ | |
106 | reg = readl(&anatop->tempsense1); | |
107 | reg &= ~TEMPSENSE1_MEASURE_FREQ; | |
108 | reg |= MEASURE_FREQ; | |
109 | writel(reg, &anatop->tempsense1); | |
110 | ||
111 | /* start the measurement process */ | |
112 | writel(TEMPSENSE0_MEASURE_TEMP, &anatop->tempsense0_clr); | |
113 | writel(TEMPSENSE0_FINISHED, &anatop->tempsense0_clr); | |
114 | writel(TEMPSENSE0_MEASURE_TEMP, &anatop->tempsense0_set); | |
115 | ||
116 | /* make sure that the latest temp is valid */ | |
117 | while ((readl(&anatop->tempsense0) & | |
118 | TEMPSENSE0_FINISHED) == 0) | |
119 | udelay(10000); | |
120 | ||
121 | /* read temperature count */ | |
122 | reg = readl(&anatop->tempsense0); | |
123 | n_meas = (reg & TEMPSENSE0_TEMP_CNT_MASK) | |
124 | >> TEMPSENSE0_TEMP_CNT_SHIFT; | |
125 | writel(TEMPSENSE0_FINISHED, &anatop->tempsense0_clr); | |
126 | ||
4fac4171 | 127 | /* Tmeas = (c2 - Nmeas * c1 + OFFSET) / 1000000 */ |
80512547 | 128 | temperature = div_s64_rem(c2 - n_meas * c1 + OFFSET, 1000000, &rem); |
e3568d2e YL |
129 | |
130 | /* power down anatop thermal sensor */ | |
131 | writel(TEMPSENSE0_POWER_DOWN, &anatop->tempsense0_set); | |
132 | writel(MISC0_REFTOP_SELBIASOFF, &anatop->ana_misc0_clr); | |
133 | ||
134 | return temperature; | |
135 | } | |
d1aa6f2d AA |
136 | #elif defined(CONFIG_MX7) |
137 | static int read_cpu_temperature(struct udevice *dev) | |
138 | { | |
fcbe8c56 | 139 | unsigned int reg, tmp; |
d1aa6f2d AA |
140 | unsigned int raw_25c, te1; |
141 | int temperature; | |
142 | unsigned int *priv = dev_get_priv(dev); | |
143 | u32 fuse = *priv; | |
144 | struct mxc_ccm_anatop_reg *ccm_anatop = (struct mxc_ccm_anatop_reg *) | |
145 | ANATOP_BASE_ADDR; | |
146 | /* | |
147 | * fuse data layout: | |
148 | * [31:21] sensor value @ 25C | |
149 | * [20:18] hot temperature value | |
150 | * [17:9] sensor value of room | |
151 | * [8:0] sensor value of hot | |
152 | */ | |
153 | ||
154 | raw_25c = fuse >> 21; | |
155 | if (raw_25c == 0) | |
156 | raw_25c = 25; | |
157 | ||
158 | te1 = (fuse >> 9) & 0x1ff; | |
159 | ||
160 | /* | |
161 | * now we only use single measure, every time we read | |
162 | * the temperature, we will power on/down anadig thermal | |
163 | * module | |
164 | */ | |
165 | writel(TEMPMON_HW_ANADIG_TEMPSENSE1_POWER_DOWN_MASK, &ccm_anatop->tempsense1_clr); | |
166 | writel(PMU_REF_REFTOP_SELFBIASOFF_MASK, &ccm_anatop->ref_set); | |
167 | ||
168 | /* write measure freq */ | |
169 | reg = readl(&ccm_anatop->tempsense1); | |
170 | reg &= ~TEMPMON_HW_ANADIG_TEMPSENSE1_MEASURE_FREQ_MASK; | |
171 | reg |= TEMPMON_HW_ANADIG_TEMPSENSE1_MEASURE_FREQ(MEASURE_FREQ); | |
172 | writel(reg, &ccm_anatop->tempsense1); | |
173 | ||
174 | writel(TEMPMON_HW_ANADIG_TEMPSENSE1_MEASURE_TEMP_MASK, &ccm_anatop->tempsense1_clr); | |
175 | writel(TEMPMON_HW_ANADIG_TEMPSENSE1_FINISHED_MASK, &ccm_anatop->tempsense1_clr); | |
176 | writel(TEMPMON_HW_ANADIG_TEMPSENSE1_MEASURE_TEMP_MASK, &ccm_anatop->tempsense1_set); | |
177 | ||
fcbe8c56 PF |
178 | if (soc_rev() >= CHIP_REV_1_1) { |
179 | while ((readl(&ccm_anatop->tempsense1) & | |
180 | TEMPMON_HW_ANADIG_TEMPSENSE1_FINISHED_MASK) == 0) | |
181 | ; | |
182 | reg = readl(&ccm_anatop->tempsense1); | |
183 | tmp = (reg & TEMPMON_HW_ANADIG_TEMPSENSE1_TEMP_VALUE_MASK) | |
184 | >> TEMPMON_HW_ANADIG_TEMPSENSE1_TEMP_VALUE_SHIFT; | |
185 | } else { | |
d1aa6f2d | 186 | /* |
fcbe8c56 PF |
187 | * Since we can not rely on finish bit, use 10ms |
188 | * delay to get temperature. From RM, 17us is | |
189 | * enough to get data, but to gurantee to get | |
190 | * the data, delay 10ms here. | |
d1aa6f2d | 191 | */ |
fcbe8c56 | 192 | udelay(10000); |
d1aa6f2d AA |
193 | reg = readl(&ccm_anatop->tempsense1); |
194 | tmp = (reg & TEMPMON_HW_ANADIG_TEMPSENSE1_TEMP_VALUE_MASK) | |
195 | >> TEMPMON_HW_ANADIG_TEMPSENSE1_TEMP_VALUE_SHIFT; | |
fcbe8c56 | 196 | } |
d1aa6f2d AA |
197 | |
198 | writel(TEMPMON_HW_ANADIG_TEMPSENSE1_FINISHED_MASK, &ccm_anatop->tempsense1_clr); | |
199 | ||
200 | /* power down anatop thermal sensor */ | |
201 | writel(TEMPMON_HW_ANADIG_TEMPSENSE1_POWER_DOWN_MASK, &ccm_anatop->tempsense1_set); | |
202 | writel(PMU_REF_REFTOP_SELFBIASOFF_MASK, &ccm_anatop->ref_clr); | |
203 | ||
204 | /* Single point */ | |
205 | temperature = tmp - (te1 - raw_25c); | |
206 | ||
207 | return temperature; | |
208 | } | |
209 | #endif | |
e3568d2e YL |
210 | |
211 | int imx_thermal_get_temp(struct udevice *dev, int *temp) | |
212 | { | |
a91db954 | 213 | struct thermal_data *priv = dev_get_priv(dev); |
e3568d2e YL |
214 | int cpu_tmp = 0; |
215 | ||
d1aa6f2d AA |
216 | cpu_tmp = read_cpu_temperature(dev); |
217 | ||
3b7ad216 TH |
218 | while (cpu_tmp >= priv->critical) { |
219 | printf("CPU Temperature (%dC) too close to max (%dC)", | |
220 | cpu_tmp, priv->maxc); | |
221 | puts(" waiting...\n"); | |
222 | udelay(5000000); | |
d1aa6f2d | 223 | cpu_tmp = read_cpu_temperature(dev); |
e3568d2e YL |
224 | } |
225 | ||
226 | *temp = cpu_tmp; | |
227 | ||
228 | return 0; | |
229 | } | |
230 | ||
231 | static const struct dm_thermal_ops imx_thermal_ops = { | |
232 | .get_temp = imx_thermal_get_temp, | |
233 | }; | |
234 | ||
235 | static int imx_thermal_probe(struct udevice *dev) | |
236 | { | |
237 | unsigned int fuse = ~0; | |
238 | ||
239 | const struct imx_thermal_plat *pdata = dev_get_platdata(dev); | |
a91db954 | 240 | struct thermal_data *priv = dev_get_priv(dev); |
e3568d2e YL |
241 | |
242 | /* Read Temperature calibration data fuse */ | |
243 | fuse_read(pdata->fuse_bank, pdata->fuse_word, &fuse); | |
244 | ||
1368f993 AA |
245 | if (is_soc_type(MXC_SOC_MX6)) { |
246 | /* Check for valid fuse */ | |
247 | if (fuse == 0 || fuse == ~0) { | |
c8434cca | 248 | debug("CPU: Thermal invalid data, fuse: 0x%x\n", |
d1aa6f2d | 249 | fuse); |
1368f993 AA |
250 | return -EPERM; |
251 | } | |
d1aa6f2d AA |
252 | } else if (is_soc_type(MXC_SOC_MX7)) { |
253 | /* No Calibration data in FUSE? */ | |
254 | if ((fuse & 0x3ffff) == 0) | |
255 | return -EPERM; | |
256 | /* We do not support 105C TE2 */ | |
257 | if (((fuse & 0x1c0000) >> 18) == 0x6) | |
258 | return -EPERM; | |
e3568d2e YL |
259 | } |
260 | ||
be56de6f | 261 | /* set critical cooling temp */ |
a91db954 | 262 | get_cpu_temp_grade(&priv->minc, &priv->maxc); |
be56de6f | 263 | priv->critical = priv->maxc - TEMPERATURE_HOT_DELTA; |
a91db954 | 264 | priv->fuse = fuse; |
e3568d2e YL |
265 | |
266 | enable_thermal_clk(); | |
267 | ||
268 | return 0; | |
269 | } | |
270 | ||
271 | U_BOOT_DRIVER(imx_thermal) = { | |
272 | .name = "imx_thermal", | |
273 | .id = UCLASS_THERMAL, | |
274 | .ops = &imx_thermal_ops, | |
275 | .probe = imx_thermal_probe, | |
a91db954 | 276 | .priv_auto_alloc_size = sizeof(struct thermal_data), |
e3568d2e YL |
277 | .flags = DM_FLAG_PRE_RELOC, |
278 | }; |