修改格式
This commit is contained in:
parent
341e52d940
commit
4a2ce8bca5
|
@ -35,7 +35,7 @@ void rt_hw_systick_isr(void)
|
||||||
void rt_hw_system_timer_init(void)
|
void rt_hw_system_timer_init(void)
|
||||||
{
|
{
|
||||||
// initial system timer interrupt, map local timer interrupt to INT14
|
// initial system timer interrupt, map local timer interrupt to INT14
|
||||||
gpCGEM_regs->INTMUX3=(CSL_GEM_TINTLN<<CSL_CGEM_INTMUX3_INTSEL14_SHIFT);
|
gpCGEM_regs->INTMUX3 = (CSL_GEM_TINTLN<<CSL_CGEM_INTMUX3_INTSEL14_SHIFT);
|
||||||
// enable CPU INT14
|
// enable CPU INT14
|
||||||
CPU_interrupt_enable(1<<14);
|
CPU_interrupt_enable(1<<14);
|
||||||
|
|
||||||
|
@ -55,10 +55,10 @@ void rt_hw_system_timer_start(void)
|
||||||
gpBootCfgRegs->TOUTSEL = (DNUM*2)<<CSL_BOOTCFG_TOUTSEL_TOUTSEL0_SHIFT;
|
gpBootCfgRegs->TOUTSEL = (DNUM*2)<<CSL_BOOTCFG_TOUTSEL_TOUTSEL0_SHIFT;
|
||||||
|
|
||||||
// configure the timer to generate clocks and interrupts
|
// configure the timer to generate clocks and interrupts
|
||||||
tmrCfg.timer_num=DNUM;
|
tmrCfg.timer_num = DNUM;
|
||||||
tmrCfg.timerMode=TIMER_PERIODIC_CLOCK;
|
tmrCfg.timerMode = TIMER_PERIODIC_CLOCK;
|
||||||
tmrCfg.period = (unsigned long long) RT_TICK_PER_SECOND*gDSP_Core_Speed_Hz/6000;
|
tmrCfg.period = (unsigned long long) RT_TICK_PER_SECOND*gDSP_Core_Speed_Hz/6000;
|
||||||
tmrCfg.reload_period=0;
|
tmrCfg.reload_period = 0;
|
||||||
|
|
||||||
// initial timer
|
// initial timer
|
||||||
Timer64_Init(&tmrCfg);
|
Timer64_Init(&tmrCfg);
|
||||||
|
|
|
@ -8,7 +8,6 @@
|
||||||
* 2021-11-16 Dystopia the first version
|
* 2021-11-16 Dystopia the first version
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
|
||||||
#include "interrupt.h"
|
#include "interrupt.h"
|
||||||
#include "c66xx.h"
|
#include "c66xx.h"
|
||||||
#include "trap.h"
|
#include "trap.h"
|
||||||
|
@ -46,7 +45,9 @@ void rt_hw_interrupt_init(void)
|
||||||
void rt_hw_interrupt_mask(int vector)
|
void rt_hw_interrupt_mask(int vector)
|
||||||
{
|
{
|
||||||
if (vector < 0 || vector >= MAX_HANDLERS)
|
if (vector < 0 || vector >= MAX_HANDLERS)
|
||||||
|
{
|
||||||
return;
|
return;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
@ -56,7 +57,9 @@ void rt_hw_interrupt_mask(int vector)
|
||||||
void rt_hw_interrupt_umask(int vector)
|
void rt_hw_interrupt_umask(int vector)
|
||||||
{
|
{
|
||||||
if (vector < 0 || vector >= MAX_HANDLERS)
|
if (vector < 0 || vector >= MAX_HANDLERS)
|
||||||
|
{
|
||||||
return;
|
return;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
@ -90,5 +93,7 @@ rt_isr_handler_t rt_hw_interrupt_install(int vector, rt_isr_handler_t handler,
|
||||||
void rt_hw_interrupt_clear(int vector)
|
void rt_hw_interrupt_clear(int vector)
|
||||||
{
|
{
|
||||||
if (vector < 0 || vector >= MAX_HANDLERS)
|
if (vector < 0 || vector >= MAX_HANDLERS)
|
||||||
|
{
|
||||||
return;
|
return;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
|
@ -12,9 +12,8 @@
|
||||||
#include "c66xx.h"
|
#include "c66xx.h"
|
||||||
|
|
||||||
#include <rthw.h>
|
#include <rthw.h>
|
||||||
#include <rtthread.h>
|
|
||||||
|
|
||||||
#include <rtdef.h>
|
#include <rtdef.h>
|
||||||
|
#include <rtthread.h>
|
||||||
|
|
||||||
#define RT_SYS_STACK_SIZE 4096
|
#define RT_SYS_STACK_SIZE 4096
|
||||||
|
|
||||||
|
@ -136,16 +135,18 @@ static struct rt_exception_info iexcept_table[10] = {
|
||||||
static int process_iexcept(struct rt_hw_exp_stack_register *regs)
|
static int process_iexcept(struct rt_hw_exp_stack_register *regs)
|
||||||
{
|
{
|
||||||
unsigned int iexcept_report = get_iexcept();
|
unsigned int iexcept_report = get_iexcept();
|
||||||
unsigned int iexcept_num;
|
unsigned int iexcept_num = 0;
|
||||||
|
|
||||||
ack_exception(EXCEPT_TYPE_IXF);
|
ack_exception(EXCEPT_TYPE_IXF);
|
||||||
|
|
||||||
while(iexcept_report) {
|
while(iexcept_report)
|
||||||
|
{
|
||||||
iexcept_num = __ffs(iexcept_report);
|
iexcept_num = __ffs(iexcept_report);
|
||||||
iexcept_report &= ~(1 << iexcept_num);
|
iexcept_report &= ~(1 << iexcept_num);
|
||||||
set_iexcept(iexcept_report);
|
set_iexcept(iexcept_report);
|
||||||
|
|
||||||
if (*(unsigned int *)regs->pc == BKPT_OPCODE) {
|
if (*(unsigned int *)regs->pc == BKPT_OPCODE)
|
||||||
|
{
|
||||||
/* This is a breakpoint */
|
/* This is a breakpoint */
|
||||||
struct rt_exception_info bkpt_exception = { " - undefined instruction", ABORT_TYPE_UNDDEF, ABORT_BRKPT_ILL };
|
struct rt_exception_info bkpt_exception = { " - undefined instruction", ABORT_TYPE_UNDDEF, ABORT_BRKPT_ILL };
|
||||||
do_trap(&bkpt_exception, regs);
|
do_trap(&bkpt_exception, regs);
|
||||||
|
@ -300,10 +301,12 @@ static void process_except(struct rt_hw_exp_stack_register *regs)
|
||||||
{
|
{
|
||||||
int except_num;
|
int except_num;
|
||||||
int bank = 0;
|
int bank = 0;
|
||||||
int i;
|
int i = 0;
|
||||||
|
|
||||||
for (i = 0; i <= 3; i++) {
|
for (i = 0; i <= 3; i++)
|
||||||
while (INTC_MEXPMASK[i]) {
|
{
|
||||||
|
while (INTC_MEXPMASK[i])
|
||||||
|
{
|
||||||
__dint();
|
__dint();
|
||||||
except_num = __ffs(INTC_MEXPMASK[i]);
|
except_num = __ffs(INTC_MEXPMASK[i]);
|
||||||
INTC_MEXPMASK[i] &= ~(1 << except_num); /* ack the external exception */
|
INTC_MEXPMASK[i] &= ~(1 << except_num); /* ack the external exception */
|
||||||
|
@ -317,14 +320,13 @@ static void process_except(struct rt_hw_exp_stack_register *regs)
|
||||||
}
|
}
|
||||||
|
|
||||||
extern void hw_nmi_handler(struct rt_hw_exp_stack_register *regs);
|
extern void hw_nmi_handler(struct rt_hw_exp_stack_register *regs);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Main exception processing
|
* Main exception processing
|
||||||
*/
|
*/
|
||||||
int rt_hw_process_exception(struct rt_hw_exp_stack_register *regs)
|
int rt_hw_process_exception(struct rt_hw_exp_stack_register *regs)
|
||||||
{
|
{
|
||||||
int type;
|
int type = 0;
|
||||||
int type_num;
|
int type_num = 0;
|
||||||
int ie_num = 9; /* default is unknown exception */
|
int ie_num = 9; /* default is unknown exception */
|
||||||
|
|
||||||
while ((type = get_except_type()) != 0) {
|
while ((type = get_except_type()) != 0) {
|
||||||
|
@ -334,12 +336,16 @@ int rt_hw_process_exception(struct rt_hw_exp_stack_register *regs)
|
||||||
case EXCEPT_TYPE_NXF: /* NMI exception */
|
case EXCEPT_TYPE_NXF: /* NMI exception */
|
||||||
ack_exception(EXCEPT_TYPE_NXF); /* clear exception */
|
ack_exception(EXCEPT_TYPE_NXF); /* clear exception */
|
||||||
if (hw_nmi_handler != RT_NULL)
|
if (hw_nmi_handler != RT_NULL)
|
||||||
|
{
|
||||||
hw_nmi_handler(regs);
|
hw_nmi_handler(regs);
|
||||||
|
}
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case EXCEPT_TYPE_IXF: /* internal exception */
|
case EXCEPT_TYPE_IXF: /* internal exception */
|
||||||
if (process_iexcept(regs))
|
if (process_iexcept(regs))
|
||||||
|
{
|
||||||
return 1;
|
return 1;
|
||||||
|
}
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case EXCEPT_TYPE_EXC: /* external exception */
|
case EXCEPT_TYPE_EXC: /* external exception */
|
||||||
|
|
|
@ -41,34 +41,34 @@
|
||||||
|
|
||||||
enum SYSTEM_TRAP_CODE
|
enum SYSTEM_TRAP_CODE
|
||||||
{
|
{
|
||||||
ABORT_BUS_ADDRERR = 0, // bus address error
|
ABORT_BUS_ADDRERR = 0, // bus address error
|
||||||
ABORT_BUS_ACCERR, // bus access permission error
|
ABORT_BUS_ACCERR, // bus access permission error
|
||||||
ABORT_OPCODE_ILL, // illegal opcode
|
ABORT_OPCODE_ILL, // illegal opcode
|
||||||
ABORT_PRVREG_ILL, // privilege register
|
ABORT_PRVREG_ILL, // privilege register
|
||||||
ABORT_PRVOPC_ILL, // privileged opcode
|
ABORT_PRVOPC_ILL, // privileged opcode
|
||||||
ABORT_ILLTRP_ILL, // illegal trap
|
ABORT_ILLTRP_ILL, // illegal trap
|
||||||
ABORT_BRKPT_ILL, // handling breakpoints
|
ABORT_BRKPT_ILL, // handling breakpoints
|
||||||
};
|
};
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* abort types
|
* abort types
|
||||||
*/
|
*/
|
||||||
#define ABORT_TYPE_BUS 0 // bus access abnormal
|
#define ABORT_TYPE_BUS 0 // bus access abnormal
|
||||||
#define ABORT_TYPE_MAP 1 // page table mapping error
|
#define ABORT_TYPE_MAP 1 // page table mapping error
|
||||||
#define ABORT_TYPE_UNDDEF 0xff // undefined exception
|
#define ABORT_TYPE_UNDDEF 0xff // undefined exception
|
||||||
#define ABORT_TYPE_FATAL 0xffffffff // fatal error
|
#define ABORT_TYPE_FATAL 0xffffffff // fatal error
|
||||||
|
|
||||||
struct rt_exception_info {
|
struct rt_exception_info {
|
||||||
char *kernel_str;
|
char *kernel_str;
|
||||||
int type;
|
int type;
|
||||||
int code;
|
int code;
|
||||||
};
|
};
|
||||||
|
|
||||||
#define BKPT_OPCODE 0x56454314 /* illegal opcode */
|
#define BKPT_OPCODE 0x56454314 /* illegal opcode */
|
||||||
#define INTC_MEXPMASK __SYSREGA(0x018000e0, unsigned int)
|
#define INTC_MEXPMASK __SYSREGA(0x018000e0, unsigned int)
|
||||||
|
|
||||||
#define __ffs(a) (_lmbd(1, _bitr(a)))
|
#define __ffs(a) (_lmbd(1, _bitr(a)))
|
||||||
#define __fls(a) (!(a) ? 0 : (32 - _lmbd(1, (a))))
|
#define __fls(a) (!(a) ? 0 : (32 - _lmbd(1, (a))))
|
||||||
|
|
||||||
extern void rt_trap_init(void);
|
extern void rt_trap_init(void);
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue