From: William Qiu <william.qiu@starfivetech.com>
Date: Fri, 6 Jan 2023 01:55:45 +0000 (+0800)
Subject: Hibernation: canfd: Add system PM API for can/canfd
X-Git-Url: http://review.tizen.org/git/?a=commitdiff_plain;h=3d3d242537ea87a5e40a010b953161f4d910f6a3;p=platform%2Fkernel%2Flinux-starfive.git

Hibernation: canfd: Add system PM API for can/canfd

Add system PM API for can/canfd.

Signed-off-by: William Qiu <william.qiu@starfivetech.com>
---

diff --git a/drivers/net/can/ipms_canfd.c b/drivers/net/can/ipms_canfd.c
index 0212b43..5fc9d16 100644
--- a/drivers/net/can/ipms_canfd.c
+++ b/drivers/net/can/ipms_canfd.c
@@ -959,7 +959,8 @@ static int canfd_driver_open(struct net_device *ndev)
 
 	ret = pm_runtime_get_sync(priv->dev);
 	if (ret < 0) {
-		dev_err(priv->dev, " %s: pm_runtime_get failed\n", __func__);
+		netdev_err(ndev, "%s: pm_runtime_get failed(%d)\n",
+			   __func__, ret);
 		goto err;
 	}
 
@@ -1172,6 +1173,46 @@ static int canfd_driver_remove(struct platform_device *pdev)
 	return 0;
 }
 
+#ifdef CONFIG_PM_SLEEP
+static int __maybe_unused canfd_suspend(struct device *dev)
+{
+	struct net_device *ndev = dev_get_drvdata(dev);
+
+	if (netif_running(ndev)) {
+		netif_stop_queue(ndev);
+		netif_device_detach(ndev);
+		canfd_driver_stop(ndev);
+	}
+
+	return pm_runtime_force_suspend(dev);
+}
+
+static int __maybe_unused canfd_resume(struct device *dev)
+{
+	struct net_device *ndev = dev_get_drvdata(dev);
+	int ret;
+
+	ret = pm_runtime_force_resume(dev);
+	if (ret) {
+		dev_err(dev, "pm_runtime_force_resume failed on resume\n");
+		return ret;
+	}
+
+	if (netif_running(ndev)) {
+		ret = canfd_chip_start(ndev);
+		if (ret) {
+			dev_err(dev, "canfd_chip_start failed on resume\n");
+			return ret;
+		}
+
+		netif_device_attach(ndev);
+		netif_start_queue(ndev);
+	}
+
+	return 0;
+}
+#endif
+
 #ifdef CONFIG_PM
 static int canfd_runtime_suspend(struct device *dev)
 {
@@ -1205,8 +1246,7 @@ static int canfd_runtime_resume(struct device *dev)
 #endif
 
 static const struct dev_pm_ops canfd_pm_ops = {
-	SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
-				pm_runtime_force_resume)
+	SET_SYSTEM_SLEEP_PM_OPS(canfd_suspend, canfd_resume)
 	SET_RUNTIME_PM_OPS(canfd_runtime_suspend,
 			   canfd_runtime_resume, NULL)
 };