| [3ae31e9] | 1 | * ------------------------------------------------------------------------------
|
|---|
| 2 | * mtints.s -- Multi-Tasker -- first level interrupt handlers
|
|---|
| 3 | * Version 11 -- 1988-04-15 -- D.N. Lynx Crowe
|
|---|
| 4 | * (c) Copyright 1988 -- D.N. Lynx Crowe
|
|---|
| 5 | * ------------------------------------------------------------------------------
|
|---|
| 6 | *
|
|---|
| 7 | .text
|
|---|
| 8 | *
|
|---|
| 9 | DEBUGGER .equ 0 * define non-zero for any debug
|
|---|
| 10 | *
|
|---|
| 11 | DEBUG_I1 .equ 0 * define non-zero for int1 debug
|
|---|
| 12 | DEBUG_I2 .equ 0 * define non-zero for int2 debug
|
|---|
| 13 | DEBUG_I3 .equ 0 * define non-zero for int3 debug
|
|---|
| 14 | DEBUG_I4 .equ 0 * define non-zero for int4 debug
|
|---|
| 15 | DEBUG_I5 .equ 0 * define non-zero for int5 debug
|
|---|
| 16 | *
|
|---|
| 17 | .xdef MTInt1
|
|---|
| 18 | .xdef MTInt2
|
|---|
| 19 | .xdef MTInt3
|
|---|
| 20 | .xdef MTInt4
|
|---|
| 21 | .xdef MTInt5
|
|---|
| 22 | *
|
|---|
| 23 | .ifne DEBUGGER
|
|---|
| 24 | *
|
|---|
| 25 | .xref _DB_Cmnt * debug comment function
|
|---|
| 26 | *
|
|---|
| 27 | .endc
|
|---|
| 28 | *
|
|---|
| 29 | .xref MT_ITCB1
|
|---|
| 30 | .xref MT_ITCB2
|
|---|
| 31 | .xref MT_ITCB3
|
|---|
| 32 | .xref MT_ITCB4
|
|---|
| 33 | .xref MT_ITCB5
|
|---|
| 34 | *
|
|---|
| 35 | .xref MT_ISEM1
|
|---|
| 36 | .xref MT_ISEM2
|
|---|
| 37 | .xref MT_ISEM3
|
|---|
| 38 | .xref MT_ISEM4
|
|---|
| 39 | .xref MT_ISEM5
|
|---|
| 40 | *
|
|---|
| 41 | .xref MT_Enq
|
|---|
| 42 | *
|
|---|
| 43 | .xref _MT_CurP
|
|---|
| 44 | .xref _MT_RdyQ
|
|---|
| 45 | *
|
|---|
| 46 | .page
|
|---|
| 47 | *
|
|---|
| 48 | * TCB offsets ('NEXT' must be the first thing in the TCB)
|
|---|
| 49 | * -----------
|
|---|
| 50 | NEXT .equ 0 * LONG - next TCB in queue
|
|---|
| 51 | FWD .equ NEXT+4 * LONG - next TCB in chain
|
|---|
| 52 | TID .equ FWD+4 * WORD - task ID
|
|---|
| 53 | PRI .equ TID+2 * WORD - task priority
|
|---|
| 54 | SLICE .equ PRI+2 * LONG - slice time limit
|
|---|
| 55 | REGS .equ SLICE+4 * LONG[16] - registers
|
|---|
| 56 | TCB_SP .equ REGS+64 * LONG - stack pointer
|
|---|
| 57 | TCB_PC .equ TCB_SP+4 * LONG - program counter
|
|---|
| 58 | TCB_SR .equ TCB_PC+4 * WORD - status register
|
|---|
| 59 | FLAGS .equ TCB_SR+2 * WORD - task flags
|
|---|
| 60 | TOS .equ FLAGS+2 * LONG - top of stack
|
|---|
| 61 | *
|
|---|
| 62 | TCB_A6 .equ REGS+56 * LONG - task a6 image
|
|---|
| 63 | TCB_A7 .equ REGS+60 * LONG - task a7 image
|
|---|
| 64 | *
|
|---|
| 65 | TCBLEN .equ TOS+4 * length of TCB
|
|---|
| 66 | *
|
|---|
| 67 | * TCB flags
|
|---|
| 68 | * ---------
|
|---|
| 69 | MTF_RDY .equ $0001 * 'ready' bit
|
|---|
| 70 | NOT_RDY .equ $FFFE * 'ready' bit complement
|
|---|
| 71 | MTF_SWT .equ $0002 * 'wait' bit
|
|---|
| 72 | NOT_SWT .equ $FFFD * 'wait' bit complement
|
|---|
| 73 | MTF_RUN .equ $0004 * 'run' bit
|
|---|
| 74 | NOT_RUN .equ $FFFB * 'run' bit complement
|
|---|
| 75 | MTF_STP .equ $0008 * 'stop' bit
|
|---|
| 76 | NOT_STP .equ $FFF7 * 'stop' bit complement
|
|---|
| 77 | *
|
|---|
| 78 | * Miscellaneous definitions
|
|---|
| 79 | * -------------------------
|
|---|
| 80 | IPL7 .equ $0700 * processor IPL 7 mask
|
|---|
| 81 | *
|
|---|
| 82 | RPRV .equ a1 * previous TCB pointer
|
|---|
| 83 | RCUR .equ a2 * current TCB pointer
|
|---|
| 84 | RNXT .equ a3 * next TCB pointer
|
|---|
| 85 | RTCP .equ a6 * general TCB pointer
|
|---|
| 86 | *
|
|---|
| 87 | RPRI .equ d0 * task priority
|
|---|
| 88 | *
|
|---|
| 89 | .page
|
|---|
| 90 | *
|
|---|
| 91 | * MTInt1 -- Level 1 -- VSDD frame interrupt
|
|---|
| 92 | * ------ -------------------------------
|
|---|
| 93 | MTInt1: ori.w #IPL7,sr * disable interrupts
|
|---|
| 94 | *
|
|---|
| 95 | .ifne DEBUG_I1
|
|---|
| 96 | movem.l d0-d7/a0-a6,-(a7) * DB_CMNT("MTInt1");
|
|---|
| 97 | move.l #DB_msg1,-(a7) * ...
|
|---|
| 98 | jsr _DB_Cmnt * ...
|
|---|
| 99 | tst.l (a7)+ * ...
|
|---|
| 100 | movem.l (a7)+,d0-d7/a0-a6 * ...
|
|---|
| 101 | .endc
|
|---|
| 102 | *
|
|---|
| 103 | movem.l a6-a7,-(a7) * save a6-a7 on stack
|
|---|
| 104 | movea.l _MT_CurP,RTCP * get the current TCB pointer
|
|---|
| 105 | movem.l d0-d7/a0-a5,REGS(RTCP) * save d0-d7/a0-a5 in the TCB
|
|---|
| 106 | move.l (a7)+,TCB_A6(RTCP) * save a6 in the TCB
|
|---|
| 107 | move.l (a7)+,TCB_A7(RTCP) * save a7 in the TCB
|
|---|
| 108 | move.w (a7)+,TCB_SR(RTCP) * save sr in the TCB
|
|---|
| 109 | move.l (a7)+,TCB_PC(RTCP) * save the pc in the TCB
|
|---|
| 110 | move.l a7,TCB_SP(RTCP) * save the sp in the TCB
|
|---|
| 111 | andi.w #NOT_RUN,FLAGS(RTCP) * turn off its run flag
|
|---|
| 112 | move.w PRI(RTCP),RPRI * get the task priority in RPRI
|
|---|
| 113 | lea _MT_RdyQ,RCUR * get the ready queue pointer
|
|---|
| 114 | lea MT_ITCB1,RNXT * get the interrupt TCB pointer
|
|---|
| 115 | andi.w #NOT_SWT,FLAGS(RNXT) * turn off its wait flag
|
|---|
| 116 | clr.l MT_ISEM1 * clear the interrupt semaphore
|
|---|
| 117 | jmp MT_Enq * go do the task dispatch
|
|---|
| 118 | *
|
|---|
| 119 | .page
|
|---|
| 120 | *
|
|---|
| 121 | * MTInt2 -- Level 2 -- FPU interrupt
|
|---|
| 122 | * ------ ------------------------
|
|---|
| 123 | MTInt2: ori.w #IPL7,sr * disable interrupts
|
|---|
| 124 | *
|
|---|
| 125 | .ifne DEBUG_I2
|
|---|
| 126 | movem.l d0-d7/a0-a6,-(a7) * DB_CMNT("MTInt2");
|
|---|
| 127 | move.l #DB_msg2,-(a7) * ...
|
|---|
| 128 | jsr _DB_Cmnt * ...
|
|---|
| 129 | tst.l (a7)+ * ...
|
|---|
| 130 | movem.l (a7)+,d0-d7/a0-a6 * ...
|
|---|
| 131 | .endc
|
|---|
| 132 | *
|
|---|
| 133 | movem.l a6-a7,-(a7) * save a6-a7 on stack
|
|---|
| 134 | movea.l _MT_CurP,RTCP * get the current TCB pointer
|
|---|
| 135 | movem.l d0-d7/a0-a5,REGS(RTCP) * save d0-d7/a0-a5 in the TCB
|
|---|
| 136 | move.l (a7)+,TCB_A6(RTCP) * save a6 in the TCB
|
|---|
| 137 | move.l (a7)+,TCB_A7(RTCP) * save a7 in the TCB
|
|---|
| 138 | move.w (a7)+,TCB_SR(RTCP) * save sr in the TCB
|
|---|
| 139 | move.l (a7)+,TCB_PC(RTCP) * save the pc in the TCB
|
|---|
| 140 | move.l a7,TCB_SP(RTCP) * save the sp in the TCB
|
|---|
| 141 | andi.w #NOT_RUN,FLAGS(RTCP) * turn off its run flag
|
|---|
| 142 | move.w PRI(RTCP),RPRI * get the task priority in RPRI
|
|---|
| 143 | lea _MT_RdyQ,RCUR * get the ready queue pointer
|
|---|
| 144 | lea MT_ITCB2,RNXT * get the interrupt TCB pointer
|
|---|
| 145 | andi.w #NOT_SWT,FLAGS(RNXT) * turn off its wait flag
|
|---|
| 146 | clr.l MT_ISEM2 * clear the interrupt semaphore
|
|---|
| 147 | jmp MT_Enq * go do the task dispatch
|
|---|
| 148 | *
|
|---|
| 149 | .page
|
|---|
| 150 | *
|
|---|
| 151 | * MTInt3 -- Level 3 -- Analog processor interrupt
|
|---|
| 152 | * ------ -------------------------------------
|
|---|
| 153 | MTInt3: ori.w #IPL7,sr * disable interrupts
|
|---|
| 154 | *
|
|---|
| 155 | .ifne DEBUG_I3
|
|---|
| 156 | movem.l d0-d7/a0-a6,-(a7) * DB_CMNT("MTInt3");
|
|---|
| 157 | move.l #DB_msg3,-(a7) * ...
|
|---|
| 158 | jsr _DB_Cmnt * ...
|
|---|
| 159 | tst.l (a7)+ * ...
|
|---|
| 160 | movem.l (a7)+,d0-d7/a0-a6 * ...
|
|---|
| 161 | .endc
|
|---|
| 162 | *
|
|---|
| 163 | movem.l a6-a7,-(a7) * save a6-a7 on stack
|
|---|
| 164 | movea.l _MT_CurP,RTCP * get the current TCB pointer
|
|---|
| 165 | movem.l d0-d7/a0-a5,REGS(RTCP) * save d0-d7/a0-a5 in the TCB
|
|---|
| 166 | move.l (a7)+,TCB_A6(RTCP) * save a6 in the TCB
|
|---|
| 167 | move.l (a7)+,TCB_A7(RTCP) * save a7 in the TCB
|
|---|
| 168 | move.w (a7)+,TCB_SR(RTCP) * save sr in the TCB
|
|---|
| 169 | move.l (a7)+,TCB_PC(RTCP) * save the pc in the TCB
|
|---|
| 170 | move.l a7,TCB_SP(RTCP) * save the sp in the TCB
|
|---|
| 171 | andi.w #NOT_RUN,FLAGS(RTCP) * turn off its run flag
|
|---|
| 172 | move.w PRI(RTCP),RPRI * get the task priority in RPRI
|
|---|
| 173 | lea _MT_RdyQ,RCUR * get the ready queue pointer
|
|---|
| 174 | lea MT_ITCB3,RNXT * get the interrupt TCB pointer
|
|---|
| 175 | andi.w #NOT_SWT,FLAGS(RNXT) * turn off its wait flag
|
|---|
| 176 | clr.l MT_ISEM3 * clear the interrupt semaphore
|
|---|
| 177 | jmp MT_Enq * go do the task dispatch
|
|---|
| 178 | *
|
|---|
| 179 | .page
|
|---|
| 180 | *
|
|---|
| 181 | * MTInt4 -- Level 4 -- Timer interrupt
|
|---|
| 182 | * ------ --------------------------
|
|---|
| 183 | MTInt4: ori.w #IPL7,sr * disable interrupts
|
|---|
| 184 | *
|
|---|
| 185 | .ifne DEBUG_I4
|
|---|
| 186 | movem.l d0-d7/a0-a6,-(a7) * DB_CMNT("MTInt4");
|
|---|
| 187 | move.l #DB_msg4,-(a7) * ...
|
|---|
| 188 | jsr _DB_Cmnt * ...
|
|---|
| 189 | tst.l (a7)+ * ...
|
|---|
| 190 | movem.l (a7)+,d0-d7/a0-a6 * ...
|
|---|
| 191 | .endc
|
|---|
| 192 | *
|
|---|
| 193 | movem.l a6-a7,-(a7) * save a6-a7 on stack
|
|---|
| 194 | movea.l _MT_CurP,RTCP * get the current TCB pointer
|
|---|
| 195 | movem.l d0-d7/a0-a5,REGS(RTCP) * save d0-d7/a0-a5 in the TCB
|
|---|
| 196 | move.l (a7)+,TCB_A6(RTCP) * save a6 in the TCB
|
|---|
| 197 | move.l (a7)+,TCB_A7(RTCP) * save a7 in the TCB
|
|---|
| 198 | move.w (a7)+,TCB_SR(RTCP) * save sr in the TCB
|
|---|
| 199 | move.l (a7)+,TCB_PC(RTCP) * save the pc in the TCB
|
|---|
| 200 | move.l a7,TCB_SP(RTCP) * save the sp in the TCB
|
|---|
| 201 | andi.w #NOT_RUN,FLAGS(RTCP) * turn off its run flag
|
|---|
| 202 | move.w PRI(RTCP),RPRI * get the task priority in RPRI
|
|---|
| 203 | lea _MT_RdyQ,RCUR * get the ready queue pointer
|
|---|
| 204 | lea MT_ITCB4,RNXT * get the interrupt TCB pointer
|
|---|
| 205 | andi.w #NOT_SWT,FLAGS(RNXT) * turn off its wait flag
|
|---|
| 206 | clr.l MT_ISEM4 * clear the interrupt semaphore
|
|---|
| 207 | jmp MT_Enq * go do the task dispatch
|
|---|
| 208 | *
|
|---|
| 209 | .page
|
|---|
| 210 | *
|
|---|
| 211 | * MTInt5 -- Level 5 -- Serial I/O interrupt
|
|---|
| 212 | * ------ -------------------------------
|
|---|
| 213 | MTInt5: ori.w #IPL7,sr * disable interrupts
|
|---|
| 214 | *
|
|---|
| 215 | .ifne DEBUG_I5
|
|---|
| 216 | movem.l d0-d7/a0-a6,-(a7) * DB_CMNT("MTInt5");
|
|---|
| 217 | move.l #DB_msg5,-(a7) * ...
|
|---|
| 218 | jsr _DB_Cmnt * ...
|
|---|
| 219 | tst.l (a7)+ * ...
|
|---|
| 220 | movem.l (a7)+,d0-d7/a0-a6 * ...
|
|---|
| 221 | .endc
|
|---|
| 222 | *
|
|---|
| 223 | movem.l a6-a7,-(a7) * save a6-a7 on stack
|
|---|
| 224 | movea.l _MT_CurP,RTCP * get the current TCB pointer
|
|---|
| 225 | movem.l d0-d7/a0-a5,REGS(RTCP) * save d0-d7/a0-a5 in the TCB
|
|---|
| 226 | move.l (a7)+,TCB_A6(RTCP) * save a6 in the TCB
|
|---|
| 227 | move.l (a7)+,TCB_A7(RTCP) * save a7 in the TCB
|
|---|
| 228 | move.w (a7)+,TCB_SR(RTCP) * save sr in the TCB
|
|---|
| 229 | move.l (a7)+,TCB_PC(RTCP) * save the pc in the TCB
|
|---|
| 230 | move.l a7,TCB_SP(RTCP) * save the sp in the TCB
|
|---|
| 231 | andi.w #NOT_RUN,FLAGS(RTCP) * turn off its run flag
|
|---|
| 232 | move.w PRI(RTCP),RPRI * get the task priority in RPRI
|
|---|
| 233 | lea _MT_RdyQ,RCUR * get the ready queue pointer
|
|---|
| 234 | lea MT_ITCB5,RNXT * get the interrupt TCB pointer
|
|---|
| 235 | andi.w #NOT_SWT,FLAGS(RNXT) * turn off its wait flag
|
|---|
| 236 | clr.l MT_ISEM5 * clear the interrupt semaphore
|
|---|
| 237 | jmp MT_Enq * go do the task dispatch
|
|---|
| 238 | *
|
|---|
| 239 | .ifne DEBUGGER
|
|---|
| 240 | *
|
|---|
| 241 | .data
|
|---|
| 242 | *
|
|---|
| 243 | DB_msg1: dc.b 'MTInt1',0
|
|---|
| 244 | DB_msg2: dc.b 'MTInt2',0
|
|---|
| 245 | DB_msg3: dc.b 'MTInt3',0
|
|---|
| 246 | DB_msg4: dc.b 'MTInt4',0
|
|---|
| 247 | DB_msg5: dc.b 'MTInt5',0
|
|---|
| 248 | *
|
|---|
| 249 | .endc
|
|---|
| 250 | *
|
|---|
| 251 | .end
|
|---|
![(please configure the [header_logo] section in trac.ini)](http://bob.lopatic.de/chrome/site/logo.png){kind=logo}
