replace multiple instructions with macro SAVE_CONTEXT and RESTORE_CONTEXT
This commit is contained in:
@@ -10,7 +10,7 @@
|
||||
|
||||
__KERNEL__ void cpu_systick_init(k_cycle_t cycle_per_tick)
|
||||
{
|
||||
port_systick_priority_set(TOS_CFG_CPU_SYSTICK_PRIO);
|
||||
port_systick_priority_set(TOS_CFG_CPU_SYSTICK_PRIO);
|
||||
port_systick_config(cycle_per_tick);
|
||||
}
|
||||
|
||||
@@ -48,38 +48,38 @@ __KERNEL__ void cpu_sched_start(void)
|
||||
/*
|
||||
|
||||
Inx Offset Register
|
||||
31 124 x31 t6
|
||||
32 120 x30 t5
|
||||
29 116 x29 t4
|
||||
28 112 x28 t3
|
||||
27 108 x27 s11
|
||||
26 104 x26 s10
|
||||
25 100 x25 s9
|
||||
24 096 x24 s8
|
||||
23 092 x23 s7
|
||||
22 088 x22 s6
|
||||
21 084 x21 s5
|
||||
20 080 x20 s4
|
||||
19 076 x19 s3
|
||||
18 072 x18 s2
|
||||
17 068 x17 a7
|
||||
16 064 x16 a6
|
||||
15 060 x15 a5
|
||||
14 056 x14 a4
|
||||
13 052 x13 a3
|
||||
12 048 x12 a2
|
||||
11 044 x11 a1
|
||||
10 040 x10 a0
|
||||
09 036 x9 s1
|
||||
08 032 x8 s0/fp
|
||||
07 028 x7 t2
|
||||
06 024 x6 t1
|
||||
05 020 x5 t0
|
||||
04 016 x4 tp
|
||||
03 012 x3 gp
|
||||
02 008 x1 ra
|
||||
01 004 mstatus
|
||||
00 000 epc
|
||||
31 124 x31 t6
|
||||
32 120 x30 t5
|
||||
29 116 x29 t4
|
||||
28 112 x28 t3
|
||||
27 108 x27 s11
|
||||
26 104 x26 s10
|
||||
25 100 x25 s9
|
||||
24 096 x24 s8
|
||||
23 092 x23 s7
|
||||
22 088 x22 s6
|
||||
21 084 x21 s5
|
||||
20 080 x20 s4
|
||||
19 076 x19 s3
|
||||
18 072 x18 s2
|
||||
17 068 x17 a7
|
||||
16 064 x16 a6
|
||||
15 060 x15 a5
|
||||
14 056 x14 a4
|
||||
13 052 x13 a3
|
||||
12 048 x12 a2
|
||||
11 044 x11 a1
|
||||
10 040 x10 a0
|
||||
09 036 x9 s1
|
||||
08 032 x8 s0/fp
|
||||
07 028 x7 t2
|
||||
06 024 x6 t1
|
||||
05 020 x5 t0
|
||||
04 016 x4 tp
|
||||
03 012 x3 gp
|
||||
02 008 x1 ra
|
||||
01 004 mstatus
|
||||
00 000 epc
|
||||
|
||||
*/
|
||||
|
||||
@@ -89,7 +89,7 @@ __KERNEL__ k_stack_t *cpu_task_stk_init(void *entry,
|
||||
k_stack_t *stk_base,
|
||||
size_t stk_size)
|
||||
{
|
||||
cpu_data_t *sp = 0;
|
||||
cpu_data_t *sp = 0;
|
||||
cpu_context_t *regs = 0;
|
||||
|
||||
sp = (cpu_data_t *)&stk_base[stk_size];
|
||||
@@ -101,16 +101,16 @@ __KERNEL__ k_stack_t *cpu_task_stk_init(void *entry,
|
||||
|
||||
#if 1
|
||||
for(int i=0; i<(sizeof(cpu_context_t)/sizeof(cpu_data_t)); i++) {
|
||||
#define _V(v) ((unsigned int)((v/10) << 4 | (v % 10)))
|
||||
*(sp + i) = (_V(i) << 24) | (_V(i) << 16) | (_V(i) << 8) | _V(i);
|
||||
#undef _V
|
||||
#define _V(v) ((unsigned int)((v/10) << 4 | (v % 10)))
|
||||
*(sp + i) = (_V(i) << 24) | (_V(i) << 16) | (_V(i) << 8) | _V(i);
|
||||
#undef _V
|
||||
}
|
||||
#endif
|
||||
|
||||
regs->a0 = (cpu_data_t)arg; // a0: argument
|
||||
regs->ra = (cpu_data_t)0xACE00ACE; // ra: return address
|
||||
regs->mstatus = (cpu_data_t)(MSTATUS_MPP | MSTATUS_MPIE); // return to machine mode and enable interrupt
|
||||
regs->epc = (cpu_data_t)entry;
|
||||
regs->a0 = (cpu_data_t)arg; // a0: argument
|
||||
regs->ra = (cpu_data_t)0xACE00ACE; // ra: return address
|
||||
regs->mstatus = (cpu_data_t)(MSTATUS_MPP | MSTATUS_MPIE); // return to machine mode and enable interrupt
|
||||
regs->epc = (cpu_data_t)entry;
|
||||
|
||||
|
||||
return (k_stack_t*)sp;
|
||||
@@ -118,38 +118,38 @@ __KERNEL__ k_stack_t *cpu_task_stk_init(void *entry,
|
||||
|
||||
void cpu_trap_entry(cpu_data_t cause, cpu_context_t *regs)
|
||||
{
|
||||
while(1) {
|
||||
// TODO
|
||||
}
|
||||
while(1) {
|
||||
// TODO
|
||||
}
|
||||
}
|
||||
|
||||
void SysTick_IRQHandler() {
|
||||
port_systick_config(k_cpu_cycle_per_tick);
|
||||
if(tos_knl_is_running()) {
|
||||
tos_knl_irq_enter();
|
||||
tos_tick_handler();
|
||||
tos_knl_irq_leave();
|
||||
}
|
||||
port_systick_config(k_cpu_cycle_per_tick);
|
||||
if(tos_knl_is_running()) {
|
||||
tos_knl_irq_enter();
|
||||
tos_tick_handler();
|
||||
tos_knl_irq_leave();
|
||||
}
|
||||
}
|
||||
|
||||
void cpu_irq_entry(cpu_data_t irq, cpu_context_t *regs)
|
||||
{
|
||||
#if 1
|
||||
if(irq != 7) {
|
||||
return;
|
||||
}
|
||||
if(irq != 7) {
|
||||
return;
|
||||
}
|
||||
|
||||
SysTick_IRQHandler();
|
||||
SysTick_IRQHandler();
|
||||
#else
|
||||
void (*irq_handler)();
|
||||
extern void (*handler_vector_table[])();
|
||||
void (*irq_handler)();
|
||||
extern void (*handler_vector_table[])();
|
||||
|
||||
irq_handler = handler_vector_table[irq];
|
||||
if((*irq_handler) == 0) {
|
||||
return;
|
||||
}
|
||||
irq_handler = handler_vector_table[irq];
|
||||
if((*irq_handler) == 0) {
|
||||
return;
|
||||
}
|
||||
|
||||
(*irq_handler)();
|
||||
(*irq_handler)();
|
||||
#endif
|
||||
}
|
||||
|
||||
|
@@ -3,38 +3,38 @@
|
||||
|
||||
|
||||
typedef struct cpu_context_st {
|
||||
cpu_data_t epc;
|
||||
cpu_data_t mstatus;
|
||||
union { cpu_data_t x1, ra; };
|
||||
union { cpu_data_t x3, gp; };
|
||||
union { cpu_data_t x4, tp; };
|
||||
union { cpu_data_t x5, t0; };
|
||||
union { cpu_data_t x6, t1; };
|
||||
union { cpu_data_t x7, t2; };
|
||||
union { cpu_data_t x8, s0, fp; };
|
||||
union { cpu_data_t x9, s1; };
|
||||
union { cpu_data_t x10, a0; };
|
||||
union { cpu_data_t x11, a1; };
|
||||
union { cpu_data_t x12, a2; };
|
||||
union { cpu_data_t x13, a3; };
|
||||
union { cpu_data_t x14, a4; };
|
||||
union { cpu_data_t x15, a5; };
|
||||
union { cpu_data_t x16, a6; };
|
||||
union { cpu_data_t x17, a7; };
|
||||
union { cpu_data_t x18, s2; };
|
||||
union { cpu_data_t x19, s3; };
|
||||
union { cpu_data_t x20, s4; };
|
||||
union { cpu_data_t x21, s5; };
|
||||
union { cpu_data_t x22, s6; };
|
||||
union { cpu_data_t x23, s7; };
|
||||
union { cpu_data_t x24, s8; };
|
||||
union { cpu_data_t x25, s9; };
|
||||
union { cpu_data_t x26, s10; };
|
||||
union { cpu_data_t x27, s11; };
|
||||
union { cpu_data_t x28, t3; };
|
||||
union { cpu_data_t x29, t4; };
|
||||
union { cpu_data_t x30, t5; };
|
||||
union { cpu_data_t x31, t6; };
|
||||
cpu_data_t epc;
|
||||
cpu_data_t mstatus;
|
||||
union { cpu_data_t x1, ra; };
|
||||
union { cpu_data_t x3, gp; };
|
||||
union { cpu_data_t x4, tp; };
|
||||
union { cpu_data_t x5, t0; };
|
||||
union { cpu_data_t x6, t1; };
|
||||
union { cpu_data_t x7, t2; };
|
||||
union { cpu_data_t x8, s0, fp; };
|
||||
union { cpu_data_t x9, s1; };
|
||||
union { cpu_data_t x10, a0; };
|
||||
union { cpu_data_t x11, a1; };
|
||||
union { cpu_data_t x12, a2; };
|
||||
union { cpu_data_t x13, a3; };
|
||||
union { cpu_data_t x14, a4; };
|
||||
union { cpu_data_t x15, a5; };
|
||||
union { cpu_data_t x16, a6; };
|
||||
union { cpu_data_t x17, a7; };
|
||||
union { cpu_data_t x18, s2; };
|
||||
union { cpu_data_t x19, s3; };
|
||||
union { cpu_data_t x20, s4; };
|
||||
union { cpu_data_t x21, s5; };
|
||||
union { cpu_data_t x22, s6; };
|
||||
union { cpu_data_t x23, s7; };
|
||||
union { cpu_data_t x24, s8; };
|
||||
union { cpu_data_t x25, s9; };
|
||||
union { cpu_data_t x26, s10; };
|
||||
union { cpu_data_t x27, s11; };
|
||||
union { cpu_data_t x28, t3; };
|
||||
union { cpu_data_t x29, t4; };
|
||||
union { cpu_data_t x30, t5; };
|
||||
union { cpu_data_t x31, t6; };
|
||||
} cpu_context_t;
|
||||
|
||||
__API__ uint32_t tos_cpu_clz(uint32_t val);
|
||||
|
Reference in New Issue
Block a user