Lines Matching full:hsp
18 #include <dt-bindings/mailbox/tegra186-hsp.h>
57 struct tegra_hsp *hsp; member
109 static inline u32 tegra_hsp_readl(struct tegra_hsp *hsp, unsigned int offset) in tegra_hsp_readl() argument
111 return readl(hsp->regs + offset); in tegra_hsp_readl()
114 static inline void tegra_hsp_writel(struct tegra_hsp *hsp, u32 value, in tegra_hsp_writel() argument
117 writel(value, hsp->regs + offset); in tegra_hsp_writel()
142 __tegra_hsp_doorbell_get(struct tegra_hsp *hsp, unsigned int master) in __tegra_hsp_doorbell_get() argument
146 list_for_each_entry(entry, &hsp->doorbells, list) in __tegra_hsp_doorbell_get()
154 tegra_hsp_doorbell_get(struct tegra_hsp *hsp, unsigned int master) in tegra_hsp_doorbell_get() argument
159 spin_lock_irqsave(&hsp->lock, flags); in tegra_hsp_doorbell_get()
160 db = __tegra_hsp_doorbell_get(hsp, master); in tegra_hsp_doorbell_get()
161 spin_unlock_irqrestore(&hsp->lock, flags); in tegra_hsp_doorbell_get()
168 struct tegra_hsp *hsp = data; in tegra_hsp_doorbell_irq() local
172 db = tegra_hsp_doorbell_get(hsp, TEGRA_HSP_DB_MASTER_CCPLEX); in tegra_hsp_doorbell_irq()
179 spin_lock(&hsp->lock); in tegra_hsp_doorbell_irq()
181 for_each_set_bit(master, &value, hsp->mbox_db.num_chans) { in tegra_hsp_doorbell_irq()
184 db = __tegra_hsp_doorbell_get(hsp, master); in tegra_hsp_doorbell_irq()
200 spin_unlock(&hsp->lock); in tegra_hsp_doorbell_irq()
207 struct tegra_hsp *hsp = data; in tegra_hsp_shared_irq() local
212 status = tegra_hsp_readl(hsp, HSP_INT_IR) & hsp->mask; in tegra_hsp_shared_irq()
217 for_each_set_bit(bit, &mask, hsp->num_sm) { in tegra_hsp_shared_irq()
218 struct tegra_hsp_mailbox *mb = &hsp->mailboxes[bit]; in tegra_hsp_shared_irq()
228 spin_lock(&hsp->lock); in tegra_hsp_shared_irq()
230 hsp->mask &= ~BIT(HSP_INT_EMPTY_SHIFT + mb->index); in tegra_hsp_shared_irq()
231 tegra_hsp_writel(hsp, hsp->mask, in tegra_hsp_shared_irq()
232 HSP_INT_IE(hsp->shared_irq)); in tegra_hsp_shared_irq()
234 spin_unlock(&hsp->lock); in tegra_hsp_shared_irq()
243 for_each_set_bit(bit, &mask, hsp->num_sm) { in tegra_hsp_shared_irq()
244 struct tegra_hsp_mailbox *mb = &hsp->mailboxes[bit]; in tegra_hsp_shared_irq()
271 tegra_hsp_doorbell_create(struct tegra_hsp *hsp, const char *name, in tegra_hsp_doorbell_create() argument
278 db = devm_kzalloc(hsp->dev, sizeof(*db), GFP_KERNEL); in tegra_hsp_doorbell_create()
282 offset = (1 + (hsp->num_sm / 2) + hsp->num_ss + hsp->num_as) * SZ_64K; in tegra_hsp_doorbell_create()
285 db->channel.regs = hsp->regs + offset; in tegra_hsp_doorbell_create()
286 db->channel.hsp = hsp; in tegra_hsp_doorbell_create()
288 db->name = devm_kstrdup_const(hsp->dev, name, GFP_KERNEL); in tegra_hsp_doorbell_create()
292 spin_lock_irqsave(&hsp->lock, flags); in tegra_hsp_doorbell_create()
293 list_add_tail(&db->list, &hsp->doorbells); in tegra_hsp_doorbell_create()
294 spin_unlock_irqrestore(&hsp->lock, flags); in tegra_hsp_doorbell_create()
311 struct tegra_hsp *hsp = db->channel.hsp; in tegra_hsp_doorbell_startup() local
318 "invalid master ID %u for HSP channel\n", in tegra_hsp_doorbell_startup()
323 ccplex = tegra_hsp_doorbell_get(hsp, TEGRA_HSP_DB_MASTER_CCPLEX); in tegra_hsp_doorbell_startup()
335 spin_lock_irqsave(&hsp->lock, flags); in tegra_hsp_doorbell_startup()
341 spin_unlock_irqrestore(&hsp->lock, flags); in tegra_hsp_doorbell_startup()
349 struct tegra_hsp *hsp = db->channel.hsp; in tegra_hsp_doorbell_shutdown() local
354 ccplex = tegra_hsp_doorbell_get(hsp, TEGRA_HSP_DB_MASTER_CCPLEX); in tegra_hsp_doorbell_shutdown()
358 spin_lock_irqsave(&hsp->lock, flags); in tegra_hsp_doorbell_shutdown()
364 spin_unlock_irqrestore(&hsp->lock, flags); in tegra_hsp_doorbell_shutdown()
376 struct tegra_hsp *hsp = mb->channel.hsp; in tegra_hsp_mailbox_send_data() local
390 spin_lock_irqsave(&hsp->lock, flags); in tegra_hsp_mailbox_send_data()
392 hsp->mask |= BIT(HSP_INT_EMPTY_SHIFT + mb->index); in tegra_hsp_mailbox_send_data()
393 tegra_hsp_writel(hsp, hsp->mask, HSP_INT_IE(hsp->shared_irq)); in tegra_hsp_mailbox_send_data()
395 spin_unlock_irqrestore(&hsp->lock, flags); in tegra_hsp_mailbox_send_data()
426 struct tegra_hsp *hsp = mb->channel.hsp; in tegra_hsp_mailbox_startup() local
442 spin_lock_irqsave(&hsp->lock, flags); in tegra_hsp_mailbox_startup()
445 hsp->mask &= ~BIT(HSP_INT_EMPTY_SHIFT + mb->index); in tegra_hsp_mailbox_startup()
447 hsp->mask |= BIT(HSP_INT_FULL_SHIFT + mb->index); in tegra_hsp_mailbox_startup()
449 tegra_hsp_writel(hsp, hsp->mask, HSP_INT_IE(hsp->shared_irq)); in tegra_hsp_mailbox_startup()
451 spin_unlock_irqrestore(&hsp->lock, flags); in tegra_hsp_mailbox_startup()
453 if (hsp->soc->has_per_mb_ie) { in tegra_hsp_mailbox_startup()
469 struct tegra_hsp *hsp = mb->channel.hsp; in tegra_hsp_mailbox_shutdown() local
472 if (hsp->soc->has_per_mb_ie) { in tegra_hsp_mailbox_shutdown()
481 spin_lock_irqsave(&hsp->lock, flags); in tegra_hsp_mailbox_shutdown()
484 hsp->mask &= ~BIT(HSP_INT_EMPTY_SHIFT + mb->index); in tegra_hsp_mailbox_shutdown()
486 hsp->mask &= ~BIT(HSP_INT_FULL_SHIFT + mb->index); in tegra_hsp_mailbox_shutdown()
488 tegra_hsp_writel(hsp, hsp->mask, HSP_INT_IE(hsp->shared_irq)); in tegra_hsp_mailbox_shutdown()
490 spin_unlock_irqrestore(&hsp->lock, flags); in tegra_hsp_mailbox_shutdown()
503 struct tegra_hsp *hsp = container_of(mbox, struct tegra_hsp, mbox_db); in tegra_hsp_db_xlate() local
511 if (type != TEGRA_HSP_MBOX_TYPE_DB || !hsp->doorbell_irq) in tegra_hsp_db_xlate()
514 db = tegra_hsp_doorbell_get(hsp, master); in tegra_hsp_db_xlate()
521 spin_lock_irqsave(&hsp->lock, flags); in tegra_hsp_db_xlate()
534 spin_unlock_irqrestore(&hsp->lock, flags); in tegra_hsp_db_xlate()
542 struct tegra_hsp *hsp = container_of(mbox, struct tegra_hsp, mbox_sm); in tegra_hsp_sm_xlate() local
548 if (type != TEGRA_HSP_MBOX_TYPE_SM || !hsp->shared_irqs || in tegra_hsp_sm_xlate()
549 index >= hsp->num_sm) in tegra_hsp_sm_xlate()
552 mb = &hsp->mailboxes[index]; in tegra_hsp_sm_xlate()
562 static int tegra_hsp_add_doorbells(struct tegra_hsp *hsp) in tegra_hsp_add_doorbells() argument
564 const struct tegra_hsp_db_map *map = hsp->soc->map; in tegra_hsp_add_doorbells()
568 channel = tegra_hsp_doorbell_create(hsp, map->name, in tegra_hsp_add_doorbells()
579 static int tegra_hsp_add_mailboxes(struct tegra_hsp *hsp, struct device *dev) in tegra_hsp_add_mailboxes() argument
583 hsp->mailboxes = devm_kcalloc(dev, hsp->num_sm, sizeof(*hsp->mailboxes), in tegra_hsp_add_mailboxes()
585 if (!hsp->mailboxes) in tegra_hsp_add_mailboxes()
588 for (i = 0; i < hsp->num_sm; i++) { in tegra_hsp_add_mailboxes()
589 struct tegra_hsp_mailbox *mb = &hsp->mailboxes[i]; in tegra_hsp_add_mailboxes()
593 mb->channel.hsp = hsp; in tegra_hsp_add_mailboxes()
594 mb->channel.regs = hsp->regs + SZ_64K + i * SZ_32K; in tegra_hsp_add_mailboxes()
595 mb->channel.chan = &hsp->mbox_sm.chans[i]; in tegra_hsp_add_mailboxes()
602 static int tegra_hsp_request_shared_irq(struct tegra_hsp *hsp) in tegra_hsp_request_shared_irq() argument
607 for (i = 0; i < hsp->num_si; i++) { in tegra_hsp_request_shared_irq()
608 irq = hsp->shared_irqs[i]; in tegra_hsp_request_shared_irq()
612 err = devm_request_irq(hsp->dev, irq, tegra_hsp_shared_irq, 0, in tegra_hsp_request_shared_irq()
613 dev_name(hsp->dev), hsp); in tegra_hsp_request_shared_irq()
615 dev_err(hsp->dev, "failed to request interrupt: %d\n", in tegra_hsp_request_shared_irq()
620 hsp->shared_irq = i; in tegra_hsp_request_shared_irq()
623 tegra_hsp_writel(hsp, 0, HSP_INT_IE(hsp->shared_irq)); in tegra_hsp_request_shared_irq()
625 dev_dbg(hsp->dev, "interrupt requested: %u\n", irq); in tegra_hsp_request_shared_irq()
630 if (i == hsp->num_si) { in tegra_hsp_request_shared_irq()
631 dev_err(hsp->dev, "failed to find available interrupt\n"); in tegra_hsp_request_shared_irq()
640 struct tegra_hsp *hsp; in tegra_hsp_probe() local
646 hsp = devm_kzalloc(&pdev->dev, sizeof(*hsp), GFP_KERNEL); in tegra_hsp_probe()
647 if (!hsp) in tegra_hsp_probe()
650 hsp->dev = &pdev->dev; in tegra_hsp_probe()
651 hsp->soc = of_device_get_match_data(&pdev->dev); in tegra_hsp_probe()
652 INIT_LIST_HEAD(&hsp->doorbells); in tegra_hsp_probe()
653 spin_lock_init(&hsp->lock); in tegra_hsp_probe()
656 hsp->regs = devm_ioremap_resource(&pdev->dev, res); in tegra_hsp_probe()
657 if (IS_ERR(hsp->regs)) in tegra_hsp_probe()
658 return PTR_ERR(hsp->regs); in tegra_hsp_probe()
660 value = tegra_hsp_readl(hsp, HSP_INT_DIMENSIONING); in tegra_hsp_probe()
661 hsp->num_sm = (value >> HSP_nSM_SHIFT) & HSP_nINT_MASK; in tegra_hsp_probe()
662 hsp->num_ss = (value >> HSP_nSS_SHIFT) & HSP_nINT_MASK; in tegra_hsp_probe()
663 hsp->num_as = (value >> HSP_nAS_SHIFT) & HSP_nINT_MASK; in tegra_hsp_probe()
664 hsp->num_db = (value >> HSP_nDB_SHIFT) & HSP_nINT_MASK; in tegra_hsp_probe()
665 hsp->num_si = (value >> HSP_nSI_SHIFT) & HSP_nINT_MASK; in tegra_hsp_probe()
669 hsp->doorbell_irq = err; in tegra_hsp_probe()
671 if (hsp->num_si > 0) { in tegra_hsp_probe()
674 hsp->shared_irqs = devm_kcalloc(&pdev->dev, hsp->num_si, in tegra_hsp_probe()
675 sizeof(*hsp->shared_irqs), in tegra_hsp_probe()
677 if (!hsp->shared_irqs) in tegra_hsp_probe()
680 for (i = 0; i < hsp->num_si; i++) { in tegra_hsp_probe()
689 hsp->shared_irqs[i] = err; in tegra_hsp_probe()
697 devm_kfree(&pdev->dev, hsp->shared_irqs); in tegra_hsp_probe()
698 hsp->shared_irqs = NULL; in tegra_hsp_probe()
703 hsp->mbox_db.of_xlate = tegra_hsp_db_xlate; in tegra_hsp_probe()
704 hsp->mbox_db.num_chans = 32; in tegra_hsp_probe()
705 hsp->mbox_db.dev = &pdev->dev; in tegra_hsp_probe()
706 hsp->mbox_db.ops = &tegra_hsp_db_ops; in tegra_hsp_probe()
708 hsp->mbox_db.chans = devm_kcalloc(&pdev->dev, hsp->mbox_db.num_chans, in tegra_hsp_probe()
709 sizeof(*hsp->mbox_db.chans), in tegra_hsp_probe()
711 if (!hsp->mbox_db.chans) in tegra_hsp_probe()
714 if (hsp->doorbell_irq) { in tegra_hsp_probe()
715 err = tegra_hsp_add_doorbells(hsp); in tegra_hsp_probe()
723 err = devm_mbox_controller_register(&pdev->dev, &hsp->mbox_db); in tegra_hsp_probe()
731 hsp->mbox_sm.of_xlate = tegra_hsp_sm_xlate; in tegra_hsp_probe()
732 hsp->mbox_sm.num_chans = hsp->num_sm; in tegra_hsp_probe()
733 hsp->mbox_sm.dev = &pdev->dev; in tegra_hsp_probe()
734 hsp->mbox_sm.ops = &tegra_hsp_sm_ops; in tegra_hsp_probe()
736 hsp->mbox_sm.chans = devm_kcalloc(&pdev->dev, hsp->mbox_sm.num_chans, in tegra_hsp_probe()
737 sizeof(*hsp->mbox_sm.chans), in tegra_hsp_probe()
739 if (!hsp->mbox_sm.chans) in tegra_hsp_probe()
742 if (hsp->shared_irqs) { in tegra_hsp_probe()
743 err = tegra_hsp_add_mailboxes(hsp, &pdev->dev); in tegra_hsp_probe()
751 err = devm_mbox_controller_register(&pdev->dev, &hsp->mbox_sm); in tegra_hsp_probe()
758 platform_set_drvdata(pdev, hsp); in tegra_hsp_probe()
760 if (hsp->doorbell_irq) { in tegra_hsp_probe()
761 err = devm_request_irq(&pdev->dev, hsp->doorbell_irq, in tegra_hsp_probe()
763 dev_name(&pdev->dev), hsp); in tegra_hsp_probe()
767 hsp->doorbell_irq, err); in tegra_hsp_probe()
772 if (hsp->shared_irqs) { in tegra_hsp_probe()
773 err = tegra_hsp_request_shared_irq(hsp); in tegra_hsp_probe()
783 struct tegra_hsp *hsp = dev_get_drvdata(dev); in tegra_hsp_resume() local
787 list_for_each_entry(db, &hsp->doorbells, list) { in tegra_hsp_resume()
792 if (hsp->mailboxes) { in tegra_hsp_resume()
793 for (i = 0; i < hsp->num_sm; i++) { in tegra_hsp_resume()
794 struct tegra_hsp_mailbox *mb = &hsp->mailboxes[i]; in tegra_hsp_resume()
825 { .compatible = "nvidia,tegra186-hsp", .data = &tegra186_hsp_soc },
826 { .compatible = "nvidia,tegra194-hsp", .data = &tegra194_hsp_soc },
832 .name = "tegra-hsp",