clocksource: sp804: add support for Hisilicon sp804 timer
cover clocksource: sp804: add support for Hisilicon sp804 timer
The ARM SP804 supports a maximum of 32-bit counter, but Hisilicon extends it to 64-bit. That means, the registers: TimerXload, TimerXValue and TimerXBGLoad are 64bits, all other registers are the same as those in the SP804. The driver code can be completely reused except that the register offset is different
The register offset differences between ARM-SP804 and HISI-SP804 are as follows:
ARM-SP804 HISI-SP804 TIMER_LOAD 0x00 HISI_TIMER_LOAD 0x00 HISI_TIMER_LOAD_H 0x04 TIMER_VALUE 0x04 HISI_TIMER_VALUE 0x08 HISI_TIMER_VALUE_H 0x0c TIMER_CTRL 0x08 HISI_TIMER_CTRL 0x10 TIMER_INTCLR 0x0c HISI_TIMER_INTCLR 0x14 TIMER_RIS 0x10 HISI_TIMER_RIS 0x18 TIMER_MIS 0x14 HISI_TIMER_MIS 0x1c TIMER_BGLOAD 0x18 HISI_TIMER_BGLOAD 0x20 HISI_TIMER_BGLOAD_H 0x24
TIMER_2_BASE 0x20 HISI_TIMER_2_BASE 0x40
----------------
In order to make the timer-sp804 driver support both ARM-SP804 and HISI-SP804. Create a new structure "sp804_clkevt" to record the calculated registers address in advance, avoid judging and calculating the register address every place that is used.
For example:
struct sp804_timer arm_sp804_timer = {
.ctrl = TIMER_CTRL,
};
struct sp804_timer hisi_sp804_timer = {
.ctrl = HISI_TIMER_CTRL,
};
struct sp804_clkevt clkevt;In the initialization phase:
if (hisi_sp804) clkevt.ctrl = base + hisi_sp804_timer.ctrl; else if (arm_sp804) clkevt.ctrl = base + arm_sp804_timer.ctrl;
After initialization:
- writel(0, base + TIMER_CTRL);
+ writel(0, clkevt.ctrl);
----------------
Additional information:
These patch series are the V2 of https://lore.kernel.org/patchwork/cover/681876/
And many of the main ideas in https://lore.kernel.org/patchwork/patch/681875/ have been considered. Thanks for Daniel Lezcano's review comments.
Kefeng Wang (1):
clocksource: sp804: cleanup clk_get_sys()
Zhen Lei (5):
clocksource: sp804: remove unused sp804_timer_disable() and
timer-sp804.h
clocksource: sp804: prepare for support non-standard register offset
clocksource: sp804: support non-standard register offset
clocksource: sp804: add support for Hisilicon sp804 timer
clocksource: sp804: enable Hisilicon sp804 timer 64bit mode
drivers/clocksource/timer-sp.h | 47 ++++++++ drivers/clocksource/timer-sp804.c | 194 ++++++++++++++++++++---------- include/clocksource/timer-sp804.h | 29 ----- 3 files changed, 178 insertions(+), 92 deletions(-) delete mode 100644 include/clocksource/timer-sp804.h
Signature · 1 line
2.26.0.106.g9fadedd
PATCH 1/6 clocksource: sp804: cleanup clk_get_sys()
From: Kefeng Wang <[email protected]>
Move the clk_get_sys() part into sp804_get_clock_rate(), cleanup the same code.
--- drivers/clocksource/timer-sp804.c | 30 ++++++++++-------------------- 1 file changed, 10 insertions(+), 20 deletions(-)
drivers/clocksource/timer-sp804.c +10 -20
@@ -22,11 +22,18 @@#include "timer-sp.h" -static long __init sp804_get_clock_rate (struct clk *clk) +static long __init sp804_get_clock_rate (struct clk *clk,const char *name) {long rate;int err; +if (!clk) + clk =clk_get_sys ("sp804" , name); +if (IS_ERR (clk)) { +pr_err ("sp804: %s clock not found: %ld\n" , name,PTR_ERR (clk)); +return PTR_ERR (clk); + } + err =clk_prepare (clk);if (err) {pr_err ("sp804: clock failed to prepare: %d\n" , err);
@@ -72,16 +79,7 @@ int __init __sp804_clocksource_and_sched_clock_init(void __iomem *base, {long rate; -if (!clk) { - clk =clk_get_sys ("sp804" , name); -if (IS_ERR (clk)) { -pr_err ("sp804: clock not found: %d\n" , - (int )PTR_ERR (clk)); -return PTR_ERR (clk); - } - } - - rate =sp804_get_clock_rate (clk); + rate =sp804_get_clock_rate (clk, name);if (rate <0 )return -EINVAL ;
@@ -173,15 +171,7 @@ int __init __sp804_clockevents_init(void __iomem *base, unsigned int irq, structstruct clock_event_device *evt = &sp804_clockevent;long rate; -if (!clk) - clk =clk_get_sys ("sp804" , name); -if (IS_ERR (clk)) { -pr_err ("sp804: %s clock not found: %d\n" , name, - (int )PTR_ERR (clk)); -return PTR_ERR (clk); - } - - rate =sp804_get_clock_rate (clk); + rate =sp804_get_clock_rate (clk, name);if (rate <0 )return -EINVAL ;
Signature · 1 line
2.26.0.106.g9fadedd
PATCH 2/6 clocksource: sp804: remove unused sp804_timer_disable() and timer-sp804.h
In reply to Zhen LeiSince commit 7484c727b636 ("ARM: realview: delete the RealView board files") and commit 16956fed35fe ("ARM: versatile: switch to DT only booting and remove legacy code"), there's no one to use the functions defined or declared in include/clocksource/timer-sp804.h. Delete it.
--- drivers/clocksource/timer-sp804.c | 7 ------- include/clocksource/timer-sp804.h | 29 ----------------------------- 2 files changed, 36 deletions(-) delete mode 100644 include/clocksource/timer-sp804.h
drivers/clocksource/timer-sp804.c +0 -7
@@ -18,8 +18,6 @@#include <linux/of_irq.h> #include <linux/sched_clock.h> -#include <clocksource/timer-sp804.h> -#include "timer-sp.h" static long __init sp804_get_clock_rate (struct clk *clk,const char *name)
@@ -67,11 +65,6 @@ static u64 notrace sp804_read(void)return ~readl_relaxed (sched_clock_base +TIMER_VALUE ); } -void __init sp804_timer_disable (void __iomem *base) -{ -writel (0 , base +TIMER_CTRL ); -} - int __init __sp804_clocksource_and_sched_clock_init(void __iomem *base, const char *name, struct clk *clk,
include/clocksource/timer-sp804.h deleted +0 -29
@@ -1,29 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -#ifndef __CLKSOURCE_TIMER_SP804_H -#define __CLKSOURCE_TIMER_SP804_H - -struct clk ; - -int __sp804_clocksource_and_sched_clock_init (void __iomem *, -const char *,struct clk *,int ); -int __sp804_clockevents_init (void __iomem *,unsigned int , -struct clk *,const char *); -void sp804_timer_disable (void __iomem *); - -static inline void sp804_clocksource_init (void __iomem *base,const char *name) -{ -__sp804_clocksource_and_sched_clock_init (base, name,NULL ,0 ); -} - -static inline void sp804_clocksource_and_sched_clock_init (void __iomem *base, -const char *name) -{ -__sp804_clocksource_and_sched_clock_init (base, name,NULL ,1 ); -} - -static inline void sp804_clockevents_init (void __iomem *base,unsigned int irq,const char *name) -{ -__sp804_clockevents_init (base, irq,NULL , name); - -} -#endif
Signature · 1 line
2.26.0.106.g9fadedd
PATCH 3/6 clocksource: sp804: prepare for support non-standard register offset
In reply to Zhen LeiDo a bit of cleaning, to make the next patch looks more clear. The details are as follows:
1. Remove a mismatched comment. It just temporarily disable a timer, and the timer will be set to periodic mode later.
2. Add two local variables: timer1_base and timer2_base in sp804_of_init(), To avoid repeatedly calculate the base address of timer2, and make it easier to recognize timer1.
3. Delete the leading "__" of __sp804_clocksource_and_sched_clock_init() and __sp804_clockevents_init().
No functional change.
--- drivers/clocksource/timer-sp804.c | 36 ++++++++++++++++++------------- 1 file changed, 21 insertions(+), 15 deletions(-)
drivers/clocksource/timer-sp804.c +21 -15
@@ -65,10 +65,10 @@ static u64 notrace sp804_read(void)return ~readl_relaxed (sched_clock_base +TIMER_VALUE ); } -int __init __sp804_clocksource_and_sched_clock_init (void __iomem *base, -const char *name, -struct clk *clk, -int use_sched_clock) +int __init sp804_clocksource_and_sched_clock_init (void __iomem *base, +const char *name, +struct clk *clk, +int use_sched_clock) {long rate;
@@ -76,7 +76,6 @@ int __init __sp804_clocksource_and_sched_clock_init(void __iomem *base,if (rate <0 )return -EINVAL ; -/* setup timer 0 as free-running clocksource */ writel (0 , base +TIMER_CTRL );writel (0xffffffff , base +TIMER_LOAD );writel (0xffffffff , base +TIMER_VALUE );
@@ -159,7 +158,8 @@ static struct clock_event_device sp804_clockevent = { .rating = 300, }; -int __init __sp804_clockevents_init (void __iomem *base,unsigned int irq,struct clk *clk,const char *name) +int __init sp804_clockevents_init (void __iomem *base,unsigned int irq, +struct clk *clk,const char *name) {struct clock_event_device *evt = &sp804_clockevent;long rate;
@@ -188,6 +188,8 @@ static int __init sp804_of_init(struct device_node *np) {static bool initialized = false;void __iomem *base; +void __iomem *timer1_base; +void __iomem *timer2_base;int irq, ret = -EINVAL ;u32 irq_num =0 ;struct clk *clk1, *clk2;
@@ -197,9 +199,12 @@ static int __init sp804_of_init(struct device_node *np)if (!base)return -ENXIO ; + timer1_base = base; + timer2_base = base +TIMER_2_BASE ; +/* Ensure timers are disabled */ -writel (0 , base +TIMER_CTRL ); -writel (0 , base +TIMER_2_BASE +TIMER_CTRL ); +writel (0 , timer1_base +TIMER_CTRL ); +writel (0 , timer2_base +TIMER_CTRL );if (initialized || !of_device_is_available (np)) { ret = -EINVAL ;
@@ -228,21 +233,22 @@ static int __init sp804_of_init(struct device_node *np)of_property_read_u32 (np,"arm,sp804-has-irq" , &irq_num);if (irq_num ==2 ) { - ret =__sp804_clockevents_init (base +TIMER_2_BASE , irq, clk2, name); + ret =sp804_clockevents_init (timer2_base, irq, clk2, name);if (ret) goto err; - ret =__sp804_clocksource_and_sched_clock_init (base, name, clk1,1 ); + ret =sp804_clocksource_and_sched_clock_init (timer1_base, + name, clk1,1 );if (ret) goto err; }else { - ret =__sp804_clockevents_init (base, irq, clk1 , name); + ret =sp804_clockevents_init (timer1_base, irq, clk1, name);if (ret) goto err; - ret =__sp804_clocksource_and_sched_clock_init (base +TIMER_2_BASE , - name, clk2,1 ); + ret =sp804_clocksource_and_sched_clock_init (timer2_base, + name, clk2,1 );if (ret) goto err; }
@@ -282,7 +288,7 @@ static int __init integrator_cp_of_init(struct device_node *np) goto err;if (!init_count) { - ret =__sp804_clocksource_and_sched_clock_init (base, name, clk,0 ); + ret =sp804_clocksource_and_sched_clock_init (base, name, clk,0 );if (ret) goto err; }else {
@@ -290,7 +296,7 @@ static int __init integrator_cp_of_init(struct device_node *np)if (irq <=0 ) goto err; - ret =__sp804_clockevents_init (base, irq, clk, name); + ret =sp804_clockevents_init (base, irq, clk, name);if (ret) goto err; }
Signature · 1 line
2.26.0.106.g9fadedd
PATCH 4/6 clocksource: sp804: support non-standard register offset
In reply to Zhen LeiThe ARM SP804 supports a maximum of 32-bit counter, but Hisilicon extends it to 64-bit. That means, the registers: TimerXload, TimerXValue and TimerXBGLoad are 64bits, all other registers are the same as those in the SP804. The driver code can be completely reused except that the register offset is different.
Currently, we get a timer register address by: add the constant register offset to the timer base address. e.g. "base + TIMER_CTRL". It can not be dynamically adjusted at run time.
So create a new structure "sp804_timer" to record the original registers offset, and create a new structure "sp804_clkevt" to record the calculated registers address. So the "base + TIMER_CTRL" is changed to "clkevt->ctrl", this will faster than "base + timer->ctrl".
For example:
struct sp804_timer arm_sp804_timer = {
.ctrl = TIMER_CTRL,
};
struct sp804_clkevt clkevt;
clkevt.ctrl = base + arm_sp804_timer.ctrl;- writel(0, base + TIMER_CTRL);
+ writel(0, clkevt.ctrl);
--- drivers/clocksource/timer-sp.h | 26 +++++++ drivers/clocksource/timer-sp804.c | 108 +++++++++++++++++++++++------- 2 files changed, 108 insertions(+), 26 deletions(-)
drivers/clocksource/timer-sp.h +26 -0
@@ -10,6 +10,7 @@* * Every SP804 contains two identical timers. */ +#define NR_TIMERS 2#define TIMER_1_BASE 0x00#define TIMER_2_BASE 0x20
@@ -29,3 +30,28 @@#define TIMER_RIS 0x10/* CVR ro */ #define TIMER_MIS 0x14/* CVR ro */ #define TIMER_BGLOAD 0x18/* CVR rw */ + +struct sp804_timer { +int load; +int value; +int ctrl; +int intclr; +int ris; +int mis; +int bgload; +int timer_base[NR_TIMERS ]; +int width; +}; + +struct sp804_clkevt { +void __iomem *base; +void __iomem *load; +void __iomem *value; +void __iomem *ctrl; +void __iomem *intclr; +void __iomem *ris; +void __iomem *mis; +void __iomem *bgload; +unsigned long reload; +int width; +};
drivers/clocksource/timer-sp804.c +82 -26
215 lines not on this page · raw message
Signature · 1 line
2.26.0.106.g9fadedd
PATCH 5/6 clocksource: sp804: add support for Hisilicon sp804 timer
In reply to Zhen LeiThe ARM SP804 supports a maximum of 32-bit counter, but Hisilicon extends it to 64-bit. That means, the registers: TimerXload, TimerXValue and TimerXBGLoad are 64bits, all other registers are the same as those in the SP804. The driver code can be completely reused except that the register offset is different.
Use compatible = "hisi,sp804" mark as Hisilicon sp804 timer.
--- drivers/clocksource/timer-sp.h | 12 ++++++++++++ drivers/clocksource/timer-sp804.c | 15 +++++++++++++++ 2 files changed, 27 insertions(+)
drivers/clocksource/timer-sp.h +12 -0
@@ -31,6 +31,18 @@#define TIMER_MIS 0x14/* CVR ro */ #define TIMER_BGLOAD 0x18/* CVR rw */ + +#define HISI_TIMER_1_BASE 0x00 +#define HISI_TIMER_2_BASE 0x40 +#define HISI_TIMER_LOAD 0x00 +#define HISI_TIMER_VALUE 0x08 +#define HISI_TIMER_CTRL 0x10 +#define HISI_TIMER_INTCLR 0x14 +#define HISI_TIMER_RIS 0x18 +#define HISI_TIMER_MIS 0x1c +#define HISI_TIMER_BGLOAD 0x20 + +struct sp804_timer {int load;int value;
drivers/clocksource/timer-sp804.c +15 -0
@@ -29,6 +29,15 @@ struct sp804_timer __initdata arm_sp804_timer = { .width = 32, }; +struct sp804_timer __initdata hisi_sp804_timer = { + .load =HISI_TIMER_LOAD , + .value =HISI_TIMER_VALUE , + .ctrl =HISI_TIMER_CTRL , + .intclr =HISI_TIMER_INTCLR , + .timer_base = {HISI_TIMER_1_BASE ,HISI_TIMER_2_BASE }, + .width =64 , +}; +static struct sp804_clkevt sp804_clkevt[NR_TIMERS ];static long __init sp804_get_clock_rate (struct clk *clk,const char *name)
@@ -315,6 +324,12 @@ static int __init arm_sp804_of_init(struct device_node *np) }TIMER_OF_DECLARE (sp804,"arm,sp804" , arm_sp804_of_init); +static int __init hisi_sp804_of_init (struct device_node *np) +{ +return sp804_of_init (np, &hisi_sp804_timer); +} +TIMER_OF_DECLARE (hisi_sp804,"hisi,sp804" , hisi_sp804_of_init); +static int __init integrator_cp_of_init (struct device_node *np) {static int init_count =0 ;
Signature · 1 line
2.26.0.106.g9fadedd
PATCH 6/6 clocksource: sp804: enable Hisilicon sp804 timer 64bit mode
In reply to Zhen LeiA 100MHZ 32-bit timer will be wrapped up less than 43s. Although the kernel maintains a software high 32-bit count in the tick IRQ. But it's not applicable to the user mode APPs.
Note: The kernel still uses the lower 32 bits of the timer.
--- drivers/clocksource/timer-sp.h | 9 +++++++++ drivers/clocksource/timer-sp804.c | 8 ++++++++ 2 files changed, 17 insertions(+)
drivers/clocksource/timer-sp.h +9 -0
@@ -35,22 +35,28 @@#define HISI_TIMER_1_BASE 0x00#define HISI_TIMER_2_BASE 0x40#define HISI_TIMER_LOAD 0x00 +#define HISI_TIMER_LOAD_H 0x04#define HISI_TIMER_VALUE 0x08 +#define HISI_TIMER_VALUE_H 0x0c#define HISI_TIMER_CTRL 0x10#define HISI_TIMER_INTCLR 0x14#define HISI_TIMER_RIS 0x18#define HISI_TIMER_MIS 0x1c#define HISI_TIMER_BGLOAD 0x20 +#define HISI_TIMER_BGLOAD_H 0x24struct sp804_timer {int load; +int load_h;int value; +int value_h;int ctrl;int intclr;int ris;int mis;int bgload; +int bgload_h;int timer_base[NR_TIMERS ];int width; };
@@ -58,12 +64,15 @@ struct sp804_timer {struct sp804_clkevt {void __iomem *base;void __iomem *load; +void __iomem *load_h;void __iomem *value; +void __iomem *value_h;void __iomem *ctrl;void __iomem *intclr;void __iomem *ris;void __iomem *mis;void __iomem *bgload; +void __iomem *bgload_h;unsigned long reload;int width; };
drivers/clocksource/timer-sp804.c +8 -0
@@ -31,7 +31,9 @@ struct sp804_timer __initdata arm_sp804_timer = {struct sp804_timer __initdata hisi_sp804_timer = { .load =HISI_TIMER_LOAD , + .load_h =HISI_TIMER_LOAD_H , .value =HISI_TIMER_VALUE , + .value_h =HISI_TIMER_VALUE_H , .ctrl =HISI_TIMER_CTRL , .intclr =HISI_TIMER_INTCLR , .timer_base = {HISI_TIMER_1_BASE ,HISI_TIMER_2_BASE },
@@ -117,6 +119,10 @@ int __init sp804_clocksource_and_sched_clock_init(void __iomem *base,writel (0 , clkevt->ctrl);writel (0xffffffff , clkevt->load);writel (0xffffffff , clkevt->value); +if (clkevt->width ==64 ) { +writel (0xffffffff , clkevt->load_h); +writel (0xffffffff , clkevt->value_h); + }writel (TIMER_CTRL_32BIT |TIMER_CTRL_ENABLE |TIMER_CTRL_PERIODIC , clkevt->ctrl);
@@ -233,7 +239,9 @@ static void __init sp804_clkevt_init(struct sp804_timer *timer, void __iomem *ba clkevt = &sp804_clkevt[i]; clkevt->base = timer_base; clkevt->load = timer_base + timer->load; + clkevt->load_h = timer_base + timer->load_h; clkevt->value = timer_base + timer->value; + clkevt->value_h = timer_base + timer->value_h; clkevt->ctrl = timer_base + timer->ctrl; clkevt->intclr = timer_base + timer->intclr; clkevt->width = timer->width;
Signature · 1 line
2.26.0.106.g9fadedd