恢复用户堆栈/寄存器

时间:2013-03-03 14:38:27

标签: c assembly arm

我在ARM926上的先发制人操作系统(极简主义)结束时遇到了困难。

今天,我能够启动操作系统,切换到用户模式(有自己的stask),并在计时器中断后返回操作系统模式(SVC)。

但是今天我试图在定时器中断之前用上下文返回用户函数。

我做了什么: 我的初始化任务功能:

init_task(taskstruct * task, unsigned int* stack, void (*function)(void) ){



    stack += STACK_SIZE;// - 16; /* End of stack, minus what we're about to push */
    //stack[0] = 0x10; /* User mode, interrupts on */
    //stack[1] = (unsigned int)function;

    task->sp = stack;

    task->sp[0] = task->registers[0]; // r0
    task->sp[1] = task->registers[1];// = task->sp[3];//0; // r1
    task->sp[2] = task->registers[2];// = task->sp[4];//0; // r2
    task->sp[3] = task->registers[3];// = task->sp[5];//0; // r3
    task->sp[4] = task->registers[4];// = task->sp[6];//0; // r4
    task->sp[5] = task->registers[5];// = task->sp[7];//0; // r5
    task->sp[6] = task->registers[6];// = task->sp[8];//0; // r6
    task->sp[7] = task->registers[7];// = task->sp[9];//0; // r7
    task->sp[8] = task->registers[8];// = task->sp[10];//0; // r8
    task->sp[9] = task->registers[9];// = task->sp[11];//0; // r9
    task->sp[10] = task->registers[10];// = task->sp[12];//0; // r10
    task->sp[11] = task->registers[11];// = task->sp[13];//0; // r11
    task->sp[12] = task->registers[12];// = task->sp[14];//0; // r12
    task->sp[13] = (unsigned int)function;
}

激活功能:

.global activate
activate:
    /* Save kernel state */
    STMFD sp!,{r1-r12,lr}
    NOP
    msr CPSR_c, SYS_MODE /* Sys mode with IRQ enabled and FIQ disabled*/
    mov sp, r0 /* MOVE TO THE STACK USER
    /* LOAD THE TASK'S CONTEXT */
    mov ip, r0
    LDMFD sp!, {r0-ip,lr}
    NOP
    mov pc, lr

致电:

activate(task[0].sp);
print_uart0("Kernel gets back control ! \n");
print_uart0("Load the next task ! \n");
activate(task[0].sp);

我在irq_handler中做了什么:

irq_handler:
/* Save the return value */
SUB ip,lr,#4
BL event_irq_handler

/* Save the user task context */
MSR CPSR_c, #INT_OFF|SYS_MODE
MOV lr, ip
STMFD sp!,{r0-ip,lr}
NOP
MOV r0, sp
BL saveTaskContext


/* Load kernel state */
MSR CPSR_c,SVC_MODE
LDMFD sp!,{r1-r12,pc}
NOP

savcontext函数:

int i = 0;
//char printable = 0x00;
/* UPDATE THE STACK TASK */
for ( i = 0 ; i <= 13 ; i++ ){
    task[0].sp[i] = *(ptr+i);
}

但我的问题是,当我第二次调用activate(task [0] .sp)时,它会分支到任何地方并重新启动我的主程序。

我哪里错了?

问候,VincentB

2 个答案:

答案 0 :(得分:1)

没关系,经过长时间的努力,我已经找到了解决办法!

最终代码非常简单:

我只是在irq_handler中更改代码,其余代码与我之前的帖子相同:

irq_handler:
/* Save the return value */
SUB lr,lr,#4
STMFD sp!, {r0-ip, lr}^ /* Save the user task context */
MOV r0, sp
BL saveTaskContext

BL event_irq_handler


/* Load kernel state */
MSR CPSR_c,SVC_MODE
LDMFD sp!,{r1-r12,pc}
NOP

答案 1 :(得分:0)

我只想在你的

for ( i = 0 ; i <= 13 ; i++ ){
    task[0].sp[i] = *(ptr+i);
}

应该这样做吗?

for ( i = 0 ; i <= 13 ; i++ ){
    task[0].sp[i] = (*ptr+i);
}

我想...你附加了ptr的地址,其值为i但不确定