X-Git-Url: https://notaz.gp2x.de/cgi-bin/gitweb.cgi?a=blobdiff_plain;f=testpico%2Fsh2_test.sh2;h=0201827f5b83c24be2f17a7edb32df2fde19bbbc;hb=6474d733133dc605ee02e4e2e02f025c41d202df;hp=1f3d61a40c9a0000c332af02bfaf4b365cf2071a;hpb=71b41fddd18f66c99e13f53bd78582627e6ff10b;p=megadrive.git diff --git a/testpico/sh2_test.sh2 b/testpico/sh2_test.sh2 index 1f3d61a..0201827 100644 --- a/testpico/sh2_test.sh2 +++ b/testpico/sh2_test.sh2 @@ -17,21 +17,21 @@ .long master_e11 /* NMI vector */ .long master_e12 /* User break vector */ .rept 19 - .long main_err /* reserved */ + .long master_err /* reserved */ .endr .rept 32 - .long main_err /* TRAPA #32-63 */ + .long master_err /* TRAPA #32-63 */ .endr - .long main_irq /* Level 1 IRQ */ - .long main_irq /* Level 2 & 3 IRQ's */ - .long main_irq /* Level 4 & 5 IRQ's */ - .long main_irq /* PWM interupt */ - .long main_irq /* Command interupt */ - .long main_irq /* H Blank interupt */ - .long main_irq /* V Blank interupt */ - .long main_irq /* Reset Button */ + .long master_irq0 /* Level 1 IRQ */ + .long master_irq1 /* Level 2 & 3 IRQ's */ + .long master_irq2 /* Level 4 & 5 IRQ's */ + .long master_irq3 /* PWM interupt */ + .long master_irq4 /* Command interupt */ + .long master_irq5 /* H Blank interupt */ + .long master_irq6 /* V Blank interupt */ + .long master_irq7 /* Reset Button */ .rept 56 - .long main_err /* peripherals */ + .long master_err /* peripherals */ .endr ! Slave Vector Base Table at 0x06000200 @@ -55,14 +55,14 @@ .rept 32 .long slave_err /* TRAPA #32-63 */ .endr - .long slave_irq /* Level 1 IRQ */ - .long slave_irq /* Level 2 & 3 IRQ's */ - .long slave_irq /* Level 4 & 5 IRQ's */ - .long slave_irq /* PWM interupt */ - .long slave_irq /* Command interupt */ - .long slave_irq /* H Blank interupt */ - .long slave_irq /* V Blank interupt */ - .long slave_irq /* Reset Button */ + .long slave_irq0 /* Level 1 IRQ */ + .long slave_irq1 /* Level 2 & 3 IRQ's */ + .long slave_irq2 /* Level 4 & 5 IRQ's */ + .long slave_irq3 /* PWM interupt */ + .long slave_irq4 /* Command interupt */ + .long slave_irq5 /* H Blank interupt */ + .long slave_irq6 /* V Blank interupt */ + .long slave_irq7 /* Reset Button */ .rept 56 .long slave_err /* peripherals */ .endr @@ -100,26 +100,47 @@ xstart: mov.b @r1, r0 mov_bc 0x01, 0, r1 /* enable */ .endif - mov #0xd0, r0 /* enable irqs */ + mov #0x10, r0 /* enable irqs, 0 causes endless irq */ ldc r0, sr mov.l l_main_c, r0 jmp @r0 nop -main_irq: - mov.l r0, @-r15 +! r0=vector_number +do_irq_master: + mov.b r0, @(0x2c, gbr) + mov.l r1, @-r15 + mov.l l_irq_cnt, r1 /* counters in fb (0x2401ff00) */ - stc sr, r0 /* SR holds IRQ level in I3-I0 */ +do_irq_cmn: + mov.l r2, @-r15 + mov #0x80, r0 + mov.b r0, @(0, gbr) /* FM=1 */ + mov.b r0, @(0, gbr) /* flush write buf */ + stc sr, r0 /* SR holds IRQ level in I3-I0 */ shlr2 r0 - and #0x38,r0 - cmp/eq #0x38,r0 - bt main_irq_vres -! todo -0: - bra 0b + shlr2 r0 + and #0x0e, r0 + mov r0, r2 + add r1, r0 + mov.w @r0, r1 + add #1, r1 + mov.w r1, @r0 + mova l_irq_ao, r0 + mov.w @(r0, r2), r0 + stc gbr, r1 + mov.w r0, @(r0, r1) /* ack */ + mov #0x80, r0 + mov.b r0, @(0, gbr) /* FM=1 and flush writebuf (alt: ~20 nops) */ + mov.l @r15+, r2 + mov.l @r15+, r1 + mov.l @r15+, r0 + rte nop -main_irq_vres: +! not used +.if 0 +main_irq_vres_: mov.w r0, @(0x14, gbr) /* ack */ mov.b @(7, gbr), r0 /* RV */ tst #1, r0 @@ -146,8 +167,10 @@ main_irq_vres: nop main_irq_ret: - rte mov.l @r15+, r0 + rte + nop +.endif .global _read_frt _read_frt: @@ -160,26 +183,38 @@ _read_frt: rts or r1, r0 -.align 2 -l_cctl: - .long 0xFFFFFE92 -l_frt: - .long 0xFFFFFE10 -l_main_c: - .long _main_c - ! dummy .global _start _start: -main_err: +master_err: bra do_exc_master mov #0xff, r0 slave_err: -slave_irq: bra do_exc_slave mov #0xff, r0 +! r0=vector_number +do_irq_slave: + mov.b r0, @(0x2d, gbr) + mov.l r1, @-r15 + mov.l l_irq_cnt, r1 /* counters in fb (0x2401ff00) */ + bra do_irq_cmn + add #0x10, r1 + +.align 2 +l_cctl: + .long 0xFFFFFE92 +l_frt: + .long 0xFFFFFE10 +l_main_c: + .long _main_c +l_irq_cnt: + .long 0x2401ff00 +l_irq_ao: + /* ?, ?, ?, pwm, cmd, h, v, rst */ + .word 0x0e, 0x0e, 0x0e, 0x1c, 0x1a, 0x18, 0x16, 0x14 + .macro exc_master num master_e\num: bra do_exc_master @@ -192,6 +227,20 @@ slave_e\num: mov #\num, r0 .endm +.macro irq_master num +master_irq\num: + mov.l r0, @-r15 + bra do_irq_master + mov #\num, r0 +.endm + +.macro irq_slave num +slave_irq\num: + mov.l r0, @-r15 + bra do_irq_slave + mov #\num, r0 +.endm + exc_master 4 exc_master 5 exc_master 6 @@ -201,6 +250,14 @@ exc_master 9 exc_master 10 exc_master 11 exc_master 12 +irq_master 0 +irq_master 1 +irq_master 2 +irq_master 3 +irq_master 4 +irq_master 5 +irq_master 6 +irq_master 7 exc_slave 4 exc_slave 5 @@ -211,15 +268,23 @@ exc_slave 9 exc_slave 10 exc_slave 11 exc_slave 12 +irq_slave 0 +irq_slave 1 +irq_slave 2 +irq_slave 3 +irq_slave 4 +irq_slave 5 +irq_slave 6 +irq_slave 7 do_exc_master: - mov.w r0, @(0x2c, gbr) + mov.b r0, @(0x2e, gbr) 0: bra 0b nop do_exc_slave: - mov.w r0, @(0x2e, gbr) + mov.b r0, @(0x2f, gbr) 0: bra 0b nop