Firebee/FireBee_SVN
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

reformat

Browse Source
This commit is contained in:
Markus Fröschle
2015-10-13 05:14:06 +00:00
parent 35d879b698
commit d118796306
1 changed files with 19 additions and 14 deletions
Download Patch File Download Diff File Expand all files Collapse all files

33
if/driver_vec.c
View File

@@ -236,36 +236,41 @@ void remove_handler(void)
*trap_0_vector = (uint32_t) std_exc_vec; *trap_0_vector = (uint32_t) std_exc_vec;
} }
/*
* trap #0 entry point
*
* this is used to retrieve the driver table that gets exposed to the OS by BaS
*/
void __attribute__((interrupt)) get_bas_drivers(void) void __attribute__((interrupt)) get_bas_drivers(void)
{ {
__asm__ __volatile( __asm__ __volatile(
/* /*
* sp should now point to the next instruction after the trap * sp should now point to the next instruction after the trap
* The trap itself is 2 bytes, the four bytes before that must * The trap itself is 2 bytes, the four bytes before that must
* read '_BAS' or we are not meant by this call * read '_BAS', otherwise we are not meant by this call
*/ */
" move.l a0,-(sp) \n\t" // save registers " move.l a0,-(sp) \n\t" // save registers
" move.l d0,-(sp) \n\t" " move.l d0,-(sp) \n\t"
" move.l 12(sp),a0 \n\t" // get return address " move.l 12(sp),a0 \n\t" // get return address
" move.l -6(a0),d0 \n\t" // " move.l -6(a0),d0 \n\t" //
" cmp.l #0x5f424153,d0 \n\t" // is it '_BAS'? " cmp.l #0x5f424153,d0 \n\t" // is it '_BAS'?
" beq fetch_drivers \n\t" // yes " beq fetch_drivers \n\t" // yes
/* /*
* This seems indeed a "normal" trap #0. Better pass control to "normal" trap #0 processing * This seems indeed a "normal" trap #0. Better pass control to "normal" trap #0 processing
* If trap #0 isn't set to something sensible, we'll probably crash here, but this must be * If trap #0 isn't set to something sensible, we'll probably crash here, but this must be
* prevented on the caller side. * prevented on the caller side.
*/ */
" move.l (sp)+,d0 \n\t" // restore registers " move.l (sp)+,d0 \n\t" // restore registers
" move.l (sp)+,a0 \n\t" " move.l (sp)+,a0 \n\t"
" move.l 0x80,-(sp) \n\t" // fetch vector " move.l 0x80,-(sp) \n\t" // fetch vector
" rts \n\t" // and jump through it " rts \n\t" // and jump through it
"fetch_drivers: \n\t" "fetch_drivers: \n\t"
" move.l #%[drivers],d0 \n\t" // return driver struct in d0 " move.l #%[drivers],d0 \n\t" // return driver struct in d0
" addq.l #4,sp \n\t" // adjust stack " addq.l #4,sp \n\t" // adjust stack
" move.l (sp)+,a0 \n\t" // restore register " move.l (sp)+,a0 \n\t" // restore register
: /* no output */ : /* no output */
: [drivers] "o" (bas_drivers) /* input */ : [drivers] "o" (bas_drivers) /* input */
: /* clobber */ : /* clobber */
); );
} }