Received-SPF: pass (google.com: domain of linux-kernel+bounces-144879-linux.lists.archive=gmail.com@vger.kernel.org designates 2604:1380:45e3:2400::1 as permitted sender) client-ip=2604:1380:45e3:2400::1;
From: "Peng Fan (OSS)" <peng.fan@oss.nxp.com>
To: sudeep.holla@arm.com,
	cristian.marussi@arm.com
Cc: linux-arm-kernel@lists.infradead.org,
	linux-kernel@vger.kernel.org,
	Peng Fan <peng.fan@nxp.com>
Subject: [PATCH] firmware: arm_scmi: power_control: support suspend command
Date: Mon, 15 Apr 2024 18:11:41 +0800
Message-Id: <20240415101141.1591112-1-peng.fan@oss.nxp.com>
Content-Transfer-Encoding: 8bit
Content-Type: text/plain
Precedence: bulk
MIME-Version: 1.0
X-MS-Exchange-MessageSentRepresentingType: 1
X-MS-PublicTrafficType: Email
X-MS-TrafficTypeDiagnostic: DU0PR04MB9417:EE_|PAXPR04MB8911:EE_
X-MS-Office365-Filtering-Correlation-Id: 17863839-7025-43b0-e53c-08dc5d335485
X-MS-Exchange-SharedMailbox-RoutingAgent-Processed: True
X-MS-Exchange-SenderADCheck: 1
X-MS-Exchange-AntiSpam-Relay: 0
X-Microsoft-Antispam: BCL:0;
X-Microsoft-Antispam-Message-Info:
	rWsE1rqYXAyR5trwblLl6o3K3/gT4xxgPnnDRk0dXSFJCymQjhRnIdnMhfv6wNnUTb79hU5Cf1FvZR6ZhMsGZ6TQffSwAV930ozY2OhkKYiLc3sYR4/yGJgGgkVTvYnApILDRlhkEE0c4FEfd2eUMGnx5ZVAN1lPhfuVUNQo2Y7F3ZVlbtMQPPj4fTlYtqUYWPZSa71K9ryWoDi3iGJGc+X/W+DczBwQnXzLqe47Du9PRKLGnWrGlxixOy8SlCylsEbdMGRPrKQa8xnZ7sfnCaIalFo7jSbovLuJl+X1zA8Zmee/7sdg0gNXuGcpwZ/w48j0jie6Qwz1N1BzyQi15PZ146ibflaAy/R4HSrhzoNfYw5+w0X8949hC8KSkJSKWrrYRM8X4U+/RxGz2khnviAFu2uqmOhNN3cng6kzw46Lzok1OIjV95O2cFcuTJ24jt1lx9Xs1SratU8Aaxv5q+HQ9pwtgMq5HDh6aDvkCEH2m6748MPUGy+MPcjMGkFZUcWVvI2sJk3MrB1L4qhq/4TBmGiVosniHllhJzpgDjNrf3fvvXV/8HdLFCuNqPD6ZteY78g1YAeJiUiTiLkDT+i67i5gH4D+u4PyzbO6AAJfsaTRAOjzv2XuJcIFxPJ0hg2roe0yPQ7z96lh1avOYn/W9yRon5S0MicVIM1dNHHnKkbfd1Kx9Zx8sz68pnHU1OTbgG3XT2unjvsHjvinD0oDs506zPSnmht0jC83Zrs=
X-Forefront-Antispam-Report:
	CIP:255.255.255.255;CTRY:;LANG:en;SCL:1;SRV:;IPV:NLI;SFV:NSPM;H:DU0PR04MB9417.eurprd04.prod.outlook.com;PTR:;CAT:NONE;SFS:(13230031)(366007)(1800799015)(376005)(52116005)(38350700005);DIR:OUT;SFP:1101;
