Received: by 2002:a05:7412:d8a:b0:e2:908c:2ebd with SMTP id b10csp2376301rdg; Mon, 16 Oct 2023 02:24:22 -0700 (PDT) X-Google-Smtp-Source: AGHT+IHUSv/xRPDwtKa0uR/3YjVVE8pSVz0R6cBnhO+SaS/38KQEUC0SDV++viyd3ek1ysQS2VA9 X-Received: by 2002:a17:903:44a:b0:1c9:bfd3:1f4a with SMTP id iw10-20020a170903044a00b001c9bfd31f4amr11619342plb.66.1697448262154; Mon, 16 Oct 2023 02:24:22 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1697448262; cv=none; d=google.com; s=arc-20160816; b=soigSt9HVxhod1xZSwge9LoNG2UWDCktO8nfpJxFvD8mosW3wPWgplngXBSbOQzfQM FpTDGpGBVg0bUjYeKB72s5K85YiyMM/7SDs4QceGMy74n7vSqLvcjKcHlVFqXIASG0fa ZnEpBWisB15PdXZp/OGLZaL6GgyChQEMLadTxLqwBY1e+3XhJU8a0jt49iAcQrHe/6Wb m82Pm5xXBlCbFeq97Ho9NvydcG2iSPoGv+Le9xbQQkGVXja8MwJa3RsrDSzO84r/6Us/ s/6FusCCgEhnIeOll5l50LwYNjZbT5vjtuYCu2W4eD9YSXDWqX40jG6kp2WMwBj2A64u PQrg== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:cc:to:subject:message-id:date:mime-version :references:in-reply-to:from:dkim-signature; bh=v3YFl+x7yg4n/kp4vO7SuLNmHzZBUUpfwrZDn1IxT5s=; fh=3vovTCM/X7uHCoc9sjsnbNuj/3Ar4wFWO+zaDYVsSJM=; b=XpXjFBYPgCE/ib5Hf1Qa5B1Cb7Bjr33M8aNM90GoCW9CulawOwG5R2TTLzk7k3rLNt Srr5YVW5P3dfROqLHrqTbJAwhMfmxxX41HRh4YmvSUPw2eP6inIkFxt6fJKhhppi1F7G aIw/1HfDqk0SalVee+2hqYykMZ2tQbhm3g0T4Odv1rz5sBbIGDFR3I4TcGI1QXILkrXt Nj6rU6iJBaguoOlbV0VJ85O6u8cBPvlu0IUB3I9J9hha5p2NzdHeBGAw069dU62JrGoo cGDkYqzhtyQ4rFO1nvKZMNqvAVX3nVYXnMZqSyRdenStJYcf69huoMzrvLY92UhxU7pX 2w9g== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@canonical.com header.s=20210705 header.b=Yuya4EkV; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.35 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=canonical.com Return-Path: Received: from groat.vger.email (groat.vger.email. [23.128.96.35]) by mx.google.com with ESMTPS id q4-20020a170902dac400b001c9e680c178si9263248plx.394.2023.10.16.02.24.21 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Mon, 16 Oct 2023 02:24:22 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.35 as permitted sender) client-ip=23.128.96.35; Authentication-Results: mx.google.com; dkim=pass header.i=@canonical.com header.s=20210705 header.b=Yuya4EkV; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.35 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=canonical.com Received: from out1.vger.email (depot.vger.email [IPv6:2620:137:e000::3:0]) by groat.vger.email (Postfix) with ESMTP id AE72980620B1; Mon, 16 Oct 2023 02:24:15 -0700 (PDT) X-Virus-Status: Clean X-Virus-Scanned: clamav-milter 0.103.10 at groat.vger.email Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S230502AbjJPJX7 (ORCPT + 99 others); Mon, 16 Oct 2023 05:23:59 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:38994 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S230045AbjJPJX6 (ORCPT ); Mon, 16 Oct 2023 05:23:58 -0400 Received: from smtp-relay-internal-0.canonical.com (smtp-relay-internal-0.canonical.com [185.125.188.122]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id D93A9B4 for ; Mon, 16 Oct 2023 02:23:54 -0700 (PDT) Received: from mail-qt1-f198.google.com (mail-qt1-f198.google.com [209.85.160.198]) (using TLSv1.3 with cipher TLS_AES_256_GCM_SHA384 (256/256 bits) key-exchange X25519 server-signature RSA-PSS (2048 bits) server-digest SHA256) (No client certificate requested) by smtp-relay-internal-0.canonical.com (Postfix) with ESMTPS id 55C1A3F722 for ; Mon, 16 Oct 2023 09:23:49 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=canonical.com; s=20210705; t=1697448229; bh=v3YFl+x7yg4n/kp4vO7SuLNmHzZBUUpfwrZDn1IxT5s=; h=From:In-Reply-To:References:Mime-Version:Date:Message-ID:Subject: To:Cc:Content-Type; b=Yuya4EkVamFYFICdRSQFvehgYz0lasB89LU6Njm9c6gEvswuKJ8nx/peIuAZQeW1U hvfBI2muObcnv1eurSjJUPN9u8enZ7t7EtISiQjNLFFJLPVn0KI4TWfacGGI7RBy8E S5guZcEZtEKbWxgEl5qK0jTsKnM2nKc6mZ3aDpoKOWw2TFXI/e4zjVq1E8I/wykM8n Ou8Fb9r8veK+N36w7uX5wph10i0cUXlOJ87rTWAp9YAPcG5uq8YZqrLA7L/YccTXM6 atX+BF2dgpQlXOGJqv95gRGDu4UmUhMhFWJewlXuMigm23QKwPVwHXnkt2xgyos2xr YcAAfZDwTKfXA== Received: by mail-qt1-f198.google.com with SMTP id d75a77b69052e-4191ef94106so50458411cf.0 for ; Mon, 16 Oct 2023 02:23:49 -0700 (PDT) X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1697448228; x=1698053028; h=cc:to:subject:message-id:date:mime-version:references:in-reply-to :from:x-gm-message-state:from:to:cc:subject:date:message-id:reply-to; bh=v3YFl+x7yg4n/kp4vO7SuLNmHzZBUUpfwrZDn1IxT5s=; b=M7RRcuzpW93jW671fzx5YEAcZHR9PjCJZRA37kLcV7jmbQdRIbgWdeP5v2wxwwAjPc a088FKW3f90/P7RmhyVrmtD6+gGV8komiZfkuo+7q0raO/4qjFCsVxMtp0qZ7+gMkuLF u+m58y2Ag746BwmySl+QD/Pi9vY79sR8oHDn89444TfCDO1rX4oEqo8qrA1DIM6EJWgu wis2fG7bJV4/aDKUnBQo8G5pR1SoGvEfguSbHdZXYdEgSlIzBSPjdTQ+4vTbXwtvoUki B488CKI6juroIeFlZiIs/3vmnixULd9tvpeHEMl2/t/POJ7Bvw2SNDyd23uQ681QEbq9 4bRQ== X-Gm-Message-State: AOJu0YzeCTbZOvL8D5Tr89/uhAUoJMIRHa839XNC4tLmHMahGY2xtbI7 o6mYQpo9YvK8TG+w3K8xQJ9jTUnztsYk65OWHzJavWbdZTZx6Ej86PSygTCazWDGC6ywIRKktXj VjmXQIF2R+V7USM8Gj71iSitmFSDGanHwBvMpD5K/2oCyNhWC2ZcGuAJLEg== X-Received: by 2002:ac8:5852:0:b0:417:9cae:b43 with SMTP id h18-20020ac85852000000b004179cae0b43mr43007820qth.35.1697448228157; Mon, 16 Oct 2023 02:23:48 -0700 (PDT) X-Received: by 2002:ac8:5852:0:b0:417:9cae:b43 with SMTP id h18-20020ac85852000000b004179cae0b43mr43007801qth.35.1697448227804; Mon, 16 Oct 2023 02:23:47 -0700 (PDT) Received: from 348282803490 named unknown by gmailapi.google.com with HTTPREST; Mon, 16 Oct 2023 02:23:47 -0700 From: Emil Renner Berthing In-Reply-To: References: <20231012081015.33121-1-xingyu.wu@starfivetech.com> <20231012081015.33121-3-xingyu.wu@starfivetech.com> Mime-Version: 1.0 Date: Mon, 16 Oct 2023 02:23:47 -0700 Message-ID: Subject: Re: [PATCH v6 2/3] clocksource: Add JH7110 timer driver To: Xingyu Wu , Emil Renner Berthing , Daniel Lezcano , Thomas Gleixner , Walker Chen Cc: linux-riscv@lists.infradead.org, devicetree@vger.kernel.org, Rob Herring , Krzysztof Kozlowski , Paul Walmsley , Palmer Dabbelt , Albert Ou , Philipp Zabel , Samin Guo , linux-kernel@vger.kernel.org, Conor Dooley Content-Type: text/plain; charset="UTF-8" X-Spam-Status: No, score=-0.9 required=5.0 tests=DKIMWL_WL_HIGH,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,HEADER_FROM_DIFFERENT_DOMAINS, MAILING_LIST_MULTI,SPF_HELO_NONE,SPF_PASS autolearn=unavailable autolearn_force=no version=3.4.6 X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on groat.vger.email Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org X-Greylist: Sender passed SPF test, not delayed by milter-greylist-4.6.4 (groat.vger.email [0.0.0.0]); Mon, 16 Oct 2023 02:24:15 -0700 (PDT) Xingyu Wu wrote: > On 2023/10/13 19:34, Emil Renner Berthing wrote: > > Xingyu Wu wrote: > >> Add timer driver for the StarFive JH7110 SoC. > >> > >> Signed-off-by: Xingyu Wu > >> --- > >> MAINTAINERS | 7 + > >> drivers/clocksource/Kconfig | 11 + > >> drivers/clocksource/Makefile | 1 + > >> drivers/clocksource/timer-jh7110.c | 387 +++++++++++++++++++++++++++++ > >> 4 files changed, 406 insertions(+) > >> create mode 100644 drivers/clocksource/timer-jh7110.c > >> > >> diff --git a/MAINTAINERS b/MAINTAINERS > >> index 6c4cce45a09d..1525f031d4a2 100644 > >> --- a/MAINTAINERS > >> +++ b/MAINTAINERS > >> @@ -20472,6 +20472,13 @@ S: Maintained > >> F: Documentation/devicetree/bindings/sound/starfive,jh7110-tdm.yaml > >> F: sound/soc/starfive/jh7110_tdm.c > >> > >> +STARFIVE JH7110 TIMER DRIVER > >> +M: Samin Guo > >> +M: Xingyu Wu > >> +S: Supported > >> +F: Documentation/devicetree/bindings/timer/starfive,jh7110-timer.yaml > >> +F: drivers/clocksource/timer-jh7110.c > >> + > >> STARFIVE JH71X0 CLOCK DRIVERS > >> M: Emil Renner Berthing > >> M: Hal Feng > >> diff --git a/drivers/clocksource/Kconfig b/drivers/clocksource/Kconfig > >> index 0ba0dc4ecf06..821abcc1e517 100644 > >> --- a/drivers/clocksource/Kconfig > >> +++ b/drivers/clocksource/Kconfig > >> @@ -641,6 +641,17 @@ config RISCV_TIMER > >> is accessed via both the SBI and the rdcycle instruction. This is > >> required for all RISC-V systems. > >> > >> +config STARFIVE_JH7110_TIMER > >> + bool "Timer for the STARFIVE JH7110 SoC" > >> + depends on ARCH_STARFIVE || COMPILE_TEST > >> + select TIMER_OF > >> + select CLKSRC_MMIO > >> + default ARCH_STARFIVE > >> + help > >> + This enables the timer for StarFive JH7110 SoC. On RISC-V platform, > >> + the system has started RISCV_TIMER, but you can also use this timer > >> + which can provide four channels to do a lot more things on JH7110 SoC. > >> + > >> config CLINT_TIMER > >> bool "CLINT Timer for the RISC-V platform" if COMPILE_TEST > >> depends on GENERIC_SCHED_CLOCK && RISCV > >> diff --git a/drivers/clocksource/Makefile b/drivers/clocksource/Makefile > >> index 368c3461dab8..b66ac05ec086 100644 > >> --- a/drivers/clocksource/Makefile > >> +++ b/drivers/clocksource/Makefile > >> @@ -80,6 +80,7 @@ obj-$(CONFIG_INGENIC_TIMER) += ingenic-timer.o > >> obj-$(CONFIG_CLKSRC_ST_LPC) += clksrc_st_lpc.o > >> obj-$(CONFIG_X86_NUMACHIP) += numachip.o > >> obj-$(CONFIG_RISCV_TIMER) += timer-riscv.o > >> +obj-$(CONFIG_STARFIVE_JH7110_TIMER) += timer-jh7110.o > >> obj-$(CONFIG_CLINT_TIMER) += timer-clint.o > >> obj-$(CONFIG_CSKY_MP_TIMER) += timer-mp-csky.o > >> obj-$(CONFIG_GX6605S_TIMER) += timer-gx6605s.o > >> diff --git a/drivers/clocksource/timer-jh7110.c b/drivers/clocksource/timer-jh7110.c > >> new file mode 100644 > >> index 000000000000..914424368290 > >> --- /dev/null > >> +++ b/drivers/clocksource/timer-jh7110.c > >> @@ -0,0 +1,387 @@ > >> +// SPDX-License-Identifier: GPL-2.0 > >> +/* > >> + * Starfive JH7110 Timer driver > >> + * > >> + * Copyright (C) 2022-2023 StarFive Technology Co., Ltd. > >> + * > >> + * Author: > >> + * Xingyu Wu > >> + * Samin Guo > >> + */ > >> + > >> +#include > >> +#include > >> +#include > >> +#include > >> +#include > >> +#include > >> +#include > >> +#include > >> +#include > >> +#include > >> +#include > >> +#include > >> +#include > >> +#include > >> +#include > >> + > >> +/* Bias: Ch0-0x0, Ch1-0x40, Ch2-0x80, and so on. */ > >> +#define JH7110_TIMER_CH_LEN 0x40 > >> +#define JH7110_TIMER_CH_BASE(x) ((x) * JH7110_TIMER_CH_LEN) > >> +#define JH7110_TIMER_CH_MAX 4 > >> + > >> +#define JH7110_CLOCK_SOURCE_RATING 200 > >> +#define JH7110_VALID_BITS 32 > >> +#define JH7110_DELAY_US 0 > >> +#define JH7110_TIMEOUT_US 10000 > >> +#define JH7110_CLOCKEVENT_RATING 300 > >> +#define JH7110_TIMER_MAX_TICKS 0xffffffff > >> +#define JH7110_TIMER_MIN_TICKS 0xf > >> +#define JH7110_TIMER_NAME_NUM 19 > >> + > >> +#define JH7110_TIMER_INT_STATUS 0x00 /* RO[0:4]: Interrupt Status for channel0~4 */ > >> +#define JH7110_TIMER_CTL 0x04 /* RW[0]: 0-continuous run, 1-single run */ > >> +#define JH7110_TIMER_LOAD 0x08 /* RW: load value to counter */ > >> +#define JH7110_TIMER_ENABLE 0x10 /* RW[0]: timer enable register */ > >> +#define JH7110_TIMER_RELOAD 0x14 /* RW: write 1 or 0 both reload counter */ > >> +#define JH7110_TIMER_VALUE 0x18 /* RO: timer value register */ > >> +#define JH7110_TIMER_INT_CLR 0x20 /* RW: timer interrupt clear register */ > >> +#define JH7110_TIMER_INT_MASK 0x24 /* RW[0]: timer interrupt mask register */ > >> +#define JH7110_TIMER_INT_CLR_AVA_MASK BIT(1) > >> + > >> +struct jh7110_clkevt { > >> + struct clock_event_device evt; > >> + struct clocksource cs; > >> + struct clk *clk; > >> + char name[JH7110_TIMER_NAME_NUM]; > > > > Instead of this define maybe just use something like > > > > char name[sizeof("jh7110-timer.chX")]; > > > > Will fix. > > >> + int irq; > > > > You wrote that you "dropped the extra copy of irq", but here you didn't. > > What I mean is to drop the local variable of irq in the probe. Do you mean to use a local variable instead this in the probe? No, what I mean is that this field is no longer used, so you can delete it. > > > > >> + u32 rate; > >> + u32 reload_val; > >> + void __iomem *base; > >> +}; > >> + > >> +static inline struct jh7110_clkevt *to_jh7110_clkevt(struct clock_event_device *evt) > >> +{ > >> + return container_of(evt, struct jh7110_clkevt, evt); > >> +} > >> + > >> +/* 0:continuous-run mode, 1:single-run mode */ > >> +static inline void jh7110_timer_set_continuous_mod(struct jh7110_clkevt *clkevt) > >> +{ > >> + writel(0, clkevt->base + JH7110_TIMER_CTL); > >> +} > >> + > >> +static inline void jh7110_timer_set_single_mod(struct jh7110_clkevt *clkevt) > >> +{ > >> + writel(1, clkevt->base + JH7110_TIMER_CTL); > >> +} > >> + > >> +/* Interrupt Mask Register, 0:Unmask, 1:Mask */ > >> +static inline void jh7110_timer_int_enable(struct jh7110_clkevt *clkevt) > >> +{ > >> + writel(0, clkevt->base + JH7110_TIMER_INT_MASK); > >> +} > >> + > >> +static inline void jh7110_timer_int_disable(struct jh7110_clkevt *clkevt) > >> +{ > >> + writel(1, clkevt->base + JH7110_TIMER_INT_MASK); > >> +} > > > > I really don't think all these wrappers make the code any clearer. Please just > > inline the writel() calls. What you can do to make it a bit clearer is > > something like > > > > enum { > > JH7110_TIMER_MODE_CONTINUOUS, > > JH7110_TIMER_MODE_SINGLE, > > }; > > > > so you can write > > > > writel(JH7110_TIMER_MODE_CONTINUOUS, clkevt->base + JH7110_TIMER_CTL); > > > > Will fix. > > >> + > >> +/* > >> + * BIT(0): Read value represent channel intr status. > >> + * Write 1 to this bit to clear interrupt. Write 0 has no effects. > >> + * BIT(1): "1" means that it is clearing interrupt. BIT(0) can not be written. > >> + */ > >> +static inline int jh7110_timer_int_clear(struct jh7110_clkevt *clkevt) > >> +{ > >> + u32 value; > >> + int ret; > >> + > >> + /* waiting interrupt can be to clearing */ > >> + ret = readl_poll_timeout_atomic(clkevt->base + JH7110_TIMER_INT_CLR, value, > >> + !(value & JH7110_TIMER_INT_CLR_AVA_MASK), > >> + JH7110_DELAY_US, JH7110_TIMEOUT_US); > >> + if (!ret) > >> + writel(0x1, clkevt->base + JH7110_TIMER_INT_CLR); > >> + > >> + return ret; > >> +} > >> + > >> +/* > >> + * The initial value to be loaded into the > >> + * counter and is also used as the reload value. > >> + * val = clock rate --> 1s > >> + */ > >> +static inline void jh7110_timer_set_load(struct jh7110_clkevt *clkevt, u32 val) > >> +{ > >> + writel(val, clkevt->base + JH7110_TIMER_LOAD); > >> +} > >> + > >> +static inline u32 jh7110_timer_get_val(struct jh7110_clkevt *clkevt) > >> +{ > >> + return readl(clkevt->base + JH7110_TIMER_VALUE); > >> +} > >> + > >> +/* > >> + * Write RELOAD register to reload preset value to counter. > >> + * Write 0 and write 1 are both ok. > >> + */ > >> +static inline void jh7110_timer_set_reload(struct jh7110_clkevt *clkevt) > >> +{ > >> + writel(0, clkevt->base + JH7110_TIMER_RELOAD); > >> +} > >> + > >> +static inline void jh7110_timer_enable(struct jh7110_clkevt *clkevt) > >> +{ > >> + writel(1, clkevt->base + JH7110_TIMER_ENABLE); > >> +} > >> + > >> +static inline void jh7110_timer_disable(struct jh7110_clkevt *clkevt) > >> +{ > >> + writel(0, clkevt->base + JH7110_TIMER_ENABLE); > >> +} > > > > The same thing goes for all these wrappers. If you do insist on having these > > wrappers then at least group them all together so you can quickly scroll past > > them to get to the "real" code. > > Will fix. > > > > >> + > >> +static int jh7110_timer_int_init_enable(struct jh7110_clkevt *clkevt) > >> +{ > >> + int ret; > >> + > >> + jh7110_timer_int_disable(clkevt); > >> + ret = jh7110_timer_int_clear(clkevt); > >> + if (ret) > >> + return ret; > >> + > >> + jh7110_timer_int_enable(clkevt); > >> + jh7110_timer_enable(clkevt); > >> + > >> + return 0; > >> +} > >> + > >> +static int jh7110_timer_shutdown(struct clock_event_device *evt) > >> +{ > >> + struct jh7110_clkevt *clkevt = to_jh7110_clkevt(evt); > >> + > >> + jh7110_timer_disable(clkevt); > >> + return jh7110_timer_int_clear(clkevt); > >> +} > >> + > >> +static void jh7110_timer_suspend(struct clock_event_device *evt) > >> +{ > >> + struct jh7110_clkevt *clkevt = to_jh7110_clkevt(evt); > >> + > >> + clkevt->reload_val = jh7110_timer_get_val(clkevt); > >> + jh7110_timer_shutdown(evt); > >> +} > >> + > >> +static void jh7110_timer_resume(struct clock_event_device *evt) > >> +{ > >> + struct jh7110_clkevt *clkevt = to_jh7110_clkevt(evt); > >> + > >> + jh7110_timer_set_load(clkevt, clkevt->reload_val); > >> + jh7110_timer_set_reload(clkevt); > >> + jh7110_timer_int_enable(clkevt); > >> + jh7110_timer_enable(clkevt); > >> +} > >> + > >> +static int jh7110_timer_tick_resume(struct clock_event_device *evt) > >> +{ > >> + jh7110_timer_resume(evt); > >> + > >> + return 0; > >> +} > >> + > >> +/* IRQ handler for the timer */ > >> +static irqreturn_t jh7110_timer_interrupt(int irq, void *priv) > >> +{ > >> + struct clock_event_device *evt = (struct clock_event_device *)priv; > >> + struct jh7110_clkevt *clkevt = to_jh7110_clkevt(evt); > >> + > >> + if (jh7110_timer_int_clear(clkevt)) > >> + return IRQ_NONE; > >> + > >> + if (evt->event_handler) > >> + evt->event_handler(evt); > >> + > >> + return IRQ_HANDLED; > >> +} > >> + > >> +static int jh7110_timer_set_periodic(struct clock_event_device *evt) > >> +{ > >> + struct jh7110_clkevt *clkevt = to_jh7110_clkevt(evt); > >> + u32 periodic = DIV_ROUND_CLOSEST(clkevt->rate, HZ); > >> + > >> + jh7110_timer_disable(clkevt); > >> + jh7110_timer_set_continuous_mod(clkevt); > >> + jh7110_timer_set_load(clkevt, periodic); > >> + > >> + return jh7110_timer_int_init_enable(clkevt); > >> +} > >> + > >> +static int jh7110_timer_set_oneshot(struct clock_event_device *evt) > >> +{ > >> + struct jh7110_clkevt *clkevt = to_jh7110_clkevt(evt); > >> + > >> + jh7110_timer_disable(clkevt); > >> + jh7110_timer_set_single_mod(clkevt); > >> + jh7110_timer_set_load(clkevt, JH7110_TIMER_MAX_TICKS); > >> + > >> + return jh7110_timer_int_init_enable(clkevt); > >> +} > >> + > >> +static int jh7110_timer_set_next_event(unsigned long next, > >> + struct clock_event_device *evt) > >> +{ > >> + struct jh7110_clkevt *clkevt = to_jh7110_clkevt(evt); > >> + > >> + jh7110_timer_disable(clkevt); > >> + jh7110_timer_set_single_mod(clkevt); > >> + jh7110_timer_set_load(clkevt, next); > >> + jh7110_timer_enable(clkevt); > >> + > >> + return 0; > >> +} > >> + > >> +static void jh7110_set_clockevent(struct clock_event_device *evt) > >> +{ > >> + evt->features = CLOCK_EVT_FEAT_PERIODIC | > >> + CLOCK_EVT_FEAT_ONESHOT | > >> + CLOCK_EVT_FEAT_DYNIRQ; > >> + evt->set_state_shutdown = jh7110_timer_shutdown; > >> + evt->set_state_periodic = jh7110_timer_set_periodic; > >> + evt->set_state_oneshot = jh7110_timer_set_oneshot; > >> + evt->set_state_oneshot_stopped = jh7110_timer_shutdown; > >> + evt->tick_resume = jh7110_timer_tick_resume; > >> + evt->set_next_event = jh7110_timer_set_next_event; > >> + evt->suspend = jh7110_timer_suspend; > >> + evt->resume = jh7110_timer_resume; > >> + evt->rating = JH7110_CLOCKEVENT_RATING; > >> +} > >> + > >> +static u64 jh7110_timer_clocksource_read(struct clocksource *cs) > >> +{ > >> + struct jh7110_clkevt *clkevt = container_of(cs, struct jh7110_clkevt, cs); > >> + > >> + return (u64)jh7110_timer_get_val(clkevt); > >> +} > >> + > >> +static int jh7110_clocksource_init(struct jh7110_clkevt *clkevt) > >> +{ > >> + int ret; > >> + > >> + jh7110_timer_set_continuous_mod(clkevt); > >> + jh7110_timer_set_load(clkevt, JH7110_TIMER_MAX_TICKS); > >> + > >> + ret = jh7110_timer_int_init_enable(clkevt); > >> + if (ret) > >> + return ret; > >> + > >> + clkevt->cs.name = clkevt->name; > >> + clkevt->cs.rating = JH7110_CLOCK_SOURCE_RATING; > >> + clkevt->cs.read = jh7110_timer_clocksource_read; > >> + clkevt->cs.mask = CLOCKSOURCE_MASK(JH7110_VALID_BITS); > >> + clkevt->cs.flags = CLOCK_SOURCE_IS_CONTINUOUS; > >> + > >> + return clocksource_register_hz(&clkevt->cs, clkevt->rate); > >> +} > >> + > >> +static void jh7110_clockevents_register(struct jh7110_clkevt *clkevt) > >> +{ > >> + clkevt->rate = clk_get_rate(clkevt->clk); > >> + > >> + jh7110_set_clockevent(&clkevt->evt); > >> + clkevt->evt.name = clkevt->name; > >> + clkevt->evt.cpumask = cpu_possible_mask; > >> + > >> + clockevents_config_and_register(&clkevt->evt, clkevt->rate, > >> + JH7110_TIMER_MIN_TICKS, JH7110_TIMER_MAX_TICKS); > >> +} > >> + > >> +static int jh7110_timer_probe(struct platform_device *pdev) > >> +{ > >> + struct jh7110_clkevt *clkevt[JH7110_TIMER_CH_MAX]; > >> + char name[4]; > >> + struct clk *pclk; > >> + struct reset_control *rst; > >> + int ch; > >> + int ret; > >> + void __iomem *base; > >> + > >> + base = devm_platform_ioremap_resource(pdev, 0); > >> + if (IS_ERR(base)) > >> + return dev_err_probe(&pdev->dev, PTR_ERR(base), > >> + "failed to map registers\n"); > >> + > >> + rst = devm_reset_control_get_exclusive(&pdev->dev, "apb"); > >> + if (IS_ERR(rst)) > >> + return dev_err_probe(&pdev->dev, PTR_ERR(rst), "failed to get apb reset\n"); > >> + > >> + pclk = devm_clk_get_enabled(&pdev->dev, "apb"); > >> + if (IS_ERR(pclk)) > >> + return dev_err_probe(&pdev->dev, PTR_ERR(pclk), > >> + "failed to get & enable apb clock\n"); > >> + > >> + ret = reset_control_deassert(rst); > >> + if (ret) > >> + return dev_err_probe(&pdev->dev, ret, "failed to deassert apb reset\n"); > >> + > >> + for (ch = 0; ch < JH7110_TIMER_CH_MAX; ch++) { > >> + clkevt[ch] = devm_kzalloc(&pdev->dev, sizeof(*clkevt[ch]), GFP_KERNEL); > >> + if (!clkevt[ch]) > >> + return -ENOMEM; > >> + > >> + snprintf(name, sizeof(name), "ch%d", ch); > >> + > >> + clkevt[ch]->base = base + JH7110_TIMER_CH_BASE(ch); > >> + /* Ensure timer is disabled */ > >> + jh7110_timer_disable(clkevt[ch]); > >> + > >> + rst = devm_reset_control_get_exclusive(&pdev->dev, name); > >> + if (IS_ERR(rst)) > >> + return PTR_ERR(rst); > >> + > >> + clkevt[ch]->clk = devm_clk_get_enabled(&pdev->dev, name); > >> + if (IS_ERR(clkevt[ch]->clk)) > >> + return PTR_ERR(clkevt[ch]->clk); > >> + > >> + ret = reset_control_deassert(rst); > >> + if (ret) > >> + return ret; > >> + > >> + clkevt[ch]->evt.irq = platform_get_irq(pdev, ch); > >> + if (clkevt[ch]->evt.irq < 0) > >> + return clkevt[ch]->evt.irq; > >> + > >> + snprintf(clkevt[ch]->name, sizeof(clkevt[ch]->name), "%s.ch%d", pdev->name, ch); > >> + jh7110_clockevents_register(clkevt[ch]); > >> + > >> + ret = devm_request_irq(&pdev->dev, clkevt[ch]->evt.irq, jh7110_timer_interrupt, > >> + IRQF_TIMER | IRQF_IRQPOLL, > >> + clkevt[ch]->name, &clkevt[ch]->evt); > >> + if (ret) > >> + return ret; > >> + > >> + ret = jh7110_clocksource_init(clkevt[ch]); > >> + if (ret) > >> + return ret; > >> + } > >> + > >> + return 0; > >> +} > >> + > >> +static const struct of_device_id jh7110_timer_match[] = { > >> + { .compatible = "starfive,jh7110-timer", }, > >> + { /* sentinel */ } > >> +}; > >> +MODULE_DEVICE_TABLE(of, jh7110_timer_match); > >> + > >> +static struct platform_driver jh7110_timer_driver = { > >> + .probe = jh7110_timer_probe, > >> + .driver = { > >> + .name = "jh7110-timer", > >> + .of_match_table = jh7110_timer_match, > >> + }, > >> +}; > >> +module_platform_driver(jh7110_timer_driver); > >> + > >> +MODULE_AUTHOR("Xingyu Wu "); > >> +MODULE_DESCRIPTION("StarFive JH7110 timer driver"); > >> +MODULE_LICENSE("GPL"); > >> -- > >> 2.25.1