From mboxrd@z Thu Jan 1 00:00:00 1970 Received: from mail.cjdns.fr (mail.cjdns.fr [5.135.140.105]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id 7EDC042C51B; Fri, 31 Jul 2026 12:03:15 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=5.135.140.105 ARC-Seal:i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1785499399; cv=none; b=HRqzzbgIH2lcwcaQCh17wHJOqMMY0y/4BuCiLRpDbDSkC1E6h8XyigHpgR3SLZzob+QJ/16RzrPwjwbh5jCCEE9zdy87vaUpQrkXma1HkwVbnKg+bXoF6zVK2zbEutVFG7dXDhFMKDoHt+HRIvkOvR5/ym8GCEwhKWp+qLVFKTM= ARC-Message-Signature:i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1785499399; c=relaxed/simple; bh=DU59HSNaB9phG8rCZl4dDJTjeDMq0KTL47w2Dyh4SlU=; h=From:To:Cc:Subject:Date:Message-Id:In-Reply-To:References: MIME-Version; b=Z2cBtkwAgbwNh4d7SNKREeiiqZF1TwUrr7ffmLIcvpCvEUZeIjDkt6NxjcsnTxNoEVu0brr8mlw2iJ3CzEU9JOpHQkGNT9dNvAju+QO2q44JAsT4efvPICQXarsrNP6HDFJ8P8NIn6ObWsg+QmjfJOikbqTTzX7lBWEY75vkVJU= ARC-Authentication-Results:i=1; smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=cjdns.fr; spf=none smtp.mailfrom=cjdns.fr; dkim=pass (2048-bit key) header.d=cjdns.fr header.i=@cjdns.fr header.b=g6OFSZ3I; arc=none smtp.client-ip=5.135.140.105 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=cjdns.fr Authentication-Results: smtp.subspace.kernel.org; spf=none smtp.mailfrom=cjdns.fr Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=cjdns.fr header.i=@cjdns.fr header.b="g6OFSZ3I" Received: from [127.0.0.1] (localhost [127.0.0.1]) by localhost (Mailerdaemon) with ESMTPSA id 8014911F554; Fri, 31 Jul 2026 14:03:09 +0200 (CEST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=cjdns.fr; s=dkim; t=1785499391; h=from:subject:date:message-id:to:cc:mime-version: content-transfer-encoding:in-reply-to:references; bh=4og5/uHZUOe1X8csZf1Cd0lBdViJnSG21+7PRelLts0=; b=g6OFSZ3IH/0+IKx6mhJxmX1vFc50LLGQoo4O0pIW0z+HclaXuV/vG1obF7trhcQwoXZi32 0rSyZ5JD3s9jkt7G1HAFqB8l/OHz1S5UbXhHBl7DziX0yZ8wDkrRWD1z3kkQkS5jJBKSQ0 FrUtZRke8Fnnt1PcgjimI0NHnatMD//60pPFtJQ9Xut49m8rXCpK97dcXtlr40VYK3rAzI n0QXyDM0iWp9l+FkYpZPPFC1xOeaG+sWdsNRRhBk8o2yqt0ewJLNJn0fpZBaxawwio97hK oPTIHZb8shIPiOVO0tWGlrqiJiyyJiF8qj2Z+dNgrbRkGGMY609Enx8CvKU4RQ== From: Caleb James DeLisle To: linux-mips@vger.kernel.org Cc: conor+dt@kernel.org, daniel.lezcano@kernel.org, devicetree@vger.kernel.org, krzk+dt@kernel.org, linux-kernel@vger.kernel.org, naseefkm@gmail.com, robh@kernel.org, tglx@kernel.org, grandmaster@al2klimov.de, Caleb James DeLisle Subject: [PATCH v7 5/5] clocksource/timer-econet-en751221: Support EN751627 without percpu IRQ Date: Fri, 31 Jul 2026 12:02:46 +0000 Message-Id: <20260731120246.1296955-6-cjd@cjdns.fr> In-Reply-To: <20260731120246.1296955-1-cjd@cjdns.fr> References: <20260731120246.1296955-1-cjd@cjdns.fr> Precedence: bulk X-Mailing-List: devicetree@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Transfer-Encoding: 8bit X-Last-TLS-Session-Version: TLSv1.3 EN751627 is based on the 1004Kc which uses a different interrupt number for each CPU timer. Support both this and the EN751221 which uses a single percpu interrupt. Signed-off-by: Caleb James DeLisle --- drivers/clocksource/timer-econet-en751221.c | 122 ++++++++++++++++---- 1 file changed, 99 insertions(+), 23 deletions(-) diff --git a/drivers/clocksource/timer-econet-en751221.c b/drivers/clocksource/timer-econet-en751221.c index f2c4c1ee0a56..040386ded132 100644 --- a/drivers/clocksource/timer-econet-en751221.c +++ b/drivers/clocksource/timer-econet-en751221.c @@ -21,10 +21,12 @@ #define ECONET_MAX_DELTA GENMASK(ECONET_BITS - 2, 0) /* 34Kc hardware has 1 block and 1004Kc has 2. */ #define ECONET_NUM_BLOCKS DIV_ROUND_UP(NR_CPUS, 2) +#define ECONET_NUM_IRQS NR_CPUS static struct { void __iomem *membase[ECONET_NUM_BLOCKS]; - int irq; + int irqs[ECONET_NUM_IRQS]; + bool is_percpu; u32 freq_hz; } econet_timer __ro_after_init; @@ -102,6 +104,25 @@ static int cevt_init_cpu(uint cpu) struct clock_event_device *cd = &per_cpu(econet_timer_pcpu, cpu); u32 reg; + if (!reg_ctl(cpu)) { + pr_err("%s: missing address resource for CPU %d\n", cd->name, + cpu); + return -EINVAL; + } + if (cd->irq <= 0) { + pr_err("%s: missing IRQ for CPU %d\n", cd->name, cpu); + return -EINVAL; + } + if (!econet_timer.is_percpu) { + int ret = irq_force_affinity(cd->irq, cpumask_of(cpu)); + + if (ret) { + pr_err("%s: failed to set IRQ affinity to CPU %d: %pe\n", + cd->name, cpu, ERR_PTR(ret)); + return ret; + } + } + pr_debug("%s: Setting up clockevent for CPU %d\n", cd->name, cpu); reg = ioread32(reg_ctl(cpu)) | ctl_bit_enabled(cpu); @@ -110,7 +131,10 @@ static int cevt_init_cpu(uint cpu) clockevents_config_and_register(cd, econet_timer.freq_hz, ECONET_MIN_DELTA, ECONET_MAX_DELTA); - enable_percpu_irq(cd->irq, IRQ_TYPE_NONE); + if (econet_timer.is_percpu) + enable_percpu_irq(cd->irq, IRQ_TYPE_NONE); + else + enable_irq(cd->irq); return 0; } @@ -141,19 +165,52 @@ static void __init cevt_init(struct device_node *np) CLOCK_EVT_FEAT_C3STOP | CLOCK_EVT_FEAT_PERCPU; cd->set_next_event = cevt_set_next_event; - cd->irq = econet_timer.irq; + + if (econet_timer.is_percpu) + cd->irq = econet_timer.irqs[0]; + else + cd->irq = econet_timer.irqs[i]; + cd->cpumask = cpumask_of(i); cd->name = np->name; - cevt_dev_init(i); + /* + * Tolerate CPUs that could exist but don't. + * Fail in cevt_init_cpu when they try to start. + */ + if (reg_ctl(i)) + cevt_dev_init(i); } } static int __init timer_init(struct device_node *np) { - int num_blocks = DIV_ROUND_UP(num_possible_cpus(), 2); + int num_blocks = of_address_count(np); + int num_irqs = of_irq_count(np); struct clk *clk; - int ret; + int ret, i; + + econet_timer.is_percpu = of_device_is_compatible(np, "econet,en751221-timer"); + + if (econet_timer.is_percpu && num_irqs != 1) { + pr_err("%pOFn: EN751221 clock must have 1 IRQ not %d\n", np, + num_irqs); + return -EINVAL; + } + if (num_irqs > ARRAY_SIZE(econet_timer.irqs)) { + pr_err("%pOFn: Too many IRQs max %d got %d\n", np, + ARRAY_SIZE(econet_timer.irqs), num_irqs); + return -EINVAL; + } + if (num_blocks > ARRAY_SIZE(econet_timer.membase)) { + pr_err("%pOFn: Too many regs: max %d got %d\n", np, + ARRAY_SIZE(econet_timer.membase), num_blocks); + return -EINVAL; + } + if (num_blocks == 0) { + pr_err("%pOFn: At least one reg block must be provided\n", np); + return -EINVAL; + } clk = of_clk_get(np, 0); if (IS_ERR(clk)) { @@ -164,7 +221,7 @@ static int __init timer_init(struct device_node *np) econet_timer.freq_hz = clk_get_rate(clk); clk_put(clk); - for (int i = 0; i < num_blocks; i++) { + for (i = 0; i < num_blocks; i++) { econet_timer.membase[i] = of_iomap(np, i); if (!econet_timer.membase[i]) { pr_err("%pOFn: failed to map register [%d]\n", np, i); @@ -173,22 +230,32 @@ static int __init timer_init(struct device_node *np) } } - econet_timer.irq = irq_of_parse_and_map(np, 0); - if (econet_timer.irq <= 0) { - pr_err("%pOFn: irq_of_parse_and_map failed\n", np); - ret = -EINVAL; - goto out_membase; + for (i = 0; i < num_irqs; i++) { + econet_timer.irqs[i] = irq_of_parse_and_map(np, i); + if (econet_timer.irqs[i] <= 0) { + pr_err("%pOFn: failed mapping irq %d\n", np, i); + ret = -EINVAL; + goto out_irq_mapping; + } } - irq_set_status_flags(econet_timer.irq, IRQ_NOAUTOEN); - - ret = request_percpu_irq(econet_timer.irq, cevt_interrupt, np->name, - &econet_timer_pcpu); - - if (ret < 0) { - pr_err("%pOFn: IRQ %d setup failed (%d)\n", np, - econet_timer.irq, ret); - goto out_irq_mapping; + for (i = 0; i < num_irqs; i++) { + irq_set_status_flags(econet_timer.irqs[i], IRQ_NOAUTOEN); + + if (econet_timer.is_percpu) + ret = request_percpu_irq(econet_timer.irqs[i], + cevt_interrupt, np->name, + &econet_timer_pcpu); + else + ret = request_irq(econet_timer.irqs[i], cevt_interrupt, + IRQF_TIMER | IRQF_NOBALANCING, + np->name, NULL); + + if (ret < 0) { + pr_err("%pOFn: IRQ %d setup failed: %pe\n", np, + i, ERR_PTR(ret)); + goto out_irq_free; + } } cevt_init(np); @@ -220,9 +287,17 @@ static int __init timer_init(struct device_node *np) return 0; out_irq_free: - free_percpu_irq(econet_timer.irq, &econet_timer_pcpu); + while (--i >= 0) { + if (econet_timer.is_percpu) + free_percpu_irq(econet_timer.irqs[i], &econet_timer_pcpu); + else + free_irq(econet_timer.irqs[i], NULL); + } out_irq_mapping: - irq_dispose_mapping(econet_timer.irq); + for (i = 0; i < num_irqs; i++) { + if (econet_timer.irqs[i] > 0) + irq_dispose_mapping(econet_timer.irqs[i]); + } out_membase: for (int i = 0; i < ARRAY_SIZE(econet_timer.membase); i++) { if (econet_timer.membase[i]) { @@ -235,3 +310,4 @@ static int __init timer_init(struct device_node *np) } TIMER_OF_DECLARE(econet_timer_hpt, "econet,en751221-timer", timer_init); +TIMER_OF_DECLARE(econet_timer_en751627, "econet,en751627-timer", timer_init); -- 2.39.5