driver: timer: Add support for sy1xx
Add sys timer driver for Sensry's RISCV32 based SY1xx. Signed-off-by: Sven Ginka <s.ginka@sensry.de>
This commit is contained in:
parent
7443a2c703
commit
686cbc90f6
6 changed files with 230 additions and 0 deletions
|
@ -37,3 +37,4 @@ zephyr_library_sources_ifdef(CONFIG_XLNX_PSTTC_TIMER xlnx_psttc_timer.c)
|
||||||
zephyr_library_sources_ifdef(CONFIG_XTENSA_TIMER xtensa_sys_timer.c)
|
zephyr_library_sources_ifdef(CONFIG_XTENSA_TIMER xtensa_sys_timer.c)
|
||||||
zephyr_library_sources_ifdef(CONFIG_SMARTBOND_TIMER smartbond_timer.c)
|
zephyr_library_sources_ifdef(CONFIG_SMARTBOND_TIMER smartbond_timer.c)
|
||||||
zephyr_library_sources_ifdef(CONFIG_MTK_ADSP_TIMER mtk_adsp_timer.c)
|
zephyr_library_sources_ifdef(CONFIG_MTK_ADSP_TIMER mtk_adsp_timer.c)
|
||||||
|
zephyr_library_sources_ifdef(CONFIG_SY1XX_SYS_TIMER sy1xx_sys_timer.c)
|
||||||
|
|
|
@ -96,6 +96,7 @@ source "drivers/timer/Kconfig.ti_dm_timer"
|
||||||
source "drivers/timer/Kconfig.xlnx_psttc"
|
source "drivers/timer/Kconfig.xlnx_psttc"
|
||||||
source "drivers/timer/Kconfig.xtensa"
|
source "drivers/timer/Kconfig.xtensa"
|
||||||
source "drivers/timer/Kconfig.mtk_adsp"
|
source "drivers/timer/Kconfig.mtk_adsp"
|
||||||
|
source "drivers/timer/Kconfig.sy1xx_sys_timer"
|
||||||
|
|
||||||
endmenu
|
endmenu
|
||||||
|
|
||||||
|
|
11
drivers/timer/Kconfig.sy1xx_sys_timer
Normal file
11
drivers/timer/Kconfig.sy1xx_sys_timer
Normal file
|
@ -0,0 +1,11 @@
|
||||||
|
# Copyright (c) 2024 sensry.io
|
||||||
|
# SPDX-License-Identifier: Apache-2.0
|
||||||
|
|
||||||
|
config SY1XX_SYS_TIMER
|
||||||
|
bool "Sensry ganymed system timer"
|
||||||
|
default y
|
||||||
|
depends on SOC_SERIES_SY1XX
|
||||||
|
depends on $(dt_nodelabel_enabled,systick)
|
||||||
|
help
|
||||||
|
This module implements a kernel device driver for the system timer
|
||||||
|
and provides the standard "system clock driver" interfaces.
|
180
drivers/timer/sy1xx_sys_timer.c
Normal file
180
drivers/timer/sy1xx_sys_timer.c
Normal file
|
@ -0,0 +1,180 @@
|
||||||
|
/*
|
||||||
|
* SPDX-License-Identifier: Apache-2.0
|
||||||
|
* Copyright (c) 2024 sensry.io
|
||||||
|
*/
|
||||||
|
|
||||||
|
#define DT_DRV_COMPAT sy1xx_sys_timer
|
||||||
|
|
||||||
|
#include <zephyr/init.h>
|
||||||
|
#include <zephyr/kernel.h>
|
||||||
|
#include <zephyr/sys/util.h>
|
||||||
|
#include <zephyr/drivers/timer/system_timer.h>
|
||||||
|
#include <soc.h>
|
||||||
|
#include <zephyr/irq.h>
|
||||||
|
|
||||||
|
#define SY1XX_SYS_TIMER_NODE DT_NODELABEL(systick)
|
||||||
|
#define SY1XX_SYS_TIMER_BASE_ADDR DT_REG_ADDR(SY1XX_SYS_TIMER_NODE)
|
||||||
|
|
||||||
|
#define SY1XX_MINIMUM_ALLOWED_TICK 1000
|
||||||
|
|
||||||
|
#define REG_TIMER_CMP_LO_OFFS 0x10
|
||||||
|
|
||||||
|
/* config bits */
|
||||||
|
#define PLP_TIMER_ENABLE_BIT 0
|
||||||
|
#define PLP_TIMER_RESET_BIT 1
|
||||||
|
#define PLP_TIMER_IRQ_ENABLE_BIT 2
|
||||||
|
#define PLP_TIMER_IEM_BIT 3
|
||||||
|
#define PLP_TIMER_CMP_CLR_BIT 4
|
||||||
|
#define PLP_TIMER_ONE_SHOT_BIT 5
|
||||||
|
#define PLP_TIMER_PRESCALER_ENABLE_BIT 6
|
||||||
|
#define PLP_TIMER_CLOCK_SOURCE_BIT 7
|
||||||
|
#define PLP_TIMER_PRESCALER_VALUE_BIT 8
|
||||||
|
#define PLP_TIMER_PRESCALER_VALUE_BITS 8
|
||||||
|
#define PLP_TIMER_64_BIT 31
|
||||||
|
|
||||||
|
/* config flags */
|
||||||
|
#define PLP_TIMER_ACTIVE 1
|
||||||
|
#define PLP_TIMER_IDLE 0
|
||||||
|
|
||||||
|
#define PLP_TIMER_RESET_ENABLED 1
|
||||||
|
#define PLP_TIMER_RESET_DISABLED 0
|
||||||
|
|
||||||
|
#define PLP_TIMER_IRQ_ENABLED 1
|
||||||
|
#define PLP_TIMER_IRQ_DISABLED 0
|
||||||
|
|
||||||
|
#define PLP_TIMER_IEM_ENABLED 1
|
||||||
|
#define PLP_TIMER_IEM_DISABLED 0
|
||||||
|
|
||||||
|
#define PLP_TIMER_CMPCLR_ENABLED 1
|
||||||
|
#define PLP_TIMER_CMPCLR_DISABLED 0
|
||||||
|
|
||||||
|
#define PLP_TIMER_ONE_SHOT_ENABLED 1
|
||||||
|
#define PLP_TIMER_ONE_SHOT_DISABLED 0
|
||||||
|
|
||||||
|
#define PLP_TIMER_REFCLK_ENABLED 1
|
||||||
|
#define PLP_TIMER_REFCLK_DISABLED 0
|
||||||
|
|
||||||
|
#define PLP_TIMER_PRESCALER_ENABLED 1
|
||||||
|
#define PLP_TIMER_PRESCALER_DISABLED 0
|
||||||
|
|
||||||
|
#define PLP_TIMER_MODE_64_ENABLED 1
|
||||||
|
#define PLP_TIMER_MODE_64_DISABLED 0
|
||||||
|
|
||||||
|
static volatile uint32_t current_sys_clock;
|
||||||
|
|
||||||
|
struct timer_cfg {
|
||||||
|
uint32_t tick_us;
|
||||||
|
};
|
||||||
|
|
||||||
|
static inline unsigned int timer_conf_prep(int enable, int reset, int irq_enable, int event_mask,
|
||||||
|
int cmp_clr, int one_shot, int clk_source,
|
||||||
|
int prescaler_enable, int prescaler, int mode_64)
|
||||||
|
{
|
||||||
|
return (enable << PLP_TIMER_ENABLE_BIT) | (reset << PLP_TIMER_RESET_BIT) |
|
||||||
|
(irq_enable << PLP_TIMER_IRQ_ENABLE_BIT) | (event_mask << PLP_TIMER_IEM_BIT) |
|
||||||
|
(cmp_clr << PLP_TIMER_CMP_CLR_BIT) | (one_shot << PLP_TIMER_ONE_SHOT_BIT) |
|
||||||
|
(clk_source << PLP_TIMER_CLOCK_SOURCE_BIT) |
|
||||||
|
(prescaler_enable << PLP_TIMER_PRESCALER_ENABLE_BIT) |
|
||||||
|
(prescaler << PLP_TIMER_PRESCALER_VALUE_BIT) | (mode_64 << PLP_TIMER_64_BIT);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void sy1xx_sys_timer_reload(uint32_t base, uint32_t reload_timer_ticks)
|
||||||
|
{
|
||||||
|
sys_write32(reload_timer_ticks, (base + REG_TIMER_CMP_LO_OFFS));
|
||||||
|
}
|
||||||
|
|
||||||
|
static void sy1xx_sys_timer_cfg_auto_reload(uint32_t base)
|
||||||
|
{
|
||||||
|
|
||||||
|
uint32_t conf =
|
||||||
|
timer_conf_prep(PLP_TIMER_ACTIVE, PLP_TIMER_RESET_ENABLED, PLP_TIMER_IRQ_ENABLED,
|
||||||
|
PLP_TIMER_IEM_DISABLED, PLP_TIMER_CMPCLR_ENABLED,
|
||||||
|
PLP_TIMER_ONE_SHOT_DISABLED, PLP_TIMER_REFCLK_ENABLED,
|
||||||
|
PLP_TIMER_PRESCALER_DISABLED, 0, PLP_TIMER_MODE_64_DISABLED);
|
||||||
|
|
||||||
|
sys_write32(conf, base);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void sy1xx_sys_timer_irq_enable(void)
|
||||||
|
{
|
||||||
|
soc_enable_irq(DT_IRQN(SY1XX_SYS_TIMER_NODE));
|
||||||
|
}
|
||||||
|
|
||||||
|
static void sy1xx_sys_timer_irq_disable(void)
|
||||||
|
{
|
||||||
|
soc_disable_irq(DT_IRQN(SY1XX_SYS_TIMER_NODE));
|
||||||
|
}
|
||||||
|
|
||||||
|
static int32_t sy1xx_sys_timer_config(uint32_t base, struct timer_cfg *cfg)
|
||||||
|
{
|
||||||
|
|
||||||
|
/* global irq disable */
|
||||||
|
uint32_t isr_state = arch_irq_lock();
|
||||||
|
|
||||||
|
if (cfg->tick_us < SY1XX_MINIMUM_ALLOWED_TICK) {
|
||||||
|
cfg->tick_us = SY1XX_MINIMUM_ALLOWED_TICK;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* expect 1.0ms resolution => tick_us = 1000 */
|
||||||
|
uint32_t us = cfg->tick_us;
|
||||||
|
volatile double ticks_f =
|
||||||
|
(((double)us / (double)1000000) * (double)soc_get_rts_clock_frequency()) + 1.0;
|
||||||
|
|
||||||
|
volatile uint32_t timer_ticks = (uint32_t)ticks_f;
|
||||||
|
|
||||||
|
printk("timer [%d] expected %u (%d)\n", soc_get_rts_clock_frequency(), cfg->tick_us,
|
||||||
|
timer_ticks);
|
||||||
|
|
||||||
|
sy1xx_sys_timer_reload(base, timer_ticks);
|
||||||
|
|
||||||
|
sy1xx_sys_timer_cfg_auto_reload(base);
|
||||||
|
|
||||||
|
/* we always start timer irq disabled */
|
||||||
|
sy1xx_sys_timer_irq_disable();
|
||||||
|
|
||||||
|
/* restore global irq */
|
||||||
|
arch_irq_unlock(isr_state);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t sys_clock_elapsed(void)
|
||||||
|
{
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t sys_clock_cycle_get_32(void)
|
||||||
|
{
|
||||||
|
return current_sys_clock;
|
||||||
|
}
|
||||||
|
|
||||||
|
void sy1xx_sys_timer_callback(const void *user_data)
|
||||||
|
{
|
||||||
|
current_sys_clock += 1;
|
||||||
|
|
||||||
|
sys_clock_announce(1);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int sy1xx_sys_timer_init(void)
|
||||||
|
{
|
||||||
|
printk("starting sys_timer\n");
|
||||||
|
|
||||||
|
struct timer_cfg timerCfg0 = {
|
||||||
|
.tick_us = DT_PROP(SY1XX_SYS_TIMER_NODE, ticks_us),
|
||||||
|
};
|
||||||
|
|
||||||
|
sy1xx_sys_timer_config(SY1XX_SYS_TIMER_BASE_ADDR, &timerCfg0);
|
||||||
|
|
||||||
|
uint32_t irq = arch_irq_lock();
|
||||||
|
|
||||||
|
/* register interrupt routine with zephyr */
|
||||||
|
irq_connect_dynamic(DT_IRQN(SY1XX_SYS_TIMER_NODE), 0, sy1xx_sys_timer_callback, NULL, 0);
|
||||||
|
|
||||||
|
sy1xx_sys_timer_irq_enable();
|
||||||
|
|
||||||
|
arch_irq_unlock(irq | 0x1);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
SYS_INIT(sy1xx_sys_timer_init, PRE_KERNEL_2, CONFIG_SYSTEM_CLOCK_INIT_PRIORITY);
|
18
dts/bindings/interrupt-controller/sy1xx,event-unit.yaml
Normal file
18
dts/bindings/interrupt-controller/sy1xx,event-unit.yaml
Normal file
|
@ -0,0 +1,18 @@
|
||||||
|
# Copyright (c) 2024 sensry.io
|
||||||
|
# SPDX-License-Identifier: Apache-2.0
|
||||||
|
|
||||||
|
description: Sensry sy1xx event unit
|
||||||
|
|
||||||
|
compatible: "sensry,sy1xx-event-unit"
|
||||||
|
|
||||||
|
include: [interrupt-controller.yaml, base.yaml]
|
||||||
|
|
||||||
|
properties:
|
||||||
|
reg:
|
||||||
|
required: true
|
||||||
|
|
||||||
|
"#interrupt-cells":
|
||||||
|
const: 1
|
||||||
|
|
||||||
|
interrupt-cells:
|
||||||
|
- irq
|
19
dts/bindings/timer/sy1xx,sys-timer.yaml
Normal file
19
dts/bindings/timer/sy1xx,sys-timer.yaml
Normal file
|
@ -0,0 +1,19 @@
|
||||||
|
# Copyright (c) 2024 sensry.io
|
||||||
|
# SPDX-License-Identifier: Apache-2.0
|
||||||
|
|
||||||
|
description: Sensry ganymed timer peripheral
|
||||||
|
|
||||||
|
compatible: "sensry,sy1xx-sys-timer"
|
||||||
|
|
||||||
|
include: base.yaml
|
||||||
|
|
||||||
|
properties:
|
||||||
|
reg:
|
||||||
|
required: true
|
||||||
|
|
||||||
|
interrupts:
|
||||||
|
required: true
|
||||||
|
|
||||||
|
ticks_us:
|
||||||
|
type: int
|
||||||
|
required: true
|
Loading…
Add table
Add a link
Reference in a new issue