49 lines
1.1 KiB
C
49 lines
1.1 KiB
C
|
/*
|
||
|
|
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
|
*
|
||
|
|
* Change Logs:
|
||
|
|
* Date Author Notes
|
||
|
|
* 2018/10/28 Bernard The unify RISC-V porting code.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <rthw.h>
|
||
|
|
#include <rtthread.h>
|
||
|
|
|
||
|
|
#include <encoding.h>
|
||
|
|
#include <clint.h>
|
||
|
|
#include <sysctl.h>
|
||
|
|
|
||
|
|
static volatile unsigned long tick_cycles = 0;
|
||
|
|
int tick_isr(void)
|
||
|
|
{
|
||
|
|
uint64_t core_id = current_coreid();
|
||
|
|
|
||
|
|
clint->mtimecmp[core_id] += tick_cycles;
|
||
|
|
rt_tick_increase();
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Sets and enable the timer interrupt */
|
||
|
|
int rt_hw_tick_init(void)
|
||
|
|
{
|
||
|
|
/* Read core id */
|
||
|
|
unsigned long core_id = current_coreid();
|
||
|
|
unsigned long interval = 1000/RT_TICK_PER_SECOND;
|
||
|
|
|
||
|
|
/* Clear the Machine-Timer bit in MIE */
|
||
|
|
clear_csr(mie, MIP_MTIP);
|
||
|
|
|
||
|
|
/* calculate the tick cycles */
|
||
|
|
tick_cycles = interval * sysctl_clock_get_freq(SYSCTL_CLOCK_CPU) / CLINT_CLOCK_DIV / 1000ULL - 1;
|
||
|
|
/* Set mtimecmp by core id */
|
||
|
|
clint->mtimecmp[core_id] = clint->mtime + tick_cycles;
|
||
|
|
|
||
|
|
/* Enable the Machine-Timer bit in MIE */
|
||
|
|
set_csr(mie, MIP_MTIP);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|