bugfixes, state load for new mode
[libpicofe.git] / gp2x / 940ctl.c
index a927913..4a571ff 100644 (file)
@@ -33,7 +33,7 @@ _940_ctl_t *shared_ctl = 0;
 unsigned char *mp3_mem = 0;\r
 \r
 #define MP3_SIZE_MAX (0x400000 + 0x800000) // 12M\r
-#define CODE940_FILE "pico940.bin"\r
+#define CODE940_FILE "pico940_v2.bin"\r
 \r
 int crashed_940 = 0;\r
 \r
@@ -51,170 +51,64 @@ static FILE *loaded_mp3 = 0;
 }\r
 \r
 /* these will be managed locally on our side */\r
-extern int   *ym2612_dacen;\r
-extern INT32 *ym2612_dacout;\r
-static UINT8 *REGS = 0;                /* we will also keep local copy of regs for savestates and such */\r
-static INT32 *addr_A1;         /* address line A1      */\r
-\r
-static int   dacen;\r
-static INT32 dacout;\r
 static UINT8 ST_address;       /* address register     */\r
-static UINT8 ST_status;                /* status flag          */\r
-static UINT8 ST_mode;          /* mode  CSM / 3SLOT    */\r
-static int   ST_TA;                    /* timer a              */\r
-static int   ST_TAC;           /* timer a maxval       */\r
-static int   ST_TAT;           /* timer a ticker       */\r
-static UINT8 ST_TB;                    /* timer b              */\r
-static int   ST_TBC;           /* timer b maxval       */\r
-static int   ST_TBT;           /* timer b ticker       */\r
+static INT32 addr_A1;          /* address line A1      */\r
 \r
 static int   writebuff_ptr = 0;\r
 \r
 \r
-/* OPN Mode Register Write */\r
-static int set_timers( int v )\r
-{\r
-       int change;\r
-\r
-       /* b7 = CSM MODE */\r
-       /* b6 = 3 slot mode */\r
-       /* b5 = reset b */\r
-       /* b4 = reset a */\r
-       /* b3 = timer enable b */\r
-       /* b2 = timer enable a */\r
-       /* b1 = load b */\r
-       /* b0 = load a */\r
-       change = (ST_mode ^ v) & 0xc0;\r
-       ST_mode = v;\r
-\r
-       /* reset Timer b flag */\r
-       if( v & 0x20 )\r
-               ST_status &= ~2;\r
-\r
-       /* reset Timer a flag */\r
-       if( v & 0x10 )\r
-               ST_status &= ~1;\r
-\r
-       return change;\r
-}\r
-\r
 /* YM2612 write */\r
 /* a = address */\r
 /* v = value   */\r
 /* returns 1 if sample affecting state changed */\r
