From patchwork Fri May 24 08:56:47 2024 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: "Peng Fan (OSS)" X-Patchwork-Id: 13672844 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 52827C25B74 for ; Fri, 24 May 2024 08:49:00 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender: Content-Transfer-Encoding:Content-Type:List-Subscribe:List-Help:List-Post: List-Archive:List-Unsubscribe:List-Id:MIME-Version:Cc:To:In-Reply-To: References:Message-Id: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=ioVVw8yFlVpxvgP9UnDnq/crhXjR3jiD6gq048sB2T0=; b=PjVgdU/K8besCVB2j2b24cebtu rUEQbQt5Ut8O3H230or0P2Fp6LKUisGEvDPJHtT1S1q4dC63CYVGNqPHRrA3PhcbX02j5nXOQItQf +WW0ccbTTSbrhJzgtthBLIdesrl2XIPgaWQsVwVxeZVfSiaJbeVcGw1fxpPsmLTQHG25dHJTu2A8/ 43IKxRjxTxBlCw1ctETeO9Y4Cg4C52zQJYvaH86tHfUP+5GoI7uGJIVGWLA6vKdmo3uBxqedYpqt4 VcwjeSdyBGKQjQxfjJuy5KtdY3tiMhEyLTenQNXZy8U9dAZX92wj7oR5A4T/3uK0q/O0N5OfvD6aX IfNnmK9Q==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.97.1 #2 (Red Hat Linux)) id 1sAQba-00000008QMA-0iMt; Fri, 24 May 2024 08:48:50 +0000 Received: from mail-vi1eur05on20600.outbound.protection.outlook.com ([2a01:111:f403:2613::600] helo=EUR05-VI1-obe.outbound.protection.outlook.com) by bombadil.infradead.org with esmtps (Exim 4.97.1 #2 (Red Hat Linux)) id 1sAQbH-00000008Q1y-2ECq for linux-arm-kernel@lists.infradead.org; Fri, 24 May 2024 08:48:34 +0000 ARC-Seal: i=1; a=rsa-sha256; s=arcselector9901; d=microsoft.com; cv=none; b=Od9Dug1wopLwMXwUL55VG8anG97DPn8ndU1FkEUUbobKP6WThlDCBhNd0WfLyF5tOj42GhZt+9MlaL0bFIoMUi7RuovcDEl+TV9NdbvO/ulvj83wgCqhQh1ZUu8RSPN9FQv6cEnt+bJmWuuOiQuXi5JofItSIvwAqFFVwJ75+LBJS2FH8Qqn5KcGE35sFK2dEDbpiTDbsZL8U1Kk8bJBuph+pCINHIXFqMYy5dfM/ml1TfX8b1udlWg/AL4g0tery4exmptmS2iUN8JqqJmFW49dRBBJKsFQPWU6Vwy6vYhi13HNQSxoj/DzJb/jKJcCmjK75EwKZOT+gVoRhQ3WQQ== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=microsoft.com; s=arcselector9901; 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=8NQY5udEZ6Omsl8pKuZ+IUofTK0jwbagvhq1E6uaoio=; b=RRv5CmxBCetvPEzHILcoovO13oC6u/lLkzNNorr40jGu0b7YSfEH+l+USPZEwb1z3201x3zsA3x8eP6fpZdcDBksNoI8QvT7KF6ovy723y1oR9T0wLnKY3qbgui46vquzvE81rQPa4EnroJ0nYF5XjGFVd30gTDsC703wfL3XcDLxhupQ3PUn+aHdKzpxoRfTEbPscFgqcSiKdWgaiXVaOMU1RNKVhvlcWWR4Sdr8wWBOsFy+WaUmCYEZ9TU8F05y4NNg+ARFevP7rBFtIJmzrgQL4dEB6gvpmK6QgiDoO8aNBVuiAFvzkPeTEtoT7/GSh2bO+3X5I8UEfA95ApYXA== 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=selector2-NXP1-onmicrosoft-com; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=8NQY5udEZ6Omsl8pKuZ+IUofTK0jwbagvhq1E6uaoio=; b=SAJfiW5aouMleQ5Veb08DJDuibkTFZL8sfsj2IXX9ljqpWUaeYzz3H2uTKyopD0m6DoqVNjDhVmQ+QqqRxRUPoEbIVpflmRus6J0qiaJV+/NL9IIjCR1aeJhdFSEQ/tDUk7Th2lngcQw6YsDu6mTXbqNxnG201x0U+I/cMFc/lQ= Authentication-Results: dkim=none (message not signed) header.d=none;dmarc=none action=none header.from=oss.nxp.com; Received: from DU0PR04MB9417.eurprd04.prod.outlook.com (2603:10a6:10:358::11) by VI1PR04MB7149.eurprd04.prod.outlook.com (2603:10a6:800:12e::22) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.7611.22; Fri, 24 May 2024 08:48:24 +0000 Received: from DU0PR04MB9417.eurprd04.prod.outlook.com ([fe80::557f:6fcf:a5a7:981c]) by DU0PR04MB9417.eurprd04.prod.outlook.com ([fe80::557f:6fcf:a5a7:981c%7]) with mapi id 15.20.7611.016; Fri, 24 May 2024 08:48:24 +0000 From: "Peng Fan (OSS)" Date: Fri, 24 May 2024 16:56:47 +0800 Subject: [PATCH v4 5/6] firmware: imx: support i.MX95 BBM module Message-Id: <20240524-imx95-bbm-misc-v2-v4-5-dc456995d590@nxp.com> References: <20240524-imx95-bbm-misc-v2-v4-0-dc456995d590@nxp.com> In-Reply-To: <20240524-imx95-bbm-misc-v2-v4-0-dc456995d590@nxp.com> To: Jonathan Corbet , Shawn Guo , Sascha Hauer , Pengutronix Kernel Team , Fabio Estevam , Sudeep Holla , Cristian Marussi , Rob Herring , Krzysztof Kozlowski , Conor Dooley , Peng Fan Cc: linux-doc@vger.kernel.org, linux-kernel@vger.kernel.org, imx@lists.linux.dev, linux-arm-kernel@lists.infradead.org, devicetree@vger.kernel.org X-Mailer: b4 0.12.3 X-Developer-Signature: v=1; a=ed25519-sha256; t=1716541024; l=9301; i=peng.fan@nxp.com; s=20230812; h=from:subject:message-id; bh=KYTXizoOVzSc57FIiRlksrodLSf5KroN9SCC/ukM9b0=; b=yQzW0dtrAJUl8NZNLs95d+aCLrCAYAH+il+T0WnEUyCaHfk+nhykqizedGrUSiGgfaYDwqKz6 f7gXNnWnILGBorWfVBmjCoFW+ONWzK7wLbfPvXQIigaoBN5HTQugmHb X-Developer-Key: i=peng.fan@nxp.com; a=ed25519; pk=I4sJg7atIT1g63H7bb5lDRGR2gJW14RKDD0wFL8TT1g= X-ClientProxiedBy: SI1PR02CA0023.apcprd02.prod.outlook.com (2603:1096:4:1f4::19) To DU0PR04MB9417.eurprd04.prod.outlook.com (2603:10a6:10:358::11) MIME-Version: 1.0 X-MS-Exchange-MessageSentRepresentingType: 1 X-MS-PublicTrafficType: Email X-MS-TrafficTypeDiagnostic: DU0PR04MB9417:EE_|VI1PR04MB7149:EE_ X-MS-Office365-Filtering-Correlation-Id: 262250b7-d1cf-4bcc-a00e-08dc7bce45b1 X-MS-Exchange-SharedMailbox-RoutingAgent-Processed: True X-MS-Exchange-SenderADCheck: 1 X-MS-Exchange-AntiSpam-Relay: 0 X-Microsoft-Antispam: BCL:0;ARA:13230031|366007|376005|7416005|52116005|1800799015|921011|38350700005; X-Microsoft-Antispam-Message-Info: =?utf-8?q?m1e75J7mqJeeA+3ynueyp3M+eyf73WJ?= =?utf-8?q?Vll7XHlbUEAoNuRm7AIz+f+GpYM4hplYNpoLo4i2STZQJoHUt52eN9IlSBPPwQadX?= =?utf-8?q?TccG/h4QR1yBqQiD1KMyRJyuUJ2vF3h7QN8tSCDEQGiUci9tJbZSrcSxWcDMv1oqr?= =?utf-8?q?6nNGAjTXe1b8AbLmyyIdVTy2JWFVubNUM1ceWCXsmP3rzGVRAqbEfHtOXlhFb7Xzz?= =?utf-8?q?Ptgp+otVJ8CjkU8kgYiTPWTtmeFEBE7g2KfexVRzrNTAhyMw07dPE3ZIvX6d/6l/X?= =?utf-8?q?sLGJlyJIQ43f2k2x6EyPfmbCpavCWhDfl2mx0x6a2CCcAX378G59vYg0yO0Ryt45S?= =?utf-8?q?ldAeJ/yJfoWMPsFhwkGzjoClsu88Ys9jMa04A+hepEITX2GaeSG7raIhVruJiyOJ/?= =?utf-8?q?ywrcdC8fn9IHUduAIzfKmK5vVHDsJuMyXkKttdASeKjTWF8M1xT2BMbtXYL3YpehB?= =?utf-8?q?IkmnTgZ64my3i/l6Cxy+WNH+SRy98/PJDESRJyFWlvA3muPZdafjUa5sN0mlQTn4+?= =?utf-8?q?2MJhCbmEe5kdfMCcezWUKRP5wP1lfsH8OwyY+WRJjzPmANpW8uh9FqwAufsYpdi+n?= =?utf-8?q?UvjLrk18CafByuxjI+4H1VxldlWZbtyOZq2IanfUqgu6uxr9RETaZK5kV63u2+Edq?= =?utf-8?q?mskK6WXLbThMOx7/a7fao89Zvu3/knLu1Fk1X9mIKt2vt9v/bFJtOBwF0t6TvXN8G?= =?utf-8?q?T3rv3QyXP20LnWd5cWN6QvddcYonCV/69QNkT8/AErebKZGRRCp2SCcNnwQsOo5Is?= =?utf-8?q?VmbdV5dhG6Aw7s3gfAwh94z2scC2PMoLaZFRhoUCgf/RO4ZlPyNPMmcQMmFTcaxuD?= =?utf-8?q?KpubCqiv/ysU8GcHPcS3iTWzCGJ6yMIt7eq+r8Taiw6hos/HkoLa6Pq9ICCDRY+Zf?= =?utf-8?q?9bUT+Aus6JuUUvFYwwHVffO3xbiNQyLQhGlzojwy2Ft7VE4vYHrLhcY+rKIUbWdzE?= =?utf-8?q?2vz9nrIAtox7mZv0BO+Ghuw73w9a3TsPpap6USdEOKaNRG3uj6gZdhPUb2sFHWLtQ?= =?utf-8?q?p1e3+fz8bopHRTPQjXFVvq9lbotHC5uym4Sb9saaZu74fYpfGizG6rAzr925l6n1x?= =?utf-8?q?sdVV3RTei4ka9s/4LX/j0IitxO8+Vzn6R6cPrTYjdydzygajrA5WFiDNObPrFkOje?= =?utf-8?q?7ToewsvT+59wFJ+e03GtuIAghy+VM5ZVUIRVXklxNy9q48UKxYoClcW+fAa/+OLay?= =?utf-8?q?KofCxwv7KAOnNJKwav9QJFgY63anJnOYSjQdfpYSBu2VcbqQjDabF3WkE2MVtPLio?= =?utf-8?q?ZByFlg9N9PIOUWZ6eI7FXjnlRdMLB98H9yL1iy9FcRsBT4e0ELi8XSfw=3D?= 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)(376005)(7416005)(52116005)(1800799015)(921011)(38350700005);DIR:OUT;SFP:1101; X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1 X-MS-Exchange-AntiSpam-MessageData-0: =?utf-8?q?wQzYN61ZwtxgAb8jLXjnbwPXOSos?= =?utf-8?q?tTyU3hDNknyPJH76pkp8ULZy3lWIyul3oeg5W1uWhh8EK1EDGCtu8Vemglvgw1Ymd?= =?utf-8?q?vxqrNgrvtfKFbGOKN+SEc08bXpCHbSzP6HlW4ikpVfjLd+4S5rl0dCExJOltS8+ba?= =?utf-8?q?eys9NX2mWPBPnoh3tQrK1j2jFtpN6Y7BJDN7kMp8X1T4CD479FYuAYruOFH+wh6qv?= =?utf-8?q?HkpBCeUrU+pmbmH7ov9oAuZzTuzAuSmd6ZabuGcCrx3twuJaurRKFv7ksF5vR/CKh?= =?utf-8?q?F8fLfeyj159gN3wndZL8O8K9zF2wm3Rw8ewOes7GBkXzzCixx0GN3L7jEXeIs0ZxS?= =?utf-8?q?NMgdTFMGe5dja6I3Zrb9dmscE0TlXGyzIu8Ag3QerD3v5U6E50smF9R/i/bNuV7H+?= =?utf-8?q?mHg/d+zwzgEpjWunNskDXyytAW+8eBRJ+SZJgjhTVf86ABMgMdVW5o+MryWjZ1Zeq?= =?utf-8?q?OQnqWVVVxdVJWRyabOQsxHodihsxrLZaU4M+vzCJBtfmvj7850wSYDSKh+aRzY6ww?= =?utf-8?q?4J31MzBPxBmUH1UEtnlYdZdLjORHBSKcuHr67JMeuEbxnBSVLxq+M2Alk4/k4cDyF?= =?utf-8?q?BPk8oyMLSdJRXJlrNn6T5SP3jQ8Nuf2wJvqQBXZQNnhktQuLtgbswK7OulmTMGWyV?= =?utf-8?q?p5ClU/kUc9Y3+ZrQyj6XJShEuG/lF6qAKF48S3cux89c7rMKLtWc/QzNttUR+QV/e?= =?utf-8?q?Kk7LjhousEoqATa+PpQ7qY/D9BrDPq9IZjwuTwEpPwVok5Gnv2W1sTDLA+I1fN6aa?= =?utf-8?q?2Kv9wQxpKvZvmSQrOjaGFOlEqc8C5np+RWgjJcPkS4TcZC/R4YPfCbDfMDYo7rEdx?= =?utf-8?q?i95iGpSQtRhfh+TPkGaR6OqJ1c1ITzVmPgiiknEhQBgKBOFipCcbpe7qJl5al9I3i?= =?utf-8?q?AbHxceQQm4Hc1n7olj+P3TvxJvyJf7OtvVvv59f6qS7erwB8z1i27AlETQTueXDX/?= =?utf-8?q?LO4/8j/qvZtufRQB+mWvtnUeSeMsNZpZ+i4OWxYMccEwAbgxfrQTr8M6MfSVFUHP2?= =?utf-8?q?D27RJivBCZU+NrwnYxvbYyTXnkWU7OL7SDiW0YOVR4hjFNrA/DqNu4gZ/Lz5WPSK+?= =?utf-8?q?hRk8qiB/1rhB7Rpz0Wrqzvv9nTyalRoY2PsiS8fs/09sGkFJ3Ob4mdAJvP1JSS3Oh?= =?utf-8?q?f2caqQ63sUV5IAVPuswrpCCg8inMRgz/Pk7l1lrRkD5dz2ZwdjA1yLpXkepwCzbTi?= =?utf-8?q?8BvbzUd1mlJ/VPHhhWge5iVL2ikv6xXQrrKuY4kuZLM+Xi0xgsANnB96CkvRqMEtq?= =?utf-8?q?qM9HL77RNEsol4C9hHtG9ixfO/1Coe9UDpNzU66kn858MkFPhvO5OvNfatEf40/dz?= =?utf-8?q?i43+WXOem2OQfTqQRpZy3NSW92gHW2Em/UWYZFL53cl2h5aLaos910V9sF4M1qcyu?= =?utf-8?q?IuAA2NXXjCEYMc8W5jx8fPwNEbGUpejxTM1KVsn6pvLoYnyAdHKr1wUIp4Cx1rlhG?= =?utf-8?q?50hFJSVBp2oI7/g+YDJUZKEj9ctO5LZWkrHujvQ5AX3ShEdbLHZtBc7YtZ4SULCmx?= =?utf-8?q?6OH0IUvAObbW?= X-OriginatorOrg: oss.nxp.com X-MS-Exchange-CrossTenant-Network-Message-Id: 262250b7-d1cf-4bcc-a00e-08dc7bce45b1 X-MS-Exchange-CrossTenant-AuthSource: DU0PR04MB9417.eurprd04.prod.outlook.com X-MS-Exchange-CrossTenant-AuthAs: Internal X-MS-Exchange-CrossTenant-OriginalArrivalTime: 24 May 2024 08:48:24.3637 (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: a2TFUp60S/dgfReowZnMSULWUWnHTpC+ysNpiLzhTDAphiEW7pqgzvs4YgJ0dopOuny93hTUC8Nf8pKOwy6P2g== X-MS-Exchange-Transport-CrossTenantHeadersStamped: VI1PR04MB7149 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20240524_014831_776285_72466994 X-CRM114-Status: GOOD ( 18.08 ) 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 BBM module provides RTC and BUTTON feature. To i.MX95, this module is managed by System Manager. Linux could use i.MX SCMI BBM Extension protocol to use RTC and BUTTON feature. This driver is to use SCMI interface to get/set RTC, enable pwrkey. Signed-off-by: Peng Fan --- drivers/firmware/imx/Makefile | 1 + drivers/firmware/imx/sm-bbm.c | 314 ++++++++++++++++++++++++++++++++++++++++++ 2 files changed, 315 insertions(+) diff --git a/drivers/firmware/imx/Makefile b/drivers/firmware/imx/Makefile index 8f9f04a513a8..fb20e22074e1 100644 --- a/drivers/firmware/imx/Makefile +++ b/drivers/firmware/imx/Makefile @@ -1,3 +1,4 @@ # 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_BBM_EXT} += sm-bbm.o diff --git a/drivers/firmware/imx/sm-bbm.c b/drivers/firmware/imx/sm-bbm.c new file mode 100644 index 000000000000..5e7083bf8fd3 --- /dev/null +++ b/drivers/firmware/imx/sm-bbm.c @@ -0,0 +1,314 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * Copyright 2024 NXP. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define DEBOUNCE_TIME 30 +#define REPEAT_INTERVAL 60 + +struct scmi_imx_bbm { + struct rtc_device *rtc_dev; + struct scmi_protocol_handle *ph; + const struct scmi_imx_bbm_proto_ops *ops; + struct notifier_block nb; + int keycode; + int keystate; /* 1:pressed */ + bool suspended; + struct delayed_work check_work; + struct input_dev *input; +}; + +static int scmi_imx_bbm_read_time(struct device *dev, struct rtc_time *tm) +{ + struct scmi_imx_bbm *bbnsm = dev_get_drvdata(dev); + struct scmi_protocol_handle *ph = bbnsm->ph; + u64 val; + int ret; + + ret = bbnsm->ops->rtc_time_get(ph, 0, &val); + if (ret) + dev_err(dev, "%s: %d\n", __func__, ret); + + rtc_time64_to_tm(val, tm); + + return 0; +} + +static int scmi_imx_bbm_set_time(struct device *dev, struct rtc_time *tm) +{ + struct scmi_imx_bbm *bbnsm = dev_get_drvdata(dev); + struct scmi_protocol_handle *ph = bbnsm->ph; + u64 val; + int ret; + + val = rtc_tm_to_time64(tm); + + ret = bbnsm->ops->rtc_time_set(ph, 0, val); + if (ret) + dev_err(dev, "%s: %d\n", __func__, ret); + + return 0; +} + +static int scmi_imx_bbm_alarm_irq_enable(struct device *dev, unsigned int enable) +{ + return 0; +} + +static int scmi_imx_bbm_set_alarm(struct device *dev, struct rtc_wkalrm *alrm) +{ + struct scmi_imx_bbm *bbnsm = dev_get_drvdata(dev); + struct scmi_protocol_handle *ph = bbnsm->ph; + struct rtc_time *alrm_tm = &alrm->time; + u64 val; + int ret; + + val = rtc_tm_to_time64(alrm_tm); + + ret = bbnsm->ops->rtc_alarm_set(ph, 0, val); + if (ret) + dev_err(dev, "%s: %d\n", __func__, ret); + + return 0; +} + +static const struct rtc_class_ops smci_imx_bbm_rtc_ops = { + .read_time = scmi_imx_bbm_read_time, + .set_time = scmi_imx_bbm_set_time, + .set_alarm = scmi_imx_bbm_set_alarm, + .alarm_irq_enable = scmi_imx_bbm_alarm_irq_enable, +}; + +static void scmi_imx_bbm_pwrkey_check_for_events(struct work_struct *work) +{ + struct scmi_imx_bbm *bbnsm = container_of(work, struct scmi_imx_bbm, check_work.work); + struct scmi_protocol_handle *ph = bbnsm->ph; + struct input_dev *input = bbnsm->input; + u32 state = 0; + int ret; + + ret = bbnsm->ops->button_get(ph, &state); + if (ret) { + pr_err("%s: %d\n", __func__, ret); + return; + } + + pr_debug("%s: state: %d, keystate %d\n", __func__, state, bbnsm->keystate); + + /* only report new event if status changed */ + if (state ^ bbnsm->keystate) { + bbnsm->keystate = state; + input_event(input, EV_KEY, bbnsm->keycode, state); + input_sync(input); + pm_relax(bbnsm->input->dev.parent); + pr_debug("EV_KEY: %x\n", bbnsm->keycode); + } + + /* repeat check if pressed long */ + if (state) + schedule_delayed_work(&bbnsm->check_work, msecs_to_jiffies(REPEAT_INTERVAL)); +} + +static int scmi_imx_bbm_pwrkey_event(struct scmi_imx_bbm *bbnsm) +{ + struct input_dev *input = bbnsm->input; + + schedule_delayed_work(&bbnsm->check_work, msecs_to_jiffies(DEBOUNCE_TIME)); + + /* + * Directly report key event after resume to make no key press + * event is missed. + */ + if (bbnsm->suspended) { + bbnsm->keystate = 1; + input_event(input, EV_KEY, bbnsm->keycode, 1); + input_sync(input); + bbnsm->suspended = false; + } + + return 0; +} + +static void scmi_imx_bbm_pwrkey_act(void *pdata) +{ + struct scmi_imx_bbm *bbnsm = pdata; + + cancel_delayed_work_sync(&bbnsm->check_work); +} + +static int scmi_imx_bbm_notifier(struct notifier_block *nb, unsigned long event, void *data) +{ + struct scmi_imx_bbm *bbnsm = container_of(nb, struct scmi_imx_bbm, nb); + struct scmi_imx_bbm_notif_report *r = data; + + if (r->is_rtc) + rtc_update_irq(bbnsm->rtc_dev, 1, RTC_AF | RTC_IRQF); + if (r->is_button) { + pr_debug("BBM Button Power key pressed\n"); + scmi_imx_bbm_pwrkey_event(bbnsm); + } + + return 0; +} + +static int scmi_imx_bbm_pwrkey_init(struct scmi_device *sdev) +{ + const struct scmi_handle *handle = sdev->handle; + struct device *dev = &sdev->dev; + struct scmi_imx_bbm *bbnsm = dev_get_drvdata(dev); + struct input_dev *input; + int ret; + + if (device_property_read_u32(dev, "linux,code", &bbnsm->keycode)) { + bbnsm->keycode = KEY_POWER; + dev_warn(dev, "key code is not specified, using default KEY_POWER\n"); + } + + INIT_DELAYED_WORK(&bbnsm->check_work, scmi_imx_bbm_pwrkey_check_for_events); + + input = devm_input_allocate_device(dev); + if (!input) { + dev_err(dev, "failed to allocate the input device for SCMI IMX BBM\n"); + return -ENOMEM; + } + + input->name = dev_name(dev); + input->phys = "bbnsm-pwrkey/input0"; + input->id.bustype = BUS_HOST; + + input_set_capability(input, EV_KEY, bbnsm->keycode); + + ret = devm_add_action_or_reset(dev, scmi_imx_bbm_pwrkey_act, bbnsm); + if (ret) { + dev_err(dev, "failed to register remove action\n"); + return ret; + } + + bbnsm->input = input; + + ret = handle->notify_ops->devm_event_notifier_register(sdev, SCMI_PROTOCOL_IMX_BBM, + SCMI_EVENT_IMX_BBM_BUTTON, + NULL, &bbnsm->nb); + + if (ret) + dev_err(dev, "Failed to register BBM Button Events %d:", ret); + + ret = input_register_device(input); + if (ret) { + dev_err(dev, "failed to register input device\n"); + return ret; + } + + return 0; +} + +static int scmi_imx_bbm_rtc_init(struct scmi_device *sdev) +{ + const struct scmi_handle *handle = sdev->handle; + struct device *dev = &sdev->dev; + struct scmi_imx_bbm *bbnsm = dev_get_drvdata(dev); + int ret; + + bbnsm->rtc_dev = devm_rtc_allocate_device(dev); + if (IS_ERR(bbnsm->rtc_dev)) + return PTR_ERR(bbnsm->rtc_dev); + + bbnsm->rtc_dev->ops = &smci_imx_bbm_rtc_ops; + bbnsm->rtc_dev->range_min = 0; + bbnsm->rtc_dev->range_max = U32_MAX; + + ret = devm_rtc_register_device(bbnsm->rtc_dev); + if (ret) + return ret; + + bbnsm->nb.notifier_call = &scmi_imx_bbm_notifier; + return handle->notify_ops->devm_event_notifier_register(sdev, SCMI_PROTOCOL_IMX_BBM, + SCMI_EVENT_IMX_BBM_RTC, + NULL, &bbnsm->nb); +} + +static int scmi_imx_bbm_probe(struct scmi_device *sdev) +{ + const struct scmi_handle *handle = sdev->handle; + struct device *dev = &sdev->dev; + struct scmi_protocol_handle *ph; + struct scmi_imx_bbm *bbnsm; + int ret; + + if (!handle) + return -ENODEV; + + bbnsm = devm_kzalloc(dev, sizeof(struct scmi_imx_bbm), GFP_KERNEL); + if (!bbnsm) + return -ENOMEM; + + bbnsm->ops = handle->devm_protocol_get(sdev, SCMI_PROTOCOL_IMX_BBM, &ph); + if (IS_ERR(bbnsm->ops)) + return PTR_ERR(bbnsm->ops); + + bbnsm->ph = ph; + + device_init_wakeup(dev, true); + + dev_set_drvdata(dev, bbnsm); + + ret = scmi_imx_bbm_rtc_init(sdev); + if (ret) { + dev_err(dev, "rtc init failed: %d\n", ret); + return ret; + } + + ret = scmi_imx_bbm_pwrkey_init(sdev); + if (ret) { + dev_err(dev, "pwr init failed: %d\n", ret); + return ret; + } + + return 0; +} + +static int __maybe_unused scmi_imx_bbm_suspend(struct device *dev) +{ + struct scmi_imx_bbm *bbnsm = dev_get_drvdata(dev); + + bbnsm->suspended = true; + + return 0; +} + +static int __maybe_unused scmi_imx_bbm_resume(struct device *dev) +{ + return 0; +} + +static SIMPLE_DEV_PM_OPS(scmi_imx_bbm_pm_ops, scmi_imx_bbm_suspend, scmi_imx_bbm_resume); + +static const struct scmi_device_id scmi_id_table[] = { + { SCMI_PROTOCOL_IMX_BBM, "imx-bbm" }, + { }, +}; +MODULE_DEVICE_TABLE(scmi, scmi_id_table); + +static struct scmi_driver scmi_imx_bbm_driver = { + .driver = { + .pm = &scmi_imx_bbm_pm_ops, + }, + .name = "scmi-imx-bbm", + .probe = scmi_imx_bbm_probe, + .id_table = scmi_id_table, +}; +module_scmi_driver(scmi_imx_bbm_driver); + +MODULE_AUTHOR("Peng Fan "); +MODULE_DESCRIPTION("IMX SM BBM driver"); +MODULE_LICENSE("GPL");