6c62131f |
1 | #include <stdio.h> |
2 | #include "../r3000a.h" |
3 | #include "../cdrom.h" |
4 | #include "../psxdma.h" |
5 | #include "../mdec.h" |
6 | #include "events.h" |
7 | |
8 | extern int pending_exception; |
9 | |
10 | //#define evprintf printf |
11 | #define evprintf(...) |
12 | |
13 | u32 event_cycles[PSXINT_COUNT]; |
14 | |
584fc319 |
15 | u32 schedule_timeslice(void) |
6c62131f |
16 | { |
17 | u32 i, c = psxRegs.cycle; |
18 | u32 irqs = psxRegs.interrupt; |
19 | s32 min, dif; |
20 | |
21 | min = PSXCLK; |
22 | for (i = 0; irqs != 0; i++, irqs >>= 1) { |
23 | if (!(irqs & 1)) |
24 | continue; |
25 | dif = event_cycles[i] - c; |
26 | //evprintf(" ev %d\n", dif); |
27 | if (0 < dif && dif < min) |
28 | min = dif; |
29 | } |
30 | next_interupt = c + min; |
584fc319 |
31 | return next_interupt; |
6c62131f |
32 | } |
33 | |
6c62131f |
34 | typedef void (irq_func)(); |
35 | |
36 | static irq_func * const irq_funcs[] = { |
37 | [PSXINT_SIO] = sioInterrupt, |
38 | [PSXINT_CDR] = cdrInterrupt, |
39 | [PSXINT_CDREAD] = cdrPlayReadInterrupt, |
40 | [PSXINT_GPUDMA] = gpuInterrupt, |
41 | [PSXINT_MDECOUTDMA] = mdec1Interrupt, |
42 | [PSXINT_SPUDMA] = spuInterrupt, |
43 | [PSXINT_MDECINDMA] = mdec0Interrupt, |
44 | [PSXINT_GPUOTCDMA] = gpuotcInterrupt, |
45 | [PSXINT_CDRDMA] = cdrDmaInterrupt, |
46 | [PSXINT_CDRLID] = cdrLidSeekInterrupt, |
d3d41455 |
47 | [PSXINT_IRQ10] = irq10Interrupt, |
6c62131f |
48 | [PSXINT_SPU_UPDATE] = spuUpdate, |
49 | [PSXINT_RCNT] = psxRcntUpdate, |
50 | }; |
51 | |
52 | /* local dupe of psxBranchTest, using event_cycles */ |
53 | static void irq_test(psxCP0Regs *cp0) |
54 | { |
55 | u32 cycle = psxRegs.cycle; |
56 | u32 irq, irq_bits; |
57 | |
58 | for (irq = 0, irq_bits = psxRegs.interrupt; irq_bits != 0; irq++, irq_bits >>= 1) { |
59 | if (!(irq_bits & 1)) |
60 | continue; |
61 | if ((s32)(cycle - event_cycles[irq]) >= 0) { |
62 | // note: irq_funcs() also modify psxRegs.interrupt |
63 | psxRegs.interrupt &= ~(1u << irq); |
64 | irq_funcs[irq](); |
65 | } |
66 | } |
67 | |
c41449cb |
68 | cp0->n.Cause &= ~0x400; |
69 | if (psxHu32(0x1070) & psxHu32(0x1074)) |
70 | cp0->n.Cause |= 0x400; |
71 | if (((cp0->n.Cause | 1) & cp0->n.SR & 0x401) == 0x401) { |
72 | psxException(0, 0, cp0); |
6c62131f |
73 | pending_exception = 1; |
74 | } |
75 | } |
76 | |
77 | void gen_interupt(psxCP0Regs *cp0) |
78 | { |
79 | evprintf(" +ge %08x, %u->%u (%d)\n", psxRegs.pc, psxRegs.cycle, |
80 | next_interupt, next_interupt - psxRegs.cycle); |
81 | |
82 | irq_test(cp0); |
83 | //pending_exception = 1; |
84 | |
85 | schedule_timeslice(); |
86 | |
87 | evprintf(" -ge %08x, %u->%u (%d)\n", psxRegs.pc, psxRegs.cycle, |
88 | next_interupt, next_interupt - psxRegs.cycle); |
89 | } |
90 | |
91 | |