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
20 #define pr_fmt(fmt) "tegra-pmc: " fmt
21
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>
31 #include <linux/iopoll.h>
32 #include <linux/of.h>
33 #include <linux/of_address.h>
34 #include <linux/of_platform.h>
35 #include <linux/platform_device.h>
36 #include <linux/pm_domain.h>
37 #include <linux/reboot.h>
38 #include <linux/reset.h>
39 #include <linux/seq_file.h>
40 #include <linux/slab.h>
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 */
54 #define PMC_CNTRL_MAIN_RST (1 << 4)
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
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
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
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
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
115 #define GPU_RG_CNTRL 0x2d4
116
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
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;
132
133 bool has_tsense_reset;
134 bool has_gpu_clamps;
135 };
136
137 /**
138 * struct tegra_pmc - NVIDIA Tegra PMC
139 * @dev: pointer to PMC device structure
140 * @base: pointer to I/O remapped register region
141 * @clk: pointer to pclk clock
142 * @soc: pointer to SoC data structure
143 * @debugfs: pointer to debugfs entry
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
157 * @powergates_available: Bitmap of available power gates
158 * @powergates_lock: mutex for power gate register access
159 */
160 struct tegra_pmc {
161 struct device *dev;
162 void __iomem *base;
163 struct clk *clk;
164 struct dentry *debugfs;
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;
182 DECLARE_BITMAP(powergates_available, TEGRA_POWERGATE_MAX);
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
192 static inline struct tegra_powergate *
to_powergate(struct generic_pm_domain * domain)193 to_powergate(struct generic_pm_domain *domain)
194 {
195 return container_of(domain, struct tegra_powergate, genpd);
196 }
197
tegra_pmc_readl(unsigned long offset)198 static u32 tegra_pmc_readl(unsigned long offset)
199 {
200 return readl(pmc->base + offset);
201 }
202
tegra_pmc_writel(u32 value,unsigned long offset)203 static void tegra_pmc_writel(u32 value, unsigned long offset)
204 {
205 writel(value, pmc->base + offset);
206 }
207
tegra_powergate_state(int id)208 static inline bool tegra_powergate_state(int id)
209 {
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;
214 }
215
tegra_powergate_is_valid(int id)216 static inline bool tegra_powergate_is_valid(int id)
217 {
218 return (pmc->soc && pmc->soc->powergates[id]);
219 }
220
tegra_powergate_is_available(int id)221 static inline bool tegra_powergate_is_available(int id)
222 {
223 return test_bit(id, pmc->powergates_available);
224 }
225
tegra_powergate_lookup(struct tegra_pmc * pmc,const char * name)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
246 /**
247 * tegra_powergate_set() - set the state of a partition
248 * @id: partition ID
249 * @new_state: new state of the partition
250 */
tegra_powergate_set(unsigned int id,bool new_state)251 static int tegra_powergate_set(unsigned int id, bool new_state)
252 {
253 bool status;
254 int err;
255
256 if (id == TEGRA_POWERGATE_3D && pmc->soc->has_gpu_clamps)
257 return -EINVAL;
258
259 mutex_lock(&pmc->powergates_lock);
260
261 if (tegra_powergate_state(id) == new_state) {
262 mutex_unlock(&pmc->powergates_lock);
263 return 0;
264 }
265
266 tegra_pmc_writel(PWRGATE_TOGGLE_START | id, PWRGATE_TOGGLE);
267
268 err = readx_poll_timeout(tegra_powergate_state, id, status,
269 status == new_state, 10, 100000);
270
271 mutex_unlock(&pmc->powergates_lock);
272
273 return err;
274 }
275
__tegra_powergate_remove_clamping(unsigned int id)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
tegra_powergate_disable_clocks(struct tegra_powergate * pg)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
tegra_powergate_enable_clocks(struct tegra_powergate * pg)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
tegra_powergate_reset_assert(struct tegra_powergate * pg)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
tegra_powergate_reset_deassert(struct tegra_powergate * pg)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
tegra_powergate_power_up(struct tegra_powergate * pg,bool disable_clocks)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);
411
412 powergate_off:
413 tegra_powergate_set(pg->id, false);
414
415 return err;
416 }
417
tegra_powergate_power_down(struct tegra_powergate * pg)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);
449
450 disable_clks:
451 tegra_powergate_disable_clocks(pg);
452
453 return err;
454 }
455
tegra_genpd_power_on(struct generic_pm_domain * domain)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
tegra_genpd_power_off(struct generic_pm_domain * domain)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
484 /**
485 * tegra_powergate_power_on() - power on partition
486 * @id: partition ID
487 */
tegra_powergate_power_on(unsigned int id)488 int tegra_powergate_power_on(unsigned int id)
489 {
490 if (!tegra_powergate_is_available(id))
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 */
tegra_powergate_power_off(unsigned int id)500 int tegra_powergate_power_off(unsigned int id)
501 {
502 if (!tegra_powergate_is_available(id))
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 */
tegra_powergate_is_powered(unsigned int id)513 int tegra_powergate_is_powered(unsigned int id)
514 {
515 int status;
516
517 if (!tegra_powergate_is_valid(id))
518 return -EINVAL;
519
520 mutex_lock(&pmc->powergates_lock);
521 status = tegra_powergate_state(id);
522 mutex_unlock(&pmc->powergates_lock);
523
524 return status;
525 }
526
527 /**
528 * tegra_powergate_remove_clamping() - remove power clamps for partition
529 * @id: partition ID
530 */
tegra_powergate_remove_clamping(unsigned int id)531 int tegra_powergate_remove_clamping(unsigned int id)
532 {
533 if (!tegra_powergate_is_available(id))
534 return -EINVAL;
535
536 return __tegra_powergate_remove_clamping(id);
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 */
tegra_powergate_sequence_power_up(unsigned int id,struct clk * clk,struct reset_control * rst)548 int tegra_powergate_sequence_power_up(unsigned int id, struct clk *clk,
549 struct reset_control *rst)
550 {
551 struct tegra_powergate pg;
552 int err;
553
554 if (!tegra_powergate_is_available(id))
555 return -EINVAL;
556
557 pg.id = id;
558 pg.clks = &clk;
559 pg.num_clks = 1;
560 pg.resets = &rst;
561 pg.num_resets = 1;
562
563 err = tegra_powergate_power_up(&pg, false);
564 if (err)
565 pr_err("failed to turn on partition %d: %d\n", id, err);
566
567 return err;
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 */
tegra_get_cpu_powergate_id(unsigned int cpuid)579 static int tegra_get_cpu_powergate_id(unsigned int cpuid)
580 {
581 if (pmc->soc && cpuid < pmc->soc->num_cpu_powergates)
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 */
tegra_pmc_cpu_is_powered(unsigned int cpuid)591 bool tegra_pmc_cpu_is_powered(unsigned int cpuid)
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 */
tegra_pmc_cpu_power_on(unsigned int cpuid)606 int tegra_pmc_cpu_power_on(unsigned int cpuid)
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 */
tegra_pmc_cpu_remove_clamping(unsigned int cpuid)621 int tegra_pmc_cpu_remove_clamping(unsigned int cpuid)
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
tegra_pmc_restart_notify(struct notifier_block * this,unsigned long action,void * data)633 static int tegra_pmc_restart_notify(struct notifier_block *this,
634 unsigned long action, void *data)
635 {
636 const char *cmd = data;
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
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);
659
660 return NOTIFY_DONE;
661 }
662
663 static struct notifier_block tegra_pmc_restart_handler = {
664 .notifier_call = tegra_pmc_restart_notify,
665 .priority = 128,
666 };
667
powergate_show(struct seq_file * s,void * data)668 static int powergate_show(struct seq_file *s, void *data)
669 {
670 unsigned int i;
671 int status;
672
673 seq_printf(s, " powergate powered\n");
674 seq_printf(s, "------------------\n");
675
676 for (i = 0; i < pmc->soc->num_powergates; i++) {
677 status = tegra_powergate_is_powered(i);
678 if (status < 0)
679 continue;
680
681 seq_printf(s, " %9s %7s\n", pmc->soc->powergates[i],
682 status ? "yes" : "no");
683 }
684
685 return 0;
686 }
687
powergate_open(struct inode * inode,struct file * file)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
tegra_powergate_debugfs_init(void)700 static int tegra_powergate_debugfs_init(void)
701 {
702 pmc->debugfs = debugfs_create_file("powergate", S_IRUGO, NULL, NULL,
703 &powergate_fops);
704 if (!pmc->debugfs)
705 return -ENOMEM;
706
707 return 0;
708 }
709
tegra_powergate_of_get_clks(struct tegra_powergate * pg,struct device_node * np)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]);
740
741 kfree(pg->clks);
742
743 return err;
744 }
745
tegra_powergate_of_get_resets(struct tegra_powergate * pg,struct device_node * np,bool off)746 static int tegra_powergate_of_get_resets(struct tegra_powergate *pg,
747 struct device_node *np, bool off)
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 }
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 }
777 }
778
779 pg->num_resets = count;
780
781 return 0;
782
783 error:
784 while (i--)
785 reset_control_put(pg->resets[i]);
786
787 kfree(pg->resets);
788
789 return err;
790 }
791
tegra_powergate_add(struct tegra_pmc * pmc,struct device_node * np)792 static void tegra_powergate_add(struct tegra_pmc *pmc, struct device_node *np)
793 {
794 struct tegra_powergate *pg;
795 int id, err;
796 bool off;
797
798 pg = kzalloc(sizeof(*pg), GFP_KERNEL);
799 if (!pg)
800 return;
801
802 id = tegra_powergate_lookup(pmc, np->name);
803 if (id < 0) {
804 dev_err(pmc->dev, "powergate lookup failed for %s: %d\n",
805 np->name, id);
806 goto free_mem;
807 }
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
821 off = !tegra_powergate_is_powered(pg->id);
822
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);
827 goto set_available;
828 }
829
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);
834 goto remove_clks;
835 }
836
837 if (!IS_ENABLED(CONFIG_PM_GENERIC_DOMAINS))
838 goto power_on_cleanup;
839
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
852 pm_genpd_init(&pg->genpd, NULL, off);
853
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);
858 goto remove_resets;
859 }
860
861 dev_dbg(pmc->dev, "added power domain %s\n", pg->genpd.name);
862
863 return;
864
865 power_on_cleanup:
866 if (off)
867 WARN_ON(tegra_powergate_power_up(pg, true));
868
869 remove_resets:
870 while (pg->num_resets--)
871 reset_control_put(pg->resets[pg->num_resets]);
872
873 kfree(pg->resets);
874
875 remove_clks:
876 while (pg->num_clks--)
877 clk_put(pg->clks[pg->num_clks]);
878
879 kfree(pg->clks);
880
881 set_available:
882 set_bit(id, pmc->powergates_available);
883
884 free_mem:
885 kfree(pg);
886 }
887
tegra_powergate_init(struct tegra_pmc * pmc,struct device_node * parent)888 static void tegra_powergate_init(struct tegra_pmc *pmc,
889 struct device_node *parent)
890 {
891 struct device_node *np, *child;
892 unsigned int i;
893
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");
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
tegra_io_rail_prepare(unsigned int id,unsigned long * request,unsigned long * status,unsigned int * bit)911 static int tegra_io_rail_prepare(unsigned int id, unsigned long *request,
912 unsigned long *status, unsigned int *bit)
913 {
914 unsigned long rate, value;
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
933 rate = clk_get_rate(pmc->clk);
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
tegra_io_rail_poll(unsigned long offset,unsigned long mask,unsigned long val,unsigned long timeout)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
tegra_io_rail_unprepare(void)963 static void tegra_io_rail_unprepare(void)
964 {
965 tegra_pmc_writel(DPD_SAMPLE_DISABLE, DPD_SAMPLE);
966 }
967
tegra_io_rail_power_on(unsigned int id)968 int tegra_io_rail_power_on(unsigned int id)
969 {
970 unsigned long request, status;
971 unsigned int bit;
972 int err;
973
974 mutex_lock(&pmc->powergates_lock);
975
976 err = tegra_io_rail_prepare(id, &request, &status, &bit);
977 if (err)
978 goto error;
979
980 tegra_pmc_writel(IO_DPD_REQ_CODE_OFF | BIT(bit), request);
981
982 err = tegra_io_rail_poll(status, BIT(bit), 0, 250);
983 if (err) {
984 pr_info("tegra_io_rail_poll() failed: %d\n", err);
985 goto error;
986 }
987
988 tegra_io_rail_unprepare();
989
990 error:
991 mutex_unlock(&pmc->powergates_lock);
992
993 return err;
994 }
995 EXPORT_SYMBOL(tegra_io_rail_power_on);
996
tegra_io_rail_power_off(unsigned int id)997 int tegra_io_rail_power_off(unsigned int id)
998 {
999 unsigned long request, status;
1000 unsigned int bit;
1001 int err;
1002
1003 mutex_lock(&pmc->powergates_lock);
1004
1005 err = tegra_io_rail_prepare(id, &request, &status, &bit);
1006 if (err) {
1007 pr_info("tegra_io_rail_prepare() failed: %d\n", err);
1008 goto error;
1009 }
1010
1011 tegra_pmc_writel(IO_DPD_REQ_CODE_ON | BIT(bit), request);
1012
1013 err = tegra_io_rail_poll(status, BIT(bit), BIT(bit), 250);
1014 if (err)
1015 goto error;
1016
1017 tegra_io_rail_unprepare();
1018
1019 error:
1020 mutex_unlock(&pmc->powergates_lock);
1021
1022 return err;
1023 }
1024 EXPORT_SYMBOL(tegra_io_rail_power_off);
1025
1026 #ifdef CONFIG_PM_SLEEP
tegra_pmc_get_suspend_mode(void)1027 enum tegra_suspend_mode tegra_pmc_get_suspend_mode(void)
1028 {
1029 return pmc->suspend_mode;
1030 }
1031
tegra_pmc_set_suspend_mode(enum tegra_suspend_mode mode)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
tegra_pmc_enter_suspend_mode(enum tegra_suspend_mode mode)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
tegra_pmc_parse_dt(struct tegra_pmc * pmc,struct device_node * np)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
tegra_pmc_init(struct tegra_pmc * pmc)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
tegra_pmc_init_tsense_reset(struct tegra_pmc * pmc)1181 static void tegra_pmc_init_tsense_reset(struct tegra_pmc *pmc)
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)
1190 return;
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);
1195 return;
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);
1255 }
1256
tegra_pmc_probe(struct platform_device * pdev)1257 static int tegra_pmc_probe(struct platform_device *pdev)
1258 {
1259 void __iomem *base;
1260 struct resource *res;
1261 int err;
1262
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
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);
1277 base = devm_ioremap_resource(&pdev->dev, res);
1278 if (IS_ERR(base))
1279 return PTR_ERR(base);
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
1288 pmc->dev = &pdev->dev;
1289
1290 tegra_pmc_init(pmc);
1291
1292 tegra_pmc_init_tsense_reset(pmc);
1293
1294 if (IS_ENABLED(CONFIG_DEBUG_FS)) {
1295 err = tegra_powergate_debugfs_init();
1296 if (err < 0)
1297 return err;
1298 }
1299
1300 err = register_restart_handler(&tegra_pmc_restart_handler);
1301 if (err) {
1302 debugfs_remove(pmc->debugfs);
1303 dev_err(&pdev->dev, "unable to register restart handler, %d\n",
1304 err);
1305 return err;
1306 }
1307
1308 mutex_lock(&pmc->powergates_lock);
1309 iounmap(pmc->base);
1310 pmc->base = base;
1311 mutex_unlock(&pmc->powergates_lock);
1312
1313 return 0;
1314 }
1315
1316 #if defined(CONFIG_PM_SLEEP) && defined(CONFIG_ARM)
tegra_pmc_suspend(struct device * dev)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
tegra_pmc_resume(struct device * dev)1324 static int tegra_pmc_resume(struct device *dev)
1325 {
1326 tegra_pmc_writel(0x0, PMC_SCRATCH41);
1327
1328 return 0;
1329 }
1330
1331 static SIMPLE_DEV_PM_OPS(tegra_pmc_pm_ops, tegra_pmc_suspend, tegra_pmc_resume);
1332
1333 #endif
1334
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,
1350 .has_tsense_reset = false,
1351 .has_gpu_clamps = false,
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,
1383 .has_tsense_reset = true,
1384 .has_gpu_clamps = false,
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,
1420 .has_tsense_reset = true,
1421 .has_gpu_clamps = false,
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",
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,
1462 .has_tsense_reset = true,
1463 .has_gpu_clamps = true,
1464 };
1465
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",
1471 [TEGRA_POWERGATE_MPE] = "mpe",
1472 [TEGRA_POWERGATE_SATA] = "sata",
1473 [TEGRA_POWERGATE_CPU1] = "cpu1",
1474 [TEGRA_POWERGATE_CPU2] = "cpu2",
1475 [TEGRA_POWERGATE_CPU3] = "cpu3",
1476 [TEGRA_POWERGATE_CPU0] = "cpu0",
1477 [TEGRA_POWERGATE_C0NC] = "c0nc",
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
1509 static const struct of_device_id tegra_pmc_match[] = {
1510 { .compatible = "nvidia,tegra210-pmc", .data = &tegra210_pmc_soc },
1511 { .compatible = "nvidia,tegra132-pmc", .data = &tegra124_pmc_soc },
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,
1524 #if defined(CONFIG_PM_SLEEP) && defined(CONFIG_ARM)
1525 .pm = &tegra_pmc_pm_ops,
1526 #endif
1527 },
1528 .probe = tegra_pmc_probe,
1529 };
1530 builtin_platform_driver(tegra_pmc_driver);
1531
1532 /*
1533 * Early initialization to allow access to registers in the very early boot
1534 * process.
1535 */
tegra_pmc_early_init(void)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
1544 mutex_init(&pmc->powergates_lock);
1545
1546 np = of_find_matching_node_and_match(NULL, tegra_pmc_match, &match);
1547 if (!np) {
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 }
1573 } else {
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");
1580 of_node_put(np);
1581 return -ENXIO;
1582 }
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");
1588 of_node_put(np);
1589 return -ENXIO;
1590 }
1591
1592 if (np) {
1593 pmc->soc = match->data;
1594
1595 tegra_powergate_init(pmc, np);
1596
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");
1602
1603 value = tegra_pmc_readl(PMC_CNTRL);
1604
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);
1611
1612 of_node_put(np);
1613 }
1614
1615 return 0;
1616 }
1617 early_initcall(tegra_pmc_early_init);
1618