From patchwork Tue Apr 8 08:44:29 2025 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Peng Fan X-Patchwork-Id: 14042459 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 D4F0AC369A1 for ; Tue, 8 Apr 2025 09:05:41 +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=jCbS96ZWJsjZvrjwTAM4otcx9/p+SEnFPLgLPLvS614=; b=2tcEQ3xYuQKvg12+ox7y03Rqbj klW5GJJcskTHPWUPyIITmRu0lnsBMwSGuajPpreCKA7I+5YEqicFnt2QxwEGxel9lOhWrvYMYDiR4 FoxLV/SLKbA7OmSMhqIZvtd4YsO3N9GqJFi9jMfncQGX+VHjB/dnCT4SXD13j7ri94yvE36+leoBB 2WsD/CJd5FHN19J2Byhawk7IO2z5TMyR3LBkQU1BHf/D+IOtDJUH/C5lk1UA00qsjZm2AtaIpgJCC XgeKDia4TYkvzeu1tZQMuAOPtU22mTilHMoXDdksUK6u48g0FaCo3YxvvltPQYEMD8e4STp3K4d7X bw6RcPhQ==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.98.1 #2 (Red Hat Linux)) id 1u24ta-00000003NHM-2z0O; Tue, 08 Apr 2025 09:05:26 +0000 Received: from mail-vi1eur05on20605.outbound.protection.outlook.com ([2a01:111:f403:2613::605] helo=EUR05-VI1-obe.outbound.protection.outlook.com) by bombadil.infradead.org with esmtps (Exim 4.98.1 #2 (Red Hat Linux)) id 1u24cJ-00000003JOE-3ohW for linux-arm-kernel@lists.infradead.org; Tue, 08 Apr 2025 08:47:37 +0000 ARC-Seal: i=1; a=rsa-sha256; s=arcselector10001; d=microsoft.com; cv=none; b=dXse5VumEj9o0nFez01ntKv1x6khF3fUS2MxZW+sC4qgGHmF4vjjYpeqCGKns23vZoRediq+SyDDBO7PAd+CDX2awAaznUCggKahinZbB737apzXwVywXu8CwWgu4PXNvgu1dv1rbU9pMKuaUT8coTwWCEuAsRp67MrNVcI5tgcAbTJQFc384qujOLV/2s5PTAkkaZCJy5bTxVpuxq2wrIZWQQBVpwwahPVby7FAy2Pni+qr58WXk1wDjGhM97/iFFU+/zgBoUJkoxCLBPKVg2I97QAeEK/xMZb997LUhEP4l4i9F2E9A+SDp3LtphuMO9DKSVMacnw4eGMxUZuXFg== 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=jCbS96ZWJsjZvrjwTAM4otcx9/p+SEnFPLgLPLvS614=; b=By6rTk8BQufMbh5bACmXutLpHEDC9uLvGOZ76xg9KVgKchcCZY18b/jLPEHMX/vRNOdAA+vw6XpePV5V21CEg2L2YxEAgkbohKMOlaGzayNvGFULPlB/EtHmPdJfSWj9kGNpnS10Usom+LSuIfGOObZApT9exwEe8+7aephWRbnGzYjmhYg4tpWKR+yOF+W179wBvTsvhewhpqfwqjfaXpRZbMqi5hRCQ8uVZq142djlGwFEYSBefyZ5j6l37oCvSn2z0+fcVfO1mjEgbHdWgfDfHxV5l6t48lximXv02QO3MFtm/l9UWMZZM2ZOZZMKOK38POQ9tLNNK7GPEuVllA== 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=jCbS96ZWJsjZvrjwTAM4otcx9/p+SEnFPLgLPLvS614=; b=hWBQcChFpnL8vhz587hgj4wcKPRENC/TLy0FFwWaO/LbNnb4gORNI3mt/u3M3xwvuqdv/PASeYVHcCNUkp/NgmDSbnaaPBvTPsSvrbFAWN6lX2iILw8mFFja2tF19hwtZvHTRyspYWenrI8/MNVXiIVjfSQGAPJltIdU2n+yQe3k9enZXpKl1xj2QiRXUE6p3sndfttkMuR4G2zhqTZoSJmubklWLW4MjTU10ErDodeMjUH3bgM56L/R79yrQJoeLTjuVXBKMInBHmUm9ALKXgATzmQRlFy+qiYJGW3bCMifVf0XhZHbjgnBlZGmO/AYRaeld14icjUIkrColt4jXw== 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 DUZPR04MB10063.eurprd04.prod.outlook.com (2603:10a6:10:4af::5) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.8606.31; Tue, 8 Apr 2025 08:47:33 +0000 Received: from PAXPR04MB8459.eurprd04.prod.outlook.com ([fe80::165a:30a2:5835:9630]) by PAXPR04MB8459.eurprd04.prod.outlook.com ([fe80::165a:30a2:5835:9630%6]) with mapi id 15.20.8606.033; Tue, 8 Apr 2025 08:47:33 +0000 From: "Peng Fan (OSS)" Date: Tue, 08 Apr 2025 16:44:29 +0800 Subject: [PATCH v4 5/7] firmware: imx: Add i.MX95 SCMI LMM driver Message-Id: <20250408-imx-lmm-cpu-v4-5-4c5f4a456e49@nxp.com> References: <20250408-imx-lmm-cpu-v4-0-4c5f4a456e49@nxp.com> In-Reply-To: <20250408-imx-lmm-cpu-v4-0-4c5f4a456e49@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=1744101964; l=6279; i=peng.fan@nxp.com; s=20230812; h=from:subject:message-id; bh=rd3I+t2nFc7Iz0+EcatlHc+yizA13sGbbHgtoWjJqf4=; b=YptcjQsD+M5dODJpAYgJ4vChb+NChKWdx1kxD9PPVxlhSLybc9iu6SwJQ76TPaWOOYM4XJ2b2 x+eR1ZXlwcnAkI1NKIpY+k8VJcNmJEdiqUlhg4o77uv3zrt2Eyq1MCI X-Developer-Key: i=peng.fan@nxp.com; a=ed25519; pk=I4sJg7atIT1g63H7bb5lDRGR2gJW14RKDD0wFL8TT1g= X-ClientProxiedBy: MA0PR01CA0056.INDPRD01.PROD.OUTLOOK.COM (2603:1096:a01:ac::12) 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_|DUZPR04MB10063:EE_ X-MS-Office365-Filtering-Correlation-Id: 08f6f329-c706-460b-da9a-08dd767a0124 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|366016|1800799024|52116014|7416014|376014|38350700014; X-Microsoft-Antispam-Message-Info: =?utf-8?q?HzNY5kaIKmjYVIHnAX/+K0G845wDhRi?= =?utf-8?q?5RcapEz1xWdCVa85sLI8okN8feaRJSytVi561XJUvxsQf8LtpMbmXYPH+i7CQU/py?= =?utf-8?q?FiZ3TRiTgPsmRTKVVDLyKiwvRd/HnvIMRxpM0l1Yl+D86M14fclrc0qTA0NuGy3+l?= =?utf-8?q?N+EogyCbzcWJocVFDdmEMxbLcSoRbxAIaJOULpsXR7vUuSXVMrT321KjkRXWiSu3/?= =?utf-8?q?isloe0zGhexWyRqvNw+4x99P8pFVBFR93+rHm8971KBw6TzmvdvHXMUjMFsm7nRLg?= =?utf-8?q?or2f+HuvPg57DK0c5BAYIixdDrZ9ggb9CpkZRF0xmbUyCJytJ2B11V3l8WgVI8/xq?= =?utf-8?q?cj+4E0GIWHzXJVAmiJif2L1WSu74/SqbHpg5sLL9k/VC1nAqLocOYM1PpLbMyufi2?= =?utf-8?q?A2aQW8WMyaJMwraR7/+kQ02tS44i9fSuchHsoWuCJEBHB8pAOKYg45VI01teVDdL+?= =?utf-8?q?3xRxWuYQBwFWe7dlg4Ia8X8od/PTbcj2Ql21gDZqsFcm9//0SnShHMWtOQmNf2G3f?= =?utf-8?q?boIiVYjOcY96wgWnSvBA8PduxHxz/pwboom0z5zxVqhV95n1Hw0kDjPR1koDcP2Ai?= =?utf-8?q?0TGtWOzndGuQKGZVQYYgyHRqeuYmHnleOie3+tyPli8b3N/xf5x65gb8cXdMQhE41?= =?utf-8?q?4JDa3JpBLEHG/R19AOgMiAsxtRuzhhgO/c+hC31zTc77sFFMDDU68ETqi1DpppRGt?= =?utf-8?q?Nb4Kjn6QdTR5qQmaYa689kx+YcU7qYaieQ9YyYLRfgJVMo6SckQZgfub+Fl7DvnpV?= =?utf-8?q?AMifj7xQlLt+eYnC3LJdFHB3HDxtB2R0fXayuFIgD6PMdkCQW0xJdRLzJ9rXppAxR?= =?utf-8?q?/LU8hRnltzcQzhPJGBheJTtiwNdxFl5hMU9CrjdZjlYFNrcVuSGbouEhZFOYjKPNK?= =?utf-8?q?wZh/lSSLFcWnN8/mECd8lQOIK4oA1sGmXy63aGh6iIE1R48vwVuk0LVVZS90AVk0/?= =?utf-8?q?6RRgwvEZDP6aai7vhoUpYvitX/sz6rBhTSsKOf+/Vdlj1lWZcvmxT0c93T4OVyBjt?= =?utf-8?q?B4Dwk+/i/Plerp5USYHlD9s0qi+t0N4GAkCERp4/+GCif6sB76vY9zHlh10tSj99Q?= =?utf-8?q?XEW3YbY3hvaLfeHhgy+hRvZWfaNiZsfAHYn/Kac/mvt+z6D4dB/NYA05w6oWiJrzz?= =?utf-8?q?DeIAxBhf2f+S1429yvbUODeSKfxAaV+bkUs+BRRn6NmcX/tCcj9dVv5vQTIYOOgvG?= =?utf-8?q?p4Iy3OH60EPdgDbCulVoERG96zT2JEdk8vR/ntWvCB1ffF0w5VmQYx011xv0sOpHj?= =?utf-8?q?UihCG++Y5V7mtsjk9pBHa8hWCVANFXRJlhB5P3tgP7+SqYR5/lY7rlGv1MJA64571?= =?utf-8?q?9VfLV6lbIic8TRE+hZ70sVcKpLIl/FhVq0EZYnY6P3vDh/IbtJqAyyzBnPI+y1nHZ?= =?utf-8?q?gtIBQH8ieQg?= 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)(366016)(1800799024)(52116014)(7416014)(376014)(38350700014);DIR:OUT;SFP:1101; X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1 X-MS-Exchange-AntiSpam-MessageData-0: =?utf-8?q?GxQu2ETNoVokXnsrvX5YyKGKXZI2?= =?utf-8?q?IZUXC49EWb3JqEoRUSqcydKUZoZ0BAA4ulQr2cNZ2X5NxiT7UfxbfiYQ8rkuN/BX3?= =?utf-8?q?6nA/x4yewUlkY44goa0PnxPj0swdTC1NSVvIymyZqSW6q2oA2ezO2keHphyKFXiJh?= =?utf-8?q?ESp4Ul2QH0XYTyW8E6VUjkCkOBgwwpARKPhPM1SS8sdeLX+HLsAlpjs9qtyEagXmT?= =?utf-8?q?n5H5Be4XlhDOSarvobmORtHKAiIDJd452zTmd1JV1AtTeDINZLu6wmZCfy88gxH17?= =?utf-8?q?PNN45XEST53aF3ye8Qy8ZrxBjtCj1n6cawuJ6xn0TCkEFzrttaEC1AYlPIIEo50Hj?= =?utf-8?q?tWRcxXiHuAMgGDIoZH/sNVaaWBuhr90PWAuMHI/ofSnhZnm00p0LW4LF8pHM0ixXL?= =?utf-8?q?hBzT864qi/TD8+lnaK7wbH9NHhnOeC8cTsaWaV0SzgQY5u2zNIN/+zdwDWSI9x0+4?= =?utf-8?q?j7maXp8VaQav7b7F+N3xmZYQrP3vGO2HPMIp+5pWeT2slu9Q5iD/RXGrgUr+lHn/D?= =?utf-8?q?m6Ok0uhDO+CSADW8zCWLJ636wZV4nnqc/qzCsw7LeHPLYuQCtzaibMSaAwNdGdMXX?= =?utf-8?q?+1W3Lf8FgXZZ0cTryMvyq7L5UxXbT1XxVXA2pHaFQO9goY1ttuJOHpedzb/zlTWf8?= =?utf-8?q?4ep2+35B3VuSDjmKD8IzZgaaOKBF1Af3S8u9a168PA3KQOY/KokK9D3DVNzPzHyV6?= =?utf-8?q?lMw8NGIhIm+SzURQfas41rU1FW4gII8Zxhse11GnU1fLVL8CQGYvlhy+SdnfPiUZ8?= =?utf-8?q?uHgmEpTqhkBcOaipRte6Qkb8Ep19EY/V9kOPU5HGa6jfqXdrV4jlVD+XR0ySA+/On?= =?utf-8?q?8thwfaLX6wZua67FbCfHVhU7Ieax+zUk5kPYswyEB7JCHUEzpeziXCXgyNAVnckkK?= =?utf-8?q?3Ctyifj/BkmWYj7n2DzT/xUHGK0ATGpEX5gpyhLENm/EYd7+yGrH7CqzuJ1lGRfh/?= =?utf-8?q?fnG00KaP0EJ506Gky94SWVZDPn1obPs2ZrjbohmCd2DZxZV1HEleEFNxQz4cVjIAR?= =?utf-8?q?OUBa9RLqjh55qSZEdVMV4KqdLer5nna3bTserCMYXI26BIKbEuSqaWuPP9YUJEM+S?= =?utf-8?q?rRkIlTgjzDrdKkoDyKy1NFrAUvF/eUkPOW7mGrT4iZan1/QPI/fhUwl3w4keLVHcp?= =?utf-8?q?rqo1D+i+ATooNvV25g4foTRbuH5VBGjvzXPEaWDt9+K/ZRN01r/TLcn/1nfOzZ+lq?= =?utf-8?q?4cKMieqCYETUJSjhvRKNtDDFLGLjltnWfaV+kfd/eBnPv7BuzomSiFgqfYHdYYoN6?= =?utf-8?q?bLYpsZh0+kx87cQ4rnwoKMAqN0MZkZApUHp/ZHhmr/npb1nVzRIH6nkPVcbWshSon?= =?utf-8?q?hG1lqXub5NBzb5ww1JzGv/Hx8QLLWwwiPwZY6GE22PlEi0VABgAiAaG+9uJ1iaHfb?= =?utf-8?q?yJIfh7Ne9+RahDgA9t8kypoqagx8DrbPEhV4QttIsGAO2PQ81Z9U/BPlwBW43Nyu3?= =?utf-8?q?7/rAD2rxk2n8IK0deF/RakIDB1htEuTiiT8jDIlcYcttFHN4w1x3UsiWCncYAc8pM?= =?utf-8?q?0c1mpcG0y00O?= X-OriginatorOrg: oss.nxp.com X-MS-Exchange-CrossTenant-Network-Message-Id: 08f6f329-c706-460b-da9a-08dd767a0124 X-MS-Exchange-CrossTenant-AuthSource: PAXPR04MB8459.eurprd04.prod.outlook.com X-MS-Exchange-CrossTenant-AuthAs: Internal X-MS-Exchange-CrossTenant-OriginalArrivalTime: 08 Apr 2025 08:47:33.4958 (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: OFn16LnYlIbFQlIBMLWPpWnsFx4N1Fa9J0WjYpOLwM1iupkkWBNSwBvhCeU2UcEd5rwcySoeDtnqUT/Q1/T59Q== X-MS-Exchange-Transport-CrossTenantHeadersStamped: DUZPR04MB10063 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20250408_014736_121642_22D05501 X-CRM114-Status: GOOD ( 18.61 ) 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 LMM protocol for linux to manage Logical Machines. The driver is to use the LMM Protocol interface to boot, shutdown a LM. Reviewed-by: Cristian Marussi Signed-off-by: Peng Fan --- drivers/firmware/arm_scmi/vendors/imx/Kconfig | 3 +- drivers/firmware/imx/Kconfig | 11 ++++ drivers/firmware/imx/Makefile | 1 + drivers/firmware/imx/sm-lmm.c | 91 +++++++++++++++++++++++++++ include/linux/firmware/imx/sm.h | 14 +++++ 5 files changed, 119 insertions(+), 1 deletion(-) diff --git a/drivers/firmware/arm_scmi/vendors/imx/Kconfig b/drivers/firmware/arm_scmi/vendors/imx/Kconfig index b5f13d0e40155e485f4d1696e9550645d888ef44..4c24e17425f830810f8ba376ece9db93c8cded6d 100644 --- a/drivers/firmware/arm_scmi/vendors/imx/Kconfig +++ b/drivers/firmware/arm_scmi/vendors/imx/Kconfig @@ -26,7 +26,8 @@ config IMX_SCMI_CPU_EXT config IMX_SCMI_LMM_EXT tristate "i.MX SCMI LMM EXTENSION" depends on ARM_SCMI_PROTOCOL || (COMPILE_TEST && OF) - default y if ARCH_MXC + depends on IMX_SCMI_LMM_DRV + default y if ARCH_MXC && ARM64 help This enables i.MX System Logical Machine Protocol to manage Logical Machines boot, shutdown and etc. diff --git a/drivers/firmware/imx/Kconfig b/drivers/firmware/imx/Kconfig index c964f4924359fcd375560ee8263021b0fe65db1b..70c092424328067ea6b946cee59f072661e27e47 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_LMM_DRV + tristate "IMX SCMI LMM Protocol driver" + depends on ARCH_MXC && ARM64 || COMPILE_TEST + default y if ARCH_MXC && ARM64 + 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 Logical Machine management features. + + This driver can also be built as a module. + config IMX_SCMI_MISC_DRV tristate "IMX SCMI MISC Protocol driver" depends on ARCH_MXC || COMPILE_TEST diff --git a/drivers/firmware/imx/Makefile b/drivers/firmware/imx/Makefile index 8d046c341be878bb6dd1e6277992ff66ae90e292..7762855d2a771169d4f1867d27e0d51be7c9ad03 100644 --- a/drivers/firmware/imx/Makefile +++ b/drivers/firmware/imx/Makefile @@ -2,3 +2,4 @@ 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_MISC_DRV} += sm-misc.o +obj-${CONFIG_IMX_SCMI_LMM_DRV} += sm-lmm.o diff --git a/drivers/firmware/imx/sm-lmm.c b/drivers/firmware/imx/sm-lmm.c new file mode 100644 index 0000000000000000000000000000000000000000..6807bf563c03d21a68022ecf3469c38bee4fc2f5 --- /dev/null +++ b/drivers/firmware/imx/sm-lmm.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_lmm_proto_ops *imx_lmm_ops; +static struct scmi_protocol_handle *ph; + +int scmi_imx_lmm_info(u32 lmid, struct scmi_imx_lmm_info *info) +{ + if (!ph) + return -EPROBE_DEFER; + + if (!info) + return -EINVAL; + + return imx_lmm_ops->lmm_info(ph, lmid, info); +}; +EXPORT_SYMBOL(scmi_imx_lmm_info); + +int scmi_imx_lmm_reset_vector_set(u32 lmid, u32 cpuid, u32 flags, u64 vector) +{ + if (!ph) + return -EPROBE_DEFER; + + return imx_lmm_ops->lmm_reset_vector_set(ph, lmid, cpuid, flags, vector); +} +EXPORT_SYMBOL(scmi_imx_lmm_reset_vector_set); + +int scmi_imx_lmm_operation(u32 lmid, enum scmi_imx_lmm_op op, u32 flags) +{ + if (!ph) + return -EPROBE_DEFER; + + switch (op) { + case SCMI_IMX_LMM_BOOT: + return imx_lmm_ops->lmm_power_boot(ph, lmid, true); + case SCMI_IMX_LMM_POWER_ON: + return imx_lmm_ops->lmm_power_boot(ph, lmid, false); + case SCMI_IMX_LMM_SHUTDOWN: + return imx_lmm_ops->lmm_shutdown(ph, lmid, flags); + default: + break; + } + + return -EINVAL; +} +EXPORT_SYMBOL(scmi_imx_lmm_operation); + +static int scmi_imx_lmm_probe(struct scmi_device *sdev) +{ + const struct scmi_handle *handle = sdev->handle; + + if (!handle) + return -ENODEV; + + if (imx_lmm_ops) { + dev_err(&sdev->dev, "lmm already initialized\n"); + return -EEXIST; + } + + imx_lmm_ops = handle->devm_protocol_get(sdev, SCMI_PROTOCOL_IMX_LMM, &ph); + if (IS_ERR(imx_lmm_ops)) + return PTR_ERR(imx_lmm_ops); + + return 0; +} + +static const struct scmi_device_id scmi_id_table[] = { + { SCMI_PROTOCOL_IMX_LMM, "imx-lmm" }, + { }, +}; +MODULE_DEVICE_TABLE(scmi, scmi_id_table); + +static struct scmi_driver scmi_imx_lmm_driver = { + .name = "scmi-imx-lmm", + .probe = scmi_imx_lmm_probe, + .id_table = scmi_id_table, +}; +module_scmi_driver(scmi_imx_lmm_driver); + +MODULE_AUTHOR("Peng Fan "); +MODULE_DESCRIPTION("IMX SM LMM driver"); +MODULE_LICENSE("GPL"); diff --git a/include/linux/firmware/imx/sm.h b/include/linux/firmware/imx/sm.h index 9b85a3f028d1b0a5287b453eb3ad8412a363fe6c..bc27b04afb2f68b048955f51c07a106f4c7e5852 100644 --- a/include/linux/firmware/imx/sm.h +++ b/include/linux/firmware/imx/sm.h @@ -8,6 +8,7 @@ #include #include +#include #include #define SCMI_IMX_CTRL_PDM_CLK_SEL 0 /* AON PDM clock sel */ @@ -20,4 +21,17 @@ int scmi_imx_misc_ctrl_get(u32 id, u32 *num, u32 *val); int scmi_imx_misc_ctrl_set(u32 id, u32 val); +enum scmi_imx_lmm_op { + SCMI_IMX_LMM_BOOT, + SCMI_IMX_LMM_POWER_ON, + SCMI_IMX_LMM_SHUTDOWN, +}; + +/* For shutdown pperation */ +#define SCMI_IMX_LMM_OP_FORCEFUL 0 +#define SCMI_IMX_LMM_OP_GRACEFUL BIT(0) + +int scmi_imx_lmm_operation(u32 lmid, enum scmi_imx_lmm_op op, u32 flags); +int scmi_imx_lmm_info(u32 lmid, struct scmi_imx_lmm_info *info); +int scmi_imx_lmm_reset_vector_set(u32 lmid, u32 cpuid, u32 flags, u64 vector); #endif