arm-refactor:document ARM assembly code.

Change-Id: I8540a09cdaf45431ad163954ce41d36f4b72cad5
This commit is contained in:
Kees Jongenburger 2014-02-10 13:12:21 +01:00
parent 9dec6c12f1
commit 3df19a0671
3 changed files with 73 additions and 67 deletions

View file

@ -28,20 +28,20 @@ MINIX:
b multiboot_init b multiboot_init
multiboot_init: multiboot_init:
ldr sp, =load_stack_start /* make usable stack */ ldr sp, =load_stack_start /* make usable stack */
mov fp, #0 mov fp, #0
bl _C_LABEL(pre_init) bl _C_LABEL(pre_init)
/* Kernel is mapped high now and ready to go, with /* Kernel is mapped high now and ready to go, with
* the boot info pointer returned in r0. Set the * the boot info pointer returned by pre_init in r0.
* highly mapped stack, initialize it, push the boot * Set the highly mapped stack and initialize it.
* info pointer and jump to the highly mapped kernel. *
* Afther that call kmain with r0 still pointing to boot info
*/ */
ldr sp, =k_initial_stktop ldr sp, =k_initial_stktop
mov r1, #0 mov r1, #0
push {r1} /* Terminate stack */ push {r1} /* Terminate stack */
/* r0 holds kinfo_t ptr */ ldr r2, =_C_LABEL(kmain) /* r0 holds kinfo_t ptr */
ldr r2, =_C_LABEL(kmain)
bx r2 bx r2
/* not reached */ /* not reached */

View file

