1 #include "../PicoInt.h"
6 picohw_state PicoPicohw;
8 static int prev_line_cnt_irq3 = 0, prev_line_cnt_irq5 = 0;
9 static int fifo_bytes_line = (16000<<16)/60/262/2; // fifo bytes/line. FIXME: other rates, modes
11 PICO_INTERNAL void PicoReratePico(void)
14 fifo_bytes_line = (16000<<16)/50/312/2;
15 else fifo_bytes_line = (16000<<16)/60/262/2;
19 static void PicoLinePico(int count)
21 PicoPicohw.line_counter += count;
24 if ((PicoPicohw.r12 & 0x4003) && PicoPicohw.line_counter - prev_line_cnt_irq3 > 200) {
25 prev_line_cnt_irq3 = PicoPicohw.line_counter;
26 // just a guess/hack, allows 101 Dalmantians to boot
27 elprintf(EL_ANOMALY, "irq3");
32 if (PicoPicohw.fifo_bytes == 16) {
33 prev_line_cnt_irq3 = PicoPicohw.line_counter;
34 elprintf(EL_ANOMALY, "irq3, fb=%i", PicoPicohw.fifo_bytes);
36 PicoPicohw.fifo_bytes--;
41 if (PicoPicohw.fifo_bytes > 0)
43 PicoPicohw.fifo_line_bytes += fifo_bytes_line * count;
44 if (PicoPicohw.fifo_line_bytes >= (1<<16)) {
45 PicoPicohw.fifo_bytes -= PicoPicohw.fifo_line_bytes >> 16;
46 PicoPicohw.fifo_line_bytes &= 0xffff;
47 if (PicoPicohw.fifo_bytes < 0)
48 PicoPicohw.fifo_bytes = 0;
52 PicoPicohw.fifo_line_bytes = 0;
55 if (PicoPicohw.line_counter - prev_line_cnt_irq5 > 512) {
56 prev_line_cnt_irq5 = PicoPicohw.line_counter;
57 elprintf(EL_ANOMALY, "irq5");
63 static void PicoResetPico(void)
66 PicoPicohw.xpcm_ptr = PicoPicohw.xpcm_buffer;
69 PICO_INTERNAL int PicoInitPico(void)
71 elprintf(EL_STATUS, "Pico detected");
72 PicoLineHook = PicoLinePico;
73 PicoResetHook = PicoResetPico;
76 memset(&PicoPicohw, 0, sizeof(PicoPicohw));
77 PicoPicohw.pen_pos[0] = 0x03c + 352/2;
78 PicoPicohw.pen_pos[1] = 0x200 + 252/2;
79 prev_line_cnt_irq3 = prev_line_cnt_irq5 = 0;
81 // map version register
83 switch (Pico.m.hardware >> 6) {
84 case 0: PicoPicohw.r1 = 0x00; break;
85 case 1: PicoPicohw.r1 = 0x00; break;
86 case 2: PicoPicohw.r1 = 0x40; break;
87 case 3: PicoPicohw.r1 = 0x20; break;