-int YM2612Write_940(unsigned int a, unsigned int v)\r
+int YM2612Write_940(unsigned int a, unsigned int v, int scanline)\r
 {\r
-       int addr;\r
        int upd = 1;    /* the write affects sample generation */\r
 \r
-       v &= 0xff;      /* adjust to 8 bit bus */\r
        a &= 3;\r
 \r
        //printf("%05i:%03i: ym w ([%i] %02x)\n", Pico.m.frame_count, Pico.m.scanline, a, v);\r
 \r
-       switch( a ) {\r
-       case 0: /* address port 0 */\r
-               if (!*addr_A1 && ST_address == v)\r
-                       return 0;       /* address already selected, don't send this command to 940 */\r
-               ST_address = v;\r
-               /* don't send DAC or timer related address changes to 940 */\r
-               if (!*addr_A1 && (v & 0xf0) == 0x20 &&\r
-                       (v == 0x24 || v == 0x25 || v == 0x26 || v == 0x2a))\r
+       switch (a) {\r
+               case 0: /* address port 0 */\r
+                       if (addr_A1 == 0 && ST_address == v)\r
+                               return 0; /* address already selected, don't send this command to 940 */\r
+                       ST_address = v;\r
+                       addr_A1 = 0;\r
+                       /* don't send DAC or timer related address changes to 940 */\r
+                       if (v == 0x24 || v == 0x25 || v == 0x26 || v == 0x2a)\r
                                return 0;\r
-               *addr_A1 = 0;\r
-               upd = 0;\r
-               break;\r
-\r
-       case 1: /* data port 0    */\r
-               if (*addr_A1 != 0) {\r
-                       return 0;       /* verified on real YM2608 */\r
-               }\r
+                       upd = 0;\r
+                       break;\r
 \r
-               addr = ST_address;\r
-               REGS[addr] = v;\r
+               case 1: /* data port 0    */\r
+                       if (ST_address == 0x2b) upd = 0; /* DAC sel */\r
+                       break;\r
 \r
-               switch( addr & 0xf0 )\r
-               {\r
-               case 0x20:      /* 0x20-0x2f Mode */\r
-                       switch( addr )\r
-                       {\r
-                       case 0x24: { // timer A High 8\r
-                                       int TAnew = (ST_TA & 0x03)|(((int)v)<<2);\r
-                                       if(ST_TA != TAnew) {\r
-                                               // we should reset ticker only if new value is written. Outrun requires this.\r
-                                               ST_TA = TAnew;\r
-                                               ST_TAC = (1024-TAnew)*18;\r
-                                               ST_TAT = 0;\r
-                                       }\r
-                                       return 0;\r
-                               }\r
-                       case 0x25: { // timer A Low 2\r
-                                       int TAnew = (ST_TA & 0x3fc)|(v&3);\r
-                                       if(ST_TA != TAnew) {\r
-                                               ST_TA = TAnew;\r
-                                               ST_TAC = (1024-TAnew)*18;\r
-                                               ST_TAT = 0;\r
-                                       }\r
-                                       return 0;\r
-                               }\r
-                       case 0x26: // timer B\r
-                               if(ST_TB != v) {\r
-                                       ST_TB = v;\r
-                                       ST_TBC  = (256-v)<<4;\r
-                                       ST_TBC *= 18;\r
-                                       ST_TBT  = 0;\r
-                               }\r
+               case 2: /* address port 1 */\r
+                       if (addr_A1 == 1 && ST_address == v)\r
                                return 0;\r
-                       case 0x27:      /* mode, timer control */\r
-                               if (set_timers( v ))\r
-                                       break; // other side needs ST.mode for 3slot mode\r
-                               return 0;\r
-                       case 0x2a:      /* DAC data (YM2612) */\r
-                               dacout = ((int)v - 0x80) << 6;  /* level unknown (notaz: 8 seems to be too much) */\r
-                               return 0;\r
-                       case 0x2b:      /* DAC Sel  (YM2612) */\r
-                               /* b7 = dac enable */\r
-                               dacen = v & 0x80;\r
-                               upd = 0;\r
-                               break; // other side has to know this\r
-                       default:\r
-                               break;\r
-                       }\r
+                       ST_address = v;\r
+                       addr_A1 = 1;\r
+                       upd = 0;\r
                        break;\r
-               }\r
-               break;\r
-\r
-       case 2: /* address port 1 */\r
-               if (*addr_A1 && ST_address == v)\r
-                       return 0;\r
-               ST_address = v;\r
-               *addr_A1 = 1;\r
-               upd = 0;\r
-               break;\r
-\r
-       case 3: /* data port 1    */\r
-               if (*addr_A1 != 1) {\r
-                       return 0;       /* verified on real YM2608 */\r
-               }\r
-\r
-               addr = ST_address | 0x100;\r
-               REGS[addr] = v;\r
-               break;\r
        }\r
 \r
        //printf("ym pass\n");\r
 \r
-       if(currentConfig.EmuOpt & 4) {\r
+       if (currentConfig.EmuOpt & 4)\r
+       {\r
                UINT16 *writebuff = shared_ctl->writebuffsel ? shared_ctl->writebuff0 : shared_ctl->writebuff1;\r
 \r
                /* detect rapid ym updates */\r
-               if (upd && !(writebuff_ptr & 0x80000000) && Pico.m.scanline < 224) {\r
+               if (upd && !(writebuff_ptr & 0x80000000) && scanline < 224)\r
+               {\r
                        int mid = Pico.m.pal ? 68 : 93;\r
-                       if (Pico.m.scanline > mid) {\r
-                               //printf("%05i:%03i: rapid ym\n", Pico.m.frame_count, Pico.m.scanline);\r
+                       if (scanline > mid) {\r
+                               //printf("%05i:%03i: rapid ym\n", Pico.m.frame_count, scanline);\r
                                writebuff[writebuff_ptr++ & 0xffff] = 0xfffe;\r
                                writebuff_ptr |= 0x80000000;\r
-                               //printf("%05i:%03i: ym w ([%02x] %02x, upd=%i)\n", Pico.m.frame_count, Pico.m.scanline, addr, v, upd);\r
+                               //printf("%05i:%03i: ym w ([%02x] %02x, upd=%i)\n", Pico.m.frame_count, scanline, addr, v, upd);\r
                        }\r
                }\r
 \r
@@ -229,38 +123,6 @@ int YM2612Write_940(unsigned int a, unsigned int v)
        return 0; // cause the engine to do updates once per frame only\r
 }\r
 \r
-UINT8 YM2612Read_940(void)\r
-{\r
-       return ST_status;\r
-}\r
-\r
-\r
-int YM2612PicoTick_940(int n)\r
-{\r
-       //int ret = 0;\r
-\r
-       // timer A\r
-       if(ST_mode & 0x01 && (ST_TAT+=64*n) >= ST_TAC) {\r
-               ST_TAT -= ST_TAC;\r
-               if(ST_mode & 0x04) ST_status |= 1;\r
-               // CSM mode total level latch and auto key on\r
-/*             FIXME\r
-               if(ST_mode & 0x80) {\r
-                       CSMKeyControll( &(ym2612_940->CH[2]) ); // Vectorman2, etc.\r
-                       ret = 1;\r
-               }\r
-*/\r
-       }\r
-\r
-       // timer B\r
-       if(ST_mode & 0x02 && (ST_TBT+=64*n) >= ST_TBC) {\r
-               ST_TBT -= ST_TBC;\r
-               if(ST_mode & 0x08) ST_status |= 2;\r
-       }\r
-\r
-       return 0;\r
-}\r
-\r
 \r
 #define CHECK_BUSY(job) \\r
        (gp2x_memregs[0x3b46>>1] & (1<<(job-1)))\r
@@ -314,40 +176,21 @@ static void add_job_940(int job)
 \r
 void YM2612PicoStateLoad_940(void)\r
 {\r
-       int i, old_A1 = *addr_A1;\r
+       UINT8 *REGS = YM2612GetRegs();\r
 \r
        /* make sure JOB940_PICOSTATELOAD gets done before next JOB940_YM2612UPDATEONE */\r
        add_job_940(JOB940_PICOSTATELOAD);\r
        if (CHECK_BUSY(JOB940_PICOSTATELOAD)) wait_busy_940(JOB940_PICOSTATELOAD);\r
 \r
        writebuff_ptr = 0;\r
-\r
-       // feed all the registers and update internal state\r
-       for(i = 0; i < 0x100; i++) {\r
-               YM2612Write_940(0, i);\r
-               YM2612Write_940(1, REGS[i]);\r
-       }\r
-       for(i = 0; i < 0x100; i++) {\r
-               YM2612Write_940(2, i);\r
-               YM2612Write_940(3, REGS[i|0x100]);\r
-       }\r
-\r
-       *addr_A1 = old_A1;\r
+       addr_A1 = *(INT32 *) (REGS + 0x200);\r
 }\r
 \r
 \r
 static void internal_reset(void)\r
 {\r
        writebuff_ptr = 0;\r
-       ST_mode   = 0;\r
-       ST_status = 0;  /* normal mode */\r
-       ST_TA     = 0;\r
-       ST_TAC    = 0;\r
-       ST_TB     = 0;\r
-       ST_TBC    = 0;\r
-       dacen     = 0;\r
-       dacout    = 0;\r
-       ST_address= 0;\r
+       ST_address = addr_A1 = -1;\r
 }\r
 \r
 \r
@@ -445,12 +288,6 @@ void YM2612Init_940(int baseclock, int rate)
        /* cause local ym2612 to init REGS */\r
        YM2612Init_(baseclock, rate);\r
 \r
-       REGS = YM2612GetRegs();\r
-       addr_A1 = (INT32 *) (REGS + 0x200);\r
-\r
-       ym2612_dacen  = &dacen;\r
-       ym2612_dacout = &dacout;\r
-\r
        internal_reset();\r
 \r
        loaded_mp3 = 0;\r
@@ -474,12 +311,13 @@ void YM2612Init_940(int baseclock, int rate)
 \r
 void YM2612ResetChip_940(void)\r
 {\r
-       printf("YM2612ResetChip_940()\n");\r
+       //printf("YM2612ResetChip_940()\n");\r
        if (shared_data == NULL) {\r
                printf("YM2612ResetChip_940: reset before init?\n");\r
                return;\r
        }\r
 \r
+       YM2612ResetChip_();\r
        internal_reset();\r
 \r
        add_job_940(JOB940_YM2612RESETCHIP);\r
@@ -651,7 +489,7 @@ int mp3_get_offset(void)
        unsigned int offs1024 = 0;\r
        int cdda_on;\r
 \r
-       cdda_on = (PicoMCD & 1) && (PicoOpt&0x800) && !(Pico_mcd->s68k_regs[0x36] & 1) &&\r
+       cdda_on = (PicoAHW & PAHW_MCD) && (PicoOpt&0x800) && !(Pico_mcd->s68k_regs[0x36] & 1) &&\r
                        (Pico_mcd->scd.Status_CDC & 1) && loaded_mp3;\r
 \r
        if (cdda_on) {\r