From patchwork Mon Mar 3 02:53:26 2025 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Peng Fan X-Patchwork-Id: 13998088 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 39270C282C6 for ; Mon, 3 Mar 2025 03:04:21 +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=cNh2lt/IgGOFC0CK/wXJ+iVesg owU+rmITumqBDTzDYHdrqw12+eI2IauWWeyypW7LGtvv/vRkZRcWM6TZOlHWZLl717vdaOoiwAEEB 0WwgByQLYTBF6c6gIlC8Xlxhw5Vqe6wRc0SKE55CGNyxnRycaF0k2K7A671mcPf2TyjRnwACrwW3e E2McOYKXcL17XdY7bAMjb3lIenJ7FRx6UATjn/UIeg6Jj2i6KryKLnH84Vu4/+mqZyc7RhrYyH5ul LGJclxyRa5EpAHEqSGFJ4sGxYo5q2wlYg1m7iPan273GZNqrRci4FXkO1KvJv/5aJHQ1xnBCDNgHZ DkulREvg==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.98 #2 (Red Hat Linux)) id 1tow6G-0000000H22z-2YtR; Mon, 03 Mar 2025 03:04:12 +0000 Received: from mail-db8eur05on2061e.outbound.protection.outlook.com ([2a01:111:f403:2614::61e] helo=EUR05-DB8-obe.outbound.protection.outlook.com) by bombadil.infradead.org with esmtps (Exim 4.98 #2 (Red Hat Linux)) id 1tovxM-0000000H191-2fkb for linux-arm-kernel@lists.infradead.org; Mon, 03 Mar 2025 02:55:02 +0000 ARC-Seal: i=1; a=rsa-sha256; s=arcselector10001; d=microsoft.com; cv=none; b=jPBKWyIC/nIfG2+Wh2JiVhZD90U3tylT9/qR7ZF4//7LDB1+aK4efLHZZlbE9JzcQm9FW4IbARqT+fVqbFXLb5J2ZpYnpJl8SRZm5c+J8XBwRvfoZyCijLeFyw+UNZj8wIcJsxI1LaSjpLSh4e4fWrsYlwPX5isD9iV3wPxtD9bpVJC3V3FiFRzlUjqrK3jr/dGNKrTiEgyf3pv/drHob9TeMSjUS9ZigWzstep2X9QmqZNypUgh8825LX6bv5ec5NC2OA21EjDl2PvgxknV3A48zjDnd9+YXSZMDJfVqVgUYpN+dbf0iH2rQzav/TdyVzXjaocV5FkW/OG0uNMcXQ== 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=P/CN7vDwI/p2qJBUNQwmCmA3cFYyUmL+4gHgKYaN51gJ2puomTQMmq9zxDyd39VqgGyJ2u0EI71QJc5MC0h/qMkiptD7vOoBWEBpL6ZvEKOkDgkDxYgq/y4mOSkx+ySEM+VhMNyn1aNWBUKSVypjD0k20bTgnqR9YnoEk+duyduB0qFB4stIlg+gEhQAcJX8uBDZu57hVUZ/txIUPUzzeb9auAo2In0yhF05++hsEyxqU7r0URF7P9uIh66T5GHYEc9BOLUnrtiWJN32OPqUcDlsg7JPk6SvQMAph3UtfFz26r6ROQ5J/2bWK8Ks3mojhfHOHQGCv7wUppp5N1Da2Q== 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=H5ehIdIE2ygDZQkIkWYT2j5z2EXhoVhcykZy38SrMjxb9qVbh76i6SZEkUKJfCD89XZ/NnDx7jtU6R2T8cmlXQdKRMxSD8Zl96BQa5iIgOvAxhKX4ojdfPvBtC6VhjlBh6hoC+Ewg3ggBiOy4eI7rsexrfVLX9MFpCOA0C/jypFAGbDLyE68f8Hq26ieIrI56SL+NsVyzHiagIJNY2Hpq+lbadJlO/7phss5Znt1ZsW0h4XfWdKegZ9FwleALKO9s9FE6y4+zw9Ev1De0ZM9IZMz/nFVdHSPWTgszzSUGH68rtIj2B7cPKlyVh5xOZliW6BbcAxH8stDmAECScvPIA== 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 AM9PR04MB8308.eurprd04.prod.outlook.com (2603:10a6:20b:3e3::10) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.8489.27; Mon, 3 Mar 2025 02:54: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%4]) with mapi id 15.20.8489.025; Mon, 3 Mar 2025 02:54:47 +0000 From: "Peng Fan (OSS)" Date: Mon, 03 Mar 2025 10:53:26 +0800 Subject: [PATCH v3 5/7] firmware: imx: Add i.MX95 SCMI LMM driver Message-Id: <20250303-imx-lmm-cpu-v3-5-7695f6f61cfc@nxp.com> References: <20250303-imx-lmm-cpu-v3-0-7695f6f61cfc@nxp.com> In-Reply-To: <20250303-imx-lmm-cpu-v3-0-7695f6f61cfc@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=1740970413; l=6279; i=peng.fan@nxp.com; s=20230812; h=from:subject:message-id; bh=rd3I+t2nFc7Iz0+EcatlHc+yizA13sGbbHgtoWjJqf4=; b=RBVEydphNnVStTr5GuJ2qU4xWWa8JsXWed/F/3nUzr0Z7mGzYw7OwCgv2UdYI0TAnpoIaqXD9 Y/4A7sC6050APQDVvHX0oHHAZsSN+hDRBfjXPYblIzxw/WRwJZ7xbgE 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_|AM9PR04MB8308:EE_ X-MS-Office365-Filtering-Correlation-Id: 131ac754-4af4-4ade-cba7-08dd59fec27d 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|1800799024|366016|52116014|7416014|376014|38350700014; X-Microsoft-Antispam-Message-Info: =?utf-8?q?AHArHN/0Nw4w4HVfSnfmTVFYXet6Lya?= =?utf-8?q?fClt2IgYwVheK36DZGLXdXtusgm3cH+5yRKX1soFUy6ptvL+/l4QhBcDtVFNFRW3b?= =?utf-8?q?G4zmLruHkaZuuBGCdYPFFhlRljD9xfGY70apHA7SBc2xWmV+YfJr+rZnsO0JyDYc/?= =?utf-8?q?P9BBrTOCEaQ9ZIIYfDvPb6Osg+xJBh3bM7ngYxLKHYJIrs3/ySBS3HxGpyf5lWIUk?= =?utf-8?q?oT4MkFnJ2db5tT5F887j28HSB0bjF/v1HoncKS7197qQrSARC2G/xtXxCSOuh1WC1?= =?utf-8?q?1yDWqGLl2aec+Vl7e2G37jiIqmtVEJBPQU83eo4Y2K78FLkUeOfzTJg3qQU4l+mII?= =?utf-8?q?HBs+1SPXrSzvGfgB8vp0tXjYUadAXXJHUoAaF3nBiF0+HI7l+SmIqCNwAP9gVDUmv?= =?utf-8?q?0LTAjFnvxAsHOdSH8Zge2BVnM/WFdsAxtaJqIqWtGV8PE6o0ZOgU9S+NrTX7w/sbR?= =?utf-8?q?V633hTdJ15x3Dmk/mVnqUaCtHmb6Byb5GGko6AQUNRArV1yJSkWiqBaTx7xwUvmf1?= =?utf-8?q?cbYZqdroQTEsrrFBNUI8ITIYsbkbZM6708iMqQLLlC4qp0+49hChzzSmfh0Rbzmqi?= =?utf-8?q?H+fETTu5siGZ1KCww07OIbSYwLA0Kh0LWq3lK+YPm/rM/fJdZ4EtCrxyXuy0kdbCf?= =?utf-8?q?k0WjTPbUdaN5Q6INsC2M3bR+DM4AkdyVIzF5HnXY3FL1I3SpbDWeTEWNUMz3pFfYy?= =?utf-8?q?TSFVNKM03Ihjv/YwtCEtlx03FuC7yxo4nFevd18PFGXgJ+0qGZ1i/DIvcGpWUgkSk?= =?utf-8?q?+aM3JIEkvMJD59P+dJdpwtqJJbUlB5i7ynd9ujkxAGWFwujGnDgK598622mh3k+QO?= =?utf-8?q?vL77gbJr+rEpGqdqaBo03Sz8r0mqBJPLcu1SQFS1klNaVdectqxDcvzt10eXWF56V?= =?utf-8?q?Tkdc0ybws4bpQpXAhpHxkUD7XoO2bixA6NJ0TQND4UrlOxaPHHRzci5JWccvNAl86?= =?utf-8?q?8EBYGmWFE1Lx7FTTQMBwOzo2jvEvWi4k/Gdl2JZvIKtuy2cb+w6L2qUMHLjN6yUaH?= =?utf-8?q?HtlMCPQ75ZDrM3akfKPojgLKdCn8CFZYruMoh5oUM48FfO+vWrxa7sKUU4lkidwzq?= =?utf-8?q?Hb4BBoVI9J3pV/vVmguNUafGPEZxG9xhFON+aiM10Zs6COArW6ubPMK8jGjpdlWoF?= =?utf-8?q?nPS2P5yttyFXyih1COprUcxGlAT4SakdO61kgJ4taOXOup4+G4VDYiBLbUgAU6nqk?= =?utf-8?q?OvQirkIQUSUdiuLSXumafzONkkWm72ax9QTQersVgf7PkWhNk/K2DO5PLZzdxbouu?= =?utf-8?q?MQrUrxnCAheZ7Etg5lYpvv86kNuAfAqBhQns/fea9JAOza5jBUIyPuSHYdISUMy6M?= =?utf-8?q?E0iJlbP0F7Cp9+DbPedWgVB6YJF/hRDN7o4hXvV/bBZCj8paJVXMIAgBsk0javP+q?= =?utf-8?q?MszO3ZcdEfc?= 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)(1800799024)(366016)(52116014)(7416014)(376014)(38350700014);DIR:OUT;SFP:1101; X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1 X-MS-Exchange-AntiSpam-MessageData-0: =?utf-8?q?Kt20PlcDHgn4EQ/5RrmdMnUgnI7Z?= =?utf-8?q?hxwGT1F4SOiQPwwudPBkS1o/R4YEolIiTcXbNp7dhRVMF3ZIBOmXizKKIiRtSwt1Y?= =?utf-8?q?usbrHXBdWbUIXW/TT1BzPux4p+o0A0DilfrKcInZ1gX/k5Bj+TO/SOK6fbCeQS0HV?= =?utf-8?q?6JPIeU3WBId/SFu5btcNIkCiGPZg2pn2Op0w58fvO3RRoSOUhSAREf1/ugTZ4W4sN?= =?utf-8?q?Gxe9L0LMBZqJgyjmwfJKT3RKNaEuCDx5M7QFQJ0TukK3Pg2Myw3LNqDDcFAbmmMkJ?= =?utf-8?q?LnQynM7NpdOXsjOJ9vhQJBMkfSDQrYJFzt70EeAbC0NaHOS9TBgS/u5JjIaobffAy?= =?utf-8?q?vBSpe38dsWnyGA0KiQs4NA5q8YNyQQApix9+6np4Yn6J2UHeNeweog2B/qWRE3MQg?= =?utf-8?q?PSZU2ZTskmz93wkD4aPvF37JxUuqGxdJRJdU5zMR+RhRNDYTIfOM0h67o3dinBLCf?= =?utf-8?q?IhgYDkaqIUrSGssTf2mQenkjV9eN0zgR+6zJZwdW1IO537oCGBxEcCdfGYxkIygN9?= =?utf-8?q?ilqIwcVmnPCS0jXDiy575W6smI0u4EhgbLXH41Ge86KZwXxdGtVwbKixaYvX/mK4M?= =?utf-8?q?PLXmV8ZxGXb0XwJukBsZ6eDKXILd92WScDB1a/wY1WypFThMGQJu/3GT+qxNH9MCQ?= =?utf-8?q?nN7qMutOh6412yluOGZS1s2Gqdo2QpQ1Jl4j97PHyq5ZZPL2adPAyvE5rRWvwsRJE?= =?utf-8?q?3njAjQ/GAHfozQ++tJWcleNwIkEzE9qz2p7+LKYkLTEWwt37NkOVb9unm38uKcUxD?= =?utf-8?q?h5TaCXlop3Yu9z84DPXRUdOp5pKMxcEtk8T2FHI4Aa7tPYGOekpQMqHrs16r6wyat?= =?utf-8?q?H43HFLin9UKPr0MnrzH+rz7AyWU+iy4+glu77D3yTM0vHCOn10puJGO/LXU6qoXDG?= =?utf-8?q?+T3fjycvxFBbbYjtp9OataiXDlrDd7x2UgQ6Ea6C8fXFmdpDbmVKlHfLq4Iws0FIU?= =?utf-8?q?dg5GsnqupVJ8yrC2UhekB7dKuFfD3YLZ1J+Ci6an5DOP7nT0MMOCXbTLKWhEJBI9v?= =?utf-8?q?k/5TD7B6f8n722b1cvJGVnJIF+W0m9Gj/lFWboPcQUS9unc0Y8KL/J3ARTjCrpW2v?= =?utf-8?q?earv3JvqaD2EI0kKsl/b7EzTDXwX67UXlXuxKvhx1mwWyKOnAnFVaEuWCufN45GWT?= =?utf-8?q?66K5JsX66eTmMJfGIR7R7VrwPgNnba1iEEJehXbDaIB2FfjVdOEXNBzxv3MIfJrNU?= =?utf-8?q?lWizM7msIoDPEz7mAnqXEciMTG23W0UXLOE0zujO5Urzt0tKVGS853k4yRxm1h8JL?= =?utf-8?q?q3YTjWjiJ1CgqcV0VcYsNcrbuZ78S6hilVRMNYSvSF8RkuNeBzR2F/BGmujuRhxO2?= =?utf-8?q?Tofwg+igmHiuekrUNznEwgVHsUHGgK9MHgvVgIZPdGKmiyOl0By6qrjaB9TSZSBYb?= =?utf-8?q?IOB5seprN4cdylbwiZTfF6T6QMuimyRtxkQ84fkWI54zgdXBH4d6G8vze0iYmbUcs?= =?utf-8?q?aEVWTlX6RY49dDQCz874JUWKznxhHnbSHj/YHwKiMIBosfbJyQh+jTxt51tMGPAqT?= =?utf-8?q?KYJsZPKtFyBm?= X-OriginatorOrg: oss.nxp.com X-MS-Exchange-CrossTenant-Network-Message-Id: 131ac754-4af4-4ade-cba7-08dd59fec27d X-MS-Exchange-CrossTenant-AuthSource: PAXPR04MB8459.eurprd04.prod.outlook.com X-MS-Exchange-CrossTenant-AuthAs: Internal X-MS-Exchange-CrossTenant-OriginalArrivalTime: 03 Mar 2025 02:54:47.8791 (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: Ifn1GCu9nCLZ253UMhuhw+jbpobK/7u/ZKFT+OyfxR/PJAMTQUVykFqj7dYJop/+vLoAx7ITAyz4lTzNCrDR7g== X-MS-Exchange-Transport-CrossTenantHeadersStamped: AM9PR04MB8308 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20250302_185500_842869_798DB231 X-CRM114-Status: GOOD ( 18.73 ) 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