From patchwork Fri Jan 26 07:09:20 2024 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Peng Fan X-Patchwork-Id: 13532150 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 0284FC47422 for ; Fri, 26 Jan 2024 07:05:51 +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=fFzgdnf+tYVGv6d3kV33wPHdsrzdtj7cBauSu+VRxdU=; b=O01NvGMYvxX04rDtsy0d3qQjmO FDFpUJVXw3l+toQ1rYiRLvMJmrF1MJs2T9Wh6PCsyLhSzQFLMYI4vxnGaF9HBHdyWAS8MF2nTWqZZ AL2eKgTEyLScU3x+7gWigeHeteG2J0OV/sxDZHXkrzWDrnM7IHzqZznGDHwvwvPewa/Mf6WZB82lH meYG0DxqSVkoK16xw8RaeQ2Xpk7+TNVgkHvjIosFgIfgzv14nt9rlEA5fptdhGkkDj5zCERCPCLD0 WRS7rzHpDxTvP2Rs+jgPK+Nejjco3PLMV2bQcRkLrxJsKAQgA4nGn22ZygEvA6dnqziHKPJcxUs6P bU0PSoag==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.97.1 #2 (Red Hat Linux)) id 1rTGHP-00000003J3K-1538; Fri, 26 Jan 2024 07:05:35 +0000 Received: from mail-vi1eur04on2043.outbound.protection.outlook.com ([40.107.8.43] helo=EUR04-VI1-obe.outbound.protection.outlook.com) by bombadil.infradead.org with esmtps (Exim 4.97.1 #2 (Red Hat Linux)) id 1rTGHF-00000003IxL-3bKp for linux-arm-kernel@lists.infradead.org; Fri, 26 Jan 2024 07:05:27 +0000 ARC-Seal: i=1; a=rsa-sha256; s=arcselector9901; d=microsoft.com; cv=none; b=VEIJKc5wY6E4SRgz/cB7qLbMxmCDHUtGLBoNdLbbGiJC+WP4suRV4S0O7lqzpEh5BwcI2jDWZ6gd0qcVZ5U6ZPJJQbQ0l1x2mkd/7zhLOwRIX7T32XlVI75Bh55CEaznx0w2qzB8+PG7u/wGv6ybSbIQC0X83DttaIQ5Xe1b2yKV0IJO2wEq+ELIj5KXlEMLqd3Ewis5ETP9cpd+/m0ogD6SmIb9uzSewe0bfnjInAj30DMaNQmZec4o+XxLp9wZsis0B3SNM5Ap+cmBJycP02oFynMWotbsOHmzNQ27NFBOOs0LYYgolpY1qiVgvvSn4rRspzue/7mC17qCswRTsw== 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=F1lUtjwppp5r6I2j8GSA70ZjQecm5QrSH07ZZ+SCFs0=; b=KU21YPkdVIaFRuaw5peeMLWs0q33erqA0BfpqyQUMtm1AMgvIcGl8BW0vPwJXaUZnqNBJckedYZFRzrft7U6ugKDtY9NKULyRZZ/p6+/8C+B5VCPeyh7Hf2DgdC9nANPczKJJObGlGp+bQgrFXVqa4mDVx1PyzigzQgNC8Lu5XVj6iRyxIsJPIQS0s3XNv+Kqpjw/H1eJr1MeA0G2+XGWYna+DPeHHMwlfONuzlQoqsEZsqgX75KzNwkFMg1dtskC6UW3wYqih+RT4VcpKV2fDQOC2namgR1vd4M5FyFa19QTcznWmpcQVDMMk8KpPjQuQJgwULVMfCif4dXSZz1ZQ== 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=F1lUtjwppp5r6I2j8GSA70ZjQecm5QrSH07ZZ+SCFs0=; b=Wpj1Td0ma9NHtMDG40kIpY0GhjSbj5eXS/Ob/L7165PkNJQwkdn4/W4c2RW7ioV5LQSNAHnOuskmxqx2gJNd4xcKX5reTQ34e2ZPqcD6jcgbP0iBZs+SQNgfRssEu0dys6Sgw2iJoYkbP//aRzcgSllMdWyzdNmWANPTh3xz76g= 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 AS5PR04MB9825.eurprd04.prod.outlook.com (2603:10a6:20b:672::21) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.7228.27; Fri, 26 Jan 2024 07:05:14 +0000 Received: from DU0PR04MB9417.eurprd04.prod.outlook.com ([fe80::c499:8cef:9bb1:ced6]) by DU0PR04MB9417.eurprd04.prod.outlook.com ([fe80::c499:8cef:9bb1:ced6%3]) with mapi id 15.20.7228.022; Fri, 26 Jan 2024 07:05:14 +0000 From: "Peng Fan (OSS)" Date: Fri, 26 Jan 2024 15:09:20 +0800 Subject: [PATCH v3 3/3] clocksource/drivers/imx-sysctr: support i.MX95 Message-Id: <20240126-imx-sysctr-v3-3-33fe801d5f31@nxp.com> References: <20240126-imx-sysctr-v3-0-33fe801d5f31@nxp.com> In-Reply-To: <20240126-imx-sysctr-v3-0-33fe801d5f31@nxp.com> To: Daniel Lezcano , Thomas Gleixner , Rob Herring , Krzysztof Kozlowski , Conor Dooley , Bai Ping , Shawn Guo , Sascha Hauer , Pengutronix Kernel Team , Fabio Estevam , NXP Linux Team , Marco Felsch Cc: linux-kernel@vger.kernel.org, devicetree@vger.kernel.org, linux-arm-kernel@lists.infradead.org, Peng Fan X-Mailer: b4 0.12.3 X-Developer-Signature: v=1; a=ed25519-sha256; t=1706252968; l=3432; i=peng.fan@nxp.com; s=20230812; h=from:subject:message-id; bh=o5T5BQKnKVPTSdGEy9mYdRRrgmMK7+tO3UEptrQOgLk=; b=J8pLB3fRXEAMmslF475aaHFSGSuGT4kGBFg2uSkYRcPYP4Nb661vtnNi6jOPgqGJQSF5HJICa DRBk9Wb14K1Aq4g2MMy2sCTrRSdqdCtwzth//2VW8eQZc9cjTakl0C4 X-Developer-Key: i=peng.fan@nxp.com; a=ed25519; pk=I4sJg7atIT1g63H7bb5lDRGR2gJW14RKDD0wFL8TT1g= X-ClientProxiedBy: SI2PR04CA0002.apcprd04.prod.outlook.com (2603:1096:4:197::17) 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_|AS5PR04MB9825:EE_ X-MS-Office365-Filtering-Correlation-Id: f6e8f4c4-6ffa-4ccf-44df-08dc1e3d250e 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: JKulW+EyU31yROhdubTjkcfnsa9ybURBcDhAQuTfhcP5q2XRDHy4S27LS4yYq+3AdmWe54Dfa5/+DmRGMmbKWatRxHyzS03/ONMp/Gnt8loIeQCNKhJX0jl0fRrguXG9DI30yPisgFpGMMpaqjw1WEl3ZCftmNdfZscMxUkqh7/0ftjEBlhcc1a24aHM/U86m+A4eES3WrDgKo62Rj7lelCiWLjTKDLoEMVhzcYLC+NgVx7z6GHUYhjRyrinHwZQQhN8DzIlFtFSzIWmgiVjMmhhsTU77PD4oTlADtzzw19BNmtCVxAa4iFjEj97GEu4seQIxbmEk8vk50bk4rWPwhXO7eN7dA7YLowQjuao+Vntamuig8K2gwNLeQIn9ZCKKegE1vFMyzEriU+cgenhwNzADm5Kq9QcT3EBGL0EKga2/c9gXR7coLb1B7S3JceD8PfJeTHGEB1SR4Tqm5SbWeL3JQPX9CBA0LRC9FpeVOUHi6nHpvCCktGo+xVVc+9JJik++l0Dq5IvecwkATnMTarIMzomqY1DgT0/mhCAgyvG5B94UMx88i2hI9glkG1Xz0yjjZFW9ts9kpF0nC5hssoNpCh6JiOLjUrieTOfYPZ7USYGXkcpjcS3AbT4KFoIp6N+aAMB2RvpsGA2NMGLRQ== 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)(376002)(396003)(346002)(366004)(136003)(39860400002)(230922051799003)(451199024)(186009)(64100799003)(1800799012)(83380400001)(921011)(110136005)(36756003)(86362001)(41300700001)(38350700005)(38100700002)(26005)(9686003)(6512007)(6486002)(52116002)(6506007)(2906002)(478600001)(66946007)(316002)(6666004)(66476007)(66556008)(5660300002)(8676002)(4326008)(7416002)(8936002);DIR:OUT;SFP:1101; X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1 X-MS-Exchange-AntiSpam-MessageData-0: =?utf-8?q?UxbnEXE/fF9V/efv/BFGsvi8E7CS?= =?utf-8?q?lrbbZ2og+owqBMIX2N3rJrcd6ssy01w1+cpT1UsMykL1Zk2D2ZpcND4CQ7wDYgpgv?= =?utf-8?q?gJlmaHCieo7IiOWWt7yjFfeuJkBD9yW4jFaaEvmDytYugIhSVcAY2TunryQ8rsyqo?= =?utf-8?q?eqg5bxUK8PIukzNA+jhvxwrn8Lx4QHcGjPYQjXCEzRSkAt1O/L02sWmW0VySB1Lji?= =?utf-8?q?mZP2t9jPaeC/T3ifLPZ0k/DfKgUPuFLMMLMsC6vJUIor4+4FjfVMTwNQcGGoYinGD?= =?utf-8?q?w4KWOpKOxj816hIwIgTaMQXoXzezfuKvQU1qgJEbxwiBu7qWat9g5g1YrEW8dAIK9?= =?utf-8?q?8tOaeu+G6mlYVvJo+FdSSjYGzxphVluKnyEmTPEodgCuhX/bmul8IYYys0X9o/loj?= =?utf-8?q?/9sSe2A4YMLMtmhQBuefOB/f09fHWFTAGOlPqO6lGTLX0ombVZ0EuTEZjaLCYOkaR?= =?utf-8?q?anzDDOmwf1iuXcRtI490UioPd3E34DZzRCjkxZulSQZmBx8o3UBS5RHaSYtwGsmaj?= =?utf-8?q?bKz2aO4D5vHVh9A8Jk1rx8abfsxQxPMx+OTLlHGDIWIQoaEkJ0rbECGd8EgLmEkUO?= =?utf-8?q?MPk1ZYCGtNK/p5qoqImuO2FhO6wtWm9lxiQxQ/nOq9+rQxMGhk+rCqbE5HK+50khF?= =?utf-8?q?oqHoO89fqftuy0uonNuXMPxgCKD/JJSylavOPIICzwCxvp2qCiNZGpiYupce7HpgX?= =?utf-8?q?238tzBjDs3n/vJBv/WQUKT7zKQE4bokOYKuoDlnSFqVCzMNqL0Pt1T6Xu+nNK+VSa?= =?utf-8?q?6/6lrwEykjZCdIq3YgVzKgs8Meh9VTp6ogV3swgFbkk7LHZ5LCC9QYi1A3tH7cS5M?= =?utf-8?q?BepBiRPYEUA0X7GDbK27z3QPcsZ5U91k2kipHzQKkFLJqXCMJ9x/W7jOXxP0ByebB?= =?utf-8?q?haa66u2HgX65Z9w/SIV/itCVkxNm/Rz8A9vlwKVN2agrK7kYG3Z6Tbr0j+S5MtfBR?= =?utf-8?q?mtf7odMizIhxkY/cend4yT1XW0Z+sKK4JbTsGTEIc6EY84RCx1LUwZhothuIGN9wi?= =?utf-8?q?08DeuUGjO9siHnPqTThTT4V5f+Kns5o47sSpwgJr6xFC9VJAzW8tlATMFNbmGByA6?= =?utf-8?q?ugyoWuHIbJw50Yq23VCKeUFtI6E2otQu86Kio5Z6PqWVQsVqz7Ne61bqOB3sSe1nB?= =?utf-8?q?F8I6ET5gBa5ltE9fi7GtCjCHlmUAPKVwPkaQrBoUiMVY28gR9xQA5iwZXkwioTSzE?= =?utf-8?q?lUVt1l1DPg1tqiuTk3+N/1qWLcSe0LIHqsEJX0Z1Ju6Z9nAe/B+p2seY0D2vpU8o3?= =?utf-8?q?bVzhqu/F37qw8S8JbCMOS1NT/uq+lt7p7oOOKL+7XZ24jYOUnsQ3/6Hbju+LlW1MO?= =?utf-8?q?r5x5MLCoVyzNMMQUFRuI/yMeOv2NlWFhQHokHzMidVeZgBiKzPHc0D39TQiXlltG/?= =?utf-8?q?XcOTOB1/xI3NeRGXDMQmtyCOOHoQhGPYshCp+mXS7Kyr+OzVtlE+PSBdy4zUiyFzT?= =?utf-8?q?E9dcBrgAEy2UnKqED9A7wT9XlpvrocP93eu9Y7h3jHeiKufuwr+PX0xWQ9wMSa+Lj?= =?utf-8?q?lJ0ukZFOKa0e?= X-OriginatorOrg: oss.nxp.com X-MS-Exchange-CrossTenant-Network-Message-Id: f6e8f4c4-6ffa-4ccf-44df-08dc1e3d250e X-MS-Exchange-CrossTenant-AuthSource: DU0PR04MB9417.eurprd04.prod.outlook.com X-MS-Exchange-CrossTenant-AuthAs: Internal X-MS-Exchange-CrossTenant-OriginalArrivalTime: 26 Jan 2024 07:05:14.4321 (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: mj6XVMb8FQPoTon2pbQ6es/ZiFGsbIRmEP9wdSs8lSkzDoFIWxkjIiuTIx1q3iZ6WrZjswfCerxPjOhW6OlvDA== X-MS-Exchange-Transport-CrossTenantHeadersStamped: AS5PR04MB9825 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20240125_230526_010916_C5345C6B X-CRM114-Status: GOOD ( 15.48 ) 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 To i.MX95 System counter module, we use Read register space to get the counter, not the Control register space to get the counter, because System Manager firmware not allow Linux to read Control register space, so add a new TIMER_OF_DECLARE entry for i.MX95. Signed-off-by: Peng Fan --- drivers/clocksource/timer-imx-sysctr.c | 53 +++++++++++++++++++++++++++++++--- 1 file changed, 49 insertions(+), 4 deletions(-) diff --git a/drivers/clocksource/timer-imx-sysctr.c b/drivers/clocksource/timer-imx-sysctr.c index 8d5bfb8470fb..9b7c021c3b46 100644 --- a/drivers/clocksource/timer-imx-sysctr.c +++ b/drivers/clocksource/timer-imx-sysctr.c @@ -8,12 +8,15 @@ #include "timer-of.h" #define CMP_OFFSET 0x10000 +#define RD_OFFSET 0x20000 #define CNTCV_LO 0x8 #define CNTCV_HI 0xc #define CMPCV_LO (CMP_OFFSET + 0x20) #define CMPCV_HI (CMP_OFFSET + 0x24) #define CMPCR (CMP_OFFSET + 0x2c) +#define CNTCV_LO_IMX95 (RD_OFFSET + 0x8) +#define CNTCV_HI_IMX95 (RD_OFFSET + 0xc) #define SYS_CTR_EN 0x1 #define SYS_CTR_IRQ_MASK 0x2 @@ -22,6 +25,8 @@ struct sysctr_private { u32 cmpcr; + u32 lo_off; + u32 hi_off; }; static void sysctr_timer_enable(struct clock_event_device *evt, bool enable) @@ -46,13 +51,14 @@ static void sysctr_irq_acknowledge(struct clock_event_device *evt) static inline u64 sysctr_read_counter(struct clock_event_device *evt) { struct timer_of *to = to_timer_of(evt); + struct sysctr_private *priv = to->private_data; void __iomem *base = timer_of_base(to); u32 cnt_hi, tmp_hi, cnt_lo; do { - cnt_hi = readl_relaxed(base + CNTCV_HI); - cnt_lo = readl_relaxed(base + CNTCV_LO); - tmp_hi = readl_relaxed(base + CNTCV_HI); + cnt_hi = readl_relaxed(base + priv->hi_off); + cnt_lo = readl_relaxed(base + priv->lo_off); + tmp_hi = readl_relaxed(base + priv->hi_off); } while (tmp_hi != cnt_hi); return ((u64) cnt_hi << 32) | cnt_lo; @@ -126,7 +132,7 @@ static struct timer_of to_sysctr = { }, }; -static int __init sysctr_timer_init(struct device_node *np) +static int __init __sysctr_timer_init(struct device_node *np) { struct sysctr_private *priv; void __iomem *base; @@ -153,9 +159,48 @@ static int __init sysctr_timer_init(struct device_node *np) base = timer_of_base(&to_sysctr); priv->cmpcr = readl(base + CMPCR) & ~SYS_CTR_EN; + return 0; +} + +static int __init sysctr_timer_init(struct device_node *np) +{ + struct sysctr_private *priv; + int ret; + + ret = __sysctr_timer_init(np); + if (ret) + return ret; + + priv = to_sysctr.private_data; + priv->lo_off = CNTCV_LO; + priv->hi_off = CNTCV_HI; + clockevents_config_and_register(&to_sysctr.clkevt, timer_of_rate(&to_sysctr), 0xff, 0x7fffffff); + return 0; } + +static int __init sysctr_timer_imx95_init(struct device_node *np) +{ + struct sysctr_private *priv; + int ret; + + ret = __sysctr_timer_init(np); + if (ret) + return ret; + + priv = to_sysctr.private_data; + priv->lo_off = CNTCV_LO_IMX95; + priv->hi_off = CNTCV_HI_IMX95; + + clockevents_config_and_register(&to_sysctr.clkevt, + timer_of_rate(&to_sysctr), + 0xff, 0x7fffffff); + + return 0; +} + TIMER_OF_DECLARE(sysctr_timer, "nxp,sysctr-timer", sysctr_timer_init); +TIMER_OF_DECLARE(sysctr_timer_imx95, "nxp,imx95-sysctr-timer", sysctr_timer_imx95_init);