@ -34,42 +34,52 @@
IMPORT(svc_stack) IMPORT(svc_stack)
/* /*
* Adjust lr, switch to SVC mode, and push pc/psr when exception triggered * Adjust lr, push pc/psr when exception triggered and switch to SVC mode
* The 'lr_offset' argument holds the adjustment. It differs based on * The 'lr_offset' argument holds the adjustment.
* which mode the CPU is in. *
* When an instruction causes the ARM core to enter the exception handler
* the value of pc is stored in the link register (lr). By default on ARM
* the program counter is 3 instruction a head of the current instruction
* being executed (because of the 3 stage pipeline). Depending on where in
* the pipeline the exception happens lr will need to de adjusted to find
* the proper return address.
*/ */
.macro switch_to_svc lr_offset .macro switch_to_svc lr_offset
sub lr, lr, #\lr_offset sub lr, lr, #\lr_offset /* do the adjustment */
srsdb sp!, #MODE_SVC srsdb sp!, #MODE_SVC /* store the saved the return */
cps #MODE_SVC /* address and program status */
/* register onto the kernel stack */
/* Also modify the stack pointer. */
cps #MODE_SVC /* do the switch to SVC. */
.endm .endm
/* /*
* Test if the exception/interrupt occured in the kernel. * Test if the exception/interrupt occurred in the kernel.
* Jump to 'label' argument if it occurred in the kernel. * Jump to 'label' argument if it occurred in the kernel.
* *
* NOTE: switch_to_svc must be called first * NOTE: switch_to_svc must be called first */
*/
.macro test_int_in_kernel, label .macro test_int_in_kernel, label
push {r3} push {r3}
ldr r3, [sp, #8] /* spsr */ ldr r3, [sp, #8] /* get spsr. */
orr r3, r3, #(PSR_F | PSR_I) /* mask interrupts on return */ orr r3, r3, #(PSR_F | PSR_I) /* mask interrupts on return. */
str r3, [sp, #8] /* spsr */ str r3, [sp, #8] /* store spsr. */
and r3, r3, #PSR_MODE_MASK and r3, r3, #PSR_MODE_MASK /* mask the ARM mode. */
cmp r3, #MODE_USR cmp r3, #MODE_USR /* compare it to user mode. */
pop {r3} pop {r3}
bne \label /* In-kernel handling */ bne \label /* In-kernel handling. */
.endm .endm
/* Save the register context to the proc structure */ /* Save the register context to the proc structure */
.macro save_process_ctx .macro save_process_ctx
add sp, sp, #8 /* srsdb pushed cpsr and pc on the stack */ add sp, sp, #8 /* We expect srsdb pushed cpsr and lr on */
ldr lr, [sp] /* lr = proc_ptr */ /* the stack. */
stm lr, {r0-r14}^ /* proc_ptr->p_reg.r0-r14 = r0-r14 */ ldr lr, [sp] /* lr = proc_ptr. */
ldr r12, [sp, #-8] /* r12 = pc stored on the stack */ stm lr, {r0-r14}^ /* store the user mode registers */
str r12, [lr, #PCREG] /* proc_ptr->p_reg.pc = r12 */ /* proc_ptr->p_reg.r0-r14 = r0-r14. */
ldr r12, [sp, #-4] /* r12 = cpsr stored on the stack */ ldr r12, [sp, #-8] /* r12 = pc stored on the stack. */
str r12, [lr, #PSREG] /* proc_ptr->p_reg.psr = r12 */ str r12, [lr, #PCREG] /* proc_ptr->p_reg.pc = r12. */
ldr r12, [sp, #-4] /* r12 = cpsr stored on the stack. */
str r12, [lr, #PSREG] /* proc_ptr->p_reg.psr = r12. */
.endm .endm
.macro exception_handler exc_name, exc_num, lr_offset .macro exception_handler exc_name, exc_num, lr_offset
@ -80,14 +90,13 @@ ENTRY(\exc_name\()_entry)
\exc_name\()entry_from_user: \exc_name\()entry_from_user:
save_process_ctx save_process_ctx
/* save the pointer to the current process */ ldr fp, [sp] /* save the pointer to the current process. */
ldr fp, [sp] add r4, fp, #PCREG /* save the exception pc (saved lr_user) */
/* save the exception pc (saved lr_user) */ /* r4-r9 are callee save. */
add r4, fp, #PCREG
/* stop user process cycles */ /* stop user process cycles */
mov r0, fp /* first param: caller proc ptr */ mov r0, fp /* first param: caller proc ptr. */
mov fp, #0 /* for stack trace */ mov fp, #0 /* for stack trace. */
bl _C_LABEL(context_stop) bl _C_LABEL(context_stop)
/* /*
@ -95,17 +104,16 @@ ENTRY(\exc_name\()_entry)
* vector number pushed by the vector handler just before calling * vector number pushed by the vector handler just before calling
* exception_entry and call the exception handler. * exception_entry and call the exception handler.
*/ */
mov r0, #0 /* it's not a nested exception */ mov r0, #0 /* it is not a nested exception. */
mov r1, r4 /* saved lr */ mov r1, r4 /* saved lr. */
mov r2, #\exc_num /* vector number */ mov r2, #\exc_num /* vector number */
bl _C_LABEL(exception_handler) bl _C_LABEL(exception_handler)
b _C_LABEL(switch_to_user) b _C_LABEL(switch_to_user)
\exc_name\()_entry_nested: \exc_name\()_entry_nested:
push {r0-r12, lr} push {r0-r12, lr}
mov r0, #1 /* it's a nested exception */ mov r0, #1 /* it is a nested exception. */
add r1, sp, #56 /* saved lr */ add r1, sp, #56 /* saved lr */
mov r2, #\exc_num /* vector number */ mov r2, #\exc_num /* vector number */
bl _C_LABEL(exception_handler) bl _C_LABEL(exception_handler)
pop {r0-r12, lr} pop {r0-r12, lr}
@ -129,22 +137,20 @@ irq_entry_from_user:
/* save the pointer to the current process */ /* save the pointer to the current process */
ldr fp, [sp] ldr fp, [sp]
push {fp} /* save caller proc ptr */ push {fp} /* save caller proc ptr. */
sub sp, sp, #4 /* maintain stack alignment */ sub sp, sp, #4 /* maintain stack alignment. */
/* stop user process cycles */ /* stop user process cycles */
mov r0, fp /* first param: caller proc ptr */ mov r0, fp /* first param: caller proc ptr. */
mov fp, #0 /* for stack trace */ mov fp, #0 /* for stack trace. */
bl _C_LABEL(context_stop) bl _C_LABEL(context_stop)
/* call handler */ /* call handler */
bl _C_LABEL(bsp_irq_handle) /* bsp_irq_handle(void) */ bl _C_LABEL(bsp_irq_handle) /* bsp_irq_handle(void) */
add sp, sp, #4 add sp, sp, #4
pop {fp} /* caller proc ptr */ pop {fp} /* caller proc ptr. */
dsb /* data synchronization barrier. */
/* data synchronization barrier */
dsb
b _C_LABEL(switch_to_user) b _C_LABEL(switch_to_user)
@ -153,11 +159,9 @@ irq_entry_from_kernel:
bl _C_LABEL(context_stop_idle) bl _C_LABEL(context_stop_idle)
/* call handler */ /* call handler */
bl _C_LABEL(bsp_irq_handle) /* bsp_irq_handle(void) */ bl _C_LABEL(bsp_irq_handle) /* bsp_irq_handle(void). */
/* data synchronization barrier */
dsb
/* data synchronization barrier */ dsb
pop {r0-r12, lr} pop {r0-r12, lr}
rfeia sp! rfeia sp!
@ -166,6 +170,7 @@ irq_entry_from_kernel:
* supervisor call (SVC) kernel entry point * supervisor call (SVC) kernel entry point
*/ */
ENTRY(svc_entry) ENTRY(svc_entry)
/* Store the LR and the SPSR of the current mode onto the SVC stack */
srsdb sp!, #MODE_SVC srsdb sp!, #MODE_SVC
save_process_ctx save_process_ctx
@ -187,20 +192,20 @@ ENTRY(svc_entry)
*/ */
ENTRY(kernel_call_entry) ENTRY(kernel_call_entry)
/* /*
* pass the syscall arguments from userspace to the handler. * pass the syscall arguments from userspace to the handler.
* save_process_ctx() does not clobber these registers, they are still * save_process_ctx() does not clobber these registers, they are still
* set as the userspace has set them * set as the userspace has set them.
*/ */
push {fp} /* save caller proc ptr */ push {fp} /* save caller proc ptr. */
push {r0} /* save msg ptr so it's not clobbered */ push {r0} /* save msg ptr so it's not clobbered. */
/* stop user process cycles */ /* stop user process cycles */
mov r0, fp /* first param: caller proc ptr */ mov r0, fp /* first param: caller proc ptr */
mov fp, #0 /* for stack trace */ mov fp, #0 /* for stack trace */
bl _C_LABEL(context_stop) bl _C_LABEL(context_stop)
pop {r0} /* first param: msg ptr */ pop {r0} /* first param: msg ptr. */
pop {r1} /* second param: caller proc ptr */ pop {r1} /* second param: caller proc ptr. */
bl _C_LABEL(kernel_call) bl _C_LABEL(kernel_call)
b _C_LABEL(switch_to_user) b _C_LABEL(switch_to_user)
@ -214,19 +219,19 @@ ENTRY(ipc_entry)
* save_process_ctx() does not clobber these registers, they are still * save_process_ctx() does not clobber these registers, they are still
* set as the userspace have set them * set as the userspace have set them
*/ */
push {fp} /* save caller proc ptr */ push {fp} /* save caller proc ptr. */
push {r0-r2} /* save regs so they're not clobbered */ push {r0-r2} /* save regs so they're not clobbered. */
/* stop user process cycles */ /* stop user process cycles */
mov r0, fp /* first param: caller proc ptr */ mov r0, fp /* first param: caller proc ptr. */
mov fp, #0 /* for stack trace */ mov fp, #0 /* for stack trace. */
bl _C_LABEL(context_stop) bl _C_LABEL(context_stop)
pop {r0-r2} /* restore regs */ pop {r0-r2} /* restore regs */
bl _C_LABEL(do_ipc) bl _C_LABEL(do_ipc)
/* restore the current process pointer and save the return value */ /* restore the current process pointer and save the return value */
pop {fp} /* caller proc ptr */ pop {fp} /* caller proc ptr. */
str r0, [fp, #REG0] str r0, [fp, #REG0]
b _C_LABEL(switch_to_user) b _C_LABEL(switch_to_user)
@ -240,7 +245,7 @@ ENTRY(restore_user_context)
/* Set SPSR and LR for return */ /* Set SPSR and LR for return */
ldr r0, [sp, #PSREG] ldr r0, [sp, #PSREG]
msr spsr_fsxc, r0 msr spsr_fsxc, r0 /* flags , status, extension control. */
ldr lr, [sp, #PCREG] ldr lr, [sp, #PCREG]
/* Restore user-mode registers from proc struct */ /* Restore user-mode registers from proc struct */
@ -250,7 +255,7 @@ ENTRY(restore_user_context)
ldr sp, [sp] ldr sp, [sp]
/* To user mode! */ /* To user mode! */
movs pc, lr movs pc, lr /* preferred way of returning from svc */
/*===========================================================================*/ /*===========================================================================*/
/* data */ /* data */

View file

@ -75,6 +75,7 @@ int booting_cpu = 0;
void prot_init() void prot_init()
{ {
/* tell the HW where we stored our vector table */
write_vbar((reg_t)&exc_vector_table); write_vbar((reg_t)&exc_vector_table);
/* Set up a new post-relocate bootstrap pagetable so that /* Set up a new post-relocate bootstrap pagetable so that