| 1 | #include "../PicoInt.h" |
| 2 | |
| 3 | // x: 0x03c - 0x19d |
| 4 | // y: 0x1fc - 0x2f7 |
| 5 | // 0x2f8 - 0x3f3 |
| 6 | picohw_state PicoPicohw; |
| 7 | |
| 8 | static int prev_line_cnt_irq3 = 0, prev_line_cnt_irq5 = 0; |
| 9 | static int fifo_bytes_line = (16000<<16)/60/262/2; |
| 10 | |
| 11 | PICO_INTERNAL void PicoReratePico(void) |
| 12 | { |
| 13 | int rate = (PicoPicohw.r12 & 0xf) ? 16000 : 8000; |
| 14 | if (Pico.m.pal) |
| 15 | fifo_bytes_line = (rate<<16)/50/312/2; |
| 16 | else fifo_bytes_line = (rate<<16)/60/262/2; |
| 17 | PicoPicoPCMRerate(rate); |
| 18 | } |
| 19 | |
| 20 | static void PicoLinePico(int count) |
| 21 | { |
| 22 | PicoPicohw.line_counter += count; |
| 23 | |
| 24 | #if 1 |
| 25 | if ((PicoPicohw.r12 & 0x4003) && PicoPicohw.line_counter - prev_line_cnt_irq3 > 200) { |
| 26 | prev_line_cnt_irq3 = PicoPicohw.line_counter; |
| 27 | // just a guess/hack, allows 101 Dalmantians to boot |
| 28 | elprintf(EL_ANOMALY, "irq3"); |
| 29 | SekInterrupt(3); |
| 30 | return; |
| 31 | } |
| 32 | |
| 33 | if (PicoPicohw.fifo_bytes == 16) { |
| 34 | prev_line_cnt_irq3 = PicoPicohw.line_counter; |
| 35 | elprintf(EL_ANOMALY, "irq3, fb=%i", PicoPicohw.fifo_bytes); |
| 36 | SekInterrupt(3); |
| 37 | PicoPicohw.fifo_bytes--; |
| 38 | return; |
| 39 | } |
| 40 | #endif |
| 41 | |
| 42 | if (PicoPicohw.fifo_bytes > 0) |
| 43 | { |
| 44 | PicoPicohw.fifo_line_bytes += fifo_bytes_line * count; |
| 45 | if (PicoPicohw.fifo_line_bytes >= (1<<16)) { |
| 46 | PicoPicohw.fifo_bytes -= PicoPicohw.fifo_line_bytes >> 16; |
| 47 | PicoPicohw.fifo_line_bytes &= 0xffff; |
| 48 | if (PicoPicohw.fifo_bytes < 0) |
| 49 | PicoPicohw.fifo_bytes = 0; |
| 50 | } |
| 51 | } |
| 52 | else |
| 53 | PicoPicohw.fifo_line_bytes = 0; |
| 54 | |
| 55 | #if 0 |
| 56 | if (PicoPicohw.line_counter - prev_line_cnt_irq5 > 512) { |
| 57 | prev_line_cnt_irq5 = PicoPicohw.line_counter; |
| 58 | elprintf(EL_ANOMALY, "irq5"); |
| 59 | SekInterrupt(5); |
| 60 | } |
| 61 | #endif |
| 62 | } |
| 63 | |
| 64 | static void PicoResetPico(void) |
| 65 | { |
| 66 | PicoPicoPCMReset(); |
| 67 | PicoPicohw.xpcm_ptr = PicoPicohw.xpcm_buffer; |
| 68 | } |
| 69 | |
| 70 | PICO_INTERNAL int PicoInitPico(void) |
| 71 | { |
| 72 | elprintf(EL_STATUS, "Pico detected"); |
| 73 | PicoLineHook = PicoLinePico; |
| 74 | PicoResetHook = PicoResetPico; |
| 75 | |
| 76 | PicoAHW = PAHW_PICO; |
| 77 | memset(&PicoPicohw, 0, sizeof(PicoPicohw)); |
| 78 | PicoPicohw.pen_pos[0] = 0x03c + 320/2; |
| 79 | PicoPicohw.pen_pos[1] = 0x200 + 240/2; |
| 80 | prev_line_cnt_irq3 = prev_line_cnt_irq5 = 0; |
| 81 | |
| 82 | // map version register |
| 83 | PicoDetectRegion(); |
| 84 | switch (Pico.m.hardware >> 6) { |
| 85 | case 0: PicoPicohw.r1 = 0x00; break; |
| 86 | case 1: PicoPicohw.r1 = 0x00; break; |
| 87 | case 2: PicoPicohw.r1 = 0x40; break; |
| 88 | case 3: PicoPicohw.r1 = 0x20; break; |
| 89 | } |
| 90 | |
| 91 | return 0; |
| 92 | } |
| 93 | |