blob: 0447afa970f5e01e63428a702ecd24581388a4bb [file] [log] [blame]
David Brazdil0f672f62019-12-10 10:32:29 +00001// SPDX-License-Identifier: GPL-2.0-only
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002/*
3 * drivers/soc/tegra/pmc.c
4 *
5 * Copyright (c) 2010 Google, Inc
David Brazdil0f672f62019-12-10 10:32:29 +00006 * Copyright (c) 2018, NVIDIA CORPORATION. All rights reserved.
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00007 *
8 * Author:
9 * Colin Cross <ccross@google.com>
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000010 */
11
12#define pr_fmt(fmt) "tegra-pmc: " fmt
13
David Brazdil0f672f62019-12-10 10:32:29 +000014#include <linux/arm-smccc.h>
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000015#include <linux/clk.h>
16#include <linux/clk/tegra.h>
17#include <linux/debugfs.h>
18#include <linux/delay.h>
19#include <linux/err.h>
20#include <linux/export.h>
21#include <linux/init.h>
22#include <linux/io.h>
23#include <linux/iopoll.h>
David Brazdil0f672f62019-12-10 10:32:29 +000024#include <linux/irqdomain.h>
25#include <linux/irq.h>
26#include <linux/kernel.h>
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000027#include <linux/of_address.h>
28#include <linux/of_clk.h>
David Brazdil0f672f62019-12-10 10:32:29 +000029#include <linux/of.h>
30#include <linux/of_irq.h>
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000031#include <linux/of_platform.h>
David Brazdil0f672f62019-12-10 10:32:29 +000032#include <linux/pinctrl/pinconf-generic.h>
33#include <linux/pinctrl/pinconf.h>
34#include <linux/pinctrl/pinctrl.h>
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000035#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
David Brazdil0f672f62019-12-10 10:32:29 +000047#include <dt-bindings/interrupt-controller/arm-gic.h>
48#include <dt-bindings/pinctrl/pinctrl-tegra-io-pad.h>
49#include <dt-bindings/gpio/tegra186-gpio.h>
50#include <dt-bindings/gpio/tegra194-gpio.h>
51
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000052#define PMC_CNTRL 0x0
53#define PMC_CNTRL_INTR_POLARITY BIT(17) /* inverts INTR polarity */
54#define PMC_CNTRL_CPU_PWRREQ_OE BIT(16) /* CPU pwr req enable */
55#define PMC_CNTRL_CPU_PWRREQ_POLARITY BIT(15) /* CPU pwr req polarity */
56#define PMC_CNTRL_SIDE_EFFECT_LP0 BIT(14) /* LP0 when CPU pwr gated */
57#define PMC_CNTRL_SYSCLK_OE BIT(11) /* system clock enable */
58#define PMC_CNTRL_SYSCLK_POLARITY BIT(10) /* sys clk polarity */
59#define PMC_CNTRL_MAIN_RST BIT(4)
60
61#define DPD_SAMPLE 0x020
62#define DPD_SAMPLE_ENABLE BIT(0)
63#define DPD_SAMPLE_DISABLE (0 << 0)
64
65#define PWRGATE_TOGGLE 0x30
66#define PWRGATE_TOGGLE_START BIT(8)
67
68#define REMOVE_CLAMPING 0x34
69
70#define PWRGATE_STATUS 0x38
71
David Brazdil0f672f62019-12-10 10:32:29 +000072#define PMC_IMPL_E_33V_PWR 0x40
73
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000074#define PMC_PWR_DET 0x48
75
76#define PMC_SCRATCH0_MODE_RECOVERY BIT(31)
77#define PMC_SCRATCH0_MODE_BOOTLOADER BIT(30)
78#define PMC_SCRATCH0_MODE_RCM BIT(1)
79#define PMC_SCRATCH0_MODE_MASK (PMC_SCRATCH0_MODE_RECOVERY | \
80 PMC_SCRATCH0_MODE_BOOTLOADER | \
81 PMC_SCRATCH0_MODE_RCM)
82
83#define PMC_CPUPWRGOOD_TIMER 0xc8
84#define PMC_CPUPWROFF_TIMER 0xcc
85
86#define PMC_PWR_DET_VALUE 0xe4
87
88#define PMC_SCRATCH41 0x140
89
90#define PMC_SENSOR_CTRL 0x1b0
91#define PMC_SENSOR_CTRL_SCRATCH_WRITE BIT(2)
92#define PMC_SENSOR_CTRL_ENABLE_RST BIT(1)
93
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000094#define PMC_RST_STATUS_POR 0
95#define PMC_RST_STATUS_WATCHDOG 1
96#define PMC_RST_STATUS_SENSOR 2
97#define PMC_RST_STATUS_SW_MAIN 3
98#define PMC_RST_STATUS_LP0 4
99#define PMC_RST_STATUS_AOTAG 5
100
101#define IO_DPD_REQ 0x1b8
102#define IO_DPD_REQ_CODE_IDLE (0U << 30)
103#define IO_DPD_REQ_CODE_OFF (1U << 30)
104#define IO_DPD_REQ_CODE_ON (2U << 30)
105#define IO_DPD_REQ_CODE_MASK (3U << 30)
106
107#define IO_DPD_STATUS 0x1bc
108#define IO_DPD2_REQ 0x1c0
109#define IO_DPD2_STATUS 0x1c4
110#define SEL_DPD_TIM 0x1c8
111
112#define PMC_SCRATCH54 0x258
113#define PMC_SCRATCH54_DATA_SHIFT 8
114#define PMC_SCRATCH54_ADDR_SHIFT 0
115
116#define PMC_SCRATCH55 0x25c
117#define PMC_SCRATCH55_RESET_TEGRA BIT(31)
118#define PMC_SCRATCH55_CNTRL_ID_SHIFT 27
119#define PMC_SCRATCH55_PINMUX_SHIFT 24
120#define PMC_SCRATCH55_16BITOP BIT(15)
121#define PMC_SCRATCH55_CHECKSUM_SHIFT 16
122#define PMC_SCRATCH55_I2CSLV1_SHIFT 0
123
124#define GPU_RG_CNTRL 0x2d4
125
126/* Tegra186 and later */
David Brazdil0f672f62019-12-10 10:32:29 +0000127#define WAKE_AOWAKE_CNTRL(x) (0x000 + ((x) << 2))
128#define WAKE_AOWAKE_CNTRL_LEVEL (1 << 3)
129#define WAKE_AOWAKE_MASK_W(x) (0x180 + ((x) << 2))
130#define WAKE_AOWAKE_MASK_R(x) (0x300 + ((x) << 2))
131#define WAKE_AOWAKE_STATUS_W(x) (0x30c + ((x) << 2))
132#define WAKE_AOWAKE_STATUS_R(x) (0x48c + ((x) << 2))
133#define WAKE_AOWAKE_TIER0_ROUTING(x) (0x4b4 + ((x) << 2))
134#define WAKE_AOWAKE_TIER1_ROUTING(x) (0x4c0 + ((x) << 2))
135#define WAKE_AOWAKE_TIER2_ROUTING(x) (0x4cc + ((x) << 2))
136
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000137#define WAKE_AOWAKE_CTRL 0x4f4
138#define WAKE_AOWAKE_CTRL_INTR_POLARITY BIT(0)
139
David Brazdil0f672f62019-12-10 10:32:29 +0000140/* for secure PMC */
141#define TEGRA_SMC_PMC 0xc2fffe00
142#define TEGRA_SMC_PMC_READ 0xaa
143#define TEGRA_SMC_PMC_WRITE 0xbb
144
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000145struct tegra_powergate {
146 struct generic_pm_domain genpd;
147 struct tegra_pmc *pmc;
148 unsigned int id;
149 struct clk **clks;
150 unsigned int num_clks;
151 struct reset_control *reset;
152};
153
154struct tegra_io_pad_soc {
155 enum tegra_io_pad id;
156 unsigned int dpd;
157 unsigned int voltage;
David Brazdil0f672f62019-12-10 10:32:29 +0000158 const char *name;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000159};
160
161struct tegra_pmc_regs {
162 unsigned int scratch0;
163 unsigned int dpd_req;
164 unsigned int dpd_status;
165 unsigned int dpd2_req;
166 unsigned int dpd2_status;
David Brazdil0f672f62019-12-10 10:32:29 +0000167 unsigned int rst_status;
168 unsigned int rst_source_shift;
169 unsigned int rst_source_mask;
170 unsigned int rst_level_shift;
171 unsigned int rst_level_mask;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000172};
173
David Brazdil0f672f62019-12-10 10:32:29 +0000174struct tegra_wake_event {
175 const char *name;
176 unsigned int id;
177 unsigned int irq;
178 struct {
179 unsigned int instance;
180 unsigned int pin;
181 } gpio;
182};
183
184#define TEGRA_WAKE_IRQ(_name, _id, _irq) \
185 { \
186 .name = _name, \
187 .id = _id, \
188 .irq = _irq, \
189 .gpio = { \
190 .instance = UINT_MAX, \
191 .pin = UINT_MAX, \
192 }, \
193 }
194
195#define TEGRA_WAKE_GPIO(_name, _id, _instance, _pin) \
196 { \
197 .name = _name, \
198 .id = _id, \
199 .irq = 0, \
200 .gpio = { \
201 .instance = _instance, \
202 .pin = _pin, \
203 }, \
204 }
205
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000206struct tegra_pmc_soc {
207 unsigned int num_powergates;
208 const char *const *powergates;
209 unsigned int num_cpu_powergates;
210 const u8 *cpu_powergates;
211
212 bool has_tsense_reset;
213 bool has_gpu_clamps;
214 bool needs_mbist_war;
David Brazdil0f672f62019-12-10 10:32:29 +0000215 bool has_impl_33v_pwr;
216 bool maybe_tz_only;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000217
218 const struct tegra_io_pad_soc *io_pads;
219 unsigned int num_io_pads;
220
David Brazdil0f672f62019-12-10 10:32:29 +0000221 const struct pinctrl_pin_desc *pin_descs;
222 unsigned int num_pin_descs;
223
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000224 const struct tegra_pmc_regs *regs;
225 void (*init)(struct tegra_pmc *pmc);
226 void (*setup_irq_polarity)(struct tegra_pmc *pmc,
227 struct device_node *np,
228 bool invert);
David Brazdil0f672f62019-12-10 10:32:29 +0000229
230 const char * const *reset_sources;
231 unsigned int num_reset_sources;
232 const char * const *reset_levels;
233 unsigned int num_reset_levels;
234
235 /*
236 * These describe events that can wake the system from sleep (i.e.
237 * LP0 or SC7). Wakeup from other sleep states (such as LP1 or LP2)
238 * are dealt with in the LIC.
239 */
240 const struct tegra_wake_event *wake_events;
241 unsigned int num_wake_events;
242};
243
244static const char * const tegra186_reset_sources[] = {
245 "SYS_RESET",
246 "AOWDT",
247 "MCCPLEXWDT",
248 "BPMPWDT",
249 "SCEWDT",
250 "SPEWDT",
251 "APEWDT",
252 "BCCPLEXWDT",
253 "SENSOR",
254 "AOTAG",
255 "VFSENSOR",
256 "SWREST",
257 "SC7",
258 "HSM",
259 "CORESIGHT"
260};
261
262static const char * const tegra186_reset_levels[] = {
263 "L0", "L1", "L2", "WARM"
264};
265
266static const char * const tegra30_reset_sources[] = {
267 "POWER_ON_RESET",
268 "WATCHDOG",
269 "SENSOR",
270 "SW_MAIN",
271 "LP0"
272};
273
274static const char * const tegra210_reset_sources[] = {
275 "POWER_ON_RESET",
276 "WATCHDOG",
277 "SENSOR",
278 "SW_MAIN",
279 "LP0",
280 "AOTAG"
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000281};
282
283/**
284 * struct tegra_pmc - NVIDIA Tegra PMC
285 * @dev: pointer to PMC device structure
286 * @base: pointer to I/O remapped register region
David Brazdil0f672f62019-12-10 10:32:29 +0000287 * @wake: pointer to I/O remapped region for WAKE registers
288 * @aotag: pointer to I/O remapped region for AOTAG registers
289 * @scratch: pointer to I/O remapped region for scratch registers
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000290 * @clk: pointer to pclk clock
291 * @soc: pointer to SoC data structure
David Brazdil0f672f62019-12-10 10:32:29 +0000292 * @tz_only: flag specifying if the PMC can only be accessed via TrustZone
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000293 * @debugfs: pointer to debugfs entry
294 * @rate: currently configured rate of pclk
295 * @suspend_mode: lowest suspend mode available
296 * @cpu_good_time: CPU power good time (in microseconds)
297 * @cpu_off_time: CPU power off time (in microsecends)
298 * @core_osc_time: core power good OSC time (in microseconds)
299 * @core_pmu_time: core power good PMU time (in microseconds)
300 * @core_off_time: core power off time (in microseconds)
301 * @corereq_high: core power request is active-high
302 * @sysclkreq_high: system clock request is active-high
303 * @combined_req: combined power request for CPU & core
304 * @cpu_pwr_good_en: CPU power good signal is enabled
305 * @lp0_vec_phys: physical base address of the LP0 warm boot code
306 * @lp0_vec_size: size of the LP0 warm boot code
307 * @powergates_available: Bitmap of available power gates
308 * @powergates_lock: mutex for power gate register access
David Brazdil0f672f62019-12-10 10:32:29 +0000309 * @pctl_dev: pin controller exposed by the PMC
310 * @domain: IRQ domain provided by the PMC
311 * @irq: chip implementation for the IRQ domain
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000312 */
313struct tegra_pmc {
314 struct device *dev;
315 void __iomem *base;
316 void __iomem *wake;
317 void __iomem *aotag;
318 void __iomem *scratch;
319 struct clk *clk;
320 struct dentry *debugfs;
321
322 const struct tegra_pmc_soc *soc;
David Brazdil0f672f62019-12-10 10:32:29 +0000323 bool tz_only;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000324
325 unsigned long rate;
326
327 enum tegra_suspend_mode suspend_mode;
328 u32 cpu_good_time;
329 u32 cpu_off_time;
330 u32 core_osc_time;
331 u32 core_pmu_time;
332 u32 core_off_time;
333 bool corereq_high;
334 bool sysclkreq_high;
335 bool combined_req;
336 bool cpu_pwr_good_en;
337 u32 lp0_vec_phys;
338 u32 lp0_vec_size;
339 DECLARE_BITMAP(powergates_available, TEGRA_POWERGATE_MAX);
340
341 struct mutex powergates_lock;
David Brazdil0f672f62019-12-10 10:32:29 +0000342
343 struct pinctrl_dev *pctl_dev;
344
345 struct irq_domain *domain;
346 struct irq_chip irq;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000347};
348
349static struct tegra_pmc *pmc = &(struct tegra_pmc) {
350 .base = NULL,
351 .suspend_mode = TEGRA_SUSPEND_NONE,
352};
353
354static inline struct tegra_powergate *
355to_powergate(struct generic_pm_domain *domain)
356{
357 return container_of(domain, struct tegra_powergate, genpd);
358}
359
David Brazdil0f672f62019-12-10 10:32:29 +0000360static u32 tegra_pmc_readl(struct tegra_pmc *pmc, unsigned long offset)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000361{
David Brazdil0f672f62019-12-10 10:32:29 +0000362 struct arm_smccc_res res;
363
364 if (pmc->tz_only) {
365 arm_smccc_smc(TEGRA_SMC_PMC, TEGRA_SMC_PMC_READ, offset, 0, 0,
366 0, 0, 0, &res);
367 if (res.a0) {
368 if (pmc->dev)
369 dev_warn(pmc->dev, "%s(): SMC failed: %lu\n",
370 __func__, res.a0);
371 else
372 pr_warn("%s(): SMC failed: %lu\n", __func__,
373 res.a0);
374 }
375
376 return res.a1;
377 }
378
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000379 return readl(pmc->base + offset);
380}
381
David Brazdil0f672f62019-12-10 10:32:29 +0000382static void tegra_pmc_writel(struct tegra_pmc *pmc, u32 value,
383 unsigned long offset)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000384{
David Brazdil0f672f62019-12-10 10:32:29 +0000385 struct arm_smccc_res res;
386
387 if (pmc->tz_only) {
388 arm_smccc_smc(TEGRA_SMC_PMC, TEGRA_SMC_PMC_WRITE, offset,
389 value, 0, 0, 0, 0, &res);
390 if (res.a0) {
391 if (pmc->dev)
392 dev_warn(pmc->dev, "%s(): SMC failed: %lu\n",
393 __func__, res.a0);
394 else
395 pr_warn("%s(): SMC failed: %lu\n", __func__,
396 res.a0);
397 }
398 } else {
399 writel(value, pmc->base + offset);
400 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000401}
402
David Brazdil0f672f62019-12-10 10:32:29 +0000403static u32 tegra_pmc_scratch_readl(struct tegra_pmc *pmc, unsigned long offset)
404{
405 if (pmc->tz_only)
406 return tegra_pmc_readl(pmc, offset);
407
408 return readl(pmc->scratch + offset);
409}
410
411static void tegra_pmc_scratch_writel(struct tegra_pmc *pmc, u32 value,
412 unsigned long offset)
413{
414 if (pmc->tz_only)
415 tegra_pmc_writel(pmc, value, offset);
416 else
417 writel(value, pmc->scratch + offset);
418}
419
420/*
421 * TODO Figure out a way to call this with the struct tegra_pmc * passed in.
422 * This currently doesn't work because readx_poll_timeout() can only operate
423 * on functions that take a single argument.
424 */
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000425static inline bool tegra_powergate_state(int id)
426{
427 if (id == TEGRA_POWERGATE_3D && pmc->soc->has_gpu_clamps)
David Brazdil0f672f62019-12-10 10:32:29 +0000428 return (tegra_pmc_readl(pmc, GPU_RG_CNTRL) & 0x1) == 0;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000429 else
David Brazdil0f672f62019-12-10 10:32:29 +0000430 return (tegra_pmc_readl(pmc, PWRGATE_STATUS) & BIT(id)) != 0;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000431}
432
David Brazdil0f672f62019-12-10 10:32:29 +0000433static inline bool tegra_powergate_is_valid(struct tegra_pmc *pmc, int id)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000434{
435 return (pmc->soc && pmc->soc->powergates[id]);
436}
437
David Brazdil0f672f62019-12-10 10:32:29 +0000438static inline bool tegra_powergate_is_available(struct tegra_pmc *pmc, int id)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000439{
440 return test_bit(id, pmc->powergates_available);
441}
442
443static int tegra_powergate_lookup(struct tegra_pmc *pmc, const char *name)
444{
445 unsigned int i;
446
447 if (!pmc || !pmc->soc || !name)
448 return -EINVAL;
449
450 for (i = 0; i < pmc->soc->num_powergates; i++) {
David Brazdil0f672f62019-12-10 10:32:29 +0000451 if (!tegra_powergate_is_valid(pmc, i))
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000452 continue;
453
454 if (!strcmp(name, pmc->soc->powergates[i]))
455 return i;
456 }
457
458 return -ENODEV;
459}
460
461/**
462 * tegra_powergate_set() - set the state of a partition
David Brazdil0f672f62019-12-10 10:32:29 +0000463 * @pmc: power management controller
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000464 * @id: partition ID
465 * @new_state: new state of the partition
466 */
David Brazdil0f672f62019-12-10 10:32:29 +0000467static int tegra_powergate_set(struct tegra_pmc *pmc, unsigned int id,
468 bool new_state)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000469{
470 bool status;
471 int err;
472
473 if (id == TEGRA_POWERGATE_3D && pmc->soc->has_gpu_clamps)
474 return -EINVAL;
475
476 mutex_lock(&pmc->powergates_lock);
477
478 if (tegra_powergate_state(id) == new_state) {
479 mutex_unlock(&pmc->powergates_lock);
480 return 0;
481 }
482
David Brazdil0f672f62019-12-10 10:32:29 +0000483 tegra_pmc_writel(pmc, PWRGATE_TOGGLE_START | id, PWRGATE_TOGGLE);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000484
485 err = readx_poll_timeout(tegra_powergate_state, id, status,
486 status == new_state, 10, 100000);
487
488 mutex_unlock(&pmc->powergates_lock);
489
490 return err;
491}
492
David Brazdil0f672f62019-12-10 10:32:29 +0000493static int __tegra_powergate_remove_clamping(struct tegra_pmc *pmc,
494 unsigned int id)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000495{
496 u32 mask;
497
498 mutex_lock(&pmc->powergates_lock);
499
500 /*
501 * On Tegra124 and later, the clamps for the GPU are controlled by a
502 * separate register (with different semantics).
503 */
504 if (id == TEGRA_POWERGATE_3D) {
505 if (pmc->soc->has_gpu_clamps) {
David Brazdil0f672f62019-12-10 10:32:29 +0000506 tegra_pmc_writel(pmc, 0, GPU_RG_CNTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000507 goto out;
508 }
509 }
510
511 /*
512 * Tegra 2 has a bug where PCIE and VDE clamping masks are
513 * swapped relatively to the partition ids
514 */
515 if (id == TEGRA_POWERGATE_VDEC)
516 mask = (1 << TEGRA_POWERGATE_PCIE);
517 else if (id == TEGRA_POWERGATE_PCIE)
518 mask = (1 << TEGRA_POWERGATE_VDEC);
519 else
520 mask = (1 << id);
521
David Brazdil0f672f62019-12-10 10:32:29 +0000522 tegra_pmc_writel(pmc, mask, REMOVE_CLAMPING);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000523
524out:
525 mutex_unlock(&pmc->powergates_lock);
526
527 return 0;
528}
529
530static void tegra_powergate_disable_clocks(struct tegra_powergate *pg)
531{
532 unsigned int i;
533
534 for (i = 0; i < pg->num_clks; i++)
535 clk_disable_unprepare(pg->clks[i]);
536}
537
538static int tegra_powergate_enable_clocks(struct tegra_powergate *pg)
539{
540 unsigned int i;
541 int err;
542
543 for (i = 0; i < pg->num_clks; i++) {
544 err = clk_prepare_enable(pg->clks[i]);
545 if (err)
546 goto out;
547 }
548
549 return 0;
550
551out:
552 while (i--)
553 clk_disable_unprepare(pg->clks[i]);
554
555 return err;
556}
557
558int __weak tegra210_clk_handle_mbist_war(unsigned int id)
559{
560 return 0;
561}
562
563static int tegra_powergate_power_up(struct tegra_powergate *pg,
564 bool disable_clocks)
565{
566 int err;
567
568 err = reset_control_assert(pg->reset);
569 if (err)
570 return err;
571
572 usleep_range(10, 20);
573
David Brazdil0f672f62019-12-10 10:32:29 +0000574 err = tegra_powergate_set(pg->pmc, pg->id, true);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000575 if (err < 0)
576 return err;
577
578 usleep_range(10, 20);
579
580 err = tegra_powergate_enable_clocks(pg);
581 if (err)
582 goto disable_clks;
583
584 usleep_range(10, 20);
585
David Brazdil0f672f62019-12-10 10:32:29 +0000586 err = __tegra_powergate_remove_clamping(pg->pmc, pg->id);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000587 if (err)
588 goto disable_clks;
589
590 usleep_range(10, 20);
591
592 err = reset_control_deassert(pg->reset);
593 if (err)
594 goto powergate_off;
595
596 usleep_range(10, 20);
597
598 if (pg->pmc->soc->needs_mbist_war)
599 err = tegra210_clk_handle_mbist_war(pg->id);
600 if (err)
601 goto disable_clks;
602
603 if (disable_clocks)
604 tegra_powergate_disable_clocks(pg);
605
606 return 0;
607
608disable_clks:
609 tegra_powergate_disable_clocks(pg);
610 usleep_range(10, 20);
611
612powergate_off:
David Brazdil0f672f62019-12-10 10:32:29 +0000613 tegra_powergate_set(pg->pmc, pg->id, false);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000614
615 return err;
616}
617
618static int tegra_powergate_power_down(struct tegra_powergate *pg)
619{
620 int err;
621
622 err = tegra_powergate_enable_clocks(pg);
623 if (err)
624 return err;
625
626 usleep_range(10, 20);
627
628 err = reset_control_assert(pg->reset);
629 if (err)
630 goto disable_clks;
631
632 usleep_range(10, 20);
633
634 tegra_powergate_disable_clocks(pg);
635
636 usleep_range(10, 20);
637
David Brazdil0f672f62019-12-10 10:32:29 +0000638 err = tegra_powergate_set(pg->pmc, pg->id, false);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000639 if (err)
640 goto assert_resets;
641
642 return 0;
643
644assert_resets:
645 tegra_powergate_enable_clocks(pg);
646 usleep_range(10, 20);
647 reset_control_deassert(pg->reset);
648 usleep_range(10, 20);
649
650disable_clks:
651 tegra_powergate_disable_clocks(pg);
652
653 return err;
654}
655
656static int tegra_genpd_power_on(struct generic_pm_domain *domain)
657{
658 struct tegra_powergate *pg = to_powergate(domain);
David Brazdil0f672f62019-12-10 10:32:29 +0000659 struct device *dev = pg->pmc->dev;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000660 int err;
661
662 err = tegra_powergate_power_up(pg, true);
David Brazdil0f672f62019-12-10 10:32:29 +0000663 if (err) {
664 dev_err(dev, "failed to turn on PM domain %s: %d\n",
665 pg->genpd.name, err);
666 goto out;
667 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000668
David Brazdil0f672f62019-12-10 10:32:29 +0000669 reset_control_release(pg->reset);
670
671out:
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000672 return err;
673}
674
675static int tegra_genpd_power_off(struct generic_pm_domain *domain)
676{
677 struct tegra_powergate *pg = to_powergate(domain);
David Brazdil0f672f62019-12-10 10:32:29 +0000678 struct device *dev = pg->pmc->dev;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000679 int err;
680
David Brazdil0f672f62019-12-10 10:32:29 +0000681 err = reset_control_acquire(pg->reset);
682 if (err < 0) {
683 pr_err("failed to acquire resets: %d\n", err);
684 return err;
685 }
686
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000687 err = tegra_powergate_power_down(pg);
David Brazdil0f672f62019-12-10 10:32:29 +0000688 if (err) {
689 dev_err(dev, "failed to turn off PM domain %s: %d\n",
690 pg->genpd.name, err);
691 reset_control_release(pg->reset);
692 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000693
694 return err;
695}
696
697/**
698 * tegra_powergate_power_on() - power on partition
699 * @id: partition ID
700 */
701int tegra_powergate_power_on(unsigned int id)
702{
David Brazdil0f672f62019-12-10 10:32:29 +0000703 if (!tegra_powergate_is_available(pmc, id))
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000704 return -EINVAL;
705
David Brazdil0f672f62019-12-10 10:32:29 +0000706 return tegra_powergate_set(pmc, id, true);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000707}
David Brazdil0f672f62019-12-10 10:32:29 +0000708EXPORT_SYMBOL(tegra_powergate_power_on);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000709
710/**
711 * tegra_powergate_power_off() - power off partition
712 * @id: partition ID
713 */
714int tegra_powergate_power_off(unsigned int id)
715{
David Brazdil0f672f62019-12-10 10:32:29 +0000716 if (!tegra_powergate_is_available(pmc, id))
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000717 return -EINVAL;
718
David Brazdil0f672f62019-12-10 10:32:29 +0000719 return tegra_powergate_set(pmc, id, false);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000720}
721EXPORT_SYMBOL(tegra_powergate_power_off);
722
723/**
724 * tegra_powergate_is_powered() - check if partition is powered
David Brazdil0f672f62019-12-10 10:32:29 +0000725 * @pmc: power management controller
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000726 * @id: partition ID
727 */
David Brazdil0f672f62019-12-10 10:32:29 +0000728static int tegra_powergate_is_powered(struct tegra_pmc *pmc, unsigned int id)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000729{
David Brazdil0f672f62019-12-10 10:32:29 +0000730 if (!tegra_powergate_is_valid(pmc, id))
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000731 return -EINVAL;
732
David Brazdil0f672f62019-12-10 10:32:29 +0000733 return tegra_powergate_state(id);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000734}
735
736/**
737 * tegra_powergate_remove_clamping() - remove power clamps for partition
738 * @id: partition ID
739 */
740int tegra_powergate_remove_clamping(unsigned int id)
741{
David Brazdil0f672f62019-12-10 10:32:29 +0000742 if (!tegra_powergate_is_available(pmc, id))
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000743 return -EINVAL;
744
David Brazdil0f672f62019-12-10 10:32:29 +0000745 return __tegra_powergate_remove_clamping(pmc, id);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000746}
747EXPORT_SYMBOL(tegra_powergate_remove_clamping);
748
749/**
750 * tegra_powergate_sequence_power_up() - power up partition
751 * @id: partition ID
752 * @clk: clock for partition
753 * @rst: reset for partition
754 *
755 * Must be called with clk disabled, and returns with clk enabled.
756 */
757int tegra_powergate_sequence_power_up(unsigned int id, struct clk *clk,
758 struct reset_control *rst)
759{
760 struct tegra_powergate *pg;
761 int err;
762
David Brazdil0f672f62019-12-10 10:32:29 +0000763 if (!tegra_powergate_is_available(pmc, id))
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000764 return -EINVAL;
765
766 pg = kzalloc(sizeof(*pg), GFP_KERNEL);
767 if (!pg)
768 return -ENOMEM;
769
770 pg->id = id;
771 pg->clks = &clk;
772 pg->num_clks = 1;
773 pg->reset = rst;
774 pg->pmc = pmc;
775
776 err = tegra_powergate_power_up(pg, false);
777 if (err)
David Brazdil0f672f62019-12-10 10:32:29 +0000778 dev_err(pmc->dev, "failed to turn on partition %d: %d\n", id,
779 err);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000780
781 kfree(pg);
782
783 return err;
784}
785EXPORT_SYMBOL(tegra_powergate_sequence_power_up);
786
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000787/**
788 * tegra_get_cpu_powergate_id() - convert from CPU ID to partition ID
David Brazdil0f672f62019-12-10 10:32:29 +0000789 * @pmc: power management controller
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000790 * @cpuid: CPU partition ID
791 *
792 * Returns the partition ID corresponding to the CPU partition ID or a
793 * negative error code on failure.
794 */
David Brazdil0f672f62019-12-10 10:32:29 +0000795static int tegra_get_cpu_powergate_id(struct tegra_pmc *pmc,
796 unsigned int cpuid)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000797{
798 if (pmc->soc && cpuid < pmc->soc->num_cpu_powergates)
799 return pmc->soc->cpu_powergates[cpuid];
800
801 return -EINVAL;
802}
803
804/**
805 * tegra_pmc_cpu_is_powered() - check if CPU partition is powered
806 * @cpuid: CPU partition ID
807 */
808bool tegra_pmc_cpu_is_powered(unsigned int cpuid)
809{
810 int id;
811
David Brazdil0f672f62019-12-10 10:32:29 +0000812 id = tegra_get_cpu_powergate_id(pmc, cpuid);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000813 if (id < 0)
814 return false;
815
David Brazdil0f672f62019-12-10 10:32:29 +0000816 return tegra_powergate_is_powered(pmc, id);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000817}
818
819/**
820 * tegra_pmc_cpu_power_on() - power on CPU partition
821 * @cpuid: CPU partition ID
822 */
823int tegra_pmc_cpu_power_on(unsigned int cpuid)
824{
825 int id;
826
David Brazdil0f672f62019-12-10 10:32:29 +0000827 id = tegra_get_cpu_powergate_id(pmc, cpuid);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000828 if (id < 0)
829 return id;
830
David Brazdil0f672f62019-12-10 10:32:29 +0000831 return tegra_powergate_set(pmc, id, true);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000832}
833
834/**
835 * tegra_pmc_cpu_remove_clamping() - remove power clamps for CPU partition
836 * @cpuid: CPU partition ID
837 */
838int tegra_pmc_cpu_remove_clamping(unsigned int cpuid)
839{
840 int id;
841
David Brazdil0f672f62019-12-10 10:32:29 +0000842 id = tegra_get_cpu_powergate_id(pmc, cpuid);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000843 if (id < 0)
844 return id;
845
846 return tegra_powergate_remove_clamping(id);
847}
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000848
849static int tegra_pmc_restart_notify(struct notifier_block *this,
850 unsigned long action, void *data)
851{
852 const char *cmd = data;
853 u32 value;
854
David Brazdil0f672f62019-12-10 10:32:29 +0000855 value = tegra_pmc_scratch_readl(pmc, pmc->soc->regs->scratch0);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000856 value &= ~PMC_SCRATCH0_MODE_MASK;
857
858 if (cmd) {
859 if (strcmp(cmd, "recovery") == 0)
860 value |= PMC_SCRATCH0_MODE_RECOVERY;
861
862 if (strcmp(cmd, "bootloader") == 0)
863 value |= PMC_SCRATCH0_MODE_BOOTLOADER;
864
865 if (strcmp(cmd, "forced-recovery") == 0)
866 value |= PMC_SCRATCH0_MODE_RCM;
867 }
868
David Brazdil0f672f62019-12-10 10:32:29 +0000869 tegra_pmc_scratch_writel(pmc, value, pmc->soc->regs->scratch0);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000870
871 /* reset everything but PMC_SCRATCH0 and PMC_RST_STATUS */
David Brazdil0f672f62019-12-10 10:32:29 +0000872 value = tegra_pmc_readl(pmc, PMC_CNTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000873 value |= PMC_CNTRL_MAIN_RST;
David Brazdil0f672f62019-12-10 10:32:29 +0000874 tegra_pmc_writel(pmc, value, PMC_CNTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000875
876 return NOTIFY_DONE;
877}
878
879static struct notifier_block tegra_pmc_restart_handler = {
880 .notifier_call = tegra_pmc_restart_notify,
881 .priority = 128,
882};
883
884static int powergate_show(struct seq_file *s, void *data)
885{
886 unsigned int i;
887 int status;
888
889 seq_printf(s, " powergate powered\n");
890 seq_printf(s, "------------------\n");
891
892 for (i = 0; i < pmc->soc->num_powergates; i++) {
David Brazdil0f672f62019-12-10 10:32:29 +0000893 status = tegra_powergate_is_powered(pmc, i);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000894 if (status < 0)
895 continue;
896
897 seq_printf(s, " %9s %7s\n", pmc->soc->powergates[i],
898 status ? "yes" : "no");
899 }
900
901 return 0;
902}
903
David Brazdil0f672f62019-12-10 10:32:29 +0000904DEFINE_SHOW_ATTRIBUTE(powergate);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000905
906static int tegra_powergate_debugfs_init(void)
907{
908 pmc->debugfs = debugfs_create_file("powergate", S_IRUGO, NULL, NULL,
909 &powergate_fops);
910 if (!pmc->debugfs)
911 return -ENOMEM;
912
913 return 0;
914}
915
916static int tegra_powergate_of_get_clks(struct tegra_powergate *pg,
917 struct device_node *np)
918{
919 struct clk *clk;
920 unsigned int i, count;
921 int err;
922
923 count = of_clk_get_parent_count(np);
924 if (count == 0)
925 return -ENODEV;
926
927 pg->clks = kcalloc(count, sizeof(clk), GFP_KERNEL);
928 if (!pg->clks)
929 return -ENOMEM;
930
931 for (i = 0; i < count; i++) {
932 pg->clks[i] = of_clk_get(np, i);
933 if (IS_ERR(pg->clks[i])) {
934 err = PTR_ERR(pg->clks[i]);
935 goto err;
936 }
937 }
938
939 pg->num_clks = count;
940
941 return 0;
942
943err:
944 while (i--)
945 clk_put(pg->clks[i]);
946
947 kfree(pg->clks);
948
949 return err;
950}
951
952static int tegra_powergate_of_get_resets(struct tegra_powergate *pg,
953 struct device_node *np, bool off)
954{
David Brazdil0f672f62019-12-10 10:32:29 +0000955 struct device *dev = pg->pmc->dev;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000956 int err;
957
David Brazdil0f672f62019-12-10 10:32:29 +0000958 pg->reset = of_reset_control_array_get_exclusive_released(np);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000959 if (IS_ERR(pg->reset)) {
960 err = PTR_ERR(pg->reset);
David Brazdil0f672f62019-12-10 10:32:29 +0000961 dev_err(dev, "failed to get device resets: %d\n", err);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000962 return err;
963 }
964
David Brazdil0f672f62019-12-10 10:32:29 +0000965 err = reset_control_acquire(pg->reset);
966 if (err < 0) {
967 pr_err("failed to acquire resets: %d\n", err);
968 goto out;
969 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000970
David Brazdil0f672f62019-12-10 10:32:29 +0000971 if (off) {
972 err = reset_control_assert(pg->reset);
973 } else {
974 err = reset_control_deassert(pg->reset);
975 if (err < 0)
976 goto out;
977
978 reset_control_release(pg->reset);
979 }
980
981out:
982 if (err) {
983 reset_control_release(pg->reset);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000984 reset_control_put(pg->reset);
David Brazdil0f672f62019-12-10 10:32:29 +0000985 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000986
987 return err;
988}
989
David Brazdil0f672f62019-12-10 10:32:29 +0000990static int tegra_powergate_add(struct tegra_pmc *pmc, struct device_node *np)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000991{
David Brazdil0f672f62019-12-10 10:32:29 +0000992 struct device *dev = pmc->dev;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000993 struct tegra_powergate *pg;
David Brazdil0f672f62019-12-10 10:32:29 +0000994 int id, err = 0;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000995 bool off;
996
997 pg = kzalloc(sizeof(*pg), GFP_KERNEL);
998 if (!pg)
David Brazdil0f672f62019-12-10 10:32:29 +0000999 return -ENOMEM;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001000
1001 id = tegra_powergate_lookup(pmc, np->name);
1002 if (id < 0) {
David Brazdil0f672f62019-12-10 10:32:29 +00001003 dev_err(dev, "powergate lookup failed for %pOFn: %d\n", np, id);
1004 err = -ENODEV;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001005 goto free_mem;
1006 }
1007
1008 /*
1009 * Clear the bit for this powergate so it cannot be managed
1010 * directly via the legacy APIs for controlling powergates.
1011 */
1012 clear_bit(id, pmc->powergates_available);
1013
1014 pg->id = id;
1015 pg->genpd.name = np->name;
1016 pg->genpd.power_off = tegra_genpd_power_off;
1017 pg->genpd.power_on = tegra_genpd_power_on;
1018 pg->pmc = pmc;
1019
David Brazdil0f672f62019-12-10 10:32:29 +00001020 off = !tegra_powergate_is_powered(pmc, pg->id);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001021
1022 err = tegra_powergate_of_get_clks(pg, np);
1023 if (err < 0) {
David Brazdil0f672f62019-12-10 10:32:29 +00001024 dev_err(dev, "failed to get clocks for %pOFn: %d\n", np, err);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001025 goto set_available;
1026 }
1027
1028 err = tegra_powergate_of_get_resets(pg, np, off);
1029 if (err < 0) {
David Brazdil0f672f62019-12-10 10:32:29 +00001030 dev_err(dev, "failed to get resets for %pOFn: %d\n", np, err);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001031 goto remove_clks;
1032 }
1033
1034 if (!IS_ENABLED(CONFIG_PM_GENERIC_DOMAINS)) {
1035 if (off)
1036 WARN_ON(tegra_powergate_power_up(pg, true));
1037
1038 goto remove_resets;
1039 }
1040
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001041 err = pm_genpd_init(&pg->genpd, NULL, off);
1042 if (err < 0) {
David Brazdil0f672f62019-12-10 10:32:29 +00001043 dev_err(dev, "failed to initialise PM domain %pOFn: %d\n", np,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001044 err);
1045 goto remove_resets;
1046 }
1047
1048 err = of_genpd_add_provider_simple(np, &pg->genpd);
1049 if (err < 0) {
David Brazdil0f672f62019-12-10 10:32:29 +00001050 dev_err(dev, "failed to add PM domain provider for %pOFn: %d\n",
1051 np, err);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001052 goto remove_genpd;
1053 }
1054
David Brazdil0f672f62019-12-10 10:32:29 +00001055 dev_dbg(dev, "added PM domain %s\n", pg->genpd.name);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001056
David Brazdil0f672f62019-12-10 10:32:29 +00001057 return 0;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001058
1059remove_genpd:
1060 pm_genpd_remove(&pg->genpd);
1061
1062remove_resets:
1063 reset_control_put(pg->reset);
1064
1065remove_clks:
1066 while (pg->num_clks--)
1067 clk_put(pg->clks[pg->num_clks]);
1068
1069 kfree(pg->clks);
1070
1071set_available:
1072 set_bit(id, pmc->powergates_available);
1073
1074free_mem:
1075 kfree(pg);
David Brazdil0f672f62019-12-10 10:32:29 +00001076
1077 return err;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001078}
1079
David Brazdil0f672f62019-12-10 10:32:29 +00001080static int tegra_powergate_init(struct tegra_pmc *pmc,
1081 struct device_node *parent)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001082{
1083 struct device_node *np, *child;
David Brazdil0f672f62019-12-10 10:32:29 +00001084 int err = 0;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001085
David Brazdil0f672f62019-12-10 10:32:29 +00001086 np = of_get_child_by_name(parent, "powergates");
1087 if (!np)
1088 return 0;
1089
1090 for_each_child_of_node(np, child) {
1091 err = tegra_powergate_add(pmc, child);
1092 if (err < 0) {
1093 of_node_put(child);
1094 break;
1095 }
1096 }
1097
1098 of_node_put(np);
1099
1100 return err;
1101}
1102
1103static void tegra_powergate_remove(struct generic_pm_domain *genpd)
1104{
1105 struct tegra_powergate *pg = to_powergate(genpd);
1106
1107 reset_control_put(pg->reset);
1108
1109 while (pg->num_clks--)
1110 clk_put(pg->clks[pg->num_clks]);
1111
1112 kfree(pg->clks);
1113
1114 set_bit(pg->id, pmc->powergates_available);
1115
1116 kfree(pg);
1117}
1118
1119static void tegra_powergate_remove_all(struct device_node *parent)
1120{
1121 struct generic_pm_domain *genpd;
1122 struct device_node *np, *child;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001123
1124 np = of_get_child_by_name(parent, "powergates");
1125 if (!np)
1126 return;
1127
David Brazdil0f672f62019-12-10 10:32:29 +00001128 for_each_child_of_node(np, child) {
1129 of_genpd_del_provider(child);
1130
1131 genpd = of_genpd_remove_last(child);
1132 if (IS_ERR(genpd))
1133 continue;
1134
1135 tegra_powergate_remove(genpd);
1136 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001137
1138 of_node_put(np);
1139}
1140
1141static const struct tegra_io_pad_soc *
1142tegra_io_pad_find(struct tegra_pmc *pmc, enum tegra_io_pad id)
1143{
1144 unsigned int i;
1145
1146 for (i = 0; i < pmc->soc->num_io_pads; i++)
1147 if (pmc->soc->io_pads[i].id == id)
1148 return &pmc->soc->io_pads[i];
1149
1150 return NULL;
1151}
1152
David Brazdil0f672f62019-12-10 10:32:29 +00001153static int tegra_io_pad_get_dpd_register_bit(struct tegra_pmc *pmc,
1154 enum tegra_io_pad id,
1155 unsigned long *request,
1156 unsigned long *status,
1157 u32 *mask)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001158{
1159 const struct tegra_io_pad_soc *pad;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001160
1161 pad = tegra_io_pad_find(pmc, id);
1162 if (!pad) {
David Brazdil0f672f62019-12-10 10:32:29 +00001163 dev_err(pmc->dev, "invalid I/O pad ID %u\n", id);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001164 return -ENOENT;
1165 }
1166
1167 if (pad->dpd == UINT_MAX)
1168 return -ENOTSUPP;
1169
1170 *mask = BIT(pad->dpd % 32);
1171
1172 if (pad->dpd < 32) {
1173 *status = pmc->soc->regs->dpd_status;
1174 *request = pmc->soc->regs->dpd_req;
1175 } else {
1176 *status = pmc->soc->regs->dpd2_status;
1177 *request = pmc->soc->regs->dpd2_req;
1178 }
1179
David Brazdil0f672f62019-12-10 10:32:29 +00001180 return 0;
1181}
1182
1183static int tegra_io_pad_prepare(struct tegra_pmc *pmc, enum tegra_io_pad id,
1184 unsigned long *request, unsigned long *status,
1185 u32 *mask)
1186{
1187 unsigned long rate, value;
1188 int err;
1189
1190 err = tegra_io_pad_get_dpd_register_bit(pmc, id, request, status, mask);
1191 if (err)
1192 return err;
1193
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001194 if (pmc->clk) {
1195 rate = clk_get_rate(pmc->clk);
1196 if (!rate) {
David Brazdil0f672f62019-12-10 10:32:29 +00001197 dev_err(pmc->dev, "failed to get clock rate\n");
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001198 return -ENODEV;
1199 }
1200
David Brazdil0f672f62019-12-10 10:32:29 +00001201 tegra_pmc_writel(pmc, DPD_SAMPLE_ENABLE, DPD_SAMPLE);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001202
1203 /* must be at least 200 ns, in APB (PCLK) clock cycles */
1204 value = DIV_ROUND_UP(1000000000, rate);
1205 value = DIV_ROUND_UP(200, value);
David Brazdil0f672f62019-12-10 10:32:29 +00001206 tegra_pmc_writel(pmc, value, SEL_DPD_TIM);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001207 }
1208
1209 return 0;
1210}
1211
David Brazdil0f672f62019-12-10 10:32:29 +00001212static int tegra_io_pad_poll(struct tegra_pmc *pmc, unsigned long offset,
1213 u32 mask, u32 val, unsigned long timeout)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001214{
1215 u32 value;
1216
1217 timeout = jiffies + msecs_to_jiffies(timeout);
1218
1219 while (time_after(timeout, jiffies)) {
David Brazdil0f672f62019-12-10 10:32:29 +00001220 value = tegra_pmc_readl(pmc, offset);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001221 if ((value & mask) == val)
1222 return 0;
1223
1224 usleep_range(250, 1000);
1225 }
1226
1227 return -ETIMEDOUT;
1228}
1229
David Brazdil0f672f62019-12-10 10:32:29 +00001230static void tegra_io_pad_unprepare(struct tegra_pmc *pmc)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001231{
1232 if (pmc->clk)
David Brazdil0f672f62019-12-10 10:32:29 +00001233 tegra_pmc_writel(pmc, DPD_SAMPLE_DISABLE, DPD_SAMPLE);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001234}
1235
1236/**
1237 * tegra_io_pad_power_enable() - enable power to I/O pad
1238 * @id: Tegra I/O pad ID for which to enable power
1239 *
1240 * Returns: 0 on success or a negative error code on failure.
1241 */
1242int tegra_io_pad_power_enable(enum tegra_io_pad id)
1243{
1244 unsigned long request, status;
1245 u32 mask;
1246 int err;
1247
1248 mutex_lock(&pmc->powergates_lock);
1249
David Brazdil0f672f62019-12-10 10:32:29 +00001250 err = tegra_io_pad_prepare(pmc, id, &request, &status, &mask);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001251 if (err < 0) {
David Brazdil0f672f62019-12-10 10:32:29 +00001252 dev_err(pmc->dev, "failed to prepare I/O pad: %d\n", err);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001253 goto unlock;
1254 }
1255
David Brazdil0f672f62019-12-10 10:32:29 +00001256 tegra_pmc_writel(pmc, IO_DPD_REQ_CODE_OFF | mask, request);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001257
David Brazdil0f672f62019-12-10 10:32:29 +00001258 err = tegra_io_pad_poll(pmc, status, mask, 0, 250);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001259 if (err < 0) {
David Brazdil0f672f62019-12-10 10:32:29 +00001260 dev_err(pmc->dev, "failed to enable I/O pad: %d\n", err);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001261 goto unlock;
1262 }
1263
David Brazdil0f672f62019-12-10 10:32:29 +00001264 tegra_io_pad_unprepare(pmc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001265
1266unlock:
1267 mutex_unlock(&pmc->powergates_lock);
1268 return err;
1269}
1270EXPORT_SYMBOL(tegra_io_pad_power_enable);
1271
1272/**
1273 * tegra_io_pad_power_disable() - disable power to I/O pad
1274 * @id: Tegra I/O pad ID for which to disable power
1275 *
1276 * Returns: 0 on success or a negative error code on failure.
1277 */
1278int tegra_io_pad_power_disable(enum tegra_io_pad id)
1279{
1280 unsigned long request, status;
1281 u32 mask;
1282 int err;
1283
1284 mutex_lock(&pmc->powergates_lock);
1285
David Brazdil0f672f62019-12-10 10:32:29 +00001286 err = tegra_io_pad_prepare(pmc, id, &request, &status, &mask);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001287 if (err < 0) {
David Brazdil0f672f62019-12-10 10:32:29 +00001288 dev_err(pmc->dev, "failed to prepare I/O pad: %d\n", err);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001289 goto unlock;
1290 }
1291
David Brazdil0f672f62019-12-10 10:32:29 +00001292 tegra_pmc_writel(pmc, IO_DPD_REQ_CODE_ON | mask, request);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001293
David Brazdil0f672f62019-12-10 10:32:29 +00001294 err = tegra_io_pad_poll(pmc, status, mask, mask, 250);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001295 if (err < 0) {
David Brazdil0f672f62019-12-10 10:32:29 +00001296 dev_err(pmc->dev, "failed to disable I/O pad: %d\n", err);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001297 goto unlock;
1298 }
1299
David Brazdil0f672f62019-12-10 10:32:29 +00001300 tegra_io_pad_unprepare(pmc);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001301
1302unlock:
1303 mutex_unlock(&pmc->powergates_lock);
1304 return err;
1305}
1306EXPORT_SYMBOL(tegra_io_pad_power_disable);
1307
David Brazdil0f672f62019-12-10 10:32:29 +00001308static int tegra_io_pad_is_powered(struct tegra_pmc *pmc, enum tegra_io_pad id)
1309{
1310 unsigned long request, status;
1311 u32 mask, value;
1312 int err;
1313
1314 err = tegra_io_pad_get_dpd_register_bit(pmc, id, &request, &status,
1315 &mask);
1316 if (err)
1317 return err;
1318
1319 value = tegra_pmc_readl(pmc, status);
1320
1321 return !(value & mask);
1322}
1323
1324static int tegra_io_pad_set_voltage(struct tegra_pmc *pmc, enum tegra_io_pad id,
1325 int voltage)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001326{
1327 const struct tegra_io_pad_soc *pad;
1328 u32 value;
1329
1330 pad = tegra_io_pad_find(pmc, id);
1331 if (!pad)
1332 return -ENOENT;
1333
1334 if (pad->voltage == UINT_MAX)
1335 return -ENOTSUPP;
1336
1337 mutex_lock(&pmc->powergates_lock);
1338
David Brazdil0f672f62019-12-10 10:32:29 +00001339 if (pmc->soc->has_impl_33v_pwr) {
1340 value = tegra_pmc_readl(pmc, PMC_IMPL_E_33V_PWR);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001341
David Brazdil0f672f62019-12-10 10:32:29 +00001342 if (voltage == TEGRA_IO_PAD_VOLTAGE_1V8)
1343 value &= ~BIT(pad->voltage);
1344 else
1345 value |= BIT(pad->voltage);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001346
David Brazdil0f672f62019-12-10 10:32:29 +00001347 tegra_pmc_writel(pmc, value, PMC_IMPL_E_33V_PWR);
1348 } else {
1349 /* write-enable PMC_PWR_DET_VALUE[pad->voltage] */
1350 value = tegra_pmc_readl(pmc, PMC_PWR_DET);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001351 value |= BIT(pad->voltage);
David Brazdil0f672f62019-12-10 10:32:29 +00001352 tegra_pmc_writel(pmc, value, PMC_PWR_DET);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001353
David Brazdil0f672f62019-12-10 10:32:29 +00001354 /* update I/O voltage */
1355 value = tegra_pmc_readl(pmc, PMC_PWR_DET_VALUE);
1356
1357 if (voltage == TEGRA_IO_PAD_VOLTAGE_1V8)
1358 value &= ~BIT(pad->voltage);
1359 else
1360 value |= BIT(pad->voltage);
1361
1362 tegra_pmc_writel(pmc, value, PMC_PWR_DET_VALUE);
1363 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001364
1365 mutex_unlock(&pmc->powergates_lock);
1366
1367 usleep_range(100, 250);
1368
1369 return 0;
1370}
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001371
David Brazdil0f672f62019-12-10 10:32:29 +00001372static int tegra_io_pad_get_voltage(struct tegra_pmc *pmc, enum tegra_io_pad id)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001373{
1374 const struct tegra_io_pad_soc *pad;
1375 u32 value;
1376
1377 pad = tegra_io_pad_find(pmc, id);
1378 if (!pad)
1379 return -ENOENT;
1380
1381 if (pad->voltage == UINT_MAX)
1382 return -ENOTSUPP;
1383
David Brazdil0f672f62019-12-10 10:32:29 +00001384 if (pmc->soc->has_impl_33v_pwr)
1385 value = tegra_pmc_readl(pmc, PMC_IMPL_E_33V_PWR);
1386 else
1387 value = tegra_pmc_readl(pmc, PMC_PWR_DET_VALUE);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001388
1389 if ((value & BIT(pad->voltage)) == 0)
David Brazdil0f672f62019-12-10 10:32:29 +00001390 return TEGRA_IO_PAD_VOLTAGE_1V8;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001391
David Brazdil0f672f62019-12-10 10:32:29 +00001392 return TEGRA_IO_PAD_VOLTAGE_3V3;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001393}
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001394
1395/**
1396 * tegra_io_rail_power_on() - enable power to I/O rail
1397 * @id: Tegra I/O pad ID for which to enable power
1398 *
1399 * See also: tegra_io_pad_power_enable()
1400 */
1401int tegra_io_rail_power_on(unsigned int id)
1402{
1403 return tegra_io_pad_power_enable(id);
1404}
1405EXPORT_SYMBOL(tegra_io_rail_power_on);
1406
1407/**
1408 * tegra_io_rail_power_off() - disable power to I/O rail
1409 * @id: Tegra I/O pad ID for which to disable power
1410 *
1411 * See also: tegra_io_pad_power_disable()
1412 */
1413int tegra_io_rail_power_off(unsigned int id)
1414{
1415 return tegra_io_pad_power_disable(id);
1416}
1417EXPORT_SYMBOL(tegra_io_rail_power_off);
1418
1419#ifdef CONFIG_PM_SLEEP
1420enum tegra_suspend_mode tegra_pmc_get_suspend_mode(void)
1421{
1422 return pmc->suspend_mode;
1423}
1424
1425void tegra_pmc_set_suspend_mode(enum tegra_suspend_mode mode)
1426{
1427 if (mode < TEGRA_SUSPEND_NONE || mode >= TEGRA_MAX_SUSPEND_MODE)
1428 return;
1429
1430 pmc->suspend_mode = mode;
1431}
1432
1433void tegra_pmc_enter_suspend_mode(enum tegra_suspend_mode mode)
1434{
1435 unsigned long long rate = 0;
1436 u32 value;
1437
1438 switch (mode) {
1439 case TEGRA_SUSPEND_LP1:
1440 rate = 32768;
1441 break;
1442
1443 case TEGRA_SUSPEND_LP2:
1444 rate = clk_get_rate(pmc->clk);
1445 break;
1446
1447 default:
1448 break;
1449 }
1450
1451 if (WARN_ON_ONCE(rate == 0))
1452 rate = 100000000;
1453
1454 if (rate != pmc->rate) {
1455 u64 ticks;
1456
1457 ticks = pmc->cpu_good_time * rate + USEC_PER_SEC - 1;
1458 do_div(ticks, USEC_PER_SEC);
David Brazdil0f672f62019-12-10 10:32:29 +00001459 tegra_pmc_writel(pmc, ticks, PMC_CPUPWRGOOD_TIMER);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001460
1461 ticks = pmc->cpu_off_time * rate + USEC_PER_SEC - 1;
1462 do_div(ticks, USEC_PER_SEC);
David Brazdil0f672f62019-12-10 10:32:29 +00001463 tegra_pmc_writel(pmc, ticks, PMC_CPUPWROFF_TIMER);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001464
1465 wmb();
1466
1467 pmc->rate = rate;
1468 }
1469
David Brazdil0f672f62019-12-10 10:32:29 +00001470 value = tegra_pmc_readl(pmc, PMC_CNTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001471 value &= ~PMC_CNTRL_SIDE_EFFECT_LP0;
1472 value |= PMC_CNTRL_CPU_PWRREQ_OE;
David Brazdil0f672f62019-12-10 10:32:29 +00001473 tegra_pmc_writel(pmc, value, PMC_CNTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001474}
1475#endif
1476
1477static int tegra_pmc_parse_dt(struct tegra_pmc *pmc, struct device_node *np)
1478{
1479 u32 value, values[2];
1480
1481 if (of_property_read_u32(np, "nvidia,suspend-mode", &value)) {
1482 } else {
1483 switch (value) {
1484 case 0:
1485 pmc->suspend_mode = TEGRA_SUSPEND_LP0;
1486 break;
1487
1488 case 1:
1489 pmc->suspend_mode = TEGRA_SUSPEND_LP1;
1490 break;
1491
1492 case 2:
1493 pmc->suspend_mode = TEGRA_SUSPEND_LP2;
1494 break;
1495
1496 default:
1497 pmc->suspend_mode = TEGRA_SUSPEND_NONE;
1498 break;
1499 }
1500 }
1501
1502 pmc->suspend_mode = tegra_pm_validate_suspend_mode(pmc->suspend_mode);
1503
1504 if (of_property_read_u32(np, "nvidia,cpu-pwr-good-time", &value))
1505 pmc->suspend_mode = TEGRA_SUSPEND_NONE;
1506
1507 pmc->cpu_good_time = value;
1508
1509 if (of_property_read_u32(np, "nvidia,cpu-pwr-off-time", &value))
1510 pmc->suspend_mode = TEGRA_SUSPEND_NONE;
1511
1512 pmc->cpu_off_time = value;
1513
1514 if (of_property_read_u32_array(np, "nvidia,core-pwr-good-time",
1515 values, ARRAY_SIZE(values)))
1516 pmc->suspend_mode = TEGRA_SUSPEND_NONE;
1517
1518 pmc->core_osc_time = values[0];
1519 pmc->core_pmu_time = values[1];
1520
1521 if (of_property_read_u32(np, "nvidia,core-pwr-off-time", &value))
1522 pmc->suspend_mode = TEGRA_SUSPEND_NONE;
1523
1524 pmc->core_off_time = value;
1525
1526 pmc->corereq_high = of_property_read_bool(np,
1527 "nvidia,core-power-req-active-high");
1528
1529 pmc->sysclkreq_high = of_property_read_bool(np,
1530 "nvidia,sys-clock-req-active-high");
1531
1532 pmc->combined_req = of_property_read_bool(np,
1533 "nvidia,combined-power-req");
1534
1535 pmc->cpu_pwr_good_en = of_property_read_bool(np,
1536 "nvidia,cpu-pwr-good-en");
1537
1538 if (of_property_read_u32_array(np, "nvidia,lp0-vec", values,
1539 ARRAY_SIZE(values)))
1540 if (pmc->suspend_mode == TEGRA_SUSPEND_LP0)
1541 pmc->suspend_mode = TEGRA_SUSPEND_LP1;
1542
1543 pmc->lp0_vec_phys = values[0];
1544 pmc->lp0_vec_size = values[1];
1545
1546 return 0;
1547}
1548
1549static void tegra_pmc_init(struct tegra_pmc *pmc)
1550{
1551 if (pmc->soc->init)
1552 pmc->soc->init(pmc);
1553}
1554
1555static void tegra_pmc_init_tsense_reset(struct tegra_pmc *pmc)
1556{
1557 static const char disabled[] = "emergency thermal reset disabled";
1558 u32 pmu_addr, ctrl_id, reg_addr, reg_data, pinmux;
1559 struct device *dev = pmc->dev;
1560 struct device_node *np;
1561 u32 value, checksum;
1562
1563 if (!pmc->soc->has_tsense_reset)
1564 return;
1565
1566 np = of_get_child_by_name(pmc->dev->of_node, "i2c-thermtrip");
1567 if (!np) {
1568 dev_warn(dev, "i2c-thermtrip node not found, %s.\n", disabled);
1569 return;
1570 }
1571
1572 if (of_property_read_u32(np, "nvidia,i2c-controller-id", &ctrl_id)) {
1573 dev_err(dev, "I2C controller ID missing, %s.\n", disabled);
1574 goto out;
1575 }
1576
1577 if (of_property_read_u32(np, "nvidia,bus-addr", &pmu_addr)) {
1578 dev_err(dev, "nvidia,bus-addr missing, %s.\n", disabled);
1579 goto out;
1580 }
1581
1582 if (of_property_read_u32(np, "nvidia,reg-addr", &reg_addr)) {
1583 dev_err(dev, "nvidia,reg-addr missing, %s.\n", disabled);
1584 goto out;
1585 }
1586
1587 if (of_property_read_u32(np, "nvidia,reg-data", &reg_data)) {
1588 dev_err(dev, "nvidia,reg-data missing, %s.\n", disabled);
1589 goto out;
1590 }
1591
1592 if (of_property_read_u32(np, "nvidia,pinmux-id", &pinmux))
1593 pinmux = 0;
1594
David Brazdil0f672f62019-12-10 10:32:29 +00001595 value = tegra_pmc_readl(pmc, PMC_SENSOR_CTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001596 value |= PMC_SENSOR_CTRL_SCRATCH_WRITE;
David Brazdil0f672f62019-12-10 10:32:29 +00001597 tegra_pmc_writel(pmc, value, PMC_SENSOR_CTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001598
1599 value = (reg_data << PMC_SCRATCH54_DATA_SHIFT) |
1600 (reg_addr << PMC_SCRATCH54_ADDR_SHIFT);
David Brazdil0f672f62019-12-10 10:32:29 +00001601 tegra_pmc_writel(pmc, value, PMC_SCRATCH54);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001602
1603 value = PMC_SCRATCH55_RESET_TEGRA;
1604 value |= ctrl_id << PMC_SCRATCH55_CNTRL_ID_SHIFT;
1605 value |= pinmux << PMC_SCRATCH55_PINMUX_SHIFT;
1606 value |= pmu_addr << PMC_SCRATCH55_I2CSLV1_SHIFT;
1607
1608 /*
1609 * Calculate checksum of SCRATCH54, SCRATCH55 fields. Bits 23:16 will
1610 * contain the checksum and are currently zero, so they are not added.
1611 */
1612 checksum = reg_addr + reg_data + (value & 0xff) + ((value >> 8) & 0xff)
1613 + ((value >> 24) & 0xff);
1614 checksum &= 0xff;
1615 checksum = 0x100 - checksum;
1616
1617 value |= checksum << PMC_SCRATCH55_CHECKSUM_SHIFT;
1618
David Brazdil0f672f62019-12-10 10:32:29 +00001619 tegra_pmc_writel(pmc, value, PMC_SCRATCH55);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001620
David Brazdil0f672f62019-12-10 10:32:29 +00001621 value = tegra_pmc_readl(pmc, PMC_SENSOR_CTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001622 value |= PMC_SENSOR_CTRL_ENABLE_RST;
David Brazdil0f672f62019-12-10 10:32:29 +00001623 tegra_pmc_writel(pmc, value, PMC_SENSOR_CTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001624
1625 dev_info(pmc->dev, "emergency thermal reset enabled\n");
1626
1627out:
1628 of_node_put(np);
1629}
1630
David Brazdil0f672f62019-12-10 10:32:29 +00001631static int tegra_io_pad_pinctrl_get_groups_count(struct pinctrl_dev *pctl_dev)
1632{
1633 struct tegra_pmc *pmc = pinctrl_dev_get_drvdata(pctl_dev);
1634
1635 return pmc->soc->num_io_pads;
1636}
1637
1638static const char *tegra_io_pad_pinctrl_get_group_name(struct pinctrl_dev *pctl,
1639 unsigned int group)
1640{
1641 struct tegra_pmc *pmc = pinctrl_dev_get_drvdata(pctl);
1642
1643 return pmc->soc->io_pads[group].name;
1644}
1645
1646static int tegra_io_pad_pinctrl_get_group_pins(struct pinctrl_dev *pctl_dev,
1647 unsigned int group,
1648 const unsigned int **pins,
1649 unsigned int *num_pins)
1650{
1651 struct tegra_pmc *pmc = pinctrl_dev_get_drvdata(pctl_dev);
1652
1653 *pins = &pmc->soc->io_pads[group].id;
1654 *num_pins = 1;
1655
1656 return 0;
1657}
1658
1659static const struct pinctrl_ops tegra_io_pad_pinctrl_ops = {
1660 .get_groups_count = tegra_io_pad_pinctrl_get_groups_count,
1661 .get_group_name = tegra_io_pad_pinctrl_get_group_name,
1662 .get_group_pins = tegra_io_pad_pinctrl_get_group_pins,
1663 .dt_node_to_map = pinconf_generic_dt_node_to_map_pin,
1664 .dt_free_map = pinconf_generic_dt_free_map,
1665};
1666
1667static int tegra_io_pad_pinconf_get(struct pinctrl_dev *pctl_dev,
1668 unsigned int pin, unsigned long *config)
1669{
1670 enum pin_config_param param = pinconf_to_config_param(*config);
1671 struct tegra_pmc *pmc = pinctrl_dev_get_drvdata(pctl_dev);
1672 const struct tegra_io_pad_soc *pad;
1673 int ret;
1674 u32 arg;
1675
1676 pad = tegra_io_pad_find(pmc, pin);
1677 if (!pad)
1678 return -EINVAL;
1679
1680 switch (param) {
1681 case PIN_CONFIG_POWER_SOURCE:
1682 ret = tegra_io_pad_get_voltage(pmc, pad->id);
1683 if (ret < 0)
1684 return ret;
1685
1686 arg = ret;
1687 break;
1688
1689 case PIN_CONFIG_LOW_POWER_MODE:
1690 ret = tegra_io_pad_is_powered(pmc, pad->id);
1691 if (ret < 0)
1692 return ret;
1693
1694 arg = !ret;
1695 break;
1696
1697 default:
1698 return -EINVAL;
1699 }
1700
1701 *config = pinconf_to_config_packed(param, arg);
1702
1703 return 0;
1704}
1705
1706static int tegra_io_pad_pinconf_set(struct pinctrl_dev *pctl_dev,
1707 unsigned int pin, unsigned long *configs,
1708 unsigned int num_configs)
1709{
1710 struct tegra_pmc *pmc = pinctrl_dev_get_drvdata(pctl_dev);
1711 const struct tegra_io_pad_soc *pad;
1712 enum pin_config_param param;
1713 unsigned int i;
1714 int err;
1715 u32 arg;
1716
1717 pad = tegra_io_pad_find(pmc, pin);
1718 if (!pad)
1719 return -EINVAL;
1720
1721 for (i = 0; i < num_configs; ++i) {
1722 param = pinconf_to_config_param(configs[i]);
1723 arg = pinconf_to_config_argument(configs[i]);
1724
1725 switch (param) {
1726 case PIN_CONFIG_LOW_POWER_MODE:
1727 if (arg)
1728 err = tegra_io_pad_power_disable(pad->id);
1729 else
1730 err = tegra_io_pad_power_enable(pad->id);
1731 if (err)
1732 return err;
1733 break;
1734 case PIN_CONFIG_POWER_SOURCE:
1735 if (arg != TEGRA_IO_PAD_VOLTAGE_1V8 &&
1736 arg != TEGRA_IO_PAD_VOLTAGE_3V3)
1737 return -EINVAL;
1738 err = tegra_io_pad_set_voltage(pmc, pad->id, arg);
1739 if (err)
1740 return err;
1741 break;
1742 default:
1743 return -EINVAL;
1744 }
1745 }
1746
1747 return 0;
1748}
1749
1750static const struct pinconf_ops tegra_io_pad_pinconf_ops = {
1751 .pin_config_get = tegra_io_pad_pinconf_get,
1752 .pin_config_set = tegra_io_pad_pinconf_set,
1753 .is_generic = true,
1754};
1755
1756static struct pinctrl_desc tegra_pmc_pctl_desc = {
1757 .pctlops = &tegra_io_pad_pinctrl_ops,
1758 .confops = &tegra_io_pad_pinconf_ops,
1759};
1760
1761static int tegra_pmc_pinctrl_init(struct tegra_pmc *pmc)
1762{
1763 int err;
1764
1765 if (!pmc->soc->num_pin_descs)
1766 return 0;
1767
1768 tegra_pmc_pctl_desc.name = dev_name(pmc->dev);
1769 tegra_pmc_pctl_desc.pins = pmc->soc->pin_descs;
1770 tegra_pmc_pctl_desc.npins = pmc->soc->num_pin_descs;
1771
1772 pmc->pctl_dev = devm_pinctrl_register(pmc->dev, &tegra_pmc_pctl_desc,
1773 pmc);
1774 if (IS_ERR(pmc->pctl_dev)) {
1775 err = PTR_ERR(pmc->pctl_dev);
1776 dev_err(pmc->dev, "failed to register pin controller: %d\n",
1777 err);
1778 return err;
1779 }
1780
1781 return 0;
1782}
1783
1784static ssize_t reset_reason_show(struct device *dev,
1785 struct device_attribute *attr, char *buf)
1786{
1787 u32 value;
1788
1789 value = tegra_pmc_readl(pmc, pmc->soc->regs->rst_status);
1790 value &= pmc->soc->regs->rst_source_mask;
1791 value >>= pmc->soc->regs->rst_source_shift;
1792
1793 if (WARN_ON(value >= pmc->soc->num_reset_sources))
1794 return sprintf(buf, "%s\n", "UNKNOWN");
1795
1796 return sprintf(buf, "%s\n", pmc->soc->reset_sources[value]);
1797}
1798
1799static DEVICE_ATTR_RO(reset_reason);
1800
1801static ssize_t reset_level_show(struct device *dev,
1802 struct device_attribute *attr, char *buf)
1803{
1804 u32 value;
1805
1806 value = tegra_pmc_readl(pmc, pmc->soc->regs->rst_status);
1807 value &= pmc->soc->regs->rst_level_mask;
1808 value >>= pmc->soc->regs->rst_level_shift;
1809
1810 if (WARN_ON(value >= pmc->soc->num_reset_levels))
1811 return sprintf(buf, "%s\n", "UNKNOWN");
1812
1813 return sprintf(buf, "%s\n", pmc->soc->reset_levels[value]);
1814}
1815
1816static DEVICE_ATTR_RO(reset_level);
1817
1818static void tegra_pmc_reset_sysfs_init(struct tegra_pmc *pmc)
1819{
1820 struct device *dev = pmc->dev;
1821 int err = 0;
1822
1823 if (pmc->soc->reset_sources) {
1824 err = device_create_file(dev, &dev_attr_reset_reason);
1825 if (err < 0)
1826 dev_warn(dev,
1827 "failed to create attr \"reset_reason\": %d\n",
1828 err);
1829 }
1830
1831 if (pmc->soc->reset_levels) {
1832 err = device_create_file(dev, &dev_attr_reset_level);
1833 if (err < 0)
1834 dev_warn(dev,
1835 "failed to create attr \"reset_level\": %d\n",
1836 err);
1837 }
1838}
1839
1840static int tegra_pmc_irq_translate(struct irq_domain *domain,
1841 struct irq_fwspec *fwspec,
1842 unsigned long *hwirq,
1843 unsigned int *type)
1844{
1845 if (WARN_ON(fwspec->param_count < 2))
1846 return -EINVAL;
1847
1848 *hwirq = fwspec->param[0];
1849 *type = fwspec->param[1];
1850
1851 return 0;
1852}
1853
1854static int tegra_pmc_irq_alloc(struct irq_domain *domain, unsigned int virq,
1855 unsigned int num_irqs, void *data)
1856{
1857 struct tegra_pmc *pmc = domain->host_data;
1858 const struct tegra_pmc_soc *soc = pmc->soc;
1859 struct irq_fwspec *fwspec = data;
1860 unsigned int i;
1861 int err = 0;
1862
1863 if (WARN_ON(num_irqs > 1))
1864 return -EINVAL;
1865
1866 for (i = 0; i < soc->num_wake_events; i++) {
1867 const struct tegra_wake_event *event = &soc->wake_events[i];
1868
1869 if (fwspec->param_count == 2) {
1870 struct irq_fwspec spec;
1871
1872 if (event->id != fwspec->param[0])
1873 continue;
1874
1875 err = irq_domain_set_hwirq_and_chip(domain, virq,
1876 event->id,
1877 &pmc->irq, pmc);
1878 if (err < 0)
1879 break;
1880
1881 spec.fwnode = &pmc->dev->of_node->fwnode;
1882 spec.param_count = 3;
1883 spec.param[0] = GIC_SPI;
1884 spec.param[1] = event->irq;
1885 spec.param[2] = fwspec->param[1];
1886
1887 err = irq_domain_alloc_irqs_parent(domain, virq,
1888 num_irqs, &spec);
1889
1890 break;
1891 }
1892
1893 if (fwspec->param_count == 3) {
1894 if (event->gpio.instance != fwspec->param[0] ||
1895 event->gpio.pin != fwspec->param[1])
1896 continue;
1897
1898 err = irq_domain_set_hwirq_and_chip(domain, virq,
1899 event->id,
1900 &pmc->irq, pmc);
1901
Olivier Deprez0e641232021-09-23 10:07:05 +02001902 /*
1903 * GPIOs don't have an equivalent interrupt in the
1904 * parent controller (GIC). However some code, such
1905 * as the one in irq_get_irqchip_state(), require a
1906 * valid IRQ chip to be set. Make sure that's the
1907 * case by passing NULL here, which will install a
1908 * dummy IRQ chip for the interrupt in the parent
1909 * domain.
1910 */
1911 if (domain->parent)
1912 irq_domain_set_hwirq_and_chip(domain->parent,
1913 virq, 0, NULL,
1914 NULL);
1915
David Brazdil0f672f62019-12-10 10:32:29 +00001916 break;
1917 }
1918 }
1919
1920 /*
1921 * For interrupts that don't have associated wake events, assign a
1922 * dummy hardware IRQ number. This is used in the ->irq_set_type()
1923 * and ->irq_set_wake() callbacks to return early for these IRQs.
1924 */
Olivier Deprez0e641232021-09-23 10:07:05 +02001925 if (i == soc->num_wake_events) {
David Brazdil0f672f62019-12-10 10:32:29 +00001926 err = irq_domain_set_hwirq_and_chip(domain, virq, ULONG_MAX,
1927 &pmc->irq, pmc);
1928
Olivier Deprez0e641232021-09-23 10:07:05 +02001929 /*
1930 * Interrupts without a wake event don't have a corresponding
1931 * interrupt in the parent controller (GIC). Pass NULL for the
1932 * chip here, which causes a dummy IRQ chip to be installed
1933 * for the interrupt in the parent domain, to make this
1934 * explicit.
1935 */
1936 if (domain->parent)
1937 irq_domain_set_hwirq_and_chip(domain->parent, virq, 0,
1938 NULL, NULL);
1939 }
1940
David Brazdil0f672f62019-12-10 10:32:29 +00001941 return err;
1942}
1943
1944static const struct irq_domain_ops tegra_pmc_irq_domain_ops = {
1945 .translate = tegra_pmc_irq_translate,
1946 .alloc = tegra_pmc_irq_alloc,
1947};
1948
1949static int tegra_pmc_irq_set_wake(struct irq_data *data, unsigned int on)
1950{
1951 struct tegra_pmc *pmc = irq_data_get_irq_chip_data(data);
1952 unsigned int offset, bit;
1953 u32 value;
1954
1955 /* nothing to do if there's no associated wake event */
1956 if (WARN_ON(data->hwirq == ULONG_MAX))
1957 return 0;
1958
1959 offset = data->hwirq / 32;
1960 bit = data->hwirq % 32;
1961
1962 /* clear wake status */
1963 writel(0x1, pmc->wake + WAKE_AOWAKE_STATUS_W(data->hwirq));
1964
1965 /* route wake to tier 2 */
1966 value = readl(pmc->wake + WAKE_AOWAKE_TIER2_ROUTING(offset));
1967
1968 if (!on)
1969 value &= ~(1 << bit);
1970 else
1971 value |= 1 << bit;
1972
1973 writel(value, pmc->wake + WAKE_AOWAKE_TIER2_ROUTING(offset));
1974
1975 /* enable wakeup event */
1976 writel(!!on, pmc->wake + WAKE_AOWAKE_MASK_W(data->hwirq));
1977
1978 return 0;
1979}
1980
1981static int tegra_pmc_irq_set_type(struct irq_data *data, unsigned int type)
1982{
1983 struct tegra_pmc *pmc = irq_data_get_irq_chip_data(data);
1984 u32 value;
1985
1986 /* nothing to do if there's no associated wake event */
1987 if (data->hwirq == ULONG_MAX)
1988 return 0;
1989
1990 value = readl(pmc->wake + WAKE_AOWAKE_CNTRL(data->hwirq));
1991
1992 switch (type) {
1993 case IRQ_TYPE_EDGE_RISING:
1994 case IRQ_TYPE_LEVEL_HIGH:
1995 value |= WAKE_AOWAKE_CNTRL_LEVEL;
1996 break;
1997
1998 case IRQ_TYPE_EDGE_FALLING:
1999 case IRQ_TYPE_LEVEL_LOW:
2000 value &= ~WAKE_AOWAKE_CNTRL_LEVEL;
2001 break;
2002
2003 case IRQ_TYPE_EDGE_RISING | IRQ_TYPE_EDGE_FALLING:
2004 value ^= WAKE_AOWAKE_CNTRL_LEVEL;
2005 break;
2006
2007 default:
2008 return -EINVAL;
2009 }
2010
2011 writel(value, pmc->wake + WAKE_AOWAKE_CNTRL(data->hwirq));
2012
2013 return 0;
2014}
2015
2016static int tegra_pmc_irq_init(struct tegra_pmc *pmc)
2017{
2018 struct irq_domain *parent = NULL;
2019 struct device_node *np;
2020
2021 np = of_irq_find_parent(pmc->dev->of_node);
2022 if (np) {
2023 parent = irq_find_host(np);
2024 of_node_put(np);
2025 }
2026
2027 if (!parent)
2028 return 0;
2029
2030 pmc->irq.name = dev_name(pmc->dev);
2031 pmc->irq.irq_mask = irq_chip_mask_parent;
2032 pmc->irq.irq_unmask = irq_chip_unmask_parent;
2033 pmc->irq.irq_eoi = irq_chip_eoi_parent;
2034 pmc->irq.irq_set_affinity = irq_chip_set_affinity_parent;
2035 pmc->irq.irq_set_type = tegra_pmc_irq_set_type;
2036 pmc->irq.irq_set_wake = tegra_pmc_irq_set_wake;
2037
2038 pmc->domain = irq_domain_add_hierarchy(parent, 0, 96, pmc->dev->of_node,
2039 &tegra_pmc_irq_domain_ops, pmc);
2040 if (!pmc->domain) {
2041 dev_err(pmc->dev, "failed to allocate domain\n");
2042 return -ENOMEM;
2043 }
2044
2045 return 0;
2046}
2047
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002048static int tegra_pmc_probe(struct platform_device *pdev)
2049{
2050 void __iomem *base;
2051 struct resource *res;
2052 int err;
2053
2054 /*
2055 * Early initialisation should have configured an initial
2056 * register mapping and setup the soc data pointer. If these
2057 * are not valid then something went badly wrong!
2058 */
2059 if (WARN_ON(!pmc->base || !pmc->soc))
2060 return -ENODEV;
2061
2062 err = tegra_pmc_parse_dt(pmc, pdev->dev.of_node);
2063 if (err < 0)
2064 return err;
2065
2066 /* take over the memory region from the early initialization */
2067 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
2068 base = devm_ioremap_resource(&pdev->dev, res);
2069 if (IS_ERR(base))
2070 return PTR_ERR(base);
2071
2072 res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "wake");
2073 if (res) {
2074 pmc->wake = devm_ioremap_resource(&pdev->dev, res);
2075 if (IS_ERR(pmc->wake))
2076 return PTR_ERR(pmc->wake);
2077 } else {
2078 pmc->wake = base;
2079 }
2080
2081 res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "aotag");
2082 if (res) {
2083 pmc->aotag = devm_ioremap_resource(&pdev->dev, res);
2084 if (IS_ERR(pmc->aotag))
2085 return PTR_ERR(pmc->aotag);
2086 } else {
2087 pmc->aotag = base;
2088 }
2089
2090 res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "scratch");
2091 if (res) {
2092 pmc->scratch = devm_ioremap_resource(&pdev->dev, res);
2093 if (IS_ERR(pmc->scratch))
2094 return PTR_ERR(pmc->scratch);
2095 } else {
2096 pmc->scratch = base;
2097 }
2098
2099 pmc->clk = devm_clk_get(&pdev->dev, "pclk");
2100 if (IS_ERR(pmc->clk)) {
2101 err = PTR_ERR(pmc->clk);
2102
2103 if (err != -ENOENT) {
2104 dev_err(&pdev->dev, "failed to get pclk: %d\n", err);
2105 return err;
2106 }
2107
2108 pmc->clk = NULL;
2109 }
2110
2111 pmc->dev = &pdev->dev;
2112
2113 tegra_pmc_init(pmc);
2114
2115 tegra_pmc_init_tsense_reset(pmc);
2116
David Brazdil0f672f62019-12-10 10:32:29 +00002117 tegra_pmc_reset_sysfs_init(pmc);
2118
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002119 if (IS_ENABLED(CONFIG_DEBUG_FS)) {
2120 err = tegra_powergate_debugfs_init();
2121 if (err < 0)
David Brazdil0f672f62019-12-10 10:32:29 +00002122 goto cleanup_sysfs;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002123 }
2124
2125 err = register_restart_handler(&tegra_pmc_restart_handler);
2126 if (err) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002127 dev_err(&pdev->dev, "unable to register restart handler, %d\n",
2128 err);
David Brazdil0f672f62019-12-10 10:32:29 +00002129 goto cleanup_debugfs;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002130 }
2131
David Brazdil0f672f62019-12-10 10:32:29 +00002132 err = tegra_pmc_pinctrl_init(pmc);
2133 if (err)
2134 goto cleanup_restart_handler;
2135
2136 err = tegra_powergate_init(pmc, pdev->dev.of_node);
2137 if (err < 0)
2138 goto cleanup_powergates;
2139
2140 err = tegra_pmc_irq_init(pmc);
2141 if (err < 0)
2142 goto cleanup_powergates;
2143
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002144 mutex_lock(&pmc->powergates_lock);
2145 iounmap(pmc->base);
2146 pmc->base = base;
2147 mutex_unlock(&pmc->powergates_lock);
2148
David Brazdil0f672f62019-12-10 10:32:29 +00002149 platform_set_drvdata(pdev, pmc);
2150
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002151 return 0;
David Brazdil0f672f62019-12-10 10:32:29 +00002152
2153cleanup_powergates:
2154 tegra_powergate_remove_all(pdev->dev.of_node);
2155cleanup_restart_handler:
2156 unregister_restart_handler(&tegra_pmc_restart_handler);
2157cleanup_debugfs:
2158 debugfs_remove(pmc->debugfs);
2159cleanup_sysfs:
2160 device_remove_file(&pdev->dev, &dev_attr_reset_reason);
2161 device_remove_file(&pdev->dev, &dev_attr_reset_level);
2162 return err;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002163}
2164
2165#if defined(CONFIG_PM_SLEEP) && defined(CONFIG_ARM)
2166static int tegra_pmc_suspend(struct device *dev)
2167{
David Brazdil0f672f62019-12-10 10:32:29 +00002168 struct tegra_pmc *pmc = dev_get_drvdata(dev);
2169
2170 tegra_pmc_writel(pmc, virt_to_phys(tegra_resume), PMC_SCRATCH41);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002171
2172 return 0;
2173}
2174
2175static int tegra_pmc_resume(struct device *dev)
2176{
David Brazdil0f672f62019-12-10 10:32:29 +00002177 struct tegra_pmc *pmc = dev_get_drvdata(dev);
2178
2179 tegra_pmc_writel(pmc, 0x0, PMC_SCRATCH41);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002180
2181 return 0;
2182}
2183
2184static SIMPLE_DEV_PM_OPS(tegra_pmc_pm_ops, tegra_pmc_suspend, tegra_pmc_resume);
2185
2186#endif
2187
2188static const char * const tegra20_powergates[] = {
2189 [TEGRA_POWERGATE_CPU] = "cpu",
2190 [TEGRA_POWERGATE_3D] = "3d",
2191 [TEGRA_POWERGATE_VENC] = "venc",
2192 [TEGRA_POWERGATE_VDEC] = "vdec",
2193 [TEGRA_POWERGATE_PCIE] = "pcie",
2194 [TEGRA_POWERGATE_L2] = "l2",
2195 [TEGRA_POWERGATE_MPE] = "mpe",
2196};
2197
2198static const struct tegra_pmc_regs tegra20_pmc_regs = {
2199 .scratch0 = 0x50,
2200 .dpd_req = 0x1b8,
2201 .dpd_status = 0x1bc,
2202 .dpd2_req = 0x1c0,
2203 .dpd2_status = 0x1c4,
David Brazdil0f672f62019-12-10 10:32:29 +00002204 .rst_status = 0x1b4,
2205 .rst_source_shift = 0x0,
2206 .rst_source_mask = 0x7,
2207 .rst_level_shift = 0x0,
2208 .rst_level_mask = 0x0,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002209};
2210
2211static void tegra20_pmc_init(struct tegra_pmc *pmc)
2212{
2213 u32 value;
2214
2215 /* Always enable CPU power request */
David Brazdil0f672f62019-12-10 10:32:29 +00002216 value = tegra_pmc_readl(pmc, PMC_CNTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002217 value |= PMC_CNTRL_CPU_PWRREQ_OE;
David Brazdil0f672f62019-12-10 10:32:29 +00002218 tegra_pmc_writel(pmc, value, PMC_CNTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002219
David Brazdil0f672f62019-12-10 10:32:29 +00002220 value = tegra_pmc_readl(pmc, PMC_CNTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002221
2222 if (pmc->sysclkreq_high)
2223 value &= ~PMC_CNTRL_SYSCLK_POLARITY;
2224 else
2225 value |= PMC_CNTRL_SYSCLK_POLARITY;
2226
2227 /* configure the output polarity while the request is tristated */
David Brazdil0f672f62019-12-10 10:32:29 +00002228 tegra_pmc_writel(pmc, value, PMC_CNTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002229
2230 /* now enable the request */
David Brazdil0f672f62019-12-10 10:32:29 +00002231 value = tegra_pmc_readl(pmc, PMC_CNTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002232 value |= PMC_CNTRL_SYSCLK_OE;
David Brazdil0f672f62019-12-10 10:32:29 +00002233 tegra_pmc_writel(pmc, value, PMC_CNTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002234}
2235
2236static void tegra20_pmc_setup_irq_polarity(struct tegra_pmc *pmc,
2237 struct device_node *np,
2238 bool invert)
2239{
2240 u32 value;
2241
David Brazdil0f672f62019-12-10 10:32:29 +00002242 value = tegra_pmc_readl(pmc, PMC_CNTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002243
2244 if (invert)
2245 value |= PMC_CNTRL_INTR_POLARITY;
2246 else
2247 value &= ~PMC_CNTRL_INTR_POLARITY;
2248
David Brazdil0f672f62019-12-10 10:32:29 +00002249 tegra_pmc_writel(pmc, value, PMC_CNTRL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002250}
2251
2252static const struct tegra_pmc_soc tegra20_pmc_soc = {
2253 .num_powergates = ARRAY_SIZE(tegra20_powergates),
2254 .powergates = tegra20_powergates,
2255 .num_cpu_powergates = 0,
2256 .cpu_powergates = NULL,
2257 .has_tsense_reset = false,
2258 .has_gpu_clamps = false,
David Brazdil0f672f62019-12-10 10:32:29 +00002259 .needs_mbist_war = false,
2260 .has_impl_33v_pwr = false,
2261 .maybe_tz_only = false,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002262 .num_io_pads = 0,
2263 .io_pads = NULL,
David Brazdil0f672f62019-12-10 10:32:29 +00002264 .num_pin_descs = 0,
2265 .pin_descs = NULL,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002266 .regs = &tegra20_pmc_regs,
2267 .init = tegra20_pmc_init,
2268 .setup_irq_polarity = tegra20_pmc_setup_irq_polarity,
David Brazdil0f672f62019-12-10 10:32:29 +00002269 .reset_sources = NULL,
2270 .num_reset_sources = 0,
2271 .reset_levels = NULL,
2272 .num_reset_levels = 0,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002273};
2274
2275static const char * const tegra30_powergates[] = {
2276 [TEGRA_POWERGATE_CPU] = "cpu0",
2277 [TEGRA_POWERGATE_3D] = "3d0",
2278 [TEGRA_POWERGATE_VENC] = "venc",
2279 [TEGRA_POWERGATE_VDEC] = "vdec",
2280 [TEGRA_POWERGATE_PCIE] = "pcie",
2281 [TEGRA_POWERGATE_L2] = "l2",
2282 [TEGRA_POWERGATE_MPE] = "mpe",
2283 [TEGRA_POWERGATE_HEG] = "heg",
2284 [TEGRA_POWERGATE_SATA] = "sata",
2285 [TEGRA_POWERGATE_CPU1] = "cpu1",
2286 [TEGRA_POWERGATE_CPU2] = "cpu2",
2287 [TEGRA_POWERGATE_CPU3] = "cpu3",
2288 [TEGRA_POWERGATE_CELP] = "celp",
2289 [TEGRA_POWERGATE_3D1] = "3d1",
2290};
2291
2292static const u8 tegra30_cpu_powergates[] = {
2293 TEGRA_POWERGATE_CPU,
2294 TEGRA_POWERGATE_CPU1,
2295 TEGRA_POWERGATE_CPU2,
2296 TEGRA_POWERGATE_CPU3,
2297};
2298
2299static const struct tegra_pmc_soc tegra30_pmc_soc = {
2300 .num_powergates = ARRAY_SIZE(tegra30_powergates),
2301 .powergates = tegra30_powergates,
2302 .num_cpu_powergates = ARRAY_SIZE(tegra30_cpu_powergates),
2303 .cpu_powergates = tegra30_cpu_powergates,
2304 .has_tsense_reset = true,
2305 .has_gpu_clamps = false,
David Brazdil0f672f62019-12-10 10:32:29 +00002306 .needs_mbist_war = false,
2307 .has_impl_33v_pwr = false,
2308 .maybe_tz_only = false,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002309 .num_io_pads = 0,
2310 .io_pads = NULL,
David Brazdil0f672f62019-12-10 10:32:29 +00002311 .num_pin_descs = 0,
2312 .pin_descs = NULL,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002313 .regs = &tegra20_pmc_regs,
2314 .init = tegra20_pmc_init,
2315 .setup_irq_polarity = tegra20_pmc_setup_irq_polarity,
David Brazdil0f672f62019-12-10 10:32:29 +00002316 .reset_sources = tegra30_reset_sources,
2317 .num_reset_sources = ARRAY_SIZE(tegra30_reset_sources),
2318 .reset_levels = NULL,
2319 .num_reset_levels = 0,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002320};
2321
2322static const char * const tegra114_powergates[] = {
2323 [TEGRA_POWERGATE_CPU] = "crail",
2324 [TEGRA_POWERGATE_3D] = "3d",
2325 [TEGRA_POWERGATE_VENC] = "venc",
2326 [TEGRA_POWERGATE_VDEC] = "vdec",
2327 [TEGRA_POWERGATE_MPE] = "mpe",
2328 [TEGRA_POWERGATE_HEG] = "heg",
2329 [TEGRA_POWERGATE_CPU1] = "cpu1",
2330 [TEGRA_POWERGATE_CPU2] = "cpu2",
2331 [TEGRA_POWERGATE_CPU3] = "cpu3",
2332 [TEGRA_POWERGATE_CELP] = "celp",
2333 [TEGRA_POWERGATE_CPU0] = "cpu0",
2334 [TEGRA_POWERGATE_C0NC] = "c0nc",
2335 [TEGRA_POWERGATE_C1NC] = "c1nc",
2336 [TEGRA_POWERGATE_DIS] = "dis",
2337 [TEGRA_POWERGATE_DISB] = "disb",
2338 [TEGRA_POWERGATE_XUSBA] = "xusba",
2339 [TEGRA_POWERGATE_XUSBB] = "xusbb",
2340 [TEGRA_POWERGATE_XUSBC] = "xusbc",
2341};
2342
2343static const u8 tegra114_cpu_powergates[] = {
2344 TEGRA_POWERGATE_CPU0,
2345 TEGRA_POWERGATE_CPU1,
2346 TEGRA_POWERGATE_CPU2,
2347 TEGRA_POWERGATE_CPU3,
2348};
2349
2350static const struct tegra_pmc_soc tegra114_pmc_soc = {
2351 .num_powergates = ARRAY_SIZE(tegra114_powergates),
2352 .powergates = tegra114_powergates,
2353 .num_cpu_powergates = ARRAY_SIZE(tegra114_cpu_powergates),
2354 .cpu_powergates = tegra114_cpu_powergates,
2355 .has_tsense_reset = true,
2356 .has_gpu_clamps = false,
David Brazdil0f672f62019-12-10 10:32:29 +00002357 .needs_mbist_war = false,
2358 .has_impl_33v_pwr = false,
2359 .maybe_tz_only = false,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002360 .num_io_pads = 0,
2361 .io_pads = NULL,
David Brazdil0f672f62019-12-10 10:32:29 +00002362 .num_pin_descs = 0,
2363 .pin_descs = NULL,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002364 .regs = &tegra20_pmc_regs,
2365 .init = tegra20_pmc_init,
2366 .setup_irq_polarity = tegra20_pmc_setup_irq_polarity,
David Brazdil0f672f62019-12-10 10:32:29 +00002367 .reset_sources = tegra30_reset_sources,
2368 .num_reset_sources = ARRAY_SIZE(tegra30_reset_sources),
2369 .reset_levels = NULL,
2370 .num_reset_levels = 0,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002371};
2372
2373static const char * const tegra124_powergates[] = {
2374 [TEGRA_POWERGATE_CPU] = "crail",
2375 [TEGRA_POWERGATE_3D] = "3d",
2376 [TEGRA_POWERGATE_VENC] = "venc",
2377 [TEGRA_POWERGATE_PCIE] = "pcie",
2378 [TEGRA_POWERGATE_VDEC] = "vdec",
2379 [TEGRA_POWERGATE_MPE] = "mpe",
2380 [TEGRA_POWERGATE_HEG] = "heg",
2381 [TEGRA_POWERGATE_SATA] = "sata",
2382 [TEGRA_POWERGATE_CPU1] = "cpu1",
2383 [TEGRA_POWERGATE_CPU2] = "cpu2",
2384 [TEGRA_POWERGATE_CPU3] = "cpu3",
2385 [TEGRA_POWERGATE_CELP] = "celp",
2386 [TEGRA_POWERGATE_CPU0] = "cpu0",
2387 [TEGRA_POWERGATE_C0NC] = "c0nc",
2388 [TEGRA_POWERGATE_C1NC] = "c1nc",
2389 [TEGRA_POWERGATE_SOR] = "sor",
2390 [TEGRA_POWERGATE_DIS] = "dis",
2391 [TEGRA_POWERGATE_DISB] = "disb",
2392 [TEGRA_POWERGATE_XUSBA] = "xusba",
2393 [TEGRA_POWERGATE_XUSBB] = "xusbb",
2394 [TEGRA_POWERGATE_XUSBC] = "xusbc",
2395 [TEGRA_POWERGATE_VIC] = "vic",
2396 [TEGRA_POWERGATE_IRAM] = "iram",
2397};
2398
2399static const u8 tegra124_cpu_powergates[] = {
2400 TEGRA_POWERGATE_CPU0,
2401 TEGRA_POWERGATE_CPU1,
2402 TEGRA_POWERGATE_CPU2,
2403 TEGRA_POWERGATE_CPU3,
2404};
2405
David Brazdil0f672f62019-12-10 10:32:29 +00002406#define TEGRA_IO_PAD(_id, _dpd, _voltage, _name) \
2407 ((struct tegra_io_pad_soc) { \
2408 .id = (_id), \
2409 .dpd = (_dpd), \
2410 .voltage = (_voltage), \
2411 .name = (_name), \
2412 })
2413
2414#define TEGRA_IO_PIN_DESC(_id, _dpd, _voltage, _name) \
2415 ((struct pinctrl_pin_desc) { \
2416 .number = (_id), \
2417 .name = (_name) \
2418 })
2419
2420#define TEGRA124_IO_PAD_TABLE(_pad) \
2421 /* .id .dpd .voltage .name */ \
2422 _pad(TEGRA_IO_PAD_AUDIO, 17, UINT_MAX, "audio"), \
2423 _pad(TEGRA_IO_PAD_BB, 15, UINT_MAX, "bb"), \
2424 _pad(TEGRA_IO_PAD_CAM, 36, UINT_MAX, "cam"), \
2425 _pad(TEGRA_IO_PAD_COMP, 22, UINT_MAX, "comp"), \
2426 _pad(TEGRA_IO_PAD_CSIA, 0, UINT_MAX, "csia"), \
2427 _pad(TEGRA_IO_PAD_CSIB, 1, UINT_MAX, "csb"), \
2428 _pad(TEGRA_IO_PAD_CSIE, 44, UINT_MAX, "cse"), \
2429 _pad(TEGRA_IO_PAD_DSI, 2, UINT_MAX, "dsi"), \
2430 _pad(TEGRA_IO_PAD_DSIB, 39, UINT_MAX, "dsib"), \
2431 _pad(TEGRA_IO_PAD_DSIC, 40, UINT_MAX, "dsic"), \
2432 _pad(TEGRA_IO_PAD_DSID, 41, UINT_MAX, "dsid"), \
2433 _pad(TEGRA_IO_PAD_HDMI, 28, UINT_MAX, "hdmi"), \
2434 _pad(TEGRA_IO_PAD_HSIC, 19, UINT_MAX, "hsic"), \
2435 _pad(TEGRA_IO_PAD_HV, 38, UINT_MAX, "hv"), \
2436 _pad(TEGRA_IO_PAD_LVDS, 57, UINT_MAX, "lvds"), \
2437 _pad(TEGRA_IO_PAD_MIPI_BIAS, 3, UINT_MAX, "mipi-bias"), \
2438 _pad(TEGRA_IO_PAD_NAND, 13, UINT_MAX, "nand"), \
2439 _pad(TEGRA_IO_PAD_PEX_BIAS, 4, UINT_MAX, "pex-bias"), \
2440 _pad(TEGRA_IO_PAD_PEX_CLK1, 5, UINT_MAX, "pex-clk1"), \
2441 _pad(TEGRA_IO_PAD_PEX_CLK2, 6, UINT_MAX, "pex-clk2"), \
2442 _pad(TEGRA_IO_PAD_PEX_CNTRL, 32, UINT_MAX, "pex-cntrl"), \
2443 _pad(TEGRA_IO_PAD_SDMMC1, 33, UINT_MAX, "sdmmc1"), \
2444 _pad(TEGRA_IO_PAD_SDMMC3, 34, UINT_MAX, "sdmmc3"), \
2445 _pad(TEGRA_IO_PAD_SDMMC4, 35, UINT_MAX, "sdmmc4"), \
2446 _pad(TEGRA_IO_PAD_SYS_DDC, 58, UINT_MAX, "sys_ddc"), \
2447 _pad(TEGRA_IO_PAD_UART, 14, UINT_MAX, "uart"), \
2448 _pad(TEGRA_IO_PAD_USB0, 9, UINT_MAX, "usb0"), \
2449 _pad(TEGRA_IO_PAD_USB1, 10, UINT_MAX, "usb1"), \
2450 _pad(TEGRA_IO_PAD_USB2, 11, UINT_MAX, "usb2"), \
2451 _pad(TEGRA_IO_PAD_USB_BIAS, 12, UINT_MAX, "usb_bias")
2452
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002453static const struct tegra_io_pad_soc tegra124_io_pads[] = {
David Brazdil0f672f62019-12-10 10:32:29 +00002454 TEGRA124_IO_PAD_TABLE(TEGRA_IO_PAD)
2455};
2456
2457static const struct pinctrl_pin_desc tegra124_pin_descs[] = {
2458 TEGRA124_IO_PAD_TABLE(TEGRA_IO_PIN_DESC)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002459};
2460
2461static const struct tegra_pmc_soc tegra124_pmc_soc = {
2462 .num_powergates = ARRAY_SIZE(tegra124_powergates),
2463 .powergates = tegra124_powergates,
2464 .num_cpu_powergates = ARRAY_SIZE(tegra124_cpu_powergates),
2465 .cpu_powergates = tegra124_cpu_powergates,
2466 .has_tsense_reset = true,
2467 .has_gpu_clamps = true,
David Brazdil0f672f62019-12-10 10:32:29 +00002468 .needs_mbist_war = false,
2469 .has_impl_33v_pwr = false,
2470 .maybe_tz_only = false,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002471 .num_io_pads = ARRAY_SIZE(tegra124_io_pads),
2472 .io_pads = tegra124_io_pads,
David Brazdil0f672f62019-12-10 10:32:29 +00002473 .num_pin_descs = ARRAY_SIZE(tegra124_pin_descs),
2474 .pin_descs = tegra124_pin_descs,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002475 .regs = &tegra20_pmc_regs,
2476 .init = tegra20_pmc_init,
2477 .setup_irq_polarity = tegra20_pmc_setup_irq_polarity,
David Brazdil0f672f62019-12-10 10:32:29 +00002478 .reset_sources = tegra30_reset_sources,
2479 .num_reset_sources = ARRAY_SIZE(tegra30_reset_sources),
2480 .reset_levels = NULL,
2481 .num_reset_levels = 0,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002482};
2483
2484static const char * const tegra210_powergates[] = {
2485 [TEGRA_POWERGATE_CPU] = "crail",
2486 [TEGRA_POWERGATE_3D] = "3d",
2487 [TEGRA_POWERGATE_VENC] = "venc",
2488 [TEGRA_POWERGATE_PCIE] = "pcie",
2489 [TEGRA_POWERGATE_MPE] = "mpe",
2490 [TEGRA_POWERGATE_SATA] = "sata",
2491 [TEGRA_POWERGATE_CPU1] = "cpu1",
2492 [TEGRA_POWERGATE_CPU2] = "cpu2",
2493 [TEGRA_POWERGATE_CPU3] = "cpu3",
2494 [TEGRA_POWERGATE_CPU0] = "cpu0",
2495 [TEGRA_POWERGATE_C0NC] = "c0nc",
2496 [TEGRA_POWERGATE_SOR] = "sor",
2497 [TEGRA_POWERGATE_DIS] = "dis",
2498 [TEGRA_POWERGATE_DISB] = "disb",
2499 [TEGRA_POWERGATE_XUSBA] = "xusba",
2500 [TEGRA_POWERGATE_XUSBB] = "xusbb",
2501 [TEGRA_POWERGATE_XUSBC] = "xusbc",
2502 [TEGRA_POWERGATE_VIC] = "vic",
2503 [TEGRA_POWERGATE_IRAM] = "iram",
2504 [TEGRA_POWERGATE_NVDEC] = "nvdec",
2505 [TEGRA_POWERGATE_NVJPG] = "nvjpg",
2506 [TEGRA_POWERGATE_AUD] = "aud",
2507 [TEGRA_POWERGATE_DFD] = "dfd",
2508 [TEGRA_POWERGATE_VE2] = "ve2",
2509};
2510
2511static const u8 tegra210_cpu_powergates[] = {
2512 TEGRA_POWERGATE_CPU0,
2513 TEGRA_POWERGATE_CPU1,
2514 TEGRA_POWERGATE_CPU2,
2515 TEGRA_POWERGATE_CPU3,
2516};
2517
David Brazdil0f672f62019-12-10 10:32:29 +00002518#define TEGRA210_IO_PAD_TABLE(_pad) \
2519 /* .id .dpd .voltage .name */ \
2520 _pad(TEGRA_IO_PAD_AUDIO, 17, 5, "audio"), \
2521 _pad(TEGRA_IO_PAD_AUDIO_HV, 61, 18, "audio-hv"), \
2522 _pad(TEGRA_IO_PAD_CAM, 36, 10, "cam"), \
2523 _pad(TEGRA_IO_PAD_CSIA, 0, UINT_MAX, "csia"), \
2524 _pad(TEGRA_IO_PAD_CSIB, 1, UINT_MAX, "csib"), \
2525 _pad(TEGRA_IO_PAD_CSIC, 42, UINT_MAX, "csic"), \
2526 _pad(TEGRA_IO_PAD_CSID, 43, UINT_MAX, "csid"), \
2527 _pad(TEGRA_IO_PAD_CSIE, 44, UINT_MAX, "csie"), \
2528 _pad(TEGRA_IO_PAD_CSIF, 45, UINT_MAX, "csif"), \
2529 _pad(TEGRA_IO_PAD_DBG, 25, 19, "dbg"), \
2530 _pad(TEGRA_IO_PAD_DEBUG_NONAO, 26, UINT_MAX, "debug-nonao"), \
2531 _pad(TEGRA_IO_PAD_DMIC, 50, 20, "dmic"), \
2532 _pad(TEGRA_IO_PAD_DP, 51, UINT_MAX, "dp"), \
2533 _pad(TEGRA_IO_PAD_DSI, 2, UINT_MAX, "dsi"), \
2534 _pad(TEGRA_IO_PAD_DSIB, 39, UINT_MAX, "dsib"), \
2535 _pad(TEGRA_IO_PAD_DSIC, 40, UINT_MAX, "dsic"), \
2536 _pad(TEGRA_IO_PAD_DSID, 41, UINT_MAX, "dsid"), \
2537 _pad(TEGRA_IO_PAD_EMMC, 35, UINT_MAX, "emmc"), \
2538 _pad(TEGRA_IO_PAD_EMMC2, 37, UINT_MAX, "emmc2"), \
2539 _pad(TEGRA_IO_PAD_GPIO, 27, 21, "gpio"), \
2540 _pad(TEGRA_IO_PAD_HDMI, 28, UINT_MAX, "hdmi"), \
2541 _pad(TEGRA_IO_PAD_HSIC, 19, UINT_MAX, "hsic"), \
2542 _pad(TEGRA_IO_PAD_LVDS, 57, UINT_MAX, "lvds"), \
2543 _pad(TEGRA_IO_PAD_MIPI_BIAS, 3, UINT_MAX, "mipi-bias"), \
2544 _pad(TEGRA_IO_PAD_PEX_BIAS, 4, UINT_MAX, "pex-bias"), \
2545 _pad(TEGRA_IO_PAD_PEX_CLK1, 5, UINT_MAX, "pex-clk1"), \
2546 _pad(TEGRA_IO_PAD_PEX_CLK2, 6, UINT_MAX, "pex-clk2"), \
2547 _pad(TEGRA_IO_PAD_PEX_CNTRL, UINT_MAX, 11, "pex-cntrl"), \
2548 _pad(TEGRA_IO_PAD_SDMMC1, 33, 12, "sdmmc1"), \
2549 _pad(TEGRA_IO_PAD_SDMMC3, 34, 13, "sdmmc3"), \
2550 _pad(TEGRA_IO_PAD_SPI, 46, 22, "spi"), \
2551 _pad(TEGRA_IO_PAD_SPI_HV, 47, 23, "spi-hv"), \
2552 _pad(TEGRA_IO_PAD_UART, 14, 2, "uart"), \
2553 _pad(TEGRA_IO_PAD_USB0, 9, UINT_MAX, "usb0"), \
2554 _pad(TEGRA_IO_PAD_USB1, 10, UINT_MAX, "usb1"), \
2555 _pad(TEGRA_IO_PAD_USB2, 11, UINT_MAX, "usb2"), \
2556 _pad(TEGRA_IO_PAD_USB3, 18, UINT_MAX, "usb3"), \
2557 _pad(TEGRA_IO_PAD_USB_BIAS, 12, UINT_MAX, "usb-bias")
2558
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002559static const struct tegra_io_pad_soc tegra210_io_pads[] = {
David Brazdil0f672f62019-12-10 10:32:29 +00002560 TEGRA210_IO_PAD_TABLE(TEGRA_IO_PAD)
2561};
2562
2563static const struct pinctrl_pin_desc tegra210_pin_descs[] = {
2564 TEGRA210_IO_PAD_TABLE(TEGRA_IO_PIN_DESC)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002565};
2566
2567static const struct tegra_pmc_soc tegra210_pmc_soc = {
2568 .num_powergates = ARRAY_SIZE(tegra210_powergates),
2569 .powergates = tegra210_powergates,
2570 .num_cpu_powergates = ARRAY_SIZE(tegra210_cpu_powergates),
2571 .cpu_powergates = tegra210_cpu_powergates,
2572 .has_tsense_reset = true,
2573 .has_gpu_clamps = true,
2574 .needs_mbist_war = true,
David Brazdil0f672f62019-12-10 10:32:29 +00002575 .has_impl_33v_pwr = false,
2576 .maybe_tz_only = true,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002577 .num_io_pads = ARRAY_SIZE(tegra210_io_pads),
2578 .io_pads = tegra210_io_pads,
David Brazdil0f672f62019-12-10 10:32:29 +00002579 .num_pin_descs = ARRAY_SIZE(tegra210_pin_descs),
2580 .pin_descs = tegra210_pin_descs,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002581 .regs = &tegra20_pmc_regs,
2582 .init = tegra20_pmc_init,
2583 .setup_irq_polarity = tegra20_pmc_setup_irq_polarity,
David Brazdil0f672f62019-12-10 10:32:29 +00002584 .reset_sources = tegra210_reset_sources,
2585 .num_reset_sources = ARRAY_SIZE(tegra210_reset_sources),
2586 .reset_levels = NULL,
2587 .num_reset_levels = 0,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002588};
2589
David Brazdil0f672f62019-12-10 10:32:29 +00002590#define TEGRA186_IO_PAD_TABLE(_pad) \
2591 /* .id .dpd .voltage .name */ \
2592 _pad(TEGRA_IO_PAD_CSIA, 0, UINT_MAX, "csia"), \
2593 _pad(TEGRA_IO_PAD_CSIB, 1, UINT_MAX, "csib"), \
2594 _pad(TEGRA_IO_PAD_DSI, 2, UINT_MAX, "dsi"), \
2595 _pad(TEGRA_IO_PAD_MIPI_BIAS, 3, UINT_MAX, "mipi-bias"), \
2596 _pad(TEGRA_IO_PAD_PEX_CLK_BIAS, 4, UINT_MAX, "pex-clk-bias"), \
2597 _pad(TEGRA_IO_PAD_PEX_CLK3, 5, UINT_MAX, "pex-clk3"), \
2598 _pad(TEGRA_IO_PAD_PEX_CLK2, 6, UINT_MAX, "pex-clk2"), \
2599 _pad(TEGRA_IO_PAD_PEX_CLK1, 7, UINT_MAX, "pex-clk1"), \
2600 _pad(TEGRA_IO_PAD_USB0, 9, UINT_MAX, "usb0"), \
2601 _pad(TEGRA_IO_PAD_USB1, 10, UINT_MAX, "usb1"), \
2602 _pad(TEGRA_IO_PAD_USB2, 11, UINT_MAX, "usb2"), \
2603 _pad(TEGRA_IO_PAD_USB_BIAS, 12, UINT_MAX, "usb-bias"), \
2604 _pad(TEGRA_IO_PAD_UART, 14, UINT_MAX, "uart"), \
2605 _pad(TEGRA_IO_PAD_AUDIO, 17, UINT_MAX, "audio"), \
2606 _pad(TEGRA_IO_PAD_HSIC, 19, UINT_MAX, "hsic"), \
2607 _pad(TEGRA_IO_PAD_DBG, 25, UINT_MAX, "dbg"), \
2608 _pad(TEGRA_IO_PAD_HDMI_DP0, 28, UINT_MAX, "hdmi-dp0"), \
2609 _pad(TEGRA_IO_PAD_HDMI_DP1, 29, UINT_MAX, "hdmi-dp1"), \
2610 _pad(TEGRA_IO_PAD_PEX_CNTRL, 32, UINT_MAX, "pex-cntrl"), \
2611 _pad(TEGRA_IO_PAD_SDMMC2_HV, 34, 5, "sdmmc2-hv"), \
2612 _pad(TEGRA_IO_PAD_SDMMC4, 36, UINT_MAX, "sdmmc4"), \
2613 _pad(TEGRA_IO_PAD_CAM, 38, UINT_MAX, "cam"), \
2614 _pad(TEGRA_IO_PAD_DSIB, 40, UINT_MAX, "dsib"), \
2615 _pad(TEGRA_IO_PAD_DSIC, 41, UINT_MAX, "dsic"), \
2616 _pad(TEGRA_IO_PAD_DSID, 42, UINT_MAX, "dsid"), \
2617 _pad(TEGRA_IO_PAD_CSIC, 43, UINT_MAX, "csic"), \
2618 _pad(TEGRA_IO_PAD_CSID, 44, UINT_MAX, "csid"), \
2619 _pad(TEGRA_IO_PAD_CSIE, 45, UINT_MAX, "csie"), \
2620 _pad(TEGRA_IO_PAD_CSIF, 46, UINT_MAX, "csif"), \
2621 _pad(TEGRA_IO_PAD_SPI, 47, UINT_MAX, "spi"), \
2622 _pad(TEGRA_IO_PAD_UFS, 49, UINT_MAX, "ufs"), \
2623 _pad(TEGRA_IO_PAD_DMIC_HV, 52, 2, "dmic-hv"), \
2624 _pad(TEGRA_IO_PAD_EDP, 53, UINT_MAX, "edp"), \
2625 _pad(TEGRA_IO_PAD_SDMMC1_HV, 55, 4, "sdmmc1-hv"), \
2626 _pad(TEGRA_IO_PAD_SDMMC3_HV, 56, 6, "sdmmc3-hv"), \
2627 _pad(TEGRA_IO_PAD_CONN, 60, UINT_MAX, "conn"), \
2628 _pad(TEGRA_IO_PAD_AUDIO_HV, 61, 1, "audio-hv"), \
2629 _pad(TEGRA_IO_PAD_AO_HV, UINT_MAX, 0, "ao-hv")
2630
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002631static const struct tegra_io_pad_soc tegra186_io_pads[] = {
David Brazdil0f672f62019-12-10 10:32:29 +00002632 TEGRA186_IO_PAD_TABLE(TEGRA_IO_PAD)
2633};
2634
2635static const struct pinctrl_pin_desc tegra186_pin_descs[] = {
2636 TEGRA186_IO_PAD_TABLE(TEGRA_IO_PIN_DESC)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002637};
2638
2639static const struct tegra_pmc_regs tegra186_pmc_regs = {
2640 .scratch0 = 0x2000,
2641 .dpd_req = 0x74,
2642 .dpd_status = 0x78,
2643 .dpd2_req = 0x7c,
2644 .dpd2_status = 0x80,
David Brazdil0f672f62019-12-10 10:32:29 +00002645 .rst_status = 0x70,
2646 .rst_source_shift = 0x2,
2647 .rst_source_mask = 0x3C,
2648 .rst_level_shift = 0x0,
2649 .rst_level_mask = 0x3,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002650};
2651
2652static void tegra186_pmc_setup_irq_polarity(struct tegra_pmc *pmc,
2653 struct device_node *np,
2654 bool invert)
2655{
2656 struct resource regs;
2657 void __iomem *wake;
2658 u32 value;
2659 int index;
2660
2661 index = of_property_match_string(np, "reg-names", "wake");
2662 if (index < 0) {
David Brazdil0f672f62019-12-10 10:32:29 +00002663 dev_err(pmc->dev, "failed to find PMC wake registers\n");
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002664 return;
2665 }
2666
2667 of_address_to_resource(np, index, &regs);
2668
2669 wake = ioremap_nocache(regs.start, resource_size(&regs));
2670 if (!wake) {
David Brazdil0f672f62019-12-10 10:32:29 +00002671 dev_err(pmc->dev, "failed to map PMC wake registers\n");
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002672 return;
2673 }
2674
2675 value = readl(wake + WAKE_AOWAKE_CTRL);
2676
2677 if (invert)
2678 value |= WAKE_AOWAKE_CTRL_INTR_POLARITY;
2679 else
2680 value &= ~WAKE_AOWAKE_CTRL_INTR_POLARITY;
2681
2682 writel(value, wake + WAKE_AOWAKE_CTRL);
2683
2684 iounmap(wake);
2685}
2686
David Brazdil0f672f62019-12-10 10:32:29 +00002687static const struct tegra_wake_event tegra186_wake_events[] = {
2688 TEGRA_WAKE_GPIO("power", 29, 1, TEGRA186_AON_GPIO(FF, 0)),
2689 TEGRA_WAKE_IRQ("rtc", 73, 10),
2690};
2691
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002692static const struct tegra_pmc_soc tegra186_pmc_soc = {
2693 .num_powergates = 0,
2694 .powergates = NULL,
2695 .num_cpu_powergates = 0,
2696 .cpu_powergates = NULL,
2697 .has_tsense_reset = false,
2698 .has_gpu_clamps = false,
David Brazdil0f672f62019-12-10 10:32:29 +00002699 .needs_mbist_war = false,
2700 .has_impl_33v_pwr = true,
2701 .maybe_tz_only = false,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002702 .num_io_pads = ARRAY_SIZE(tegra186_io_pads),
2703 .io_pads = tegra186_io_pads,
David Brazdil0f672f62019-12-10 10:32:29 +00002704 .num_pin_descs = ARRAY_SIZE(tegra186_pin_descs),
2705 .pin_descs = tegra186_pin_descs,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002706 .regs = &tegra186_pmc_regs,
2707 .init = NULL,
2708 .setup_irq_polarity = tegra186_pmc_setup_irq_polarity,
David Brazdil0f672f62019-12-10 10:32:29 +00002709 .reset_sources = tegra186_reset_sources,
2710 .num_reset_sources = ARRAY_SIZE(tegra186_reset_sources),
2711 .reset_levels = tegra186_reset_levels,
2712 .num_reset_levels = ARRAY_SIZE(tegra186_reset_levels),
2713 .num_wake_events = ARRAY_SIZE(tegra186_wake_events),
2714 .wake_events = tegra186_wake_events,
2715};
2716
2717static const struct tegra_io_pad_soc tegra194_io_pads[] = {
2718 { .id = TEGRA_IO_PAD_CSIA, .dpd = 0, .voltage = UINT_MAX },
2719 { .id = TEGRA_IO_PAD_CSIB, .dpd = 1, .voltage = UINT_MAX },
2720 { .id = TEGRA_IO_PAD_MIPI_BIAS, .dpd = 3, .voltage = UINT_MAX },
2721 { .id = TEGRA_IO_PAD_PEX_CLK_BIAS, .dpd = 4, .voltage = UINT_MAX },
2722 { .id = TEGRA_IO_PAD_PEX_CLK3, .dpd = 5, .voltage = UINT_MAX },
2723 { .id = TEGRA_IO_PAD_PEX_CLK2, .dpd = 6, .voltage = UINT_MAX },
2724 { .id = TEGRA_IO_PAD_PEX_CLK1, .dpd = 7, .voltage = UINT_MAX },
2725 { .id = TEGRA_IO_PAD_EQOS, .dpd = 8, .voltage = UINT_MAX },
2726 { .id = TEGRA_IO_PAD_PEX_CLK2_BIAS, .dpd = 9, .voltage = UINT_MAX },
2727 { .id = TEGRA_IO_PAD_PEX_CLK2, .dpd = 10, .voltage = UINT_MAX },
2728 { .id = TEGRA_IO_PAD_DAP3, .dpd = 11, .voltage = UINT_MAX },
2729 { .id = TEGRA_IO_PAD_DAP5, .dpd = 12, .voltage = UINT_MAX },
2730 { .id = TEGRA_IO_PAD_UART, .dpd = 14, .voltage = UINT_MAX },
2731 { .id = TEGRA_IO_PAD_PWR_CTL, .dpd = 15, .voltage = UINT_MAX },
2732 { .id = TEGRA_IO_PAD_SOC_GPIO53, .dpd = 16, .voltage = UINT_MAX },
2733 { .id = TEGRA_IO_PAD_AUDIO, .dpd = 17, .voltage = UINT_MAX },
2734 { .id = TEGRA_IO_PAD_GP_PWM2, .dpd = 18, .voltage = UINT_MAX },
2735 { .id = TEGRA_IO_PAD_GP_PWM3, .dpd = 19, .voltage = UINT_MAX },
2736 { .id = TEGRA_IO_PAD_SOC_GPIO12, .dpd = 20, .voltage = UINT_MAX },
2737 { .id = TEGRA_IO_PAD_SOC_GPIO13, .dpd = 21, .voltage = UINT_MAX },
2738 { .id = TEGRA_IO_PAD_SOC_GPIO10, .dpd = 22, .voltage = UINT_MAX },
2739 { .id = TEGRA_IO_PAD_UART4, .dpd = 23, .voltage = UINT_MAX },
2740 { .id = TEGRA_IO_PAD_UART5, .dpd = 24, .voltage = UINT_MAX },
2741 { .id = TEGRA_IO_PAD_DBG, .dpd = 25, .voltage = UINT_MAX },
2742 { .id = TEGRA_IO_PAD_HDMI_DP3, .dpd = 26, .voltage = UINT_MAX },
2743 { .id = TEGRA_IO_PAD_HDMI_DP2, .dpd = 27, .voltage = UINT_MAX },
2744 { .id = TEGRA_IO_PAD_HDMI_DP0, .dpd = 28, .voltage = UINT_MAX },
2745 { .id = TEGRA_IO_PAD_HDMI_DP1, .dpd = 29, .voltage = UINT_MAX },
2746 { .id = TEGRA_IO_PAD_PEX_CNTRL, .dpd = 32, .voltage = UINT_MAX },
2747 { .id = TEGRA_IO_PAD_PEX_CTL2, .dpd = 33, .voltage = UINT_MAX },
2748 { .id = TEGRA_IO_PAD_PEX_L0_RST_N, .dpd = 34, .voltage = UINT_MAX },
2749 { .id = TEGRA_IO_PAD_PEX_L1_RST_N, .dpd = 35, .voltage = UINT_MAX },
2750 { .id = TEGRA_IO_PAD_SDMMC4, .dpd = 36, .voltage = UINT_MAX },
2751 { .id = TEGRA_IO_PAD_PEX_L5_RST_N, .dpd = 37, .voltage = UINT_MAX },
2752 { .id = TEGRA_IO_PAD_CSIC, .dpd = 43, .voltage = UINT_MAX },
2753 { .id = TEGRA_IO_PAD_CSID, .dpd = 44, .voltage = UINT_MAX },
2754 { .id = TEGRA_IO_PAD_CSIE, .dpd = 45, .voltage = UINT_MAX },
2755 { .id = TEGRA_IO_PAD_CSIF, .dpd = 46, .voltage = UINT_MAX },
2756 { .id = TEGRA_IO_PAD_SPI, .dpd = 47, .voltage = UINT_MAX },
2757 { .id = TEGRA_IO_PAD_UFS, .dpd = 49, .voltage = UINT_MAX },
2758 { .id = TEGRA_IO_PAD_CSIG, .dpd = 50, .voltage = UINT_MAX },
2759 { .id = TEGRA_IO_PAD_CSIH, .dpd = 51, .voltage = UINT_MAX },
2760 { .id = TEGRA_IO_PAD_EDP, .dpd = 53, .voltage = UINT_MAX },
2761 { .id = TEGRA_IO_PAD_SDMMC1_HV, .dpd = 55, .voltage = UINT_MAX },
2762 { .id = TEGRA_IO_PAD_SDMMC3_HV, .dpd = 56, .voltage = UINT_MAX },
2763 { .id = TEGRA_IO_PAD_CONN, .dpd = 60, .voltage = UINT_MAX },
2764 { .id = TEGRA_IO_PAD_AUDIO_HV, .dpd = 61, .voltage = UINT_MAX },
2765};
2766
2767static const struct tegra_wake_event tegra194_wake_events[] = {
2768 TEGRA_WAKE_GPIO("power", 29, 1, TEGRA194_AON_GPIO(EE, 4)),
2769 TEGRA_WAKE_IRQ("rtc", 73, 10),
2770};
2771
2772static const struct tegra_pmc_soc tegra194_pmc_soc = {
2773 .num_powergates = 0,
2774 .powergates = NULL,
2775 .num_cpu_powergates = 0,
2776 .cpu_powergates = NULL,
2777 .has_tsense_reset = false,
2778 .has_gpu_clamps = false,
2779 .needs_mbist_war = false,
2780 .has_impl_33v_pwr = false,
2781 .maybe_tz_only = false,
2782 .num_io_pads = ARRAY_SIZE(tegra194_io_pads),
2783 .io_pads = tegra194_io_pads,
2784 .regs = &tegra186_pmc_regs,
2785 .init = NULL,
2786 .setup_irq_polarity = tegra186_pmc_setup_irq_polarity,
2787 .num_wake_events = ARRAY_SIZE(tegra194_wake_events),
2788 .wake_events = tegra194_wake_events,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002789};
2790
2791static const struct of_device_id tegra_pmc_match[] = {
David Brazdil0f672f62019-12-10 10:32:29 +00002792 { .compatible = "nvidia,tegra194-pmc", .data = &tegra194_pmc_soc },
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002793 { .compatible = "nvidia,tegra186-pmc", .data = &tegra186_pmc_soc },
2794 { .compatible = "nvidia,tegra210-pmc", .data = &tegra210_pmc_soc },
2795 { .compatible = "nvidia,tegra132-pmc", .data = &tegra124_pmc_soc },
2796 { .compatible = "nvidia,tegra124-pmc", .data = &tegra124_pmc_soc },
2797 { .compatible = "nvidia,tegra114-pmc", .data = &tegra114_pmc_soc },
2798 { .compatible = "nvidia,tegra30-pmc", .data = &tegra30_pmc_soc },
2799 { .compatible = "nvidia,tegra20-pmc", .data = &tegra20_pmc_soc },
2800 { }
2801};
2802
2803static struct platform_driver tegra_pmc_driver = {
2804 .driver = {
2805 .name = "tegra-pmc",
2806 .suppress_bind_attrs = true,
2807 .of_match_table = tegra_pmc_match,
2808#if defined(CONFIG_PM_SLEEP) && defined(CONFIG_ARM)
2809 .pm = &tegra_pmc_pm_ops,
2810#endif
2811 },
2812 .probe = tegra_pmc_probe,
2813};
2814builtin_platform_driver(tegra_pmc_driver);
2815
David Brazdil0f672f62019-12-10 10:32:29 +00002816static bool __init tegra_pmc_detect_tz_only(struct tegra_pmc *pmc)
2817{
2818 u32 value, saved;
2819
2820 saved = readl(pmc->base + pmc->soc->regs->scratch0);
2821 value = saved ^ 0xffffffff;
2822
2823 if (value == 0xffffffff)
2824 value = 0xdeadbeef;
2825
2826 /* write pattern and read it back */
2827 writel(value, pmc->base + pmc->soc->regs->scratch0);
2828 value = readl(pmc->base + pmc->soc->regs->scratch0);
2829
2830 /* if we read all-zeroes, access is restricted to TZ only */
2831 if (value == 0) {
2832 pr_info("access to PMC is restricted to TZ\n");
2833 return true;
2834 }
2835
2836 /* restore original value */
2837 writel(saved, pmc->base + pmc->soc->regs->scratch0);
2838
2839 return false;
2840}
2841
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002842/*
2843 * Early initialization to allow access to registers in the very early boot
2844 * process.
2845 */
2846static int __init tegra_pmc_early_init(void)
2847{
2848 const struct of_device_id *match;
2849 struct device_node *np;
2850 struct resource regs;
David Brazdil0f672f62019-12-10 10:32:29 +00002851 unsigned int i;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002852 bool invert;
2853
2854 mutex_init(&pmc->powergates_lock);
2855
2856 np = of_find_matching_node_and_match(NULL, tegra_pmc_match, &match);
2857 if (!np) {
2858 /*
2859 * Fall back to legacy initialization for 32-bit ARM only. All
2860 * 64-bit ARM device tree files for Tegra are required to have
2861 * a PMC node.
2862 *
2863 * This is for backwards-compatibility with old device trees
2864 * that didn't contain a PMC node. Note that in this case the
2865 * SoC data can't be matched and therefore powergating is
2866 * disabled.
2867 */
2868 if (IS_ENABLED(CONFIG_ARM) && soc_is_tegra()) {
2869 pr_warn("DT node not found, powergating disabled\n");
2870
2871 regs.start = 0x7000e400;
2872 regs.end = 0x7000e7ff;
2873 regs.flags = IORESOURCE_MEM;
2874
2875 pr_warn("Using memory region %pR\n", &regs);
2876 } else {
2877 /*
2878 * At this point we're not running on Tegra, so play
2879 * nice with multi-platform kernels.
2880 */
2881 return 0;
2882 }
2883 } else {
2884 /*
2885 * Extract information from the device tree if we've found a
2886 * matching node.
2887 */
2888 if (of_address_to_resource(np, 0, &regs) < 0) {
2889 pr_err("failed to get PMC registers\n");
2890 of_node_put(np);
2891 return -ENXIO;
2892 }
2893 }
2894
2895 pmc->base = ioremap_nocache(regs.start, resource_size(&regs));
2896 if (!pmc->base) {
2897 pr_err("failed to map PMC registers\n");
2898 of_node_put(np);
2899 return -ENXIO;
2900 }
2901
2902 if (np) {
2903 pmc->soc = match->data;
2904
David Brazdil0f672f62019-12-10 10:32:29 +00002905 if (pmc->soc->maybe_tz_only)
2906 pmc->tz_only = tegra_pmc_detect_tz_only(pmc);
2907
2908 /* Create a bitmap of the available and valid partitions */
2909 for (i = 0; i < pmc->soc->num_powergates; i++)
2910 if (pmc->soc->powergates[i])
2911 set_bit(i, pmc->powergates_available);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00002912
2913 /*
2914 * Invert the interrupt polarity if a PMC device tree node
2915 * exists and contains the nvidia,invert-interrupt property.
2916 */
2917 invert = of_property_read_bool(np, "nvidia,invert-interrupt");
2918
2919 pmc->soc->setup_irq_polarity(pmc, np, invert);
2920
2921 of_node_put(np);
2922 }
2923
2924 return 0;
2925}
2926early_initcall(tegra_pmc_early_init);