Commit | Line | Data |
---|---|---|
7232398a TR |
1 | /* |
2 | * drivers/soc/tegra/pmc.c | |
3 | * | |
4 | * Copyright (c) 2010 Google, Inc | |
5 | * | |
6 | * Author: | |
7 | * Colin Cross <ccross@google.com> | |
8 | * | |
9 | * This software is licensed under the terms of the GNU General Public | |
10 | * License version 2, as published by the Free Software Foundation, and | |
11 | * may be copied, distributed, and modified under those terms. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, | |
14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
16 | * GNU General Public License for more details. | |
17 | * | |
18 | */ | |
19 | ||
7d71e903 TR |
20 | #define pr_fmt(fmt) "tegra-pmc: " fmt |
21 | ||
7232398a TR |
22 | #include <linux/kernel.h> |
23 | #include <linux/clk.h> | |
24 | #include <linux/clk/tegra.h> | |
25 | #include <linux/debugfs.h> | |
26 | #include <linux/delay.h> | |
27 | #include <linux/err.h> | |
28 | #include <linux/export.h> | |
29 | #include <linux/init.h> | |
30 | #include <linux/io.h> | |
0a2d87e0 | 31 | #include <linux/iopoll.h> |
7232398a TR |
32 | #include <linux/of.h> |
33 | #include <linux/of_address.h> | |
a3804512 | 34 | #include <linux/of_platform.h> |
7232398a | 35 | #include <linux/platform_device.h> |
a3804512 | 36 | #include <linux/pm_domain.h> |
7232398a TR |
37 | #include <linux/reboot.h> |
38 | #include <linux/reset.h> | |
39 | #include <linux/seq_file.h> | |
a3804512 | 40 | #include <linux/slab.h> |
7232398a TR |
41 | #include <linux/spinlock.h> |
42 | ||
43 | #include <soc/tegra/common.h> | |
44 | #include <soc/tegra/fuse.h> | |
45 | #include <soc/tegra/pmc.h> | |
46 | ||
47 | #define PMC_CNTRL 0x0 | |
48 | #define PMC_CNTRL_SYSCLK_POLARITY (1 << 10) /* sys clk polarity */ | |
49 | #define PMC_CNTRL_SYSCLK_OE (1 << 11) /* system clock enable */ | |
50 | #define PMC_CNTRL_SIDE_EFFECT_LP0 (1 << 14) /* LP0 when CPU pwr gated */ | |
51 | #define PMC_CNTRL_CPU_PWRREQ_POLARITY (1 << 15) /* CPU pwr req polarity */ | |
52 | #define PMC_CNTRL_CPU_PWRREQ_OE (1 << 16) /* CPU pwr req enable */ | |
53 | #define PMC_CNTRL_INTR_POLARITY (1 << 17) /* inverts INTR polarity */ | |
f5353c60 | 54 | #define PMC_CNTRL_MAIN_RST (1 << 4) |
7232398a TR |
55 | |
56 | #define DPD_SAMPLE 0x020 | |
57 | #define DPD_SAMPLE_ENABLE (1 << 0) | |
58 | #define DPD_SAMPLE_DISABLE (0 << 0) | |
59 | ||
60 | #define PWRGATE_TOGGLE 0x30 | |
61 | #define PWRGATE_TOGGLE_START (1 << 8) | |
62 | ||
63 | #define REMOVE_CLAMPING 0x34 | |
64 | ||
65 | #define PWRGATE_STATUS 0x38 | |
66 | ||
67 | #define PMC_SCRATCH0 0x50 | |
68 | #define PMC_SCRATCH0_MODE_RECOVERY (1 << 31) | |
69 | #define PMC_SCRATCH0_MODE_BOOTLOADER (1 << 30) | |
70 | #define PMC_SCRATCH0_MODE_RCM (1 << 1) | |
71 | #define PMC_SCRATCH0_MODE_MASK (PMC_SCRATCH0_MODE_RECOVERY | \ | |
72 | PMC_SCRATCH0_MODE_BOOTLOADER | \ | |
73 | PMC_SCRATCH0_MODE_RCM) | |
74 | ||
75 | #define PMC_CPUPWRGOOD_TIMER 0xc8 | |
76 | #define PMC_CPUPWROFF_TIMER 0xcc | |
77 | ||
78 | #define PMC_SCRATCH41 0x140 | |
79 | ||
3568df3d MP |
80 | #define PMC_SENSOR_CTRL 0x1b0 |
81 | #define PMC_SENSOR_CTRL_SCRATCH_WRITE (1 << 2) | |
82 | #define PMC_SENSOR_CTRL_ENABLE_RST (1 << 1) | |
83 | ||
f5353c60 TR |
84 | #define PMC_RST_STATUS 0x1b4 |
85 | #define PMC_RST_STATUS_POR 0 | |
86 | #define PMC_RST_STATUS_WATCHDOG 1 | |
87 | #define PMC_RST_STATUS_SENSOR 2 | |
88 | #define PMC_RST_STATUS_SW_MAIN 3 | |
89 | #define PMC_RST_STATUS_LP0 4 | |
90 | #define PMC_RST_STATUS_AOTAG 5 | |
91 | ||
7232398a TR |
92 | #define IO_DPD_REQ 0x1b8 |
93 | #define IO_DPD_REQ_CODE_IDLE (0 << 30) | |
94 | #define IO_DPD_REQ_CODE_OFF (1 << 30) | |
95 | #define IO_DPD_REQ_CODE_ON (2 << 30) | |
96 | #define IO_DPD_REQ_CODE_MASK (3 << 30) | |
97 | ||
98 | #define IO_DPD_STATUS 0x1bc | |
99 | #define IO_DPD2_REQ 0x1c0 | |
100 | #define IO_DPD2_STATUS 0x1c4 | |
101 | #define SEL_DPD_TIM 0x1c8 | |
102 | ||
3568df3d MP |
103 | #define PMC_SCRATCH54 0x258 |
104 | #define PMC_SCRATCH54_DATA_SHIFT 8 | |
105 | #define PMC_SCRATCH54_ADDR_SHIFT 0 | |
106 | ||
107 | #define PMC_SCRATCH55 0x25c | |
108 | #define PMC_SCRATCH55_RESET_TEGRA (1 << 31) | |
109 | #define PMC_SCRATCH55_CNTRL_ID_SHIFT 27 | |
110 | #define PMC_SCRATCH55_PINMUX_SHIFT 24 | |
111 | #define PMC_SCRATCH55_16BITOP (1 << 15) | |
112 | #define PMC_SCRATCH55_CHECKSUM_SHIFT 16 | |
113 | #define PMC_SCRATCH55_I2CSLV1_SHIFT 0 | |
114 | ||
7232398a TR |
115 | #define GPU_RG_CNTRL 0x2d4 |
116 | ||
a3804512 JH |
117 | struct tegra_powergate { |
118 | struct generic_pm_domain genpd; | |
119 | struct tegra_pmc *pmc; | |
120 | unsigned int id; | |
121 | struct clk **clks; | |
122 | unsigned int num_clks; | |
123 | struct reset_control **resets; | |
124 | unsigned int num_resets; | |
125 | }; | |
126 | ||
7232398a TR |
127 | struct tegra_pmc_soc { |
128 | unsigned int num_powergates; | |
129 | const char *const *powergates; | |
130 | unsigned int num_cpu_powergates; | |
131 | const u8 *cpu_powergates; | |
a9a40a4a | 132 | |
3568df3d | 133 | bool has_tsense_reset; |
a9a40a4a | 134 | bool has_gpu_clamps; |
7232398a TR |
135 | }; |
136 | ||
137 | /** | |
138 | * struct tegra_pmc - NVIDIA Tegra PMC | |
35b67291 | 139 | * @dev: pointer to PMC device structure |
7232398a TR |
140 | * @base: pointer to I/O remapped register region |
141 | * @clk: pointer to pclk clock | |
35b67291 | 142 | * @soc: pointer to SoC data structure |
3195ac6d | 143 | * @debugfs: pointer to debugfs entry |
7232398a TR |
144 | * @rate: currently configured rate of pclk |
145 | * @suspend_mode: lowest suspend mode available | |
146 | * @cpu_good_time: CPU power good time (in microseconds) | |
147 | * @cpu_off_time: CPU power off time (in microsecends) | |
148 | * @core_osc_time: core power good OSC time (in microseconds) | |
149 | * @core_pmu_time: core power good PMU time (in microseconds) | |
150 | * @core_off_time: core power off time (in microseconds) | |
151 | * @corereq_high: core power request is active-high | |
152 | * @sysclkreq_high: system clock request is active-high | |
153 | * @combined_req: combined power request for CPU & core | |
154 | * @cpu_pwr_good_en: CPU power good signal is enabled | |
155 | * @lp0_vec_phys: physical base address of the LP0 warm boot code | |
156 | * @lp0_vec_size: size of the LP0 warm boot code | |
a3804512 | 157 | * @powergates_available: Bitmap of available power gates |
7232398a TR |
158 | * @powergates_lock: mutex for power gate register access |
159 | */ | |
160 | struct tegra_pmc { | |
3568df3d | 161 | struct device *dev; |
7232398a TR |
162 | void __iomem *base; |
163 | struct clk *clk; | |
3195ac6d | 164 | struct dentry *debugfs; |
7232398a TR |
165 | |
166 | const struct tegra_pmc_soc *soc; | |
167 | ||
168 | unsigned long rate; | |
169 | ||
170 | enum tegra_suspend_mode suspend_mode; | |
171 | u32 cpu_good_time; | |
172 | u32 cpu_off_time; | |
173 | u32 core_osc_time; | |
174 | u32 core_pmu_time; | |
175 | u32 core_off_time; | |
176 | bool corereq_high; | |
177 | bool sysclkreq_high; | |
178 | bool combined_req; | |
179 | bool cpu_pwr_good_en; | |
180 | u32 lp0_vec_phys; | |
181 | u32 lp0_vec_size; | |
a3804512 | 182 | DECLARE_BITMAP(powergates_available, TEGRA_POWERGATE_MAX); |
7232398a TR |
183 | |
184 | struct mutex powergates_lock; | |
185 | }; | |
186 | ||
187 | static struct tegra_pmc *pmc = &(struct tegra_pmc) { | |
188 | .base = NULL, | |
189 | .suspend_mode = TEGRA_SUSPEND_NONE, | |
190 | }; | |
191 | ||
a3804512 JH |
192 | static inline struct tegra_powergate * |
193 | to_powergate(struct generic_pm_domain *domain) | |
194 | { | |
195 | return container_of(domain, struct tegra_powergate, genpd); | |
196 | } | |
197 | ||
7232398a TR |
198 | static u32 tegra_pmc_readl(unsigned long offset) |
199 | { | |
200 | return readl(pmc->base + offset); | |
201 | } | |
202 | ||
203 | static void tegra_pmc_writel(u32 value, unsigned long offset) | |
204 | { | |
205 | writel(value, pmc->base + offset); | |
206 | } | |
207 | ||
0ecf2d33 JH |
208 | static inline bool tegra_powergate_state(int id) |
209 | { | |
bc9af23d JH |
210 | if (id == TEGRA_POWERGATE_3D && pmc->soc->has_gpu_clamps) |
211 | return (tegra_pmc_readl(GPU_RG_CNTRL) & 0x1) == 0; | |
212 | else | |
213 | return (tegra_pmc_readl(PWRGATE_STATUS) & BIT(id)) != 0; | |
0ecf2d33 JH |
214 | } |
215 | ||
0a243bd4 JH |
216 | static inline bool tegra_powergate_is_valid(int id) |
217 | { | |
218 | return (pmc->soc && pmc->soc->powergates[id]); | |
219 | } | |
220 | ||
a3804512 JH |
221 | static inline bool tegra_powergate_is_available(int id) |
222 | { | |
223 | return test_bit(id, pmc->powergates_available); | |
224 | } | |
225 | ||
226 | static int tegra_powergate_lookup(struct tegra_pmc *pmc, const char *name) | |
227 | { | |
228 | unsigned int i; | |
229 | ||
230 | if (!pmc || !pmc->soc || !name) | |
231 | return -EINVAL; | |
232 | ||
233 | for (i = 0; i < pmc->soc->num_powergates; i++) { | |
234 | if (!tegra_powergate_is_valid(i)) | |
235 | continue; | |
236 | ||
237 | if (!strcmp(name, pmc->soc->powergates[i])) | |
238 | return i; | |
239 | } | |
240 | ||
241 | dev_err(pmc->dev, "powergate %s not found\n", name); | |
242 | ||
243 | return -ENODEV; | |
244 | } | |
245 | ||
7232398a TR |
246 | /** |
247 | * tegra_powergate_set() - set the state of a partition | |
248 | * @id: partition ID | |
249 | * @new_state: new state of the partition | |
250 | */ | |
70293ed0 | 251 | static int tegra_powergate_set(unsigned int id, bool new_state) |
7232398a | 252 | { |
0a2d87e0 JH |
253 | bool status; |
254 | int err; | |
255 | ||
bc9af23d JH |
256 | if (id == TEGRA_POWERGATE_3D && pmc->soc->has_gpu_clamps) |
257 | return -EINVAL; | |
258 | ||
7232398a TR |
259 | mutex_lock(&pmc->powergates_lock); |
260 | ||
0ecf2d33 | 261 | if (tegra_powergate_state(id) == new_state) { |
7232398a TR |
262 | mutex_unlock(&pmc->powergates_lock); |
263 | return 0; | |
264 | } | |
265 | ||
266 | tegra_pmc_writel(PWRGATE_TOGGLE_START | id, PWRGATE_TOGGLE); | |
267 | ||
0a2d87e0 JH |
268 | err = readx_poll_timeout(tegra_powergate_state, id, status, |
269 | status == new_state, 10, 100000); | |
270 | ||
7232398a TR |
271 | mutex_unlock(&pmc->powergates_lock); |
272 | ||
0a2d87e0 | 273 | return err; |
7232398a TR |
274 | } |
275 | ||
a3804512 JH |
276 | static int __tegra_powergate_remove_clamping(unsigned int id) |
277 | { | |
278 | u32 mask; | |
279 | ||
280 | mutex_lock(&pmc->powergates_lock); | |
281 | ||
282 | /* | |
283 | * On Tegra124 and later, the clamps for the GPU are controlled by a | |
284 | * separate register (with different semantics). | |
285 | */ | |
286 | if (id == TEGRA_POWERGATE_3D) { | |
287 | if (pmc->soc->has_gpu_clamps) { | |
288 | tegra_pmc_writel(0, GPU_RG_CNTRL); | |
289 | goto out; | |
290 | } | |
291 | } | |
292 | ||
293 | /* | |
294 | * Tegra 2 has a bug where PCIE and VDE clamping masks are | |
295 | * swapped relatively to the partition ids | |
296 | */ | |
297 | if (id == TEGRA_POWERGATE_VDEC) | |
298 | mask = (1 << TEGRA_POWERGATE_PCIE); | |
299 | else if (id == TEGRA_POWERGATE_PCIE) | |
300 | mask = (1 << TEGRA_POWERGATE_VDEC); | |
301 | else | |
302 | mask = (1 << id); | |
303 | ||
304 | tegra_pmc_writel(mask, REMOVE_CLAMPING); | |
305 | ||
306 | out: | |
307 | mutex_unlock(&pmc->powergates_lock); | |
308 | ||
309 | return 0; | |
310 | } | |
311 | ||
312 | static void tegra_powergate_disable_clocks(struct tegra_powergate *pg) | |
313 | { | |
314 | unsigned int i; | |
315 | ||
316 | for (i = 0; i < pg->num_clks; i++) | |
317 | clk_disable_unprepare(pg->clks[i]); | |
318 | } | |
319 | ||
320 | static int tegra_powergate_enable_clocks(struct tegra_powergate *pg) | |
321 | { | |
322 | unsigned int i; | |
323 | int err; | |
324 | ||
325 | for (i = 0; i < pg->num_clks; i++) { | |
326 | err = clk_prepare_enable(pg->clks[i]); | |
327 | if (err) | |
328 | goto out; | |
329 | } | |
330 | ||
331 | return 0; | |
332 | ||
333 | out: | |
334 | while (i--) | |
335 | clk_disable_unprepare(pg->clks[i]); | |
336 | ||
337 | return err; | |
338 | } | |
339 | ||
340 | static int tegra_powergate_reset_assert(struct tegra_powergate *pg) | |
341 | { | |
342 | unsigned int i; | |
343 | int err; | |
344 | ||
345 | for (i = 0; i < pg->num_resets; i++) { | |
346 | err = reset_control_assert(pg->resets[i]); | |
347 | if (err) | |
348 | return err; | |
349 | } | |
350 | ||
351 | return 0; | |
352 | } | |
353 | ||
354 | static int tegra_powergate_reset_deassert(struct tegra_powergate *pg) | |
355 | { | |
356 | unsigned int i; | |
357 | int err; | |
358 | ||
359 | for (i = 0; i < pg->num_resets; i++) { | |
360 | err = reset_control_deassert(pg->resets[i]); | |
361 | if (err) | |
362 | return err; | |
363 | } | |
364 | ||
365 | return 0; | |
366 | } | |
367 | ||
368 | static int tegra_powergate_power_up(struct tegra_powergate *pg, | |
369 | bool disable_clocks) | |
370 | { | |
371 | int err; | |
372 | ||
373 | err = tegra_powergate_reset_assert(pg); | |
374 | if (err) | |
375 | return err; | |
376 | ||
377 | usleep_range(10, 20); | |
378 | ||
379 | err = tegra_powergate_set(pg->id, true); | |
380 | if (err < 0) | |
381 | return err; | |
382 | ||
383 | usleep_range(10, 20); | |
384 | ||
385 | err = tegra_powergate_enable_clocks(pg); | |
386 | if (err) | |
387 | goto disable_clks; | |
388 | ||
389 | usleep_range(10, 20); | |
390 | ||
391 | err = __tegra_powergate_remove_clamping(pg->id); | |
392 | if (err) | |
393 | goto disable_clks; | |
394 | ||
395 | usleep_range(10, 20); | |
396 | ||
397 | err = tegra_powergate_reset_deassert(pg); | |
398 | if (err) | |
399 | goto powergate_off; | |
400 | ||
401 | usleep_range(10, 20); | |
402 | ||
403 | if (disable_clocks) | |
404 | tegra_powergate_disable_clocks(pg); | |
405 | ||
406 | return 0; | |
407 | ||
408 | disable_clks: | |
409 | tegra_powergate_disable_clocks(pg); | |
410 | usleep_range(10, 20); | |
da8f4b45 | 411 | |
a3804512 JH |
412 | powergate_off: |
413 | tegra_powergate_set(pg->id, false); | |
414 | ||
415 | return err; | |
416 | } | |
417 | ||
418 | static int tegra_powergate_power_down(struct tegra_powergate *pg) | |
419 | { | |
420 | int err; | |
421 | ||
422 | err = tegra_powergate_enable_clocks(pg); | |
423 | if (err) | |
424 | return err; | |
425 | ||
426 | usleep_range(10, 20); | |
427 | ||
428 | err = tegra_powergate_reset_assert(pg); | |
429 | if (err) | |
430 | goto disable_clks; | |
431 | ||
432 | usleep_range(10, 20); | |
433 | ||
434 | tegra_powergate_disable_clocks(pg); | |
435 | ||
436 | usleep_range(10, 20); | |
437 | ||
438 | err = tegra_powergate_set(pg->id, false); | |
439 | if (err) | |
440 | goto assert_resets; | |
441 | ||
442 | return 0; | |
443 | ||
444 | assert_resets: | |
445 | tegra_powergate_enable_clocks(pg); | |
446 | usleep_range(10, 20); | |
447 | tegra_powergate_reset_deassert(pg); | |
448 | usleep_range(10, 20); | |
da8f4b45 | 449 | |
a3804512 JH |
450 | disable_clks: |
451 | tegra_powergate_disable_clocks(pg); | |
452 | ||
453 | return err; | |
454 | } | |
455 | ||
456 | static int tegra_genpd_power_on(struct generic_pm_domain *domain) | |
457 | { | |
458 | struct tegra_powergate *pg = to_powergate(domain); | |
459 | struct tegra_pmc *pmc = pg->pmc; | |
460 | int err; | |
461 | ||
462 | err = tegra_powergate_power_up(pg, true); | |
463 | if (err) | |
464 | dev_err(pmc->dev, "failed to turn on PM domain %s: %d\n", | |
465 | pg->genpd.name, err); | |
466 | ||
467 | return err; | |
468 | } | |
469 | ||
470 | static int tegra_genpd_power_off(struct generic_pm_domain *domain) | |
471 | { | |
472 | struct tegra_powergate *pg = to_powergate(domain); | |
473 | struct tegra_pmc *pmc = pg->pmc; | |
474 | int err; | |
475 | ||
476 | err = tegra_powergate_power_down(pg); | |
477 | if (err) | |
478 | dev_err(pmc->dev, "failed to turn off PM domain %s: %d\n", | |
479 | pg->genpd.name, err); | |
480 | ||
481 | return err; | |
482 | } | |
483 | ||
7232398a TR |
484 | /** |
485 | * tegra_powergate_power_on() - power on partition | |
486 | * @id: partition ID | |
487 | */ | |
70293ed0 | 488 | int tegra_powergate_power_on(unsigned int id) |
7232398a | 489 | { |
a3804512 | 490 | if (!tegra_powergate_is_available(id)) |
7232398a TR |
491 | return -EINVAL; |
492 | ||
493 | return tegra_powergate_set(id, true); | |
494 | } | |
495 | ||
496 | /** | |
497 | * tegra_powergate_power_off() - power off partition | |
498 | * @id: partition ID | |
499 | */ | |
70293ed0 | 500 | int tegra_powergate_power_off(unsigned int id) |
7232398a | 501 | { |
a3804512 | 502 | if (!tegra_powergate_is_available(id)) |
7232398a TR |
503 | return -EINVAL; |
504 | ||
505 | return tegra_powergate_set(id, false); | |
506 | } | |
507 | EXPORT_SYMBOL(tegra_powergate_power_off); | |
508 | ||
509 | /** | |
510 | * tegra_powergate_is_powered() - check if partition is powered | |
511 | * @id: partition ID | |
512 | */ | |
70293ed0 | 513 | int tegra_powergate_is_powered(unsigned int id) |
7232398a | 514 | { |
0ecf2d33 | 515 | int status; |
7232398a | 516 | |
0a243bd4 | 517 | if (!tegra_powergate_is_valid(id)) |
7232398a TR |
518 | return -EINVAL; |
519 | ||
e8cf6616 | 520 | mutex_lock(&pmc->powergates_lock); |
0ecf2d33 | 521 | status = tegra_powergate_state(id); |
e8cf6616 JH |
522 | mutex_unlock(&pmc->powergates_lock); |
523 | ||
0ecf2d33 | 524 | return status; |
7232398a TR |
525 | } |
526 | ||
527 | /** | |
528 | * tegra_powergate_remove_clamping() - remove power clamps for partition | |
529 | * @id: partition ID | |
530 | */ | |
70293ed0 | 531 | int tegra_powergate_remove_clamping(unsigned int id) |
7232398a | 532 | { |
a3804512 | 533 | if (!tegra_powergate_is_available(id)) |
7232398a TR |
534 | return -EINVAL; |
535 | ||
a3804512 | 536 | return __tegra_powergate_remove_clamping(id); |
7232398a TR |
537 | } |
538 | EXPORT_SYMBOL(tegra_powergate_remove_clamping); | |
539 | ||
540 | /** | |
541 | * tegra_powergate_sequence_power_up() - power up partition | |
542 | * @id: partition ID | |
543 | * @clk: clock for partition | |
544 | * @rst: reset for partition | |
545 | * | |
546 | * Must be called with clk disabled, and returns with clk enabled. | |
547 | */ | |
70293ed0 | 548 | int tegra_powergate_sequence_power_up(unsigned int id, struct clk *clk, |
7232398a TR |
549 | struct reset_control *rst) |
550 | { | |
a3804512 JH |
551 | struct tegra_powergate pg; |
552 | int err; | |
7232398a | 553 | |
403db2d2 JH |
554 | if (!tegra_powergate_is_available(id)) |
555 | return -EINVAL; | |
556 | ||
a3804512 JH |
557 | pg.id = id; |
558 | pg.clks = &clk; | |
559 | pg.num_clks = 1; | |
560 | pg.resets = &rst; | |
561 | pg.num_resets = 1; | |
7232398a | 562 | |
a3804512 JH |
563 | err = tegra_powergate_power_up(&pg, false); |
564 | if (err) | |
565 | pr_err("failed to turn on partition %d: %d\n", id, err); | |
7232398a | 566 | |
a3804512 | 567 | return err; |
7232398a TR |
568 | } |
569 | EXPORT_SYMBOL(tegra_powergate_sequence_power_up); | |
570 | ||
571 | #ifdef CONFIG_SMP | |
572 | /** | |
573 | * tegra_get_cpu_powergate_id() - convert from CPU ID to partition ID | |
574 | * @cpuid: CPU partition ID | |
575 | * | |
576 | * Returns the partition ID corresponding to the CPU partition ID or a | |
577 | * negative error code on failure. | |
578 | */ | |
70293ed0 | 579 | static int tegra_get_cpu_powergate_id(unsigned int cpuid) |
7232398a | 580 | { |
70293ed0 | 581 | if (pmc->soc && cpuid < pmc->soc->num_cpu_powergates) |
7232398a TR |
582 | return pmc->soc->cpu_powergates[cpuid]; |
583 | ||
584 | return -EINVAL; | |
585 | } | |
586 | ||
587 | /** | |
588 | * tegra_pmc_cpu_is_powered() - check if CPU partition is powered | |
589 | * @cpuid: CPU partition ID | |
590 | */ | |
70293ed0 | 591 | bool tegra_pmc_cpu_is_powered(unsigned int cpuid) |
7232398a TR |
592 | { |
593 | int id; | |
594 | ||
595 | id = tegra_get_cpu_powergate_id(cpuid); | |
596 | if (id < 0) | |
597 | return false; | |
598 | ||
599 | return tegra_powergate_is_powered(id); | |
600 | } | |
601 | ||
602 | /** | |
603 | * tegra_pmc_cpu_power_on() - power on CPU partition | |
604 | * @cpuid: CPU partition ID | |
605 | */ | |
70293ed0 | 606 | int tegra_pmc_cpu_power_on(unsigned int cpuid) |
7232398a TR |
607 | { |
608 | int id; | |
609 | ||
610 | id = tegra_get_cpu_powergate_id(cpuid); | |
611 | if (id < 0) | |
612 | return id; | |
613 | ||
614 | return tegra_powergate_set(id, true); | |
615 | } | |
616 | ||
617 | /** | |
618 | * tegra_pmc_cpu_remove_clamping() - remove power clamps for CPU partition | |
619 | * @cpuid: CPU partition ID | |
620 | */ | |
70293ed0 | 621 | int tegra_pmc_cpu_remove_clamping(unsigned int cpuid) |
7232398a TR |
622 | { |
623 | int id; | |
624 | ||
625 | id = tegra_get_cpu_powergate_id(cpuid); | |
626 | if (id < 0) | |
627 | return id; | |
628 | ||
629 | return tegra_powergate_remove_clamping(id); | |
630 | } | |
631 | #endif /* CONFIG_SMP */ | |
632 | ||
7892158a DR |
633 | static int tegra_pmc_restart_notify(struct notifier_block *this, |
634 | unsigned long action, void *data) | |
7232398a | 635 | { |
7892158a | 636 | const char *cmd = data; |
7232398a TR |
637 | u32 value; |
638 | ||
639 | value = tegra_pmc_readl(PMC_SCRATCH0); | |
640 | value &= ~PMC_SCRATCH0_MODE_MASK; | |
641 | ||
642 | if (cmd) { | |
643 | if (strcmp(cmd, "recovery") == 0) | |
644 | value |= PMC_SCRATCH0_MODE_RECOVERY; | |
645 | ||
646 | if (strcmp(cmd, "bootloader") == 0) | |
647 | value |= PMC_SCRATCH0_MODE_BOOTLOADER; | |
648 | ||
649 | if (strcmp(cmd, "forced-recovery") == 0) | |
650 | value |= PMC_SCRATCH0_MODE_RCM; | |
651 | } | |
652 | ||
653 | tegra_pmc_writel(value, PMC_SCRATCH0); | |
654 | ||
f5353c60 TR |
655 | /* reset everything but PMC_SCRATCH0 and PMC_RST_STATUS */ |
656 | value = tegra_pmc_readl(PMC_CNTRL); | |
657 | value |= PMC_CNTRL_MAIN_RST; | |
658 | tegra_pmc_writel(value, PMC_CNTRL); | |
7892158a DR |
659 | |
660 | return NOTIFY_DONE; | |
7232398a TR |
661 | } |
662 | ||
7892158a DR |
663 | static struct notifier_block tegra_pmc_restart_handler = { |
664 | .notifier_call = tegra_pmc_restart_notify, | |
665 | .priority = 128, | |
666 | }; | |
667 | ||
7232398a TR |
668 | static int powergate_show(struct seq_file *s, void *data) |
669 | { | |
670 | unsigned int i; | |
c3ea2972 | 671 | int status; |
7232398a TR |
672 | |
673 | seq_printf(s, " powergate powered\n"); | |
674 | seq_printf(s, "------------------\n"); | |
675 | ||
676 | for (i = 0; i < pmc->soc->num_powergates; i++) { | |
c3ea2972 JH |
677 | status = tegra_powergate_is_powered(i); |
678 | if (status < 0) | |
7232398a TR |
679 | continue; |
680 | ||
681 | seq_printf(s, " %9s %7s\n", pmc->soc->powergates[i], | |
c3ea2972 | 682 | status ? "yes" : "no"); |
7232398a TR |
683 | } |
684 | ||
685 | return 0; | |
686 | } | |
687 | ||
688 | static int powergate_open(struct inode *inode, struct file *file) | |
689 | { | |
690 | return single_open(file, powergate_show, inode->i_private); | |
691 | } | |
692 | ||
693 | static const struct file_operations powergate_fops = { | |
694 | .open = powergate_open, | |
695 | .read = seq_read, | |
696 | .llseek = seq_lseek, | |
697 | .release = single_release, | |
698 | }; | |
699 | ||
700 | static int tegra_powergate_debugfs_init(void) | |
701 | { | |
3195ac6d JH |
702 | pmc->debugfs = debugfs_create_file("powergate", S_IRUGO, NULL, NULL, |
703 | &powergate_fops); | |
704 | if (!pmc->debugfs) | |
7232398a TR |
705 | return -ENOMEM; |
706 | ||
707 | return 0; | |
708 | } | |
709 | ||
a3804512 JH |
710 | static int tegra_powergate_of_get_clks(struct tegra_powergate *pg, |
711 | struct device_node *np) | |
712 | { | |
713 | struct clk *clk; | |
714 | unsigned int i, count; | |
715 | int err; | |
716 | ||
717 | count = of_count_phandle_with_args(np, "clocks", "#clock-cells"); | |
718 | if (count == 0) | |
719 | return -ENODEV; | |
720 | ||
721 | pg->clks = kcalloc(count, sizeof(clk), GFP_KERNEL); | |
722 | if (!pg->clks) | |
723 | return -ENOMEM; | |
724 | ||
725 | for (i = 0; i < count; i++) { | |
726 | pg->clks[i] = of_clk_get(np, i); | |
727 | if (IS_ERR(pg->clks[i])) { | |
728 | err = PTR_ERR(pg->clks[i]); | |
729 | goto err; | |
730 | } | |
731 | } | |
732 | ||
733 | pg->num_clks = count; | |
734 | ||
735 | return 0; | |
736 | ||
737 | err: | |
738 | while (i--) | |
739 | clk_put(pg->clks[i]); | |
da8f4b45 | 740 | |
a3804512 JH |
741 | kfree(pg->clks); |
742 | ||
743 | return err; | |
744 | } | |
745 | ||
746 | static int tegra_powergate_of_get_resets(struct tegra_powergate *pg, | |
05cfb988 | 747 | struct device_node *np, bool off) |
a3804512 JH |
748 | { |
749 | struct reset_control *rst; | |
750 | unsigned int i, count; | |
751 | int err; | |
752 | ||
753 | count = of_count_phandle_with_args(np, "resets", "#reset-cells"); | |
754 | if (count == 0) | |
755 | return -ENODEV; | |
756 | ||
757 | pg->resets = kcalloc(count, sizeof(rst), GFP_KERNEL); | |
758 | if (!pg->resets) | |
759 | return -ENOMEM; | |
760 | ||
761 | for (i = 0; i < count; i++) { | |
762 | pg->resets[i] = of_reset_control_get_by_index(np, i); | |
763 | if (IS_ERR(pg->resets[i])) { | |
764 | err = PTR_ERR(pg->resets[i]); | |
765 | goto error; | |
766 | } | |
05cfb988 JH |
767 | |
768 | if (off) | |
769 | err = reset_control_assert(pg->resets[i]); | |
770 | else | |
771 | err = reset_control_deassert(pg->resets[i]); | |
772 | ||
773 | if (err) { | |
774 | reset_control_put(pg->resets[i]); | |
775 | goto error; | |
776 | } | |
a3804512 JH |
777 | } |
778 | ||
779 | pg->num_resets = count; | |
780 | ||
781 | return 0; | |
782 | ||
783 | error: | |
784 | while (i--) | |
785 | reset_control_put(pg->resets[i]); | |
da8f4b45 | 786 | |
a3804512 JH |
787 | kfree(pg->resets); |
788 | ||
789 | return err; | |
790 | } | |
791 | ||
792 | static void tegra_powergate_add(struct tegra_pmc *pmc, struct device_node *np) | |
793 | { | |
794 | struct tegra_powergate *pg; | |
c2710ac9 | 795 | int id, err; |
a3804512 | 796 | bool off; |
a3804512 JH |
797 | |
798 | pg = kzalloc(sizeof(*pg), GFP_KERNEL); | |
799 | if (!pg) | |
c2710ac9 | 800 | return; |
a3804512 JH |
801 | |
802 | id = tegra_powergate_lookup(pmc, np->name); | |
c2710ac9 JH |
803 | if (id < 0) { |
804 | dev_err(pmc->dev, "powergate lookup failed for %s: %d\n", | |
805 | np->name, id); | |
a3804512 | 806 | goto free_mem; |
c2710ac9 | 807 | } |
a3804512 JH |
808 | |
809 | /* | |
810 | * Clear the bit for this powergate so it cannot be managed | |
811 | * directly via the legacy APIs for controlling powergates. | |
812 | */ | |
813 | clear_bit(id, pmc->powergates_available); | |
814 | ||
815 | pg->id = id; | |
816 | pg->genpd.name = np->name; | |
817 | pg->genpd.power_off = tegra_genpd_power_off; | |
818 | pg->genpd.power_on = tegra_genpd_power_on; | |
819 | pg->pmc = pmc; | |
820 | ||
05cfb988 JH |
821 | off = !tegra_powergate_is_powered(pg->id); |
822 | ||
c2710ac9 JH |
823 | err = tegra_powergate_of_get_clks(pg, np); |
824 | if (err < 0) { | |
825 | dev_err(pmc->dev, "failed to get clocks for %s: %d\n", | |
826 | np->name, err); | |
a3804512 | 827 | goto set_available; |
c2710ac9 | 828 | } |
a3804512 | 829 | |
c2710ac9 JH |
830 | err = tegra_powergate_of_get_resets(pg, np, off); |
831 | if (err < 0) { | |
832 | dev_err(pmc->dev, "failed to get resets for %s: %d\n", | |
833 | np->name, err); | |
a3804512 | 834 | goto remove_clks; |
c2710ac9 | 835 | } |
a3804512 | 836 | |
e2d17960 JH |
837 | if (!IS_ENABLED(CONFIG_PM_GENERIC_DOMAINS)) |
838 | goto power_on_cleanup; | |
839 | ||
8df12745 JH |
840 | /* |
841 | * FIXME: If XHCI is enabled for Tegra, then power-up the XUSB | |
842 | * host and super-speed partitions. Once the XHCI driver | |
843 | * manages the partitions itself this code can be removed. Note | |
844 | * that we don't register these partitions with the genpd core | |
845 | * to avoid it from powering down the partitions as they appear | |
846 | * to be unused. | |
847 | */ | |
848 | if (IS_ENABLED(CONFIG_USB_XHCI_TEGRA) && | |
849 | (id == TEGRA_POWERGATE_XUSBA || id == TEGRA_POWERGATE_XUSBC)) | |
850 | goto power_on_cleanup; | |
851 | ||
a3804512 JH |
852 | pm_genpd_init(&pg->genpd, NULL, off); |
853 | ||
c2710ac9 JH |
854 | err = of_genpd_add_provider_simple(np, &pg->genpd); |
855 | if (err < 0) { | |
856 | dev_err(pmc->dev, "failed to add genpd provider for %s: %d\n", | |
857 | np->name, err); | |
a3804512 | 858 | goto remove_resets; |
c2710ac9 | 859 | } |
a3804512 JH |
860 | |
861 | dev_dbg(pmc->dev, "added power domain %s\n", pg->genpd.name); | |
862 | ||
863 | return; | |
864 | ||
e2d17960 JH |
865 | power_on_cleanup: |
866 | if (off) | |
867 | WARN_ON(tegra_powergate_power_up(pg, true)); | |
868 | ||
a3804512 JH |
869 | remove_resets: |
870 | while (pg->num_resets--) | |
871 | reset_control_put(pg->resets[pg->num_resets]); | |
da8f4b45 | 872 | |
a3804512 JH |
873 | kfree(pg->resets); |
874 | ||
875 | remove_clks: | |
876 | while (pg->num_clks--) | |
877 | clk_put(pg->clks[pg->num_clks]); | |
da8f4b45 | 878 | |
a3804512 JH |
879 | kfree(pg->clks); |
880 | ||
881 | set_available: | |
882 | set_bit(id, pmc->powergates_available); | |
883 | ||
884 | free_mem: | |
885 | kfree(pg); | |
a3804512 JH |
886 | } |
887 | ||
e2d17960 JH |
888 | static void tegra_powergate_init(struct tegra_pmc *pmc, |
889 | struct device_node *parent) | |
a3804512 JH |
890 | { |
891 | struct device_node *np, *child; | |
e2d17960 | 892 | unsigned int i; |
a3804512 | 893 | |
e2d17960 JH |
894 | /* Create a bitmap of the available and valid partitions */ |
895 | for (i = 0; i < pmc->soc->num_powergates; i++) | |
896 | if (pmc->soc->powergates[i]) | |
897 | set_bit(i, pmc->powergates_available); | |
898 | ||
899 | np = of_get_child_by_name(parent, "powergates"); | |
a3804512 JH |
900 | if (!np) |
901 | return; | |
902 | ||
903 | for_each_child_of_node(np, child) { | |
904 | tegra_powergate_add(pmc, child); | |
905 | of_node_put(child); | |
906 | } | |
907 | ||
908 | of_node_put(np); | |
909 | } | |
910 | ||
70293ed0 | 911 | static int tegra_io_rail_prepare(unsigned int id, unsigned long *request, |
7232398a TR |
912 | unsigned long *status, unsigned int *bit) |
913 | { | |
914 | unsigned long rate, value; | |
7232398a TR |
915 | |
916 | *bit = id % 32; | |
917 | ||
918 | /* | |
919 | * There are two sets of 30 bits to select IO rails, but bits 30 and | |
920 | * 31 are control bits rather than IO rail selection bits. | |
921 | */ | |
922 | if (id > 63 || *bit == 30 || *bit == 31) | |
923 | return -EINVAL; | |
924 | ||
925 | if (id < 32) { | |
926 | *status = IO_DPD_STATUS; | |
927 | *request = IO_DPD_REQ; | |
928 | } else { | |
929 | *status = IO_DPD2_STATUS; | |
930 | *request = IO_DPD2_REQ; | |
931 | } | |
932 | ||
592431b0 | 933 | rate = clk_get_rate(pmc->clk); |
7232398a TR |
934 | |
935 | tegra_pmc_writel(DPD_SAMPLE_ENABLE, DPD_SAMPLE); | |
936 | ||
937 | /* must be at least 200 ns, in APB (PCLK) clock cycles */ | |
938 | value = DIV_ROUND_UP(1000000000, rate); | |
939 | value = DIV_ROUND_UP(200, value); | |
940 | tegra_pmc_writel(value, SEL_DPD_TIM); | |
941 | ||
942 | return 0; | |
943 | } | |
944 | ||
945 | static int tegra_io_rail_poll(unsigned long offset, unsigned long mask, | |
946 | unsigned long val, unsigned long timeout) | |
947 | { | |
948 | unsigned long value; | |
949 | ||
950 | timeout = jiffies + msecs_to_jiffies(timeout); | |
951 | ||
952 | while (time_after(timeout, jiffies)) { | |
953 | value = tegra_pmc_readl(offset); | |
954 | if ((value & mask) == val) | |
955 | return 0; | |
956 | ||
957 | usleep_range(250, 1000); | |
958 | } | |
959 | ||
960 | return -ETIMEDOUT; | |
961 | } | |
962 | ||
963 | static void tegra_io_rail_unprepare(void) | |
964 | { | |
965 | tegra_pmc_writel(DPD_SAMPLE_DISABLE, DPD_SAMPLE); | |
966 | } | |
967 | ||
70293ed0 | 968 | int tegra_io_rail_power_on(unsigned int id) |
7232398a | 969 | { |
a9ccc123 VH |
970 | unsigned long request, status; |
971 | unsigned int bit; | |
7232398a TR |
972 | int err; |
973 | ||
e8cf6616 JH |
974 | mutex_lock(&pmc->powergates_lock); |
975 | ||
7232398a | 976 | err = tegra_io_rail_prepare(id, &request, &status, &bit); |
e8cf6616 JH |
977 | if (err) |
978 | goto error; | |
7232398a | 979 | |
a9ccc123 | 980 | tegra_pmc_writel(IO_DPD_REQ_CODE_OFF | BIT(bit), request); |
7232398a | 981 | |
a9ccc123 | 982 | err = tegra_io_rail_poll(status, BIT(bit), 0, 250); |
e8cf6616 | 983 | if (err) { |
592431b0 | 984 | pr_info("tegra_io_rail_poll() failed: %d\n", err); |
e8cf6616 | 985 | goto error; |
592431b0 | 986 | } |
7232398a TR |
987 | |
988 | tegra_io_rail_unprepare(); | |
989 | ||
e8cf6616 JH |
990 | error: |
991 | mutex_unlock(&pmc->powergates_lock); | |
992 | ||
993 | return err; | |
7232398a TR |
994 | } |
995 | EXPORT_SYMBOL(tegra_io_rail_power_on); | |
996 | ||
70293ed0 | 997 | int tegra_io_rail_power_off(unsigned int id) |
7232398a | 998 | { |
a9ccc123 VH |
999 | unsigned long request, status; |
1000 | unsigned int bit; | |
7232398a TR |
1001 | int err; |
1002 | ||
e8cf6616 JH |
1003 | mutex_lock(&pmc->powergates_lock); |
1004 | ||
7232398a | 1005 | err = tegra_io_rail_prepare(id, &request, &status, &bit); |
e8cf6616 | 1006 | if (err) { |
592431b0 | 1007 | pr_info("tegra_io_rail_prepare() failed: %d\n", err); |
e8cf6616 | 1008 | goto error; |
592431b0 | 1009 | } |
7232398a | 1010 | |
a9ccc123 | 1011 | tegra_pmc_writel(IO_DPD_REQ_CODE_ON | BIT(bit), request); |
7232398a | 1012 | |
a9ccc123 | 1013 | err = tegra_io_rail_poll(status, BIT(bit), BIT(bit), 250); |
e8cf6616 JH |
1014 | if (err) |
1015 | goto error; | |
7232398a TR |
1016 | |
1017 | tegra_io_rail_unprepare(); | |
1018 | ||
e8cf6616 JH |
1019 | error: |
1020 | mutex_unlock(&pmc->powergates_lock); | |
1021 | ||
1022 | return err; | |
7232398a TR |
1023 | } |
1024 | EXPORT_SYMBOL(tegra_io_rail_power_off); | |
1025 | ||
1026 | #ifdef CONFIG_PM_SLEEP | |
1027 | enum tegra_suspend_mode tegra_pmc_get_suspend_mode(void) | |
1028 | { | |
1029 | return pmc->suspend_mode; | |
1030 | } | |
1031 | ||
1032 | void tegra_pmc_set_suspend_mode(enum tegra_suspend_mode mode) | |
1033 | { | |
1034 | if (mode < TEGRA_SUSPEND_NONE || mode >= TEGRA_MAX_SUSPEND_MODE) | |
1035 | return; | |
1036 | ||
1037 | pmc->suspend_mode = mode; | |
1038 | } | |
1039 | ||
1040 | void tegra_pmc_enter_suspend_mode(enum tegra_suspend_mode mode) | |
1041 | { | |
1042 | unsigned long long rate = 0; | |
1043 | u32 value; | |
1044 | ||
1045 | switch (mode) { | |
1046 | case TEGRA_SUSPEND_LP1: | |
1047 | rate = 32768; | |
1048 | break; | |
1049 | ||
1050 | case TEGRA_SUSPEND_LP2: | |
1051 | rate = clk_get_rate(pmc->clk); | |
1052 | break; | |
1053 | ||
1054 | default: | |
1055 | break; | |
1056 | } | |
1057 | ||
1058 | if (WARN_ON_ONCE(rate == 0)) | |
1059 | rate = 100000000; | |
1060 | ||
1061 | if (rate != pmc->rate) { | |
1062 | u64 ticks; | |
1063 | ||
1064 | ticks = pmc->cpu_good_time * rate + USEC_PER_SEC - 1; | |
1065 | do_div(ticks, USEC_PER_SEC); | |
1066 | tegra_pmc_writel(ticks, PMC_CPUPWRGOOD_TIMER); | |
1067 | ||
1068 | ticks = pmc->cpu_off_time * rate + USEC_PER_SEC - 1; | |
1069 | do_div(ticks, USEC_PER_SEC); | |
1070 | tegra_pmc_writel(ticks, PMC_CPUPWROFF_TIMER); | |
1071 | ||
1072 | wmb(); | |
1073 | ||
1074 | pmc->rate = rate; | |
1075 | } | |
1076 | ||
1077 | value = tegra_pmc_readl(PMC_CNTRL); | |
1078 | value &= ~PMC_CNTRL_SIDE_EFFECT_LP0; | |
1079 | value |= PMC_CNTRL_CPU_PWRREQ_OE; | |
1080 | tegra_pmc_writel(value, PMC_CNTRL); | |
1081 | } | |
1082 | #endif | |
1083 | ||
1084 | static int tegra_pmc_parse_dt(struct tegra_pmc *pmc, struct device_node *np) | |
1085 | { | |
1086 | u32 value, values[2]; | |
1087 | ||
1088 | if (of_property_read_u32(np, "nvidia,suspend-mode", &value)) { | |
1089 | } else { | |
1090 | switch (value) { | |
1091 | case 0: | |
1092 | pmc->suspend_mode = TEGRA_SUSPEND_LP0; | |
1093 | break; | |
1094 | ||
1095 | case 1: | |
1096 | pmc->suspend_mode = TEGRA_SUSPEND_LP1; | |
1097 | break; | |
1098 | ||
1099 | case 2: | |
1100 | pmc->suspend_mode = TEGRA_SUSPEND_LP2; | |
1101 | break; | |
1102 | ||
1103 | default: | |
1104 | pmc->suspend_mode = TEGRA_SUSPEND_NONE; | |
1105 | break; | |
1106 | } | |
1107 | } | |
1108 | ||
1109 | pmc->suspend_mode = tegra_pm_validate_suspend_mode(pmc->suspend_mode); | |
1110 | ||
1111 | if (of_property_read_u32(np, "nvidia,cpu-pwr-good-time", &value)) | |
1112 | pmc->suspend_mode = TEGRA_SUSPEND_NONE; | |
1113 | ||
1114 | pmc->cpu_good_time = value; | |
1115 | ||
1116 | if (of_property_read_u32(np, "nvidia,cpu-pwr-off-time", &value)) | |
1117 | pmc->suspend_mode = TEGRA_SUSPEND_NONE; | |
1118 | ||
1119 | pmc->cpu_off_time = value; | |
1120 | ||
1121 | if (of_property_read_u32_array(np, "nvidia,core-pwr-good-time", | |
1122 | values, ARRAY_SIZE(values))) | |
1123 | pmc->suspend_mode = TEGRA_SUSPEND_NONE; | |
1124 | ||
1125 | pmc->core_osc_time = values[0]; | |
1126 | pmc->core_pmu_time = values[1]; | |
1127 | ||
1128 | if (of_property_read_u32(np, "nvidia,core-pwr-off-time", &value)) | |
1129 | pmc->suspend_mode = TEGRA_SUSPEND_NONE; | |
1130 | ||
1131 | pmc->core_off_time = value; | |
1132 | ||
1133 | pmc->corereq_high = of_property_read_bool(np, | |
1134 | "nvidia,core-power-req-active-high"); | |
1135 | ||
1136 | pmc->sysclkreq_high = of_property_read_bool(np, | |
1137 | "nvidia,sys-clock-req-active-high"); | |
1138 | ||
1139 | pmc->combined_req = of_property_read_bool(np, | |
1140 | "nvidia,combined-power-req"); | |
1141 | ||
1142 | pmc->cpu_pwr_good_en = of_property_read_bool(np, | |
1143 | "nvidia,cpu-pwr-good-en"); | |
1144 | ||
1145 | if (of_property_read_u32_array(np, "nvidia,lp0-vec", values, | |
1146 | ARRAY_SIZE(values))) | |
1147 | if (pmc->suspend_mode == TEGRA_SUSPEND_LP0) | |
1148 | pmc->suspend_mode = TEGRA_SUSPEND_LP1; | |
1149 | ||
1150 | pmc->lp0_vec_phys = values[0]; | |
1151 | pmc->lp0_vec_size = values[1]; | |
1152 | ||
1153 | return 0; | |
1154 | } | |
1155 | ||
1156 | static void tegra_pmc_init(struct tegra_pmc *pmc) | |
1157 | { | |
1158 | u32 value; | |
1159 | ||
1160 | /* Always enable CPU power request */ | |
1161 | value = tegra_pmc_readl(PMC_CNTRL); | |
1162 | value |= PMC_CNTRL_CPU_PWRREQ_OE; | |
1163 | tegra_pmc_writel(value, PMC_CNTRL); | |
1164 | ||
1165 | value = tegra_pmc_readl(PMC_CNTRL); | |
1166 | ||
1167 | if (pmc->sysclkreq_high) | |
1168 | value &= ~PMC_CNTRL_SYSCLK_POLARITY; | |
1169 | else | |
1170 | value |= PMC_CNTRL_SYSCLK_POLARITY; | |
1171 | ||
1172 | /* configure the output polarity while the request is tristated */ | |
1173 | tegra_pmc_writel(value, PMC_CNTRL); | |
1174 | ||
1175 | /* now enable the request */ | |
1176 | value = tegra_pmc_readl(PMC_CNTRL); | |
1177 | value |= PMC_CNTRL_SYSCLK_OE; | |
1178 | tegra_pmc_writel(value, PMC_CNTRL); | |
1179 | } | |
1180 | ||
1e52efdf | 1181 | static void tegra_pmc_init_tsense_reset(struct tegra_pmc *pmc) |
3568df3d MP |
1182 | { |
1183 | static const char disabled[] = "emergency thermal reset disabled"; | |
1184 | u32 pmu_addr, ctrl_id, reg_addr, reg_data, pinmux; | |
1185 | struct device *dev = pmc->dev; | |
1186 | struct device_node *np; | |
1187 | u32 value, checksum; | |
1188 | ||
1189 | if (!pmc->soc->has_tsense_reset) | |
95169cd2 | 1190 | return; |
3568df3d MP |
1191 | |
1192 | np = of_find_node_by_name(pmc->dev->of_node, "i2c-thermtrip"); | |
1193 | if (!np) { | |
1194 | dev_warn(dev, "i2c-thermtrip node not found, %s.\n", disabled); | |
95169cd2 | 1195 | return; |
3568df3d MP |
1196 | } |
1197 | ||
1198 | if (of_property_read_u32(np, "nvidia,i2c-controller-id", &ctrl_id)) { | |
1199 | dev_err(dev, "I2C controller ID missing, %s.\n", disabled); | |
1200 | goto out; | |
1201 | } | |
1202 | ||
1203 | if (of_property_read_u32(np, "nvidia,bus-addr", &pmu_addr)) { | |
1204 | dev_err(dev, "nvidia,bus-addr missing, %s.\n", disabled); | |
1205 | goto out; | |
1206 | } | |
1207 | ||
1208 | if (of_property_read_u32(np, "nvidia,reg-addr", ®_addr)) { | |
1209 | dev_err(dev, "nvidia,reg-addr missing, %s.\n", disabled); | |
1210 | goto out; | |
1211 | } | |
1212 | ||
1213 | if (of_property_read_u32(np, "nvidia,reg-data", ®_data)) { | |
1214 | dev_err(dev, "nvidia,reg-data missing, %s.\n", disabled); | |
1215 | goto out; | |
1216 | } | |
1217 | ||
1218 | if (of_property_read_u32(np, "nvidia,pinmux-id", &pinmux)) | |
1219 | pinmux = 0; | |
1220 | ||
1221 | value = tegra_pmc_readl(PMC_SENSOR_CTRL); | |
1222 | value |= PMC_SENSOR_CTRL_SCRATCH_WRITE; | |
1223 | tegra_pmc_writel(value, PMC_SENSOR_CTRL); | |
1224 | ||
1225 | value = (reg_data << PMC_SCRATCH54_DATA_SHIFT) | | |
1226 | (reg_addr << PMC_SCRATCH54_ADDR_SHIFT); | |
1227 | tegra_pmc_writel(value, PMC_SCRATCH54); | |
1228 | ||
1229 | value = PMC_SCRATCH55_RESET_TEGRA; | |
1230 | value |= ctrl_id << PMC_SCRATCH55_CNTRL_ID_SHIFT; | |
1231 | value |= pinmux << PMC_SCRATCH55_PINMUX_SHIFT; | |
1232 | value |= pmu_addr << PMC_SCRATCH55_I2CSLV1_SHIFT; | |
1233 | ||
1234 | /* | |
1235 | * Calculate checksum of SCRATCH54, SCRATCH55 fields. Bits 23:16 will | |
1236 | * contain the checksum and are currently zero, so they are not added. | |
1237 | */ | |
1238 | checksum = reg_addr + reg_data + (value & 0xff) + ((value >> 8) & 0xff) | |
1239 | + ((value >> 24) & 0xff); | |
1240 | checksum &= 0xff; | |
1241 | checksum = 0x100 - checksum; | |
1242 | ||
1243 | value |= checksum << PMC_SCRATCH55_CHECKSUM_SHIFT; | |
1244 | ||
1245 | tegra_pmc_writel(value, PMC_SCRATCH55); | |
1246 | ||
1247 | value = tegra_pmc_readl(PMC_SENSOR_CTRL); | |
1248 | value |= PMC_SENSOR_CTRL_ENABLE_RST; | |
1249 | tegra_pmc_writel(value, PMC_SENSOR_CTRL); | |
1250 | ||
1251 | dev_info(pmc->dev, "emergency thermal reset enabled\n"); | |
1252 | ||
1253 | out: | |
1254 | of_node_put(np); | |
3568df3d MP |
1255 | } |
1256 | ||
7232398a TR |
1257 | static int tegra_pmc_probe(struct platform_device *pdev) |
1258 | { | |
e8cf6616 | 1259 | void __iomem *base; |
7232398a TR |
1260 | struct resource *res; |
1261 | int err; | |
1262 | ||
a83f1fc3 JH |
1263 | /* |
1264 | * Early initialisation should have configured an initial | |
1265 | * register mapping and setup the soc data pointer. If these | |
1266 | * are not valid then something went badly wrong! | |
1267 | */ | |
1268 | if (WARN_ON(!pmc->base || !pmc->soc)) | |
1269 | return -ENODEV; | |
1270 | ||
7232398a TR |
1271 | err = tegra_pmc_parse_dt(pmc, pdev->dev.of_node); |
1272 | if (err < 0) | |
1273 | return err; | |
1274 | ||
1275 | /* take over the memory region from the early initialization */ | |
1276 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
0259f522 JH |
1277 | base = devm_ioremap_resource(&pdev->dev, res); |
1278 | if (IS_ERR(base)) | |
1279 | return PTR_ERR(base); | |
7232398a TR |
1280 | |
1281 | pmc->clk = devm_clk_get(&pdev->dev, "pclk"); | |
1282 | if (IS_ERR(pmc->clk)) { | |
1283 | err = PTR_ERR(pmc->clk); | |
1284 | dev_err(&pdev->dev, "failed to get pclk: %d\n", err); | |
1285 | return err; | |
1286 | } | |
1287 | ||
3568df3d MP |
1288 | pmc->dev = &pdev->dev; |
1289 | ||
7232398a TR |
1290 | tegra_pmc_init(pmc); |
1291 | ||
3568df3d MP |
1292 | tegra_pmc_init_tsense_reset(pmc); |
1293 | ||
7232398a TR |
1294 | if (IS_ENABLED(CONFIG_DEBUG_FS)) { |
1295 | err = tegra_powergate_debugfs_init(); | |
1296 | if (err < 0) | |
1297 | return err; | |
7892158a DR |
1298 | } |
1299 | ||
1300 | err = register_restart_handler(&tegra_pmc_restart_handler); | |
1301 | if (err) { | |
3195ac6d | 1302 | debugfs_remove(pmc->debugfs); |
7892158a DR |
1303 | dev_err(&pdev->dev, "unable to register restart handler, %d\n", |
1304 | err); | |
1305 | return err; | |
7232398a TR |
1306 | } |
1307 | ||
e8cf6616 JH |
1308 | mutex_lock(&pmc->powergates_lock); |
1309 | iounmap(pmc->base); | |
0259f522 | 1310 | pmc->base = base; |
e8cf6616 | 1311 | mutex_unlock(&pmc->powergates_lock); |
0259f522 | 1312 | |
7232398a TR |
1313 | return 0; |
1314 | } | |
1315 | ||
2b20b616 | 1316 | #if defined(CONFIG_PM_SLEEP) && defined(CONFIG_ARM) |
7232398a TR |
1317 | static int tegra_pmc_suspend(struct device *dev) |
1318 | { | |
1319 | tegra_pmc_writel(virt_to_phys(tegra_resume), PMC_SCRATCH41); | |
1320 | ||
1321 | return 0; | |
1322 | } | |
1323 | ||
1324 | static int tegra_pmc_resume(struct device *dev) | |
1325 | { | |
1326 | tegra_pmc_writel(0x0, PMC_SCRATCH41); | |
1327 | ||
1328 | return 0; | |
1329 | } | |
7232398a TR |
1330 | |
1331 | static SIMPLE_DEV_PM_OPS(tegra_pmc_pm_ops, tegra_pmc_suspend, tegra_pmc_resume); | |
1332 | ||
2b20b616 PW |
1333 | #endif |
1334 | ||
7232398a TR |
1335 | static const char * const tegra20_powergates[] = { |
1336 | [TEGRA_POWERGATE_CPU] = "cpu", | |
1337 | [TEGRA_POWERGATE_3D] = "3d", | |
1338 | [TEGRA_POWERGATE_VENC] = "venc", | |
1339 | [TEGRA_POWERGATE_VDEC] = "vdec", | |
1340 | [TEGRA_POWERGATE_PCIE] = "pcie", | |
1341 | [TEGRA_POWERGATE_L2] = "l2", | |
1342 | [TEGRA_POWERGATE_MPE] = "mpe", | |
1343 | }; | |
1344 | ||
1345 | static const struct tegra_pmc_soc tegra20_pmc_soc = { | |
1346 | .num_powergates = ARRAY_SIZE(tegra20_powergates), | |
1347 | .powergates = tegra20_powergates, | |
1348 | .num_cpu_powergates = 0, | |
1349 | .cpu_powergates = NULL, | |
3568df3d | 1350 | .has_tsense_reset = false, |
a9a40a4a | 1351 | .has_gpu_clamps = false, |
7232398a TR |
1352 | }; |
1353 | ||
1354 | static const char * const tegra30_powergates[] = { | |
1355 | [TEGRA_POWERGATE_CPU] = "cpu0", | |
1356 | [TEGRA_POWERGATE_3D] = "3d0", | |
1357 | [TEGRA_POWERGATE_VENC] = "venc", | |
1358 | [TEGRA_POWERGATE_VDEC] = "vdec", | |
1359 | [TEGRA_POWERGATE_PCIE] = "pcie", | |
1360 | [TEGRA_POWERGATE_L2] = "l2", | |
1361 | [TEGRA_POWERGATE_MPE] = "mpe", | |
1362 | [TEGRA_POWERGATE_HEG] = "heg", | |
1363 | [TEGRA_POWERGATE_SATA] = "sata", | |
1364 | [TEGRA_POWERGATE_CPU1] = "cpu1", | |
1365 | [TEGRA_POWERGATE_CPU2] = "cpu2", | |
1366 | [TEGRA_POWERGATE_CPU3] = "cpu3", | |
1367 | [TEGRA_POWERGATE_CELP] = "celp", | |
1368 | [TEGRA_POWERGATE_3D1] = "3d1", | |
1369 | }; | |
1370 | ||
1371 | static const u8 tegra30_cpu_powergates[] = { | |
1372 | TEGRA_POWERGATE_CPU, | |
1373 | TEGRA_POWERGATE_CPU1, | |
1374 | TEGRA_POWERGATE_CPU2, | |
1375 | TEGRA_POWERGATE_CPU3, | |
1376 | }; | |
1377 | ||
1378 | static const struct tegra_pmc_soc tegra30_pmc_soc = { | |
1379 | .num_powergates = ARRAY_SIZE(tegra30_powergates), | |
1380 | .powergates = tegra30_powergates, | |
1381 | .num_cpu_powergates = ARRAY_SIZE(tegra30_cpu_powergates), | |
1382 | .cpu_powergates = tegra30_cpu_powergates, | |
3568df3d | 1383 | .has_tsense_reset = true, |
a9a40a4a | 1384 | .has_gpu_clamps = false, |
7232398a TR |
1385 | }; |
1386 | ||
1387 | static const char * const tegra114_powergates[] = { | |
1388 | [TEGRA_POWERGATE_CPU] = "crail", | |
1389 | [TEGRA_POWERGATE_3D] = "3d", | |
1390 | [TEGRA_POWERGATE_VENC] = "venc", | |
1391 | [TEGRA_POWERGATE_VDEC] = "vdec", | |
1392 | [TEGRA_POWERGATE_MPE] = "mpe", | |
1393 | [TEGRA_POWERGATE_HEG] = "heg", | |
1394 | [TEGRA_POWERGATE_CPU1] = "cpu1", | |
1395 | [TEGRA_POWERGATE_CPU2] = "cpu2", | |
1396 | [TEGRA_POWERGATE_CPU3] = "cpu3", | |
1397 | [TEGRA_POWERGATE_CELP] = "celp", | |
1398 | [TEGRA_POWERGATE_CPU0] = "cpu0", | |
1399 | [TEGRA_POWERGATE_C0NC] = "c0nc", | |
1400 | [TEGRA_POWERGATE_C1NC] = "c1nc", | |
1401 | [TEGRA_POWERGATE_DIS] = "dis", | |
1402 | [TEGRA_POWERGATE_DISB] = "disb", | |
1403 | [TEGRA_POWERGATE_XUSBA] = "xusba", | |
1404 | [TEGRA_POWERGATE_XUSBB] = "xusbb", | |
1405 | [TEGRA_POWERGATE_XUSBC] = "xusbc", | |
1406 | }; | |
1407 | ||
1408 | static const u8 tegra114_cpu_powergates[] = { | |
1409 | TEGRA_POWERGATE_CPU0, | |
1410 | TEGRA_POWERGATE_CPU1, | |
1411 | TEGRA_POWERGATE_CPU2, | |
1412 | TEGRA_POWERGATE_CPU3, | |
1413 | }; | |
1414 | ||
1415 | static const struct tegra_pmc_soc tegra114_pmc_soc = { | |
1416 | .num_powergates = ARRAY_SIZE(tegra114_powergates), | |
1417 | .powergates = tegra114_powergates, | |
1418 | .num_cpu_powergates = ARRAY_SIZE(tegra114_cpu_powergates), | |
1419 | .cpu_powergates = tegra114_cpu_powergates, | |
3568df3d | 1420 | .has_tsense_reset = true, |
a9a40a4a | 1421 | .has_gpu_clamps = false, |
7232398a TR |
1422 | }; |
1423 | ||
1424 | static const char * const tegra124_powergates[] = { | |
1425 | [TEGRA_POWERGATE_CPU] = "crail", | |
1426 | [TEGRA_POWERGATE_3D] = "3d", | |
1427 | [TEGRA_POWERGATE_VENC] = "venc", | |
1428 | [TEGRA_POWERGATE_PCIE] = "pcie", | |
1429 | [TEGRA_POWERGATE_VDEC] = "vdec", | |
7232398a TR |
1430 | [TEGRA_POWERGATE_MPE] = "mpe", |
1431 | [TEGRA_POWERGATE_HEG] = "heg", | |
1432 | [TEGRA_POWERGATE_SATA] = "sata", | |
1433 | [TEGRA_POWERGATE_CPU1] = "cpu1", | |
1434 | [TEGRA_POWERGATE_CPU2] = "cpu2", | |
1435 | [TEGRA_POWERGATE_CPU3] = "cpu3", | |
1436 | [TEGRA_POWERGATE_CELP] = "celp", | |
1437 | [TEGRA_POWERGATE_CPU0] = "cpu0", | |
1438 | [TEGRA_POWERGATE_C0NC] = "c0nc", | |
1439 | [TEGRA_POWERGATE_C1NC] = "c1nc", | |
1440 | [TEGRA_POWERGATE_SOR] = "sor", | |
1441 | [TEGRA_POWERGATE_DIS] = "dis", | |
1442 | [TEGRA_POWERGATE_DISB] = "disb", | |
1443 | [TEGRA_POWERGATE_XUSBA] = "xusba", | |
1444 | [TEGRA_POWERGATE_XUSBB] = "xusbb", | |
1445 | [TEGRA_POWERGATE_XUSBC] = "xusbc", | |
1446 | [TEGRA_POWERGATE_VIC] = "vic", | |
1447 | [TEGRA_POWERGATE_IRAM] = "iram", | |
1448 | }; | |
1449 | ||
1450 | static const u8 tegra124_cpu_powergates[] = { | |
1451 | TEGRA_POWERGATE_CPU0, | |
1452 | TEGRA_POWERGATE_CPU1, | |
1453 | TEGRA_POWERGATE_CPU2, | |
1454 | TEGRA_POWERGATE_CPU3, | |
1455 | }; | |
1456 | ||
1457 | static const struct tegra_pmc_soc tegra124_pmc_soc = { | |
1458 | .num_powergates = ARRAY_SIZE(tegra124_powergates), | |
1459 | .powergates = tegra124_powergates, | |
1460 | .num_cpu_powergates = ARRAY_SIZE(tegra124_cpu_powergates), | |
1461 | .cpu_powergates = tegra124_cpu_powergates, | |
3568df3d | 1462 | .has_tsense_reset = true, |
a9a40a4a | 1463 | .has_gpu_clamps = true, |
7232398a TR |
1464 | }; |
1465 | ||
c2fe4694 TR |
1466 | static const char * const tegra210_powergates[] = { |
1467 | [TEGRA_POWERGATE_CPU] = "crail", | |
1468 | [TEGRA_POWERGATE_3D] = "3d", | |
1469 | [TEGRA_POWERGATE_VENC] = "venc", | |
1470 | [TEGRA_POWERGATE_PCIE] = "pcie", | |
c2fe4694 | 1471 | [TEGRA_POWERGATE_MPE] = "mpe", |
c2fe4694 TR |
1472 | [TEGRA_POWERGATE_SATA] = "sata", |
1473 | [TEGRA_POWERGATE_CPU1] = "cpu1", | |
1474 | [TEGRA_POWERGATE_CPU2] = "cpu2", | |
1475 | [TEGRA_POWERGATE_CPU3] = "cpu3", | |
c2fe4694 TR |
1476 | [TEGRA_POWERGATE_CPU0] = "cpu0", |
1477 | [TEGRA_POWERGATE_C0NC] = "c0nc", | |
c2fe4694 TR |
1478 | [TEGRA_POWERGATE_SOR] = "sor", |
1479 | [TEGRA_POWERGATE_DIS] = "dis", | |
1480 | [TEGRA_POWERGATE_DISB] = "disb", | |
1481 | [TEGRA_POWERGATE_XUSBA] = "xusba", | |
1482 | [TEGRA_POWERGATE_XUSBB] = "xusbb", | |
1483 | [TEGRA_POWERGATE_XUSBC] = "xusbc", | |
1484 | [TEGRA_POWERGATE_VIC] = "vic", | |
1485 | [TEGRA_POWERGATE_IRAM] = "iram", | |
1486 | [TEGRA_POWERGATE_NVDEC] = "nvdec", | |
1487 | [TEGRA_POWERGATE_NVJPG] = "nvjpg", | |
1488 | [TEGRA_POWERGATE_AUD] = "aud", | |
1489 | [TEGRA_POWERGATE_DFD] = "dfd", | |
1490 | [TEGRA_POWERGATE_VE2] = "ve2", | |
1491 | }; | |
1492 | ||
1493 | static const u8 tegra210_cpu_powergates[] = { | |
1494 | TEGRA_POWERGATE_CPU0, | |
1495 | TEGRA_POWERGATE_CPU1, | |
1496 | TEGRA_POWERGATE_CPU2, | |
1497 | TEGRA_POWERGATE_CPU3, | |
1498 | }; | |
1499 | ||
1500 | static const struct tegra_pmc_soc tegra210_pmc_soc = { | |
1501 | .num_powergates = ARRAY_SIZE(tegra210_powergates), | |
1502 | .powergates = tegra210_powergates, | |
1503 | .num_cpu_powergates = ARRAY_SIZE(tegra210_cpu_powergates), | |
1504 | .cpu_powergates = tegra210_cpu_powergates, | |
1505 | .has_tsense_reset = true, | |
1506 | .has_gpu_clamps = true, | |
1507 | }; | |
1508 | ||
7232398a | 1509 | static const struct of_device_id tegra_pmc_match[] = { |
c2fe4694 | 1510 | { .compatible = "nvidia,tegra210-pmc", .data = &tegra210_pmc_soc }, |
7d71e903 | 1511 | { .compatible = "nvidia,tegra132-pmc", .data = &tegra124_pmc_soc }, |
7232398a TR |
1512 | { .compatible = "nvidia,tegra124-pmc", .data = &tegra124_pmc_soc }, |
1513 | { .compatible = "nvidia,tegra114-pmc", .data = &tegra114_pmc_soc }, | |
1514 | { .compatible = "nvidia,tegra30-pmc", .data = &tegra30_pmc_soc }, | |
1515 | { .compatible = "nvidia,tegra20-pmc", .data = &tegra20_pmc_soc }, | |
1516 | { } | |
1517 | }; | |
1518 | ||
1519 | static struct platform_driver tegra_pmc_driver = { | |
1520 | .driver = { | |
1521 | .name = "tegra-pmc", | |
1522 | .suppress_bind_attrs = true, | |
1523 | .of_match_table = tegra_pmc_match, | |
2b20b616 | 1524 | #if defined(CONFIG_PM_SLEEP) && defined(CONFIG_ARM) |
7232398a | 1525 | .pm = &tegra_pmc_pm_ops, |
2b20b616 | 1526 | #endif |
7232398a TR |
1527 | }, |
1528 | .probe = tegra_pmc_probe, | |
1529 | }; | |
7d4d9ed6 | 1530 | builtin_platform_driver(tegra_pmc_driver); |
7232398a TR |
1531 | |
1532 | /* | |
1533 | * Early initialization to allow access to registers in the very early boot | |
1534 | * process. | |
1535 | */ | |
1536 | static int __init tegra_pmc_early_init(void) | |
1537 | { | |
1538 | const struct of_device_id *match; | |
1539 | struct device_node *np; | |
1540 | struct resource regs; | |
1541 | bool invert; | |
1542 | u32 value; | |
1543 | ||
61fd284b JH |
1544 | mutex_init(&pmc->powergates_lock); |
1545 | ||
7232398a TR |
1546 | np = of_find_matching_node_and_match(NULL, tegra_pmc_match, &match); |
1547 | if (!np) { | |
7d71e903 TR |
1548 | /* |
1549 | * Fall back to legacy initialization for 32-bit ARM only. All | |
1550 | * 64-bit ARM device tree files for Tegra are required to have | |
1551 | * a PMC node. | |
1552 | * | |
1553 | * This is for backwards-compatibility with old device trees | |
1554 | * that didn't contain a PMC node. Note that in this case the | |
1555 | * SoC data can't be matched and therefore powergating is | |
1556 | * disabled. | |
1557 | */ | |
1558 | if (IS_ENABLED(CONFIG_ARM) && soc_is_tegra()) { | |
1559 | pr_warn("DT node not found, powergating disabled\n"); | |
1560 | ||
1561 | regs.start = 0x7000e400; | |
1562 | regs.end = 0x7000e7ff; | |
1563 | regs.flags = IORESOURCE_MEM; | |
1564 | ||
1565 | pr_warn("Using memory region %pR\n", ®s); | |
1566 | } else { | |
1567 | /* | |
1568 | * At this point we're not running on Tegra, so play | |
1569 | * nice with multi-platform kernels. | |
1570 | */ | |
1571 | return 0; | |
1572 | } | |
7232398a | 1573 | } else { |
7d71e903 TR |
1574 | /* |
1575 | * Extract information from the device tree if we've found a | |
1576 | * matching node. | |
1577 | */ | |
1578 | if (of_address_to_resource(np, 0, ®s) < 0) { | |
1579 | pr_err("failed to get PMC registers\n"); | |
b69a6258 | 1580 | of_node_put(np); |
7d71e903 TR |
1581 | return -ENXIO; |
1582 | } | |
7232398a TR |
1583 | } |
1584 | ||
1585 | pmc->base = ioremap_nocache(regs.start, resource_size(®s)); | |
1586 | if (!pmc->base) { | |
1587 | pr_err("failed to map PMC registers\n"); | |
b69a6258 | 1588 | of_node_put(np); |
7232398a TR |
1589 | return -ENXIO; |
1590 | } | |
1591 | ||
11131895 | 1592 | if (np) { |
718a2426 JH |
1593 | pmc->soc = match->data; |
1594 | ||
e2d17960 | 1595 | tegra_powergate_init(pmc, np); |
7232398a | 1596 | |
11131895 JH |
1597 | /* |
1598 | * Invert the interrupt polarity if a PMC device tree node | |
1599 | * exists and contains the nvidia,invert-interrupt property. | |
1600 | */ | |
1601 | invert = of_property_read_bool(np, "nvidia,invert-interrupt"); | |
7232398a | 1602 | |
11131895 | 1603 | value = tegra_pmc_readl(PMC_CNTRL); |
7232398a | 1604 | |
11131895 JH |
1605 | if (invert) |
1606 | value |= PMC_CNTRL_INTR_POLARITY; | |
1607 | else | |
1608 | value &= ~PMC_CNTRL_INTR_POLARITY; | |
1609 | ||
1610 | tegra_pmc_writel(value, PMC_CNTRL); | |
b69a6258 JH |
1611 | |
1612 | of_node_put(np); | |
11131895 | 1613 | } |
7232398a TR |
1614 | |
1615 | return 0; | |
1616 | } | |
1617 | early_initcall(tegra_pmc_early_init); |