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

add a routine to set interrupt level from C

Browse Source
This commit is contained in:
Markus Fröschle
2013-08-13 15:20:23 +00:00
parent f0f25eac5e
commit 5ebb345478
1 changed files with 26 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

26
BaS_gcc/sources/exceptions.S
View File

@@ -1001,3 +1001,29 @@ video_chg_end:
lea 7 * 4(sp),a7
rte
asm_set_ipl:
_asm_set_ipl:
link a6,#-8 // some space for locals
movem.l d6-d7,(sp) // save register
move.w sr,d7 // current sr
move.l d7,d0 // prepare return value
andi.l #0x0700,d0 // maks out ipl bits
lsr.l #8,d0 // IPL
move.l 8(a6),d6 // get argument
andi.l #0x07,d6 // least significant three bits
lsl.l #8,d6 // shift to make mask
andi.l #0x0000f8ff,d7 // zero out current ipl
or.l d6,d7 // place new ipl in sr
move.w d7,sr
movem.l (sp),d6-d7 // restore registers
lea 8(sp),sp // clear local variables
unlk a6
rts