Loading...
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright (C) 2014 NVIDIA CORPORATION. All rights reserved.
4 */
5
6#include <linux/clk.h>
7#include <linux/delay.h>
8#include <linux/dma-mapping.h>
9#include <linux/export.h>
10#include <linux/interrupt.h>
11#include <linux/kernel.h>
12#include <linux/module.h>
13#include <linux/of.h>
14#include <linux/of_platform.h>
15#include <linux/platform_device.h>
16#include <linux/slab.h>
17#include <linux/sort.h>
18#include <linux/tegra-icc.h>
19
20#include <soc/tegra/fuse.h>
21
22#include "mc.h"
23
24static const struct of_device_id tegra_mc_of_match[] = {
25#ifdef CONFIG_ARCH_TEGRA_2x_SOC
26 { .compatible = "nvidia,tegra20-mc-gart", .data = &tegra20_mc_soc },
27#endif
28#ifdef CONFIG_ARCH_TEGRA_3x_SOC
29 { .compatible = "nvidia,tegra30-mc", .data = &tegra30_mc_soc },
30#endif
31#ifdef CONFIG_ARCH_TEGRA_114_SOC
32 { .compatible = "nvidia,tegra114-mc", .data = &tegra114_mc_soc },
33#endif
34#ifdef CONFIG_ARCH_TEGRA_124_SOC
35 { .compatible = "nvidia,tegra124-mc", .data = &tegra124_mc_soc },
36#endif
37#ifdef CONFIG_ARCH_TEGRA_132_SOC
38 { .compatible = "nvidia,tegra132-mc", .data = &tegra132_mc_soc },
39#endif
40#ifdef CONFIG_ARCH_TEGRA_210_SOC
41 { .compatible = "nvidia,tegra210-mc", .data = &tegra210_mc_soc },
42#endif
43#ifdef CONFIG_ARCH_TEGRA_186_SOC
44 { .compatible = "nvidia,tegra186-mc", .data = &tegra186_mc_soc },
45#endif
46#ifdef CONFIG_ARCH_TEGRA_194_SOC
47 { .compatible = "nvidia,tegra194-mc", .data = &tegra194_mc_soc },
48#endif
49#ifdef CONFIG_ARCH_TEGRA_234_SOC
50 { .compatible = "nvidia,tegra234-mc", .data = &tegra234_mc_soc },
51#endif
52 { /* sentinel */ }
53};
54MODULE_DEVICE_TABLE(of, tegra_mc_of_match);
55
56static void tegra_mc_devm_action_put_device(void *data)
57{
58 struct tegra_mc *mc = data;
59
60 put_device(mc->dev);
61}
62
63/**
64 * devm_tegra_memory_controller_get() - get Tegra Memory Controller handle
65 * @dev: device pointer for the consumer device
66 *
67 * This function will search for the Memory Controller node in a device-tree
68 * and retrieve the Memory Controller handle.
69 *
70 * Return: ERR_PTR() on error or a valid pointer to a struct tegra_mc.
71 */
72struct tegra_mc *devm_tegra_memory_controller_get(struct device *dev)
73{
74 struct platform_device *pdev;
75 struct device_node *np;
76 struct tegra_mc *mc;
77 int err;
78
79 np = of_parse_phandle(dev->of_node, "nvidia,memory-controller", 0);
80 if (!np)
81 return ERR_PTR(-ENOENT);
82
83 pdev = of_find_device_by_node(np);
84 of_node_put(np);
85 if (!pdev)
86 return ERR_PTR(-ENODEV);
87
88 mc = platform_get_drvdata(pdev);
89 if (!mc) {
90 put_device(&pdev->dev);
91 return ERR_PTR(-EPROBE_DEFER);
92 }
93
94 err = devm_add_action_or_reset(dev, tegra_mc_devm_action_put_device, mc);
95 if (err)
96 return ERR_PTR(err);
97
98 return mc;
99}
100EXPORT_SYMBOL_GPL(devm_tegra_memory_controller_get);
101
102int tegra_mc_probe_device(struct tegra_mc *mc, struct device *dev)
103{
104 if (mc->soc->ops && mc->soc->ops->probe_device)
105 return mc->soc->ops->probe_device(mc, dev);
106
107 return 0;
108}
109EXPORT_SYMBOL_GPL(tegra_mc_probe_device);
110
111int tegra_mc_get_carveout_info(struct tegra_mc *mc, unsigned int id,
112 phys_addr_t *base, u64 *size)
113{
114 u32 offset;
115
116 if (id < 1 || id >= mc->soc->num_carveouts)
117 return -EINVAL;
118
119 if (id < 6)
120 offset = 0xc0c + 0x50 * (id - 1);
121 else
122 offset = 0x2004 + 0x50 * (id - 6);
123
124 *base = mc_ch_readl(mc, MC_BROADCAST_CHANNEL, offset + 0x0);
125#ifdef CONFIG_PHYS_ADDR_T_64BIT
126 *base |= (phys_addr_t)mc_ch_readl(mc, MC_BROADCAST_CHANNEL, offset + 0x4) << 32;
127#endif
128
129 if (size)
130 *size = mc_ch_readl(mc, MC_BROADCAST_CHANNEL, offset + 0x8) << 17;
131
132 return 0;
133}
134EXPORT_SYMBOL_GPL(tegra_mc_get_carveout_info);
135
136static int tegra_mc_block_dma_common(struct tegra_mc *mc,
137 const struct tegra_mc_reset *rst)
138{
139 unsigned long flags;
140 u32 value;
141
142 spin_lock_irqsave(&mc->lock, flags);
143
144 value = mc_readl(mc, rst->control) | BIT(rst->bit);
145 mc_writel(mc, value, rst->control);
146
147 spin_unlock_irqrestore(&mc->lock, flags);
148
149 return 0;
150}
151
152static bool tegra_mc_dma_idling_common(struct tegra_mc *mc,
153 const struct tegra_mc_reset *rst)
154{
155 return (mc_readl(mc, rst->status) & BIT(rst->bit)) != 0;
156}
157
158static int tegra_mc_unblock_dma_common(struct tegra_mc *mc,
159 const struct tegra_mc_reset *rst)
160{
161 unsigned long flags;
162 u32 value;
163
164 spin_lock_irqsave(&mc->lock, flags);
165
166 value = mc_readl(mc, rst->control) & ~BIT(rst->bit);
167 mc_writel(mc, value, rst->control);
168
169 spin_unlock_irqrestore(&mc->lock, flags);
170
171 return 0;
172}
173
174static int tegra_mc_reset_status_common(struct tegra_mc *mc,
175 const struct tegra_mc_reset *rst)
176{
177 return (mc_readl(mc, rst->control) & BIT(rst->bit)) != 0;
178}
179
180const struct tegra_mc_reset_ops tegra_mc_reset_ops_common = {
181 .block_dma = tegra_mc_block_dma_common,
182 .dma_idling = tegra_mc_dma_idling_common,
183 .unblock_dma = tegra_mc_unblock_dma_common,
184 .reset_status = tegra_mc_reset_status_common,
185};
186
187static inline struct tegra_mc *reset_to_mc(struct reset_controller_dev *rcdev)
188{
189 return container_of(rcdev, struct tegra_mc, reset);
190}
191
192static const struct tegra_mc_reset *tegra_mc_reset_find(struct tegra_mc *mc,
193 unsigned long id)
194{
195 unsigned int i;
196
197 for (i = 0; i < mc->soc->num_resets; i++)
198 if (mc->soc->resets[i].id == id)
199 return &mc->soc->resets[i];
200
201 return NULL;
202}
203
204static int tegra_mc_hotreset_assert(struct reset_controller_dev *rcdev,
205 unsigned long id)
206{
207 struct tegra_mc *mc = reset_to_mc(rcdev);
208 const struct tegra_mc_reset_ops *rst_ops;
209 const struct tegra_mc_reset *rst;
210 int retries = 500;
211 int err;
212
213 rst = tegra_mc_reset_find(mc, id);
214 if (!rst)
215 return -ENODEV;
216
217 rst_ops = mc->soc->reset_ops;
218 if (!rst_ops)
219 return -ENODEV;
220
221 /* DMA flushing will fail if reset is already asserted */
222 if (rst_ops->reset_status) {
223 /* check whether reset is asserted */
224 if (rst_ops->reset_status(mc, rst))
225 return 0;
226 }
227
228 if (rst_ops->block_dma) {
229 /* block clients DMA requests */
230 err = rst_ops->block_dma(mc, rst);
231 if (err) {
232 dev_err(mc->dev, "failed to block %s DMA: %d\n",
233 rst->name, err);
234 return err;
235 }
236 }
237
238 if (rst_ops->dma_idling) {
239 /* wait for completion of the outstanding DMA requests */
240 while (!rst_ops->dma_idling(mc, rst)) {
241 if (!retries--) {
242 dev_err(mc->dev, "failed to flush %s DMA\n",
243 rst->name);
244 return -EBUSY;
245 }
246
247 usleep_range(10, 100);
248 }
249 }
250
251 if (rst_ops->hotreset_assert) {
252 /* clear clients DMA requests sitting before arbitration */
253 err = rst_ops->hotreset_assert(mc, rst);
254 if (err) {
255 dev_err(mc->dev, "failed to hot reset %s: %d\n",
256 rst->name, err);
257 return err;
258 }
259 }
260
261 return 0;
262}
263
264static int tegra_mc_hotreset_deassert(struct reset_controller_dev *rcdev,
265 unsigned long id)
266{
267 struct tegra_mc *mc = reset_to_mc(rcdev);
268 const struct tegra_mc_reset_ops *rst_ops;
269 const struct tegra_mc_reset *rst;
270 int err;
271
272 rst = tegra_mc_reset_find(mc, id);
273 if (!rst)
274 return -ENODEV;
275
276 rst_ops = mc->soc->reset_ops;
277 if (!rst_ops)
278 return -ENODEV;
279
280 if (rst_ops->hotreset_deassert) {
281 /* take out client from hot reset */
282 err = rst_ops->hotreset_deassert(mc, rst);
283 if (err) {
284 dev_err(mc->dev, "failed to deassert hot reset %s: %d\n",
285 rst->name, err);
286 return err;
287 }
288 }
289
290 if (rst_ops->unblock_dma) {
291 /* allow new DMA requests to proceed to arbitration */
292 err = rst_ops->unblock_dma(mc, rst);
293 if (err) {
294 dev_err(mc->dev, "failed to unblock %s DMA : %d\n",
295 rst->name, err);
296 return err;
297 }
298 }
299
300 return 0;
301}
302
303static int tegra_mc_hotreset_status(struct reset_controller_dev *rcdev,
304 unsigned long id)
305{
306 struct tegra_mc *mc = reset_to_mc(rcdev);
307 const struct tegra_mc_reset_ops *rst_ops;
308 const struct tegra_mc_reset *rst;
309
310 rst = tegra_mc_reset_find(mc, id);
311 if (!rst)
312 return -ENODEV;
313
314 rst_ops = mc->soc->reset_ops;
315 if (!rst_ops)
316 return -ENODEV;
317
318 return rst_ops->reset_status(mc, rst);
319}
320
321static const struct reset_control_ops tegra_mc_reset_ops = {
322 .assert = tegra_mc_hotreset_assert,
323 .deassert = tegra_mc_hotreset_deassert,
324 .status = tegra_mc_hotreset_status,
325};
326
327static int tegra_mc_reset_setup(struct tegra_mc *mc)
328{
329 int err;
330
331 mc->reset.ops = &tegra_mc_reset_ops;
332 mc->reset.owner = THIS_MODULE;
333 mc->reset.of_node = mc->dev->of_node;
334 mc->reset.of_reset_n_cells = 1;
335 mc->reset.nr_resets = mc->soc->num_resets;
336
337 err = reset_controller_register(&mc->reset);
338 if (err < 0)
339 return err;
340
341 return 0;
342}
343
344int tegra_mc_write_emem_configuration(struct tegra_mc *mc, unsigned long rate)
345{
346 unsigned int i;
347 struct tegra_mc_timing *timing = NULL;
348
349 for (i = 0; i < mc->num_timings; i++) {
350 if (mc->timings[i].rate == rate) {
351 timing = &mc->timings[i];
352 break;
353 }
354 }
355
356 if (!timing) {
357 dev_err(mc->dev, "no memory timing registered for rate %lu\n",
358 rate);
359 return -EINVAL;
360 }
361
362 for (i = 0; i < mc->soc->num_emem_regs; ++i)
363 mc_writel(mc, timing->emem_data[i], mc->soc->emem_regs[i]);
364
365 return 0;
366}
367EXPORT_SYMBOL_GPL(tegra_mc_write_emem_configuration);
368
369unsigned int tegra_mc_get_emem_device_count(struct tegra_mc *mc)
370{
371 u8 dram_count;
372
373 dram_count = mc_readl(mc, MC_EMEM_ADR_CFG);
374 dram_count &= MC_EMEM_ADR_CFG_EMEM_NUMDEV;
375 dram_count++;
376
377 return dram_count;
378}
379EXPORT_SYMBOL_GPL(tegra_mc_get_emem_device_count);
380
381#if defined(CONFIG_ARCH_TEGRA_3x_SOC) || \
382 defined(CONFIG_ARCH_TEGRA_114_SOC) || \
383 defined(CONFIG_ARCH_TEGRA_124_SOC) || \
384 defined(CONFIG_ARCH_TEGRA_132_SOC) || \
385 defined(CONFIG_ARCH_TEGRA_210_SOC)
386static int tegra_mc_setup_latency_allowance(struct tegra_mc *mc)
387{
388 unsigned long long tick;
389 unsigned int i;
390 u32 value;
391
392 /* compute the number of MC clock cycles per tick */
393 tick = (unsigned long long)mc->tick * clk_get_rate(mc->clk);
394 do_div(tick, NSEC_PER_SEC);
395
396 value = mc_readl(mc, MC_EMEM_ARB_CFG);
397 value &= ~MC_EMEM_ARB_CFG_CYCLES_PER_UPDATE_MASK;
398 value |= MC_EMEM_ARB_CFG_CYCLES_PER_UPDATE(tick);
399 mc_writel(mc, value, MC_EMEM_ARB_CFG);
400
401 /* write latency allowance defaults */
402 for (i = 0; i < mc->soc->num_clients; i++) {
403 const struct tegra_mc_client *client = &mc->soc->clients[i];
404 u32 value;
405
406 value = mc_readl(mc, client->regs.la.reg);
407 value &= ~(client->regs.la.mask << client->regs.la.shift);
408 value |= (client->regs.la.def & client->regs.la.mask) << client->regs.la.shift;
409 mc_writel(mc, value, client->regs.la.reg);
410 }
411
412 /* latch new values */
413 mc_writel(mc, MC_TIMING_UPDATE, MC_TIMING_CONTROL);
414
415 return 0;
416}
417
418static int load_one_timing(struct tegra_mc *mc,
419 struct tegra_mc_timing *timing,
420 struct device_node *node)
421{
422 int err;
423 u32 tmp;
424
425 err = of_property_read_u32(node, "clock-frequency", &tmp);
426 if (err) {
427 dev_err(mc->dev,
428 "timing %pOFn: failed to read rate\n", node);
429 return err;
430 }
431
432 timing->rate = tmp;
433 timing->emem_data = devm_kcalloc(mc->dev, mc->soc->num_emem_regs,
434 sizeof(u32), GFP_KERNEL);
435 if (!timing->emem_data)
436 return -ENOMEM;
437
438 err = of_property_read_u32_array(node, "nvidia,emem-configuration",
439 timing->emem_data,
440 mc->soc->num_emem_regs);
441 if (err) {
442 dev_err(mc->dev,
443 "timing %pOFn: failed to read EMEM configuration\n",
444 node);
445 return err;
446 }
447
448 return 0;
449}
450
451static int load_timings(struct tegra_mc *mc, struct device_node *node)
452{
453 struct device_node *child;
454 struct tegra_mc_timing *timing;
455 int child_count = of_get_child_count(node);
456 int i = 0, err;
457
458 mc->timings = devm_kcalloc(mc->dev, child_count, sizeof(*timing),
459 GFP_KERNEL);
460 if (!mc->timings)
461 return -ENOMEM;
462
463 mc->num_timings = child_count;
464
465 for_each_child_of_node(node, child) {
466 timing = &mc->timings[i++];
467
468 err = load_one_timing(mc, timing, child);
469 if (err) {
470 of_node_put(child);
471 return err;
472 }
473 }
474
475 return 0;
476}
477
478static int tegra_mc_setup_timings(struct tegra_mc *mc)
479{
480 struct device_node *node;
481 u32 ram_code, node_ram_code;
482 int err;
483
484 ram_code = tegra_read_ram_code();
485
486 mc->num_timings = 0;
487
488 for_each_child_of_node(mc->dev->of_node, node) {
489 err = of_property_read_u32(node, "nvidia,ram-code",
490 &node_ram_code);
491 if (err || (node_ram_code != ram_code))
492 continue;
493
494 err = load_timings(mc, node);
495 of_node_put(node);
496 if (err)
497 return err;
498 break;
499 }
500
501 if (mc->num_timings == 0)
502 dev_warn(mc->dev,
503 "no memory timings for RAM code %u registered\n",
504 ram_code);
505
506 return 0;
507}
508
509int tegra30_mc_probe(struct tegra_mc *mc)
510{
511 int err;
512
513 mc->clk = devm_clk_get_optional(mc->dev, "mc");
514 if (IS_ERR(mc->clk)) {
515 dev_err(mc->dev, "failed to get MC clock: %ld\n", PTR_ERR(mc->clk));
516 return PTR_ERR(mc->clk);
517 }
518
519 /* ensure that debug features are disabled */
520 mc_writel(mc, 0x00000000, MC_TIMING_CONTROL_DBG);
521
522 err = tegra_mc_setup_latency_allowance(mc);
523 if (err < 0) {
524 dev_err(mc->dev, "failed to setup latency allowance: %d\n", err);
525 return err;
526 }
527
528 err = tegra_mc_setup_timings(mc);
529 if (err < 0) {
530 dev_err(mc->dev, "failed to setup timings: %d\n", err);
531 return err;
532 }
533
534 return 0;
535}
536
537const struct tegra_mc_ops tegra30_mc_ops = {
538 .probe = tegra30_mc_probe,
539 .handle_irq = tegra30_mc_handle_irq,
540};
541#endif
542
543static int mc_global_intstatus_to_channel(const struct tegra_mc *mc, u32 status,
544 unsigned int *mc_channel)
545{
546 if ((status & mc->soc->ch_intmask) == 0)
547 return -EINVAL;
548
549 *mc_channel = __ffs((status & mc->soc->ch_intmask) >>
550 mc->soc->global_intstatus_channel_shift);
551
552 return 0;
553}
554
555static u32 mc_channel_to_global_intstatus(const struct tegra_mc *mc,
556 unsigned int channel)
557{
558 return BIT(channel) << mc->soc->global_intstatus_channel_shift;
559}
560
561irqreturn_t tegra30_mc_handle_irq(int irq, void *data)
562{
563 struct tegra_mc *mc = data;
564 unsigned int bit, channel;
565 unsigned long status;
566
567 if (mc->soc->num_channels) {
568 u32 global_status;
569 int err;
570
571 global_status = mc_ch_readl(mc, MC_BROADCAST_CHANNEL, MC_GLOBAL_INTSTATUS);
572 err = mc_global_intstatus_to_channel(mc, global_status, &channel);
573 if (err < 0) {
574 dev_err_ratelimited(mc->dev, "unknown interrupt channel 0x%08x\n",
575 global_status);
576 return IRQ_NONE;
577 }
578
579 /* mask all interrupts to avoid flooding */
580 status = mc_ch_readl(mc, channel, MC_INTSTATUS) & mc->soc->intmask;
581 } else {
582 status = mc_readl(mc, MC_INTSTATUS) & mc->soc->intmask;
583 }
584
585 if (!status)
586 return IRQ_NONE;
587
588 for_each_set_bit(bit, &status, 32) {
589 const char *error = tegra_mc_status_names[bit] ?: "unknown";
590 const char *client = "unknown", *desc;
591 const char *direction, *secure;
592 u32 status_reg, addr_reg;
593 u32 intmask = BIT(bit);
594 phys_addr_t addr = 0;
595#ifdef CONFIG_PHYS_ADDR_T_64BIT
596 u32 addr_hi_reg = 0;
597#endif
598 unsigned int i;
599 char perm[7];
600 u8 id, type;
601 u32 value;
602
603 switch (intmask) {
604 case MC_INT_DECERR_VPR:
605 status_reg = MC_ERR_VPR_STATUS;
606 addr_reg = MC_ERR_VPR_ADR;
607 break;
608
609 case MC_INT_SECERR_SEC:
610 status_reg = MC_ERR_SEC_STATUS;
611 addr_reg = MC_ERR_SEC_ADR;
612 break;
613
614 case MC_INT_DECERR_MTS:
615 status_reg = MC_ERR_MTS_STATUS;
616 addr_reg = MC_ERR_MTS_ADR;
617 break;
618
619 case MC_INT_DECERR_GENERALIZED_CARVEOUT:
620 status_reg = MC_ERR_GENERALIZED_CARVEOUT_STATUS;
621 addr_reg = MC_ERR_GENERALIZED_CARVEOUT_ADR;
622 break;
623
624 case MC_INT_DECERR_ROUTE_SANITY:
625 status_reg = MC_ERR_ROUTE_SANITY_STATUS;
626 addr_reg = MC_ERR_ROUTE_SANITY_ADR;
627 break;
628
629 default:
630 status_reg = MC_ERR_STATUS;
631 addr_reg = MC_ERR_ADR;
632
633#ifdef CONFIG_PHYS_ADDR_T_64BIT
634 if (mc->soc->has_addr_hi_reg)
635 addr_hi_reg = MC_ERR_ADR_HI;
636#endif
637 break;
638 }
639
640 if (mc->soc->num_channels)
641 value = mc_ch_readl(mc, channel, status_reg);
642 else
643 value = mc_readl(mc, status_reg);
644
645#ifdef CONFIG_PHYS_ADDR_T_64BIT
646 if (mc->soc->num_address_bits > 32) {
647 if (addr_hi_reg) {
648 if (mc->soc->num_channels)
649 addr = mc_ch_readl(mc, channel, addr_hi_reg);
650 else
651 addr = mc_readl(mc, addr_hi_reg);
652 } else {
653 addr = ((value >> MC_ERR_STATUS_ADR_HI_SHIFT) &
654 MC_ERR_STATUS_ADR_HI_MASK);
655 }
656 addr <<= 32;
657 }
658#endif
659
660 if (value & MC_ERR_STATUS_RW)
661 direction = "write";
662 else
663 direction = "read";
664
665 if (value & MC_ERR_STATUS_SECURITY)
666 secure = "secure ";
667 else
668 secure = "";
669
670 id = value & mc->soc->client_id_mask;
671
672 for (i = 0; i < mc->soc->num_clients; i++) {
673 if (mc->soc->clients[i].id == id) {
674 client = mc->soc->clients[i].name;
675 break;
676 }
677 }
678
679 type = (value & MC_ERR_STATUS_TYPE_MASK) >>
680 MC_ERR_STATUS_TYPE_SHIFT;
681 desc = tegra_mc_error_names[type];
682
683 switch (value & MC_ERR_STATUS_TYPE_MASK) {
684 case MC_ERR_STATUS_TYPE_INVALID_SMMU_PAGE:
685 perm[0] = ' ';
686 perm[1] = '[';
687
688 if (value & MC_ERR_STATUS_READABLE)
689 perm[2] = 'R';
690 else
691 perm[2] = '-';
692
693 if (value & MC_ERR_STATUS_WRITABLE)
694 perm[3] = 'W';
695 else
696 perm[3] = '-';
697
698 if (value & MC_ERR_STATUS_NONSECURE)
699 perm[4] = '-';
700 else
701 perm[4] = 'S';
702
703 perm[5] = ']';
704 perm[6] = '\0';
705 break;
706
707 default:
708 perm[0] = '\0';
709 break;
710 }
711
712 if (mc->soc->num_channels)
713 value = mc_ch_readl(mc, channel, addr_reg);
714 else
715 value = mc_readl(mc, addr_reg);
716 addr |= value;
717
718 dev_err_ratelimited(mc->dev, "%s: %s%s @%pa: %s (%s%s)\n",
719 client, secure, direction, &addr, error,
720 desc, perm);
721 }
722
723 /* clear interrupts */
724 if (mc->soc->num_channels) {
725 mc_ch_writel(mc, channel, status, MC_INTSTATUS);
726 mc_ch_writel(mc, MC_BROADCAST_CHANNEL,
727 mc_channel_to_global_intstatus(mc, channel),
728 MC_GLOBAL_INTSTATUS);
729 } else {
730 mc_writel(mc, status, MC_INTSTATUS);
731 }
732
733 return IRQ_HANDLED;
734}
735
736const char *const tegra_mc_status_names[32] = {
737 [ 1] = "External interrupt",
738 [ 6] = "EMEM address decode error",
739 [ 7] = "GART page fault",
740 [ 8] = "Security violation",
741 [ 9] = "EMEM arbitration error",
742 [10] = "Page fault",
743 [11] = "Invalid APB ASID update",
744 [12] = "VPR violation",
745 [13] = "Secure carveout violation",
746 [16] = "MTS carveout violation",
747 [17] = "Generalized carveout violation",
748 [20] = "Route Sanity error",
749};
750
751const char *const tegra_mc_error_names[8] = {
752 [2] = "EMEM decode error",
753 [3] = "TrustZone violation",
754 [4] = "Carveout violation",
755 [6] = "SMMU translation error",
756};
757
758struct icc_node *tegra_mc_icc_xlate(struct of_phandle_args *spec, void *data)
759{
760 struct tegra_mc *mc = icc_provider_to_tegra_mc(data);
761 struct icc_node *node;
762
763 list_for_each_entry(node, &mc->provider.nodes, node_list) {
764 if (node->id == spec->args[0])
765 return node;
766 }
767
768 /*
769 * If a client driver calls devm_of_icc_get() before the MC driver
770 * is probed, then return EPROBE_DEFER to the client driver.
771 */
772 return ERR_PTR(-EPROBE_DEFER);
773}
774
775static int tegra_mc_icc_get(struct icc_node *node, u32 *average, u32 *peak)
776{
777 *average = 0;
778 *peak = 0;
779
780 return 0;
781}
782
783static int tegra_mc_icc_set(struct icc_node *src, struct icc_node *dst)
784{
785 return 0;
786}
787
788const struct tegra_mc_icc_ops tegra_mc_icc_ops = {
789 .xlate = tegra_mc_icc_xlate,
790 .aggregate = icc_std_aggregate,
791 .get_bw = tegra_mc_icc_get,
792 .set = tegra_mc_icc_set,
793};
794
795/*
796 * Memory Controller (MC) has few Memory Clients that are issuing memory
797 * bandwidth allocation requests to the MC interconnect provider. The MC
798 * provider aggregates the requests and then sends the aggregated request
799 * up to the External Memory Controller (EMC) interconnect provider which
800 * re-configures hardware interface to External Memory (EMEM) in accordance
801 * to the required bandwidth. Each MC interconnect node represents an
802 * individual Memory Client.
803 *
804 * Memory interconnect topology:
805 *
806 * +----+
807 * +--------+ | |
808 * | TEXSRD +--->+ |
809 * +--------+ | |
810 * | | +-----+ +------+
811 * ... | MC +--->+ EMC +--->+ EMEM |
812 * | | +-----+ +------+
813 * +--------+ | |
814 * | DISP.. +--->+ |
815 * +--------+ | |
816 * +----+
817 */
818static int tegra_mc_interconnect_setup(struct tegra_mc *mc)
819{
820 struct icc_node *node;
821 unsigned int i;
822 int err;
823
824 /* older device-trees don't have interconnect properties */
825 if (!device_property_present(mc->dev, "#interconnect-cells") ||
826 !mc->soc->icc_ops)
827 return 0;
828
829 mc->provider.dev = mc->dev;
830 mc->provider.data = &mc->provider;
831 mc->provider.set = mc->soc->icc_ops->set;
832 mc->provider.aggregate = mc->soc->icc_ops->aggregate;
833 mc->provider.get_bw = mc->soc->icc_ops->get_bw;
834 mc->provider.xlate = mc->soc->icc_ops->xlate;
835 mc->provider.xlate_extended = mc->soc->icc_ops->xlate_extended;
836
837 icc_provider_init(&mc->provider);
838
839 /* create Memory Controller node */
840 node = icc_node_create(TEGRA_ICC_MC);
841 if (IS_ERR(node))
842 return PTR_ERR(node);
843
844 node->name = "Memory Controller";
845 icc_node_add(node, &mc->provider);
846
847 /* link Memory Controller to External Memory Controller */
848 err = icc_link_create(node, TEGRA_ICC_EMC);
849 if (err)
850 goto remove_nodes;
851
852 for (i = 0; i < mc->soc->num_clients; i++) {
853 /* create MC client node */
854 node = icc_node_create(mc->soc->clients[i].id);
855 if (IS_ERR(node)) {
856 err = PTR_ERR(node);
857 goto remove_nodes;
858 }
859
860 node->name = mc->soc->clients[i].name;
861 icc_node_add(node, &mc->provider);
862
863 /* link Memory Client to Memory Controller */
864 err = icc_link_create(node, TEGRA_ICC_MC);
865 if (err)
866 goto remove_nodes;
867
868 node->data = (struct tegra_mc_client *)&(mc->soc->clients[i]);
869 }
870
871 err = icc_provider_register(&mc->provider);
872 if (err)
873 goto remove_nodes;
874
875 return 0;
876
877remove_nodes:
878 icc_nodes_remove(&mc->provider);
879
880 return err;
881}
882
883static void tegra_mc_num_channel_enabled(struct tegra_mc *mc)
884{
885 unsigned int i;
886 u32 value;
887
888 value = mc_ch_readl(mc, 0, MC_EMEM_ADR_CFG_CHANNEL_ENABLE);
889 if (value <= 0) {
890 mc->num_channels = mc->soc->num_channels;
891 return;
892 }
893
894 for (i = 0; i < 32; i++) {
895 if (value & BIT(i))
896 mc->num_channels++;
897 }
898}
899
900static int tegra_mc_probe(struct platform_device *pdev)
901{
902 struct tegra_mc *mc;
903 u64 mask;
904 int err;
905
906 mc = devm_kzalloc(&pdev->dev, sizeof(*mc), GFP_KERNEL);
907 if (!mc)
908 return -ENOMEM;
909
910 platform_set_drvdata(pdev, mc);
911 spin_lock_init(&mc->lock);
912 mc->soc = of_device_get_match_data(&pdev->dev);
913 mc->dev = &pdev->dev;
914
915 mask = DMA_BIT_MASK(mc->soc->num_address_bits);
916
917 err = dma_coerce_mask_and_coherent(&pdev->dev, mask);
918 if (err < 0) {
919 dev_err(&pdev->dev, "failed to set DMA mask: %d\n", err);
920 return err;
921 }
922
923 /* length of MC tick in nanoseconds */
924 mc->tick = 30;
925
926 mc->regs = devm_platform_ioremap_resource(pdev, 0);
927 if (IS_ERR(mc->regs))
928 return PTR_ERR(mc->regs);
929
930 mc->debugfs.root = debugfs_create_dir("mc", NULL);
931
932 if (mc->soc->ops && mc->soc->ops->probe) {
933 err = mc->soc->ops->probe(mc);
934 if (err < 0)
935 return err;
936 }
937
938 tegra_mc_num_channel_enabled(mc);
939
940 if (mc->soc->ops && mc->soc->ops->handle_irq) {
941 mc->irq = platform_get_irq(pdev, 0);
942 if (mc->irq < 0)
943 return mc->irq;
944
945 WARN(!mc->soc->client_id_mask, "missing client ID mask for this SoC\n");
946
947 if (mc->soc->num_channels)
948 mc_ch_writel(mc, MC_BROADCAST_CHANNEL, mc->soc->intmask,
949 MC_INTMASK);
950 else
951 mc_writel(mc, mc->soc->intmask, MC_INTMASK);
952
953 err = devm_request_irq(&pdev->dev, mc->irq, mc->soc->ops->handle_irq, 0,
954 dev_name(&pdev->dev), mc);
955 if (err < 0) {
956 dev_err(&pdev->dev, "failed to request IRQ#%u: %d\n", mc->irq,
957 err);
958 return err;
959 }
960 }
961
962 if (mc->soc->reset_ops) {
963 err = tegra_mc_reset_setup(mc);
964 if (err < 0)
965 dev_err(&pdev->dev, "failed to register reset controller: %d\n", err);
966 }
967
968 err = tegra_mc_interconnect_setup(mc);
969 if (err < 0)
970 dev_err(&pdev->dev, "failed to initialize interconnect: %d\n",
971 err);
972
973 if (IS_ENABLED(CONFIG_TEGRA_IOMMU_SMMU) && mc->soc->smmu) {
974 mc->smmu = tegra_smmu_probe(&pdev->dev, mc->soc->smmu, mc);
975 if (IS_ERR(mc->smmu)) {
976 dev_err(&pdev->dev, "failed to probe SMMU: %ld\n",
977 PTR_ERR(mc->smmu));
978 mc->smmu = NULL;
979 }
980 }
981
982 return 0;
983}
984
985static void tegra_mc_sync_state(struct device *dev)
986{
987 struct tegra_mc *mc = dev_get_drvdata(dev);
988
989 /* check whether ICC provider is registered */
990 if (mc->provider.dev == dev)
991 icc_sync_state(dev);
992}
993
994static struct platform_driver tegra_mc_driver = {
995 .driver = {
996 .name = "tegra-mc",
997 .of_match_table = tegra_mc_of_match,
998 .suppress_bind_attrs = true,
999 .sync_state = tegra_mc_sync_state,
1000 },
1001 .prevent_deferred_probe = true,
1002 .probe = tegra_mc_probe,
1003};
1004
1005static int tegra_mc_init(void)
1006{
1007 return platform_driver_register(&tegra_mc_driver);
1008}
1009arch_initcall(tegra_mc_init);
1010
1011MODULE_AUTHOR("Thierry Reding <treding@nvidia.com>");
1012MODULE_DESCRIPTION("NVIDIA Tegra Memory Controller driver");
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright (C) 2014 NVIDIA CORPORATION. All rights reserved.
4 */
5
6#include <linux/clk.h>
7#include <linux/delay.h>
8#include <linux/interrupt.h>
9#include <linux/kernel.h>
10#include <linux/module.h>
11#include <linux/of.h>
12#include <linux/of_device.h>
13#include <linux/platform_device.h>
14#include <linux/slab.h>
15#include <linux/sort.h>
16
17#include <soc/tegra/fuse.h>
18
19#include "mc.h"
20
21#define MC_INTSTATUS 0x000
22
23#define MC_INTMASK 0x004
24
25#define MC_ERR_STATUS 0x08
26#define MC_ERR_STATUS_TYPE_SHIFT 28
27#define MC_ERR_STATUS_TYPE_INVALID_SMMU_PAGE (6 << MC_ERR_STATUS_TYPE_SHIFT)
28#define MC_ERR_STATUS_TYPE_MASK (0x7 << MC_ERR_STATUS_TYPE_SHIFT)
29#define MC_ERR_STATUS_READABLE (1 << 27)
30#define MC_ERR_STATUS_WRITABLE (1 << 26)
31#define MC_ERR_STATUS_NONSECURE (1 << 25)
32#define MC_ERR_STATUS_ADR_HI_SHIFT 20
33#define MC_ERR_STATUS_ADR_HI_MASK 0x3
34#define MC_ERR_STATUS_SECURITY (1 << 17)
35#define MC_ERR_STATUS_RW (1 << 16)
36
37#define MC_ERR_ADR 0x0c
38
39#define MC_GART_ERROR_REQ 0x30
40#define MC_DECERR_EMEM_OTHERS_STATUS 0x58
41#define MC_SECURITY_VIOLATION_STATUS 0x74
42
43#define MC_EMEM_ARB_CFG 0x90
44#define MC_EMEM_ARB_CFG_CYCLES_PER_UPDATE(x) (((x) & 0x1ff) << 0)
45#define MC_EMEM_ARB_CFG_CYCLES_PER_UPDATE_MASK 0x1ff
46#define MC_EMEM_ARB_MISC0 0xd8
47
48#define MC_EMEM_ADR_CFG 0x54
49#define MC_EMEM_ADR_CFG_EMEM_NUMDEV BIT(0)
50
51#define MC_TIMING_CONTROL 0xfc
52#define MC_TIMING_UPDATE BIT(0)
53
54static const struct of_device_id tegra_mc_of_match[] = {
55#ifdef CONFIG_ARCH_TEGRA_2x_SOC
56 { .compatible = "nvidia,tegra20-mc-gart", .data = &tegra20_mc_soc },
57#endif
58#ifdef CONFIG_ARCH_TEGRA_3x_SOC
59 { .compatible = "nvidia,tegra30-mc", .data = &tegra30_mc_soc },
60#endif
61#ifdef CONFIG_ARCH_TEGRA_114_SOC
62 { .compatible = "nvidia,tegra114-mc", .data = &tegra114_mc_soc },
63#endif
64#ifdef CONFIG_ARCH_TEGRA_124_SOC
65 { .compatible = "nvidia,tegra124-mc", .data = &tegra124_mc_soc },
66#endif
67#ifdef CONFIG_ARCH_TEGRA_132_SOC
68 { .compatible = "nvidia,tegra132-mc", .data = &tegra132_mc_soc },
69#endif
70#ifdef CONFIG_ARCH_TEGRA_210_SOC
71 { .compatible = "nvidia,tegra210-mc", .data = &tegra210_mc_soc },
72#endif
73 { }
74};
75MODULE_DEVICE_TABLE(of, tegra_mc_of_match);
76
77static int tegra_mc_block_dma_common(struct tegra_mc *mc,
78 const struct tegra_mc_reset *rst)
79{
80 unsigned long flags;
81 u32 value;
82
83 spin_lock_irqsave(&mc->lock, flags);
84
85 value = mc_readl(mc, rst->control) | BIT(rst->bit);
86 mc_writel(mc, value, rst->control);
87
88 spin_unlock_irqrestore(&mc->lock, flags);
89
90 return 0;
91}
92
93static bool tegra_mc_dma_idling_common(struct tegra_mc *mc,
94 const struct tegra_mc_reset *rst)
95{
96 return (mc_readl(mc, rst->status) & BIT(rst->bit)) != 0;
97}
98
99static int tegra_mc_unblock_dma_common(struct tegra_mc *mc,
100 const struct tegra_mc_reset *rst)
101{
102 unsigned long flags;
103 u32 value;
104
105 spin_lock_irqsave(&mc->lock, flags);
106
107 value = mc_readl(mc, rst->control) & ~BIT(rst->bit);
108 mc_writel(mc, value, rst->control);
109
110 spin_unlock_irqrestore(&mc->lock, flags);
111
112 return 0;
113}
114
115static int tegra_mc_reset_status_common(struct tegra_mc *mc,
116 const struct tegra_mc_reset *rst)
117{
118 return (mc_readl(mc, rst->control) & BIT(rst->bit)) != 0;
119}
120
121const struct tegra_mc_reset_ops tegra_mc_reset_ops_common = {
122 .block_dma = tegra_mc_block_dma_common,
123 .dma_idling = tegra_mc_dma_idling_common,
124 .unblock_dma = tegra_mc_unblock_dma_common,
125 .reset_status = tegra_mc_reset_status_common,
126};
127
128static inline struct tegra_mc *reset_to_mc(struct reset_controller_dev *rcdev)
129{
130 return container_of(rcdev, struct tegra_mc, reset);
131}
132
133static const struct tegra_mc_reset *tegra_mc_reset_find(struct tegra_mc *mc,
134 unsigned long id)
135{
136 unsigned int i;
137
138 for (i = 0; i < mc->soc->num_resets; i++)
139 if (mc->soc->resets[i].id == id)
140 return &mc->soc->resets[i];
141
142 return NULL;
143}
144
145static int tegra_mc_hotreset_assert(struct reset_controller_dev *rcdev,
146 unsigned long id)
147{
148 struct tegra_mc *mc = reset_to_mc(rcdev);
149 const struct tegra_mc_reset_ops *rst_ops;
150 const struct tegra_mc_reset *rst;
151 int retries = 500;
152 int err;
153
154 rst = tegra_mc_reset_find(mc, id);
155 if (!rst)
156 return -ENODEV;
157
158 rst_ops = mc->soc->reset_ops;
159 if (!rst_ops)
160 return -ENODEV;
161
162 if (rst_ops->block_dma) {
163 /* block clients DMA requests */
164 err = rst_ops->block_dma(mc, rst);
165 if (err) {
166 dev_err(mc->dev, "failed to block %s DMA: %d\n",
167 rst->name, err);
168 return err;
169 }
170 }
171
172 if (rst_ops->dma_idling) {
173 /* wait for completion of the outstanding DMA requests */
174 while (!rst_ops->dma_idling(mc, rst)) {
175 if (!retries--) {
176 dev_err(mc->dev, "failed to flush %s DMA\n",
177 rst->name);
178 return -EBUSY;
179 }
180
181 usleep_range(10, 100);
182 }
183 }
184
185 if (rst_ops->hotreset_assert) {
186 /* clear clients DMA requests sitting before arbitration */
187 err = rst_ops->hotreset_assert(mc, rst);
188 if (err) {
189 dev_err(mc->dev, "failed to hot reset %s: %d\n",
190 rst->name, err);
191 return err;
192 }
193 }
194
195 return 0;
196}
197
198static int tegra_mc_hotreset_deassert(struct reset_controller_dev *rcdev,
199 unsigned long id)
200{
201 struct tegra_mc *mc = reset_to_mc(rcdev);
202 const struct tegra_mc_reset_ops *rst_ops;
203 const struct tegra_mc_reset *rst;
204 int err;
205
206 rst = tegra_mc_reset_find(mc, id);
207 if (!rst)
208 return -ENODEV;
209
210 rst_ops = mc->soc->reset_ops;
211 if (!rst_ops)
212 return -ENODEV;
213
214 if (rst_ops->hotreset_deassert) {
215 /* take out client from hot reset */
216 err = rst_ops->hotreset_deassert(mc, rst);
217 if (err) {
218 dev_err(mc->dev, "failed to deassert hot reset %s: %d\n",
219 rst->name, err);
220 return err;
221 }
222 }
223
224 if (rst_ops->unblock_dma) {
225 /* allow new DMA requests to proceed to arbitration */
226 err = rst_ops->unblock_dma(mc, rst);
227 if (err) {
228 dev_err(mc->dev, "failed to unblock %s DMA : %d\n",
229 rst->name, err);
230 return err;
231 }
232 }
233
234 return 0;
235}
236
237static int tegra_mc_hotreset_status(struct reset_controller_dev *rcdev,
238 unsigned long id)
239{
240 struct tegra_mc *mc = reset_to_mc(rcdev);
241 const struct tegra_mc_reset_ops *rst_ops;
242 const struct tegra_mc_reset *rst;
243
244 rst = tegra_mc_reset_find(mc, id);
245 if (!rst)
246 return -ENODEV;
247
248 rst_ops = mc->soc->reset_ops;
249 if (!rst_ops)
250 return -ENODEV;
251
252 return rst_ops->reset_status(mc, rst);
253}
254
255static const struct reset_control_ops tegra_mc_reset_ops = {
256 .assert = tegra_mc_hotreset_assert,
257 .deassert = tegra_mc_hotreset_deassert,
258 .status = tegra_mc_hotreset_status,
259};
260
261static int tegra_mc_reset_setup(struct tegra_mc *mc)
262{
263 int err;
264
265 mc->reset.ops = &tegra_mc_reset_ops;
266 mc->reset.owner = THIS_MODULE;
267 mc->reset.of_node = mc->dev->of_node;
268 mc->reset.of_reset_n_cells = 1;
269 mc->reset.nr_resets = mc->soc->num_resets;
270
271 err = reset_controller_register(&mc->reset);
272 if (err < 0)
273 return err;
274
275 return 0;
276}
277
278static int tegra_mc_setup_latency_allowance(struct tegra_mc *mc)
279{
280 unsigned long long tick;
281 unsigned int i;
282 u32 value;
283
284 /* compute the number of MC clock cycles per tick */
285 tick = (unsigned long long)mc->tick * clk_get_rate(mc->clk);
286 do_div(tick, NSEC_PER_SEC);
287
288 value = mc_readl(mc, MC_EMEM_ARB_CFG);
289 value &= ~MC_EMEM_ARB_CFG_CYCLES_PER_UPDATE_MASK;
290 value |= MC_EMEM_ARB_CFG_CYCLES_PER_UPDATE(tick);
291 mc_writel(mc, value, MC_EMEM_ARB_CFG);
292
293 /* write latency allowance defaults */
294 for (i = 0; i < mc->soc->num_clients; i++) {
295 const struct tegra_mc_la *la = &mc->soc->clients[i].la;
296 u32 value;
297
298 value = mc_readl(mc, la->reg);
299 value &= ~(la->mask << la->shift);
300 value |= (la->def & la->mask) << la->shift;
301 mc_writel(mc, value, la->reg);
302 }
303
304 /* latch new values */
305 mc_writel(mc, MC_TIMING_UPDATE, MC_TIMING_CONTROL);
306
307 return 0;
308}
309
310void tegra_mc_write_emem_configuration(struct tegra_mc *mc, unsigned long rate)
311{
312 unsigned int i;
313 struct tegra_mc_timing *timing = NULL;
314
315 for (i = 0; i < mc->num_timings; i++) {
316 if (mc->timings[i].rate == rate) {
317 timing = &mc->timings[i];
318 break;
319 }
320 }
321
322 if (!timing) {
323 dev_err(mc->dev, "no memory timing registered for rate %lu\n",
324 rate);
325 return;
326 }
327
328 for (i = 0; i < mc->soc->num_emem_regs; ++i)
329 mc_writel(mc, timing->emem_data[i], mc->soc->emem_regs[i]);
330}
331
332unsigned int tegra_mc_get_emem_device_count(struct tegra_mc *mc)
333{
334 u8 dram_count;
335
336 dram_count = mc_readl(mc, MC_EMEM_ADR_CFG);
337 dram_count &= MC_EMEM_ADR_CFG_EMEM_NUMDEV;
338 dram_count++;
339
340 return dram_count;
341}
342
343static int load_one_timing(struct tegra_mc *mc,
344 struct tegra_mc_timing *timing,
345 struct device_node *node)
346{
347 int err;
348 u32 tmp;
349
350 err = of_property_read_u32(node, "clock-frequency", &tmp);
351 if (err) {
352 dev_err(mc->dev,
353 "timing %pOFn: failed to read rate\n", node);
354 return err;
355 }
356
357 timing->rate = tmp;
358 timing->emem_data = devm_kcalloc(mc->dev, mc->soc->num_emem_regs,
359 sizeof(u32), GFP_KERNEL);
360 if (!timing->emem_data)
361 return -ENOMEM;
362
363 err = of_property_read_u32_array(node, "nvidia,emem-configuration",
364 timing->emem_data,
365 mc->soc->num_emem_regs);
366 if (err) {
367 dev_err(mc->dev,
368 "timing %pOFn: failed to read EMEM configuration\n",
369 node);
370 return err;
371 }
372
373 return 0;
374}
375
376static int load_timings(struct tegra_mc *mc, struct device_node *node)
377{
378 struct device_node *child;
379 struct tegra_mc_timing *timing;
380 int child_count = of_get_child_count(node);
381 int i = 0, err;
382
383 mc->timings = devm_kcalloc(mc->dev, child_count, sizeof(*timing),
384 GFP_KERNEL);
385 if (!mc->timings)
386 return -ENOMEM;
387
388 mc->num_timings = child_count;
389
390 for_each_child_of_node(node, child) {
391 timing = &mc->timings[i++];
392
393 err = load_one_timing(mc, timing, child);
394 if (err) {
395 of_node_put(child);
396 return err;
397 }
398 }
399
400 return 0;
401}
402
403static int tegra_mc_setup_timings(struct tegra_mc *mc)
404{
405 struct device_node *node;
406 u32 ram_code, node_ram_code;
407 int err;
408
409 ram_code = tegra_read_ram_code();
410
411 mc->num_timings = 0;
412
413 for_each_child_of_node(mc->dev->of_node, node) {
414 err = of_property_read_u32(node, "nvidia,ram-code",
415 &node_ram_code);
416 if (err || (node_ram_code != ram_code))
417 continue;
418
419 err = load_timings(mc, node);
420 of_node_put(node);
421 if (err)
422 return err;
423 break;
424 }
425
426 if (mc->num_timings == 0)
427 dev_warn(mc->dev,
428 "no memory timings for RAM code %u registered\n",
429 ram_code);
430
431 return 0;
432}
433
434static const char *const status_names[32] = {
435 [ 1] = "External interrupt",
436 [ 6] = "EMEM address decode error",
437 [ 7] = "GART page fault",
438 [ 8] = "Security violation",
439 [ 9] = "EMEM arbitration error",
440 [10] = "Page fault",
441 [11] = "Invalid APB ASID update",
442 [12] = "VPR violation",
443 [13] = "Secure carveout violation",
444 [16] = "MTS carveout violation",
445};
446
447static const char *const error_names[8] = {
448 [2] = "EMEM decode error",
449 [3] = "TrustZone violation",
450 [4] = "Carveout violation",
451 [6] = "SMMU translation error",
452};
453
454static irqreturn_t tegra_mc_irq(int irq, void *data)
455{
456 struct tegra_mc *mc = data;
457 unsigned long status;
458 unsigned int bit;
459
460 /* mask all interrupts to avoid flooding */
461 status = mc_readl(mc, MC_INTSTATUS) & mc->soc->intmask;
462 if (!status)
463 return IRQ_NONE;
464
465 for_each_set_bit(bit, &status, 32) {
466 const char *error = status_names[bit] ?: "unknown";
467 const char *client = "unknown", *desc;
468 const char *direction, *secure;
469 phys_addr_t addr = 0;
470 unsigned int i;
471 char perm[7];
472 u8 id, type;
473 u32 value;
474
475 value = mc_readl(mc, MC_ERR_STATUS);
476
477#ifdef CONFIG_PHYS_ADDR_T_64BIT
478 if (mc->soc->num_address_bits > 32) {
479 addr = ((value >> MC_ERR_STATUS_ADR_HI_SHIFT) &
480 MC_ERR_STATUS_ADR_HI_MASK);
481 addr <<= 32;
482 }
483#endif
484
485 if (value & MC_ERR_STATUS_RW)
486 direction = "write";
487 else
488 direction = "read";
489
490 if (value & MC_ERR_STATUS_SECURITY)
491 secure = "secure ";
492 else
493 secure = "";
494
495 id = value & mc->soc->client_id_mask;
496
497 for (i = 0; i < mc->soc->num_clients; i++) {
498 if (mc->soc->clients[i].id == id) {
499 client = mc->soc->clients[i].name;
500 break;
501 }
502 }
503
504 type = (value & MC_ERR_STATUS_TYPE_MASK) >>
505 MC_ERR_STATUS_TYPE_SHIFT;
506 desc = error_names[type];
507
508 switch (value & MC_ERR_STATUS_TYPE_MASK) {
509 case MC_ERR_STATUS_TYPE_INVALID_SMMU_PAGE:
510 perm[0] = ' ';
511 perm[1] = '[';
512
513 if (value & MC_ERR_STATUS_READABLE)
514 perm[2] = 'R';
515 else
516 perm[2] = '-';
517
518 if (value & MC_ERR_STATUS_WRITABLE)
519 perm[3] = 'W';
520 else
521 perm[3] = '-';
522
523 if (value & MC_ERR_STATUS_NONSECURE)
524 perm[4] = '-';
525 else
526 perm[4] = 'S';
527
528 perm[5] = ']';
529 perm[6] = '\0';
530 break;
531
532 default:
533 perm[0] = '\0';
534 break;
535 }
536
537 value = mc_readl(mc, MC_ERR_ADR);
538 addr |= value;
539
540 dev_err_ratelimited(mc->dev, "%s: %s%s @%pa: %s (%s%s)\n",
541 client, secure, direction, &addr, error,
542 desc, perm);
543 }
544
545 /* clear interrupts */
546 mc_writel(mc, status, MC_INTSTATUS);
547
548 return IRQ_HANDLED;
549}
550
551static __maybe_unused irqreturn_t tegra20_mc_irq(int irq, void *data)
552{
553 struct tegra_mc *mc = data;
554 unsigned long status;
555 unsigned int bit;
556
557 /* mask all interrupts to avoid flooding */
558 status = mc_readl(mc, MC_INTSTATUS) & mc->soc->intmask;
559 if (!status)
560 return IRQ_NONE;
561
562 for_each_set_bit(bit, &status, 32) {
563 const char *direction = "read", *secure = "";
564 const char *error = status_names[bit];
565 const char *client, *desc;
566 phys_addr_t addr;
567 u32 value, reg;
568 u8 id, type;
569
570 switch (BIT(bit)) {
571 case MC_INT_DECERR_EMEM:
572 reg = MC_DECERR_EMEM_OTHERS_STATUS;
573 value = mc_readl(mc, reg);
574
575 id = value & mc->soc->client_id_mask;
576 desc = error_names[2];
577
578 if (value & BIT(31))
579 direction = "write";
580 break;
581
582 case MC_INT_INVALID_GART_PAGE:
583 reg = MC_GART_ERROR_REQ;
584 value = mc_readl(mc, reg);
585
586 id = (value >> 1) & mc->soc->client_id_mask;
587 desc = error_names[2];
588
589 if (value & BIT(0))
590 direction = "write";
591 break;
592
593 case MC_INT_SECURITY_VIOLATION:
594 reg = MC_SECURITY_VIOLATION_STATUS;
595 value = mc_readl(mc, reg);
596
597 id = value & mc->soc->client_id_mask;
598 type = (value & BIT(30)) ? 4 : 3;
599 desc = error_names[type];
600 secure = "secure ";
601
602 if (value & BIT(31))
603 direction = "write";
604 break;
605
606 default:
607 continue;
608 }
609
610 client = mc->soc->clients[id].name;
611 addr = mc_readl(mc, reg + sizeof(u32));
612
613 dev_err_ratelimited(mc->dev, "%s: %s%s @%pa: %s (%s)\n",
614 client, secure, direction, &addr, error,
615 desc);
616 }
617
618 /* clear interrupts */
619 mc_writel(mc, status, MC_INTSTATUS);
620
621 return IRQ_HANDLED;
622}
623
624static int tegra_mc_probe(struct platform_device *pdev)
625{
626 struct resource *res;
627 struct tegra_mc *mc;
628 void *isr;
629 int err;
630
631 mc = devm_kzalloc(&pdev->dev, sizeof(*mc), GFP_KERNEL);
632 if (!mc)
633 return -ENOMEM;
634
635 platform_set_drvdata(pdev, mc);
636 spin_lock_init(&mc->lock);
637 mc->soc = of_device_get_match_data(&pdev->dev);
638 mc->dev = &pdev->dev;
639
640 /* length of MC tick in nanoseconds */
641 mc->tick = 30;
642
643 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
644 mc->regs = devm_ioremap_resource(&pdev->dev, res);
645 if (IS_ERR(mc->regs))
646 return PTR_ERR(mc->regs);
647
648 mc->clk = devm_clk_get(&pdev->dev, "mc");
649 if (IS_ERR(mc->clk)) {
650 dev_err(&pdev->dev, "failed to get MC clock: %ld\n",
651 PTR_ERR(mc->clk));
652 return PTR_ERR(mc->clk);
653 }
654
655#ifdef CONFIG_ARCH_TEGRA_2x_SOC
656 if (mc->soc == &tegra20_mc_soc) {
657 isr = tegra20_mc_irq;
658 } else
659#endif
660 {
661 err = tegra_mc_setup_latency_allowance(mc);
662 if (err < 0) {
663 dev_err(&pdev->dev,
664 "failed to setup latency allowance: %d\n",
665 err);
666 return err;
667 }
668
669 isr = tegra_mc_irq;
670
671 err = tegra_mc_setup_timings(mc);
672 if (err < 0) {
673 dev_err(&pdev->dev, "failed to setup timings: %d\n",
674 err);
675 return err;
676 }
677 }
678
679 mc->irq = platform_get_irq(pdev, 0);
680 if (mc->irq < 0) {
681 dev_err(&pdev->dev, "interrupt not specified\n");
682 return mc->irq;
683 }
684
685 WARN(!mc->soc->client_id_mask, "missing client ID mask for this SoC\n");
686
687 mc_writel(mc, mc->soc->intmask, MC_INTMASK);
688
689 err = devm_request_irq(&pdev->dev, mc->irq, isr, 0,
690 dev_name(&pdev->dev), mc);
691 if (err < 0) {
692 dev_err(&pdev->dev, "failed to request IRQ#%u: %d\n", mc->irq,
693 err);
694 return err;
695 }
696
697 err = tegra_mc_reset_setup(mc);
698 if (err < 0)
699 dev_err(&pdev->dev, "failed to register reset controller: %d\n",
700 err);
701
702 if (IS_ENABLED(CONFIG_TEGRA_IOMMU_SMMU) && mc->soc->smmu) {
703 mc->smmu = tegra_smmu_probe(&pdev->dev, mc->soc->smmu, mc);
704 if (IS_ERR(mc->smmu)) {
705 dev_err(&pdev->dev, "failed to probe SMMU: %ld\n",
706 PTR_ERR(mc->smmu));
707 mc->smmu = NULL;
708 }
709 }
710
711 if (IS_ENABLED(CONFIG_TEGRA_IOMMU_GART) && !mc->soc->smmu) {
712 mc->gart = tegra_gart_probe(&pdev->dev, mc);
713 if (IS_ERR(mc->gart)) {
714 dev_err(&pdev->dev, "failed to probe GART: %ld\n",
715 PTR_ERR(mc->gart));
716 mc->gart = NULL;
717 }
718 }
719
720 return 0;
721}
722
723static int tegra_mc_suspend(struct device *dev)
724{
725 struct tegra_mc *mc = dev_get_drvdata(dev);
726 int err;
727
728 if (IS_ENABLED(CONFIG_TEGRA_IOMMU_GART) && mc->gart) {
729 err = tegra_gart_suspend(mc->gart);
730 if (err)
731 return err;
732 }
733
734 return 0;
735}
736
737static int tegra_mc_resume(struct device *dev)
738{
739 struct tegra_mc *mc = dev_get_drvdata(dev);
740 int err;
741
742 if (IS_ENABLED(CONFIG_TEGRA_IOMMU_GART) && mc->gart) {
743 err = tegra_gart_resume(mc->gart);
744 if (err)
745 return err;
746 }
747
748 return 0;
749}
750
751static const struct dev_pm_ops tegra_mc_pm_ops = {
752 .suspend = tegra_mc_suspend,
753 .resume = tegra_mc_resume,
754};
755
756static struct platform_driver tegra_mc_driver = {
757 .driver = {
758 .name = "tegra-mc",
759 .of_match_table = tegra_mc_of_match,
760 .pm = &tegra_mc_pm_ops,
761 .suppress_bind_attrs = true,
762 },
763 .prevent_deferred_probe = true,
764 .probe = tegra_mc_probe,
765};
766
767static int tegra_mc_init(void)
768{
769 return platform_driver_register(&tegra_mc_driver);
770}
771arch_initcall(tegra_mc_init);
772
773MODULE_AUTHOR("Thierry Reding <treding@nvidia.com>");
774MODULE_DESCRIPTION("NVIDIA Tegra Memory Controller driver");
775MODULE_LICENSE("GPL v2");