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_INTR_POLARITY BIT(17) /* inverts INTR polarity */ 49 #define PMC_CNTRL_CPU_PWRREQ_OE BIT(16) /* CPU pwr req enable */ 50 #define PMC_CNTRL_CPU_PWRREQ_POLARITY BIT(15) /* CPU pwr req polarity */ 51 #define PMC_CNTRL_SIDE_EFFECT_LP0 BIT(14) /* LP0 when CPU pwr gated */ 52 #define PMC_CNTRL_SYSCLK_OE BIT(11) /* system clock enable */ 53 #define PMC_CNTRL_SYSCLK_POLARITY BIT(10) /* sys clk polarity */ 54 #define PMC_CNTRL_MAIN_RST BIT(4) 55 56 #define DPD_SAMPLE 0x020 57 #define DPD_SAMPLE_ENABLE BIT(0) 58 #define DPD_SAMPLE_DISABLE (0 << 0) 59 60 #define PWRGATE_TOGGLE 0x30 61 #define PWRGATE_TOGGLE_START BIT(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 BIT(31) 69 #define PMC_SCRATCH0_MODE_BOOTLOADER BIT(30) 70 #define PMC_SCRATCH0_MODE_RCM BIT(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 BIT(2) 82 #define PMC_SENSOR_CTRL_ENABLE_RST BIT(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 (0U << 30) 94 #define IO_DPD_REQ_CODE_OFF (1U << 30) 95 #define IO_DPD_REQ_CODE_ON (2U << 30) 96 #define IO_DPD_REQ_CODE_MASK (3U << 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 BIT(31) 109 #define PMC_SCRATCH55_CNTRL_ID_SHIFT 27 110 #define PMC_SCRATCH55_PINMUX_SHIFT 24 111 #define PMC_SCRATCH55_16BITOP BIT(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 * 193 to_powergate(struct generic_pm_domain *domain) 194 { 195 return container_of(domain, struct tegra_powergate, genpd); 196 } 197 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 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 216 static inline bool tegra_powergate_is_valid(int id) 217 { 218 return (pmc->soc && pmc->soc->powergates[id]); 219 } 220 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 246 /** 247 * tegra_powergate_set() - set the state of a partition 248 * @id: partition ID 249 * @new_state: new state of the partition 250 */ 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 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); 411 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); 449 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 484 /** 485 * tegra_powergate_power_on() - power on partition 486 * @id: partition ID 487 */ 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 */ 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 */ 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 */ 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 */ 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 */ 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 */ 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 */ 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 */ 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 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 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 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 { 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 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 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 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 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 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 945 static int tegra_io_rail_poll(unsigned long offset, u32 mask, 946 u32 val, unsigned long timeout) 947 { 948 u32 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 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 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 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 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 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) 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 } 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 */ 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