X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1
X-MS-Exchange-AntiSpam-MessageData-0:
	=?us-ascii?Q?Mh160fTa+fCPRExHtEzmpr+LYPFbgFHmCNhOZSMwGYYwZ8YvDkkSFUs2pC4m?=
 =?us-ascii?Q?WF52TxztaMpcXGp+wt0f1tCNxCd4vg7N8J1B8cAxrWrth6Az/kOVirSBsnLT?=
 =?us-ascii?Q?ysGiOzFXE1NascWLzzuDNWEy21DTL6J2Vqb1hxLcGN3eFyiIkv0qv+30mXVu?=
 =?us-ascii?Q?eWbIaFGF9o3gI62loT2/QWb/b+u3LX4Ob1OKx7XPk47oFHediWvujxfO3bXg?=
 =?us-ascii?Q?0esxEtnp5hUTDzFojngioJz0eAUKMpTLyQE5ZqMmflJvn/3WwFZRDtNo6MfH?=
 =?us-ascii?Q?mjoUnqpkg0m+zjk3yyYyiFnkDhOApp00ToQcWAjcsonDVS45ITnUvmyZQ2L1?=
 =?us-ascii?Q?HN9zwxKMFWEcZbTXawZVequKfzr3WpjgaKl1wMl0fJyVGx2ozcXmS+cLuuZY?=
 =?us-ascii?Q?hlxCJ8x3gDAjaROKph2oNnyDqVs6LSFvhV5wAEFWKTNPild2ty8lw2ly7FMg?=
 =?us-ascii?Q?g1QUfyUCuFJV5TCUTq2wa3GsJyapwk6pT2GDES36rWsqyoirUDKYDGetULgC?=
 =?us-ascii?Q?LSam0HcCkcuSlfoVOEjspPh/dpR1ffVyXnPO6dHbFJq9t384GjF1+O70iYbz?=
 =?us-ascii?Q?mYZW5hT5JnFaJqh/OQHUDdnRTNzxBU5DVKYen55GqrVd8OxgCkq1vByehWtY?=
 =?us-ascii?Q?UV0GgMyrhi7cn/oxMwDgffHzD2FQZE8vAyIcHYlVTsgHk0DLJ0zbBFDeaeUR?=
 =?us-ascii?Q?LxoFHiEtrqG+UWptOO+TjibB2hQY3CtLU+TRKChOqKz7Ii2Wlx4UBR05LlTr?=
 =?us-ascii?Q?PWmyxJYL7GkLEoYSOY1LQDbkWNvYEJXoSvyg9i3mVwIV3PClvi93/xj1TwDw?=
 =?us-ascii?Q?YFvlz2wF43omiwyRGJIdW4OK3MrUxp7tIL2lJa+Lg089O5/MDV9ZsPnXBWzd?=
 =?us-ascii?Q?AZ1II927b6zbCreaOb5tXM/xakuCTffu/5/qUw2LAQQiy8b7HxvzLUlRNf7e?=
 =?us-ascii?Q?4LgKsyDJ/0C3MPAyg8rJWTHt9ktVdhXuz0y7UeFjO6fs8hfg0NDV3d6CF2yZ?=
 =?us-ascii?Q?B+TIUesekyWfvexJolJYo5/iIPtlDV/F7BzYVFK3xATqUeuLWFd01cZr36M8?=
 =?us-ascii?Q?nTdkYIim2YgZHe3Ewbb12HhYrrtEN3kuxrkdAwnItBV01f52MKAWMhzinL4c?=
 =?us-ascii?Q?1RVV6w9y80wclofGqtFeniHH5d+YOmH8QBRbyhaaNyU+4xQmR7xQsULelnXh?=
 =?us-ascii?Q?n5SC3FNq4nzEo3DTUJ3JXTKS2RE6UCNKCevOpro9ekwimfV2/Cg0zmeRMvdv?=
 =?us-ascii?Q?IzXd8ZZeG4aGWN9b7bRialTr1Rb6KoKDC9O7CQzLT+ovuNLT71uXm/5644GJ?=
 =?us-ascii?Q?H5Zti/O98JqgbZfmxW7PZQPmfJBOUKEsR4Q7ygslFj/W5jOgYQSUIx+pQy5+?=
 =?us-ascii?Q?OLmAi55wHfyB51k7vY80xRqpghZGDXbg9rT0wKGgOjoqYA6skC2aZBlA1WOp?=
 =?us-ascii?Q?4FqQPscOjFRgbgMopfYio97MgS9jv2+nvUXZVbyOxkt01QZhJ7hdyVxmypwT?=
 =?us-ascii?Q?8gH3JSXS+Py1oaQdjyy4CS0pGP+ISt2rzRJXKxUWLo/0DS3uXClMtdA1Q3F3?=
 =?us-ascii?Q?/uSRqcDDUxqQOSk+0Flg8+TVAjr/HTuDwhtE895N?=
