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;
 | 
						|
}
 |