From: ys <eason.xiong@starfivetech.com>
Date: Wed, 26 Oct 2022 06:18:49 +0000 (-0700)
Subject: drive:mailbox:add pm ops
X-Git-Url: http://review.tizen.org/git/?a=commitdiff_plain;h=021fbb3bc3fa031d37c004d8d33f03d8cb31105c;p=platform%2Fkernel%2Flinux-starfive.git

drive:mailbox:add pm ops

add runtime pm and system pm ops

Signed-off-by: ys <eason.xiong@starfivetech.com>
---

diff --git a/drivers/mailbox/starfive_mailbox.c b/drivers/mailbox/starfive_mailbox.c
index d8081c4d9651..c73ed9c453ed 100644
--- a/drivers/mailbox/starfive_mailbox.c
+++ b/drivers/mailbox/starfive_mailbox.c
@@ -30,6 +30,7 @@
 #include <linux/slab.h>
 #include <linux/clk.h>
 #include <linux/reset.h>
+#include <linux/pm_runtime.h>
 
 #include "mailbox.h"
 
@@ -144,8 +145,14 @@ static int starfive_mbox_check_state(struct mbox_chan *chan)
 {
 	unsigned long ch = (unsigned long)chan->con_priv;
 	struct starfive_mbox *mbox = to_starfive_mbox(chan->mbox);
+	unsigned long irq_flag = IRQF_SHARED;
 	long ret = 0;
 
+	pm_runtime_get_sync(mbox->dev);
+	/* MAILBOX should be with IRQF_NO_SUSPEND set */
+	if (!mbox->dev->pm_domain)
+		irq_flag |= IRQF_NO_SUSPEND;
+
 	/* Mailbox is idle so directly bail out */
 	if (readl(mbox->base + MBC_PEND_SMRY) & BIT(ch))
 		return -EBUSY;
@@ -153,7 +160,7 @@ static int starfive_mbox_check_state(struct mbox_chan *chan)
 	if (mbox->mchan[ch].dst_irq > 0) {
 		dev_dbg(mbox->dev, "%s: host IRQ = %d, ch:%ld", __func__, mbox->mchan[ch].dst_irq, ch);
 		ret = devm_request_irq(mbox->dev, mbox->mchan[ch].dst_irq, starfive_rx_irq_handler,
-			IRQF_SHARED, irq_peer_name[ch].name, chan);
+			irq_flag, irq_peer_name[ch].name, chan);
 		if (ret < 0)
 			dev_err(mbox->dev, "request_irq %d failed\n", mbox->mchan[ch].dst_irq);
 	}
@@ -177,6 +184,7 @@ static void starfive_mbox_shutdown(struct mbox_chan *chan)
 
 	if (mbox->mchan[ch].dst_irq > 0)
 		devm_free_irq(mbox->dev, mbox->mchan[ch].dst_irq, chan);
+	pm_runtime_put_sync(mbox->dev);
 }
 
 static int starfive_mbox_send_data(struct mbox_chan *chan, void *msg)
@@ -280,6 +288,9 @@ static int starfive_mbox_probe(struct platform_device *pdev)
 
 	platform_set_drvdata(pdev, mbox);
 	dev_info(dev, "Mailbox enabled\n");
+	pm_runtime_set_active(dev);
+	pm_runtime_enable(dev);
+
 	return 0;
 }
 
@@ -289,16 +300,44 @@ static int starfive_mbox_remove(struct platform_device *pdev)
 
 	mbox_controller_unregister(&mbox->controller);
 	devm_clk_put(mbox->dev, mbox->clk);
+	pm_runtime_disable(mbox->dev);
+
+	return 0;
+}
+
+static int __maybe_unused starfive_mbox_suspend(struct device *dev)
+{
+	struct starfive_mbox *mbox = dev_get_drvdata(dev);
+
+	clk_disable_unprepare(mbox->clk);
 
 	return 0;
 }
 
+static int __maybe_unused starfive_mbox_resume(struct device *dev)
+{
+	struct starfive_mbox *mbox = dev_get_drvdata(dev);
+	int ret;
+
+	ret = clk_prepare_enable(mbox->clk);
+	if (ret)
+		dev_err(dev, "failed to enable clock\n");
+
+	return ret;
+}
+
+static const struct dev_pm_ops starfive_mbox_pm_ops = {
+	.suspend = starfive_mbox_suspend,
+	.resume = starfive_mbox_resume,
+	SET_RUNTIME_PM_OPS(starfive_mbox_suspend, starfive_mbox_resume, NULL)
+};
 static struct platform_driver starfive_mbox_driver = {
 	.probe  = starfive_mbox_probe,
 	.remove = starfive_mbox_remove,
 	.driver = {
 	.name = "mailbox",
 		.of_match_table = starfive_mbox_of_match,
+		.pm = &starfive_mbox_pm_ops,
 	},
 };