X-OriginatorOrg: oss.nxp.com
X-MS-Exchange-CrossTenant-Network-Message-Id: 17863839-7025-43b0-e53c-08dc5d335485
X-MS-Exchange-CrossTenant-AuthSource: DU0PR04MB9417.eurprd04.prod.outlook.com
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 15 Apr 2024 10:03:42.8882
 (UTC)
X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted
X-MS-Exchange-CrossTenant-Id: 686ea1d3-bc2b-4c6f-a92c-d99c5c301635
X-MS-Exchange-CrossTenant-MailboxType: HOSTED
X-MS-Exchange-CrossTenant-UserPrincipalName: 7PGSlhOLG2ol3s9IMj2M65oLS+3P/mT3wDGfymg8834YMThQAzM57nKKQC/+azJqhhWZGUeJysHPV5qD3jWbJA==
X-MS-Exchange-Transport-CrossTenantHeadersStamped: PAXPR04MB8911

From: Peng Fan <peng.fan@nxp.com>

Support System suspend notification. Using a work struct to call
pm_suspend. There is no way to pass suspend level to pm_suspend,
so use MEM as of now.

Signed-off-by: Peng Fan <peng.fan@nxp.com>
---
 .../firmware/arm_scmi/scmi_power_control.c    | 20 ++++++++++++++++++-
 1 file changed, 19 insertions(+), 1 deletion(-)

diff --git a/drivers/firmware/arm_scmi/scmi_power_control.c b/drivers/firmware/arm_scmi/scmi_power_control.c
index 6eb7d2a4b6b1..beafca9957c7 100644
--- a/drivers/firmware/arm_scmi/scmi_power_control.c
+++ b/drivers/firmware/arm_scmi/scmi_power_control.c
@@ -50,6 +50,7 @@
 #include <linux/reboot.h>
 #include <linux/scmi_protocol.h>
 #include <linux/slab.h>
+#include <linux/suspend.h>
 #include <linux/time64.h>
 #include <linux/timer.h>
 #include <linux/types.h>
@@ -90,6 +91,7 @@ struct scmi_syspower_conf {
 	struct notifier_block reboot_nb;
 
 	struct delayed_work forceful_work;
+	struct work_struct suspend_work;
 };
 
 #define userspace_nb_to_sconf(x)	\
@@ -249,6 +251,9 @@ static void scmi_request_graceful_transition(struct scmi_syspower_conf *sc,
 	case SCMI_SYSTEM_WARMRESET:
 		orderly_reboot();
 		break;
+	case SCMI_SYSTEM_SUSPEND:
+		schedule_work(&sc->suspend_work);
+		break;
 	default:
 		break;
 	}
@@ -277,7 +282,8 @@ static int scmi_userspace_notifier(struct notifier_block *nb,
 	struct scmi_system_power_state_notifier_report *er = data;
 	struct scmi_syspower_conf *sc = userspace_nb_to_sconf(nb);
 
-	if (er->system_state >= SCMI_SYSTEM_POWERUP) {
+	if (er->system_state >= SCMI_SYSTEM_MAX ||
+	    er->system_state == SCMI_SYSTEM_POWERUP) {
 		dev_err(sc->dev, "Ignoring unsupported system_state: 0x%X\n",
 			er->system_state);
 		return NOTIFY_DONE;
@@ -315,6 +321,16 @@ static int scmi_userspace_notifier(struct notifier_block *nb,
 	return NOTIFY_OK;
 }
 
+static void scmi_suspend_work_func(struct work_struct *work)
+{
+	struct scmi_syspower_conf *sc =
+		container_of(work, struct scmi_syspower_conf, suspend_work);
+
+	pm_suspend(PM_SUSPEND_MEM);
+
+	sc->state = SCMI_SYSPOWER_IDLE;
+}
+
 static int scmi_syspower_probe(struct scmi_device *sdev)
 {
 	int ret;
@@ -338,6 +354,8 @@ static int scmi_syspower_probe(struct scmi_device *sdev)
 	sc->userspace_nb.notifier_call = &scmi_userspace_notifier;
 	sc->dev = &sdev->dev;
 
+	INIT_WORK(&sc->suspend_work, scmi_suspend_work_func);
+
 	return handle->notify_ops->devm_event_notifier_register(sdev,
 							   SCMI_PROTOCOL_SYSTEM,
 					 SCMI_EVENT_SYSTEM_POWER_STATE_NOTIFIER,
-- 
2.37.1