From patchwork Wed Feb 12 07:40:28 2025 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Peng Fan X-Patchwork-Id: 13971311 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.133]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.lore.kernel.org (Postfix) with ESMTPS id C8CBEC02198 for ; Wed, 12 Feb 2025 07:51:35 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender:List-Subscribe:List-Help :List-Post:List-Archive:List-Unsubscribe:List-Id:MIME-Version:Cc:To: In-Reply-To:References:Message-Id:Content-Transfer-Encoding:Content-Type: Subject:Date:From:Reply-To:Content-ID:Content-Description:Resent-Date: Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner; bh=cSP0XDMY0TfQbgL6hb2bpJpAy/LolSImVLH+edvMo1I=; b=ESgrk5OsZrFG91oR5VyrrkKvgf t2dAoVXQmt4zVkGI88PMZPMX7rtbNXycAZzueFcJtTWJuqKsZXAoVgiFnna2ZqPMRQYI3oH6dvwzz w2XM5G8BcjanK+DHwf90kFp5Gwa6fkdhjqiYZzToaUyMmWCzkSn1cAHYWoXRs5p5+9urlkO00pAOT fexEhYhtVvMNtl2AXpDvkKbK7X/9TLqK9EGq20jEjpQDFKkf4qgpkitlwF93ZRrFv0rgZqQhTFjyI Otf/4VkURJB7upE+J3+1sSFNL5iAKisSQsOBCX42X5CvzRir/sHG5cBrXWXQPgm3Ciy+igTLtQSbg Nqh0Hikg==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.98 #2 (Red Hat Linux)) id 1ti7Wn-00000006X7t-0wZ2; Wed, 12 Feb 2025 07:51:25 +0000 Received: from mail-db8eur05on20625.outbound.protection.outlook.com ([2a01:111:f403:2614::625] helo=EUR05-DB8-obe.outbound.protection.outlook.com) by bombadil.infradead.org with esmtps (Exim 4.98 #2 (Red Hat Linux)) id 1ti7NX-00000006Vfn-245b for linux-arm-kernel@lists.infradead.org; Wed, 12 Feb 2025 07:41:52 +0000 ARC-Seal: i=1; a=rsa-sha256; s=arcselector10001; d=microsoft.com; cv=none; b=eucVAusdF2VFaY2yi8IQxIMLs3VZs1WAYEx1XfJoFLovFQLq6q87AQ9UdyxsyJbm/l0jiheW3F7PCL/LObvvXTeKZlNdm/AVyWcBwOIgfrUn9grlAN7j/YIqfvyY/x+J4+xvqQ3iTU2NFjvxHbn5qf/RD4zsOVcFXs4TMSfZu2OUcNds3or61lWTeIhWZXnwufPuwM+Ymr8OtDxNTQy0w7CXrd+BSJlWyMiuu+hRbbgOme9rI1mDw0jc2BukLR6xVfXaUmewG0zPsqTplbOO7N5b90HP30j6txxPV1qN9Km/98IkI/cGcdHd1jiiaIS/zGU3pyrmTl2SjMb4gNpB4w== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=microsoft.com; s=arcselector10001; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-AntiSpam-MessageData-ChunkCount:X-MS-Exchange-AntiSpam-MessageData-0:X-MS-Exchange-AntiSpam-MessageData-1; bh=cSP0XDMY0TfQbgL6hb2bpJpAy/LolSImVLH+edvMo1I=; b=REwMxwTaFtzhZBv5YaqsD0zw1x5Taj/I+vQuBqGtP7IIcJYkb77mnfgdLFIXQGFwK2KSMT2d3CnQH2x6gDx5/bQWbyFgrucoSVioKH+Ed/gspkQyFi3Fdkl1RaFbIeBPxRxPRHpVAeWcRtKvG1xOp7m27VYlNy+funyzem9+FJwDzLpyQLbZUJ6eBfAcB1ahA8wPt5v8oGXgRmMcTcYb1PpILvUb2X1ejRfuMfdHLOAplhdsOCqvYKB8awxu5d0dKTry/XeTnTqyoGVUcTFTMZjsTnSTDXUuTwUUPkMQd6GZGJM8LOMNdCy6J+9FnnqndrJELrGEf5nwx3pa9Ay+hg== ARC-Authentication-Results: i=1; mx.microsoft.com 1; spf=pass smtp.mailfrom=oss.nxp.com; dmarc=pass action=none header.from=oss.nxp.com; dkim=pass header.d=oss.nxp.com; arc=none DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=NXP1.onmicrosoft.com; s=selector1-NXP1-onmicrosoft-com; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=cSP0XDMY0TfQbgL6hb2bpJpAy/LolSImVLH+edvMo1I=; b=ZRlapBVZxgJOFje87si9UmdNw/sN7Br3qGHMujqE9dnt2KNldmFfd3F0VGjAAZFP/7YfMvrq23ljA9WK2PoI+uUAEnwlTQNUe5xmZ/yerY2Yx2VVyshe7LWtFvjcbGugWzkVR5I2EEEa0gJRK0uZ0fSwB0bb//I9ujhVz6tRiOOumbfUb/qd5enQv0jreoMgUi+ZYJSdX1AOuqIvQBe8cYpORfa4MnjmfxQ2uYSaAMeI3qiD5E2H3p09xxbTVatC78QyE7xXljfaPPVw4urQaD/1zE34LcST/Xy+VHcsko4gknypf1efxYLnNyplZ72NaHEgS09XEivez4UY/ySYEg== Authentication-Results: dkim=none (message not signed) header.d=none;dmarc=none action=none header.from=oss.nxp.com; Received: from PAXPR04MB8459.eurprd04.prod.outlook.com (2603:10a6:102:1da::15) by PA1PR04MB10865.eurprd04.prod.outlook.com (2603:10a6:102:48a::5) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.8422.18; Wed, 12 Feb 2025 07:41:48 +0000 Received: from PAXPR04MB8459.eurprd04.prod.outlook.com ([fe80::165a:30a2:5835:9630]) by PAXPR04MB8459.eurprd04.prod.outlook.com ([fe80::165a:30a2:5835:9630%3]) with mapi id 15.20.8445.008; Wed, 12 Feb 2025 07:41:48 +0000 From: "Peng Fan (OSS)" Date: Wed, 12 Feb 2025 15:40:28 +0800 Subject: [PATCH v2 6/7] firmware: imx: Add i.MX95 SCMI CPU driver Message-Id: <20250212-imx-lmm-cpu-v2-6-3aee005968c1@nxp.com> References: <20250212-imx-lmm-cpu-v2-0-3aee005968c1@nxp.com> In-Reply-To: <20250212-imx-lmm-cpu-v2-0-3aee005968c1@nxp.com> To: Sudeep Holla , Cristian Marussi , Shawn Guo , Sascha Hauer , Pengutronix Kernel Team , Fabio Estevam , Rob Herring , Krzysztof Kozlowski , Conor Dooley Cc: Dan Carpenter , linux-kernel@vger.kernel.org, arm-scmi@vger.kernel.org, linux-arm-kernel@lists.infradead.org, imx@lists.linux.dev, devicetree@vger.kernel.org, Peng Fan X-Mailer: b4 0.14.2 X-Developer-Signature: v=1; a=ed25519-sha256; t=1739346036; l=5658; i=peng.fan@nxp.com; s=20230812; h=from:subject:message-id; bh=jnqCj8AkedEQ9gtARM7DQLSPNZL2HiFxGo0lP+P4RLA=; b=OV37mNXSGzRyca89q7GCG6r73vcCc2n7Vvf4yzwO1O1B5Op7ve7bo1xy4W7Y1Z6ya9dhkMN51 zefTWTPNZfuDT2k+UnBMyjPca7eaEop8wAYNN+hj6bWzgoBGecZrKvg X-Developer-Key: i=peng.fan@nxp.com; a=ed25519; pk=I4sJg7atIT1g63H7bb5lDRGR2gJW14RKDD0wFL8TT1g= X-ClientProxiedBy: SI2P153CA0014.APCP153.PROD.OUTLOOK.COM (2603:1096:4:140::6) To PAXPR04MB8459.eurprd04.prod.outlook.com (2603:10a6:102:1da::15) MIME-Version: 1.0 X-MS-Exchange-MessageSentRepresentingType: 1 X-MS-PublicTrafficType: Email X-MS-TrafficTypeDiagnostic: PAXPR04MB8459:EE_|PA1PR04MB10865:EE_ X-MS-Office365-Filtering-Correlation-Id: 2b9203b3-53f7-465f-4401-08dd4b38b524 X-MS-Exchange-SharedMailbox-RoutingAgent-Processed: True X-MS-Exchange-SenderADCheck: 1 X-MS-Exchange-AntiSpam-Relay: 0 X-Microsoft-Antispam: BCL:0;ARA:13230040|7416014|376014|52116014|366016|1800799024|38350700014; X-Microsoft-Antispam-Message-Info: =?utf-8?q?BTJDD0dn77u9P71wpqtG9ygIaNklA5l?= =?utf-8?q?Xyv09G3Jop9Io6adLLuZRs07HUbcS1lFispYrrAgqE5Hkb+RjdV5f8MY/z0dnBIf3?= =?utf-8?q?YYFCEr4NNaC1U/J1Yosp5i+cRMkxMaXXByH4tUyxKBCFZ6bxD4fvMidpekb2gQdEO?= =?utf-8?q?7YYid4G7R7/eVpMpfpuTMN87T2yUkVkFnw0vsTXt8AWiiIjKrz8Eg0HEV+1K46DxF?= =?utf-8?q?qbEjhYzJ0obkExP14i/9jZRHkOqzJhpcPCxe9aXPtz9fa1y9WhZKBPB/gx2FEFD3n?= =?utf-8?q?u9J9DP041Rhr2DDU6OuWX096O9j7/84xPrhN8ub4rdSZx/D0zXArxhYbcyTXOF25Q?= =?utf-8?q?Nq7vFsaQwkDhMldco6rfRlUNGjvAQVA3o6Ish1rAYL+uWK2Zpt2Y4kct9Jtn8voz7?= =?utf-8?q?xpB6HwpqUEhf7DLQ0sL/mTc137zKn9Wi85XgHKNb8AXxAXkWNNbECANbGMSowFOT9?= =?utf-8?q?E1koImFro2LHo5eFid1hZpnKusCJ3dPbuDVWrm6/sqdKeJb6oA7tGKjWF2x6mZUGK?= =?utf-8?q?gJBk+eCWH1seeMVfxrigD/9yEPnNLVu3p5YpYDDv3aYhDhf119q43DmTlkr3TwY3b?= =?utf-8?q?6ek27evZxHrJqJpiIvl2CVFuO/VwqY6jwmmbtrop0VQC5asHUMBBIs6OKrgOX/Y92?= =?utf-8?q?bpRgSy4wsD7dtVaARV5zJzwMXOHAoO8UBvjTttHJOs9W1GA0bGW6CPPdTuMqemc8f?= =?utf-8?q?Nm9nXzHvdWWa9AB1U1WNpNgdwmX4WxHik2Q5ry4FlYBRSdUz7iku+ISX69e8ZjP5W?= =?utf-8?q?vEyA1P/2tfx/rKDEMagW1EOBQRJw4ZF7APDjTlaSdEu+wsg9RXMBFjratMJ7TEMo5?= =?utf-8?q?w631ITGmh9tnhhb7aJ60jCZtgLFAcn4dJshQQyEbP9UcLVw9ULhGjB1wNEOulHOto?= =?utf-8?q?XQAdfFErQvWH+OrFHUl2KDpD5vYzSnzx1SvCFp6CQDbeXfXr+cw4BdIJlLlUR5XxG?= =?utf-8?q?4YuKPfv4U9PUZV3pvtc5Q6N9s83C/ZvSSyPiok8CmmMvnzciFKoIutzpQrHjYMLnV?= =?utf-8?q?DQxK+AKcvwEGhUEeOEF9v5JT+mZqN5Osn/kgEOSLIB2qHCcRTeDkK5r5DQ0Q8Jp04?= =?utf-8?q?t1iD7kDhKjTtCXfKQPoIs4U4TVsV6XwN+67ORlbagkWByPb+0kJ4ngonayK8ZXNqE?= =?utf-8?q?YheE7IBH94+1okNoPGi0dYrqmrmdhox+p7cdgtq1+plLnDwAMSaxiy2w6IhJclmbY?= =?utf-8?q?D3HwpbtsqolxjYNLEgtYfGTfxluu+yPA+7HbzX8IpfkGdnPLls/4pAoZ3N7zjJ0ij?= =?utf-8?q?JzJGDRX5r1aiaqpzgS87aSWZ71WHnxRHZdxuAw9THOC7zavrFpten89GZ7nreHz5p?= =?utf-8?q?5iWgbsFuZgFjpmTHavs+gGsAF2Xl5BvyA22ZYgQvtU04ZVOboMeYFqbS7pNNUVbK3?= =?utf-8?q?EOhRIcUx/4Z?= X-Forefront-Antispam-Report: CIP:255.255.255.255;CTRY:;LANG:en;SCL:1;SRV:;IPV:NLI;SFV:NSPM;H:PAXPR04MB8459.eurprd04.prod.outlook.com;PTR:;CAT:NONE;SFS:(13230040)(7416014)(376014)(52116014)(366016)(1800799024)(38350700014);DIR:OUT;SFP:1101; X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1 X-MS-Exchange-AntiSpam-MessageData-0: =?utf-8?q?PKslBPcxPh8WsQy3dTv51NDusvJ4?= =?utf-8?q?Hj/v10DXM0QIvMdqSp4on9dqJ2nWRekt4F7U6K4sZLHwFqoJbYZ9BwyyFLBzoM2FZ?= =?utf-8?q?XG2byJxqinJA4lynnxdbsZQB3CbXHQj1/rTANPdG51vbOu/wP8Q5D1huK9jL7+Jwc?= =?utf-8?q?PSp1arV4z47GFm//QJ7iMT7MhBFJ90psbH0uLF3NY7ldi8cAdm2GMr5KASQVvm7Qr?= =?utf-8?q?cAN10VEpdebmVXJ45ip8lvHCWm6kZLKWcat/olIHHeB/KV4HyYd2VLTzhE4Q3D5R8?= =?utf-8?q?xwCEkESA4h1y6R8C76YX9VbOu977ibG2vs4ueeGVzPSVmiVvmparOXOL5Wvr6Hzli?= =?utf-8?q?yb5I9CszSmT+N29B2vRFGkFe41AgMTBavTbZmw5DbvPZQZ10QdZecDwiYTqaYpnON?= =?utf-8?q?dRU3YbkZRn9SUnZ+RXRyoUonHqM64+Y7i6jreTOSj3FEkILBEV+ht/Py6uQvPA+ES?= =?utf-8?q?JV5BTnodhZUhRGMs7qXv6poocRWAFQBiMVfaonQX/Nms4rW5jNiigM5AU4phJRxND?= =?utf-8?q?Wnh989rA0iXj7MTMcxGP1Orsj/qPER05iEJVIgE3ynHFgyNdQhsOimJnAW6OccvX4?= =?utf-8?q?feGilgwzFMq0g8xKg4+oW0wTZrbnk1WmfnhhhnD3DIztbkkrshLHBBZqkwmI0ZvhP?= =?utf-8?q?zuD0fl49DnQknlsjLrOWtcQpM98cHwha36xancclFUOYQp5wEzeqwEwnK3X+DsstT?= =?utf-8?q?NFIucL3ZJBBLiUEIIMDMgQp/Sg1nDE4x84Uv1uLD7hl09Nc9lfz+NCALnINeYIxGh?= =?utf-8?q?SVKxTM/kTLByqRQ3v4/oiX0vWZEUnna2Asp362QrBvLzgbs7zepR2K/nV95XvDNkz?= =?utf-8?q?+TV6E3kWJO4ZvPsQosDgS1MU+AJC78e5wAh5eV6B/heH9ja9hs0C+fc7e3WGz2Gtq?= =?utf-8?q?PlN3fHI+TEUrZr/Eq9XQEoo4pr3pRZlfz+1alUfu7pU5tPrZHlbsKbS2oy45yOYi0?= =?utf-8?q?MwuqkJjWAIJFaySPxpTBvPl8dbUxEozZumw5kiXFaEqhWnel7YUrKmaZBmbJIkcLF?= =?utf-8?q?PPjm9pU50ipw4kRtPWsPn49QKGMWKrTTU4PaCQ4pU6BqkDaM8fIeXhu8AYlWCKxV2?= =?utf-8?q?t7TBOqKr390psls7UcXMk8mQpD4HINnERDRre0NqADn7Q7bqivb+u2nAseJZoKu/A?= =?utf-8?q?hEnv2523gQC1OLQfC1IualT2Z1Hc/MESBE1zDpd3cdZaAKwKLPhwljmuO//4bmcSV?= =?utf-8?q?7Z6oB2FRvVAD1xpDR6zVjU7oFmXHo6IPeN83Qx3gtmocdOyUO4fEmZhC1X/wni8qf?= =?utf-8?q?Ckq+y7eQHCIHhmP9X1GW0BSM4dxm15DLoOVLe0QSsSgj9uLHsoqjvAz9OSYPiOo8Y?= =?utf-8?q?Sgu+tyLqdedO+36b4U+V4Hht8dxDblOW8rouJk2/ReIypwQQ2Zk6fJAhKGyzjhskj?= =?utf-8?q?cFuTL0LMFf4OcdTOtJjoJTRoRsn7JPP8mpPw6H+/unow4l5r9/ZZm0ABxM9tN3Z70?= =?utf-8?q?GoVbQ26X+YrNkx4Mi4yTEk4+mnJFhre6Y0mBZCA7w9vCTQ54+mgXBam+NUICHWIwQ?= =?utf-8?q?FpevZjnfwyRU?= X-OriginatorOrg: oss.nxp.com X-MS-Exchange-CrossTenant-Network-Message-Id: 2b9203b3-53f7-465f-4401-08dd4b38b524 X-MS-Exchange-CrossTenant-AuthSource: PAXPR04MB8459.eurprd04.prod.outlook.com X-MS-Exchange-CrossTenant-AuthAs: Internal X-MS-Exchange-CrossTenant-OriginalArrivalTime: 12 Feb 2025 07:41:48.6682 (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: 9WTzK043RQ5JB8BjY08DzsuYvS03AmDdHq6hKj1nqgv461tKMRfyZXAHK621dr39xyNN5epf5RUWvFQ1Av1KdQ== X-MS-Exchange-Transport-CrossTenantHeadersStamped: PA1PR04MB10865 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20250211_234151_693159_9BAF0645 X-CRM114-Status: GOOD ( 17.56 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org From: Peng Fan The i.MX95 System manager exports SCMI CPU protocol for linux to manage cpu cores. The driver is to use the cpu Protocol interface to start, stop a cpu cores (eg, M7). Signed-off-by: Peng Fan --- drivers/firmware/imx/Kconfig | 11 +++++ drivers/firmware/imx/Makefile | 1 + drivers/firmware/imx/sm-cpu.c | 91 +++++++++++++++++++++++++++++++++++++++++ include/linux/firmware/imx/sm.h | 29 +++++++++++++ 4 files changed, 132 insertions(+) diff --git a/drivers/firmware/imx/Kconfig b/drivers/firmware/imx/Kconfig index c3e344d6ecc645df1f0e3ee8078934c47f347fd7..91c753921dffbe16ced8c10565d44c15b66b2797 100644 --- a/drivers/firmware/imx/Kconfig +++ b/drivers/firmware/imx/Kconfig @@ -23,6 +23,17 @@ config IMX_SCU This driver manages the IPC interface between host CPU and the SCU firmware running on M4. +config IMX_SCMI_CPU_DRV + tristate "IMX SCMI CPU Protocol driver" + depends on IMX_SCMI_CPU_EXT || COMPILE_TEST + default y if ARCH_MXC + help + The System Controller Management Interface firmware (SCMI FW) is + a low-level system function which runs on a dedicated Cortex-M + core that could provide cpu management features. + + This driver can also be built as a module. + config IMX_SCMI_LMM_DRV tristate "IMX SCMI LMM Protocol driver" depends on IMX_SCMI_LMM_EXT || COMPILE_TEST diff --git a/drivers/firmware/imx/Makefile b/drivers/firmware/imx/Makefile index 7762855d2a771169d4f1867d27e0d51be7c9ad03..3bbaffa6e3478112638ed031375602389f18ef09 100644 --- a/drivers/firmware/imx/Makefile +++ b/drivers/firmware/imx/Makefile @@ -1,5 +1,6 @@ # SPDX-License-Identifier: GPL-2.0 obj-$(CONFIG_IMX_DSP) += imx-dsp.o obj-$(CONFIG_IMX_SCU) += imx-scu.o misc.o imx-scu-irq.o rm.o imx-scu-soc.o +obj-${CONFIG_IMX_SCMI_CPU_DRV} += sm-cpu.o obj-${CONFIG_IMX_SCMI_MISC_DRV} += sm-misc.o obj-${CONFIG_IMX_SCMI_LMM_DRV} += sm-lmm.o diff --git a/drivers/firmware/imx/sm-cpu.c b/drivers/firmware/imx/sm-cpu.c new file mode 100644 index 0000000000000000000000000000000000000000..1ce694a34b22843db5c1697ecb33c0479edb2ed9 --- /dev/null +++ b/drivers/firmware/imx/sm-cpu.c @@ -0,0 +1,91 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright 2025 NXP + */ + +#include +#include +#include +#include +#include +#include + +static const struct scmi_imx_cpu_proto_ops *imx_cpu_ops; +static struct scmi_protocol_handle *ph; + +int scmi_imx_cpu_reset_vector_set(u32 cpuid, u64 vector, bool start, bool boot, + bool resume) +{ + if (!ph) + return -EPROBE_DEFER; + + return imx_cpu_ops->cpu_reset_vector_set(ph, cpuid, vector, start, + boot, resume); +} +EXPORT_SYMBOL(scmi_imx_cpu_reset_vector_set); + +int scmi_imx_cpu_start(u32 cpuid) +{ + if (!ph) + return -EPROBE_DEFER; + + return imx_cpu_ops->cpu_start(ph, cpuid); +}; +EXPORT_SYMBOL(scmi_imx_cpu_start); + +int scmi_imx_cpu_started(u32 cpuid, bool *started) +{ + if (!ph) + return -EPROBE_DEFER; + + if (!started) + return -EINVAL; + + return imx_cpu_ops->cpu_started(ph, cpuid, started); +}; +EXPORT_SYMBOL(scmi_imx_cpu_started); + +int scmi_imx_cpu_stop(u32 cpuid) +{ + if (!ph) + return -EPROBE_DEFER; + + return imx_cpu_ops->cpu_stop(ph, cpuid); +}; +EXPORT_SYMBOL(scmi_imx_cpu_stop); + +static int scmi_imx_cpu_probe(struct scmi_device *sdev) +{ + const struct scmi_handle *handle = sdev->handle; + + if (!handle) + return -ENODEV; + + if (imx_cpu_ops) { + dev_err(&sdev->dev, "sm cpu already initialized\n"); + return -EEXIST; + } + + imx_cpu_ops = handle->devm_protocol_get(sdev, SCMI_PROTOCOL_IMX_CPU, &ph); + if (IS_ERR(imx_cpu_ops)) + return PTR_ERR(imx_cpu_ops); + + return 0; +} + +static const struct scmi_device_id scmi_id_table[] = { + { SCMI_PROTOCOL_IMX_CPU, "imx-cpu" }, + { }, +}; +MODULE_DEVICE_TABLE(scmi, scmi_id_table); + +static struct scmi_driver scmi_imx_cpu_driver = { + .name = "scmi-imx-cpu", + .probe = scmi_imx_cpu_probe, + .id_table = scmi_id_table, +}; +module_scmi_driver(scmi_imx_cpu_driver); + +MODULE_AUTHOR("Peng Fan "); +MODULE_DESCRIPTION("IMX SM CPU driver"); +MODULE_LICENSE("GPL"); diff --git a/include/linux/firmware/imx/sm.h b/include/linux/firmware/imx/sm.h index e02b7b558afb6f430f6fbeeaf3ee1f59feea3c1b..0eff427e5ba2cb3f93c26f7d055c346a1d1433f0 100644 --- a/include/linux/firmware/imx/sm.h +++ b/include/linux/firmware/imx/sm.h @@ -21,6 +21,35 @@ int scmi_imx_misc_ctrl_get(u32 id, u32 *num, u32 *val); int scmi_imx_misc_ctrl_set(u32 id, u32 val); +#if IS_ENABLED(CONFIG_IMX_SCMI_CPU_DRV) || IS_ENABLED(CONFIG_COMPILE_TEST) +int scmi_imx_cpu_start(u32 cpuid); +int scmi_imx_cpu_started(u32 cpuid, bool *started); +int scmi_imx_cpu_stop(u32 cpuid); +int scmi_imx_cpu_reset_vector_set(u32 cpuid, u64 vector, bool start, bool boot, + bool resume); +#else +static inline int scmi_imx_cpu_start(u32 cpuid) +{ + return -EOPNOTSUPP; +} + +static inline int scmi_imx_cpu_started(u32 cpuid, bool *started) +{ + return -EOPNOTSUPP; +} + +static inline int scmi_imx_cpu_stop(u32 cpuid) +{ + return -EOPNOTSUPP; +} + +static inline int scmi_imx_cpu_reset_vector_set(u32 cpuid, u64 vector, + bool start, bool boot, bool resume) +{ + return -EOPNOTSUPP; +} +#endif + #if IS_ENABLED(CONFIG_IMX_SCMI_LMM_DRV) || IS_ENABLED(CONFIG_COMPILE_TEST) int scmi_imx_lmm_boot(u32 lmid); int scmi_imx_lmm_info(u32 lmid, struct scmi_imx_lmm_info *info);