ldr lr, =PicoCpuS68k
ldr r2, =CycloneEnd_M68k
ldr r3, =CycloneEnd_S68k
- str r2, [r7,#0x54]
- str r3, [lr,#0x54]
+ str r2, [r7,#0x98]
+ str r3, [lr,#0x98]
@ update aims
ldr r8, =SekCycleAim
ldr r9, [r9]
sub r0, r9, r8
- add r3, r3, r3, asr #1
- add r3, r3, r3, asr #3 @ cycn_s68k = (cycn + cycn/2 + cycn/8)
+ mov r2, r3
+ add r3, r3, r2, asr #1
+ add r3, r3, r2, asr #3 @ cycn_s68k = (cycn + cycn/2 + cycn/8)
subs r5, r0, r3, asr #16
ble schedule_m68k @ s68k has not enough cycles
ldr r7, =PicoCpu
ldr lr, =PicoCpuS68k
mov r0, #0
- str r0, [r7,#0x54] @ remove CycloneEnd handler
- str r0, [lr,#0x54]
+ str r0, [r7,#0x98] @ remove CycloneEnd handler
+ str r0, [lr,#0x98]
@ return
add sp, sp, #2*4
ldmfd sp!, {r4-r11,pc}
-
CycloneRunLocal:
;@ r0-3 = Temporary registers
ldr r4,[r7,#0x40] ;@ r4 = Current PC + Memory Base
;@ r7 = Pointer to Cpu Context
;@ r8 = Current Opcode
ldrb r9,[r7,#0x46] ;@ r9 = Flags (NZCV)
- ldr r0,[r7,#0x44]
- mov r9,r9,lsl #28 ;@ r9 = Flags 0xf0000000, cpsr format
+ ldr r1,[r7,#0x44] ;@ get SR high and IRQ level
+ orr r9,r9,r9,lsl #28 ;@ r9 = Flags 0xf0000000, cpsr format
;@ r10 = Source value / Memory Base
;@ CheckInterrupt:
- movs r0,r0,lsr #24 ;@ Get IRQ level
+ movs r0,r1,lsr #24 ;@ Get IRQ level
beq NoIntsLocal
cmp r0,#6 ;@ irq>6 ?
- ldrleb r1,[r7,#0x44] ;@ Get SR high: T_S__III
andle r1,r1,#7 ;@ Get interrupt mask
cmple r0,r1 ;@ irq<=6: Is irq<=mask ?
- blgt CycloneDoInterrupt
-;@ Check if interrupt used up all the cycles:
- subs r5,r5,#0
- ldrlt r1,[r7,#0x54]
- bxlt r1 ;@ jump to alternative CycloneEnd
+ bgt CycloneDoInterrupt
NoIntsLocal:
-;@ Check if our processor is in stopped state and jump to opcode handler if not
- ldr r0,[r7,#0x58]
+;@ Check if our processor is in special state
+;@ and jump to opcode handler if not
+ ldr r0,[r7,#0x58] ;@ state_flags
ldrh r8,[r4],#2 ;@ Fetch first opcode
- tst r0,r0 ;@ stopped?
+ tst r0,#0x03 ;@ special state?
+ andeq r9,r9,#0xf0000000
ldreq pc,[r6,r8,asl #2] ;@ Jump to opcode handler
- @ stopped
- ldr r1,[r7,#0x54]
+CycloneSpecial2:
+ tst r0,#2 ;@ tracing?
+ bne CycloneDoTrace
+;@ stopped or halted
+ sub r4,r4,#2
+ ldr r1,[r7,#0x98]
mov r5,#0
bx r1