2025-06-27 00:32:57 +08:00
|
|
|
|
#include "irq_vector.h"
|
|
|
|
|
|
#include "base.h"
|
|
|
|
|
|
#include "mymem.h"
|
|
|
|
|
|
#include "rthw.h"
|
|
|
|
|
|
|
2025-06-29 11:20:46 +08:00
|
|
|
|
extern int isr_vector_start;
|
|
|
|
|
|
extern int isr_vector_end;
|
2025-06-27 00:32:57 +08:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static void *g_base=0;
|
|
|
|
|
|
static void **g_irq_vector=0;
|
|
|
|
|
|
//void *g_irq_vector[0x1ac] __attribute__((at(0x20000200)));
|
|
|
|
|
|
|
|
|
|
|
|
void irq_vector_init(void)
|
|
|
|
|
|
{
|
2025-06-29 11:20:46 +08:00
|
|
|
|
int size=(int)&isr_vector_end-(int)&isr_vector_start;
|
2025-06-27 00:32:57 +08:00
|
|
|
|
if(g_irq_vector==0)
|
|
|
|
|
|
{
|
|
|
|
|
|
//向量表必须0x200字节对齐，这里申请大于0x200字节的内存，然后所申请的内存一定有0x200对齐的部分
|
2025-06-29 11:20:46 +08:00
|
|
|
|
g_base=mymalloc((int)size+0x200);
|
2025-06-27 00:32:57 +08:00
|
|
|
|
g_irq_vector=(void **)(((int)g_base+0x200)&0xfffffe00);
|
2025-06-29 11:20:46 +08:00
|
|
|
|
mymemcpy(g_irq_vector,(void *)&isr_vector_start,size);
|
2025-06-27 00:32:57 +08:00
|
|
|
|
rt_base_t level=rt_hw_interrupt_disable();
|
|
|
|
|
|
NVIC_SetVectorTable(NVIC_VectTab_RAM,(u32)g_irq_vector-NVIC_VectTab_RAM);
|
|
|
|
|
|
rt_hw_interrupt_enable(level);
|
|
|
|
|
|
}
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
//设置中断函数,同时返回旧的中断函数，irq_fun==0时不做修改
|
|
|
|
|
|
void *irq_vector_set_irq(int irq_num,void *irq_fun)
|
|
|
|
|
|
{
|
|
|
|
|
|
void *ret=0;
|
|
|
|
|
|
irq_num+=16;//前16个中断是内核中断，中断号为负数
|
|
|
|
|
|
rt_base_t level=rt_hw_interrupt_disable();
|
|
|
|
|
|
ret=g_irq_vector[irq_num];
|
|
|
|
|
|
if(irq_fun)
|
|
|
|
|
|
g_irq_vector[irq_num]=irq_fun;
|
|
|
|
|
|
rt_hw_interrupt_enable(level);
|
|
|
|
|
|
return ret;
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
