Cyclone poll detection problem fixed
[picodrive.git] / Pico / cd / LC89510.c
index 2549fa8..05ac5d1 100644 (file)
@@ -1,16 +1,15 @@
 /***********************************************************\r
  *                                                         *\r
- * This source is taken from the Gens project              *\r
+ * This source file was taken from the Gens project        *\r
  * Written by Stéphane Dallongeville                       *\r
  * Copyright (c) 2002 by Stéphane Dallongeville            *\r
- * Modified/adapted for Picodrive by notaz, 2007           *\r
+ * Modified/adapted for PicoDrive by notaz, 2007           *\r
  *                                                         *\r
  ***********************************************************/\r
 \r
 #include "../PicoInt.h"\r
 \r
-#define cdprintf dprintf\r
-//#define cdprintf(x...)\r
+#define cdprintf(x...)\r
 \r
 \r
 #define CDC_DMA_SPEED 256\r
@@ -37,9 +36,7 @@ static void CDC_Reset(void)
 {\r
        // Reseting CDC\r
 \r
-       memset(Pico_mcd->cdc.Buffer, 0, (16 * 1024 * 2) + 2352);\r
-\r
-       CDC_Update_Header();\r
+       memset(Pico_mcd->cdc.Buffer, 0, sizeof(Pico_mcd->cdc.Buffer));\r
 \r
        Pico_mcd->cdc.COMIN = 0;\r
        Pico_mcd->cdc.IFSTAT = 0xFF;\r
@@ -58,7 +55,7 @@ static void CDC_Reset(void)
 }\r
 \r
 \r
-void LC89510_Reset(void)\r
+PICO_INTERNAL void LC89510_Reset(void)\r
 {\r
        CDD_Reset();\r
        CDC_Reset();\r
@@ -68,9 +65,9 @@ void LC89510_Reset(void)
 }\r
 \r
 \r
-void Update_CDC_TRansfer(int which)\r
+PICO_INTERNAL void Update_CDC_TRansfer(int which)\r
 {\r
-       unsigned int DMA_Adr, dep, length, len;\r
+       unsigned int DMA_Adr, dep, length;\r
        unsigned short *dest;\r
        unsigned char  *src;\r
 \r
@@ -88,7 +85,7 @@ void Update_CDC_TRansfer(int which)
 \r
                        if (Pico_mcd->s68k_regs[0x33] & (1<<5))\r
                        {\r
-                               dprintf("cdc DTE irq 5");\r
+                               elprintf(EL_INTS, "cdc DTE irq 5");\r
                                SekInterruptS68k(5);\r
                        }\r
                }\r
@@ -96,7 +93,7 @@ void Update_CDC_TRansfer(int which)
        else length = CDC_DMA_SPEED;\r
 \r
 \r
-       // TODO: dst bounds checking? DAC.N alignment?\r
+       // TODO: dst bounds checking?\r
        src = Pico_mcd->cdc.Buffer + Pico_mcd->cdc.DAC.N;\r
        DMA_Adr = (Pico_mcd->s68k_regs[0xA]<<8) | Pico_mcd->s68k_regs[0xB];\r
 \r
@@ -104,50 +101,50 @@ void Update_CDC_TRansfer(int which)
        {\r
                if (Pico_mcd->s68k_regs[3] & 4)\r
                {\r
+                       // test: Final Fight\r
+                       int bank = !(Pico_mcd->s68k_regs[3]&1);\r
                        dep = ((DMA_Adr & 0x3FFF) << 3);\r
                        cdprintf("CD DMA # %04x -> word_ram1M # %06x, len=%i",\r
                                        Pico_mcd->cdc.DAC.N, dep, length);\r
 \r
-                       dep = ((DMA_Adr & 0x3FFF) << 4);\r
-                       if (!(Pico_mcd->s68k_regs[3]&1)) dep += 2;\r
-                       dest = (unsigned short *) (Pico_mcd->word_ram + dep);\r
+                       dest = (unsigned short *) (Pico_mcd->word_ram1M[bank] + dep);\r
 \r
-                       for (len = length; len > 0; len--, src+=2, dest+=2)\r
-                               *dest = (src[0]<<8) | src[1];\r
+                       memcpy16bswap(dest, src, length);\r
 \r
-                       { // debug\r
-                               unsigned char *b1 = Pico_mcd->word_ram + dep;\r
-                               unsigned char *b2 = (unsigned char *)dest - 8;\r
+                       /*{ // debug\r
+                               unsigned char *b1 = Pico_mcd->word_ram1M[bank] + dep;\r
+                               unsigned char *b2 = (unsigned char *)(dest+length) - 8;\r
                                dprintf("%02x %02x %02x %02x .. %02x %02x %02x %02x",\r
                                        b1[0], b1[1], b1[4], b1[5], b2[0], b2[1], b2[4], b2[5]);\r
-                       }\r
+                       }*/\r
                }\r
                else\r
                {\r
                        dep = ((DMA_Adr & 0x7FFF) << 3);\r
                        cdprintf("CD DMA # %04x -> word_ram2M # %06x, len=%i",\r
                                        Pico_mcd->cdc.DAC.N, dep, length);\r
-                       dest = (unsigned short *) (Pico_mcd->word_ram + dep);\r
+                       dest = (unsigned short *) (Pico_mcd->word_ram2M + dep);\r
 \r
-                       for (len = length; len > 0; len--, src+=2, dest++)\r
-                               *dest = (src[0]<<8) | src[1];\r
+                       memcpy16bswap(dest, src, length);\r
 \r
-                       { // debug\r
-                               unsigned char *b1 = Pico_mcd->word_ram + dep;\r
-                               unsigned char *b2 = (unsigned char *)dest - 4;\r
+                       /*{ // debug\r
+                               unsigned char *b1 = Pico_mcd->word_ram2M + dep;\r
+                               unsigned char *b2 = (unsigned char *)(dest+length) - 4;\r
                                dprintf("%02x %02x %02x %02x .. %02x %02x %02x %02x",\r
                                        b1[0], b1[1], b1[2], b1[3], b2[0], b2[1], b2[2], b2[3]);\r
-                       }\r
+                       }*/\r
                }\r
        }\r
-       else if (which == 4) // PCM RAM\r
+       else if (which == 4) // PCM RAM (check: popful Mail)\r
        {\r
-#if 0\r
-                       dest = (unsigned char *) Ram_PCM;\r
-                       dep = ((DMA_Adr & 0x03FF) << 2) + PCM_Chip.Bank;\r
-#else\r
-                       cdprintf("CD DMA # %04x -> PCM TODO", Pico_mcd->cdc.DAC.N);\r
-#endif\r
+               dep = (DMA_Adr & 0x03FF) << 2;\r
+               cdprintf("CD DMA # %04x -> PCM[%i] # %04x, len=%i",\r
+                       Pico_mcd->cdc.DAC.N, Pico_mcd->pcm.bank, dep, length);\r
+               dest = (unsigned short *) (Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank] + dep);\r
+\r
+               if (Pico_mcd->cdc.DAC.N & 1) /* unaligned src? */\r
+                       memcpy(dest, src, length*2);\r
+               else    memcpy16(dest, (unsigned short *) src, length);\r
        }\r
        else if (which == 5) // PRG RAM\r
        {\r
@@ -156,15 +153,14 @@ void Update_CDC_TRansfer(int which)
                cdprintf("CD DMA # %04x -> prg_ram # %06x, len=%i",\r
                                Pico_mcd->cdc.DAC.N, dep, length);\r
 \r
-               for (len = length; len > 0; len--, src+=2, dest++)\r
-                       *dest = (src[0]<<8) | src[1];\r
+               memcpy16bswap(dest, src, length);\r
 \r
-               { // debug\r
+               /*{ // debug\r
                        unsigned char *b1 = Pico_mcd->prg_ram + dep;\r
-                       unsigned char *b2 = (unsigned char *)dest - 4;\r
+                       unsigned char *b2 = (unsigned char *)(dest+length) - 4;\r
                        dprintf("%02x %02x %02x %02x .. %02x %02x %02x %02x",\r
                                b1[0], b1[1], b1[2], b1[3], b2[0], b2[1], b2[2], b2[3]);\r
-               }\r
+               }*/\r
        }\r
 \r
        length <<= 1;\r
@@ -181,14 +177,14 @@ void Update_CDC_TRansfer(int which)
 }\r
 \r
 \r
-unsigned short Read_CDC_Host(int is_sub)\r
+PICO_INTERNAL_ASM unsigned short Read_CDC_Host(int is_sub)\r
 {\r
        int addr;\r
 \r
        if (!(Pico_mcd->scd.Status_CDC & 0x08))\r
        {\r
                // Transfer data disabled\r
-               cdprintf("Read_CDC_Host: Transfer data disabled");\r
+               cdprintf("Read_CDC_Host FIXME: Transfer data disabled");\r
                return 0;\r
        }\r
 \r
@@ -196,7 +192,7 @@ unsigned short Read_CDC_Host(int is_sub)
                (!is_sub && (Pico_mcd->s68k_regs[4] & 7) != 2))\r
        {\r
                // Wrong setting\r
-               cdprintf("Read_CDC_Host: Wrong setting");\r
+               cdprintf("Read_CDC_Host FIXME: Wrong setting");\r
                return 0;\r
        }\r
 \r
@@ -215,7 +211,7 @@ unsigned short Read_CDC_Host(int is_sub)
                        Pico_mcd->cdc.IFSTAT &= ~0x40;\r
 \r
                        if (Pico_mcd->s68k_regs[0x33]&(1<<5)) {\r
-                               dprintf("m68k: s68k irq 5");\r
+                               elprintf(EL_INTS, "m68k: s68k irq 5");\r
                                SekInterruptS68k(5);\r
                        }\r
 \r
@@ -230,24 +226,10 @@ unsigned short Read_CDC_Host(int is_sub)
                (Pico_mcd->cdc.Buffer[addr]<<8) | Pico_mcd->cdc.Buffer[addr+1], Pico_mcd->cdc.DAC.N, Pico_mcd->cdc.DBC.N);\r
 \r
        return (Pico_mcd->cdc.Buffer[addr]<<8) | Pico_mcd->cdc.Buffer[addr+1];\r
-\r
-#if 0\r
-       __asm\r
-       {\r
-               mov esi, Pico_mcd->cdc.DAC.N\r
-               lea ebx, Pico_mcd->cdc.Buffer\r
-//                             and esi, 0x3FFF\r
-               mov ax, [ebx + esi]\r
-               add esi, 2\r
-               rol ax, 8\r
-               mov Pico_mcd->cdc.DAC.N, esi\r
-               mov val, ax\r
-       }\r
-#endif\r
 }\r
 \r
 \r
-void CDC_Update_Header(void)\r
+PICO_INTERNAL void CDC_Update_Header(void)\r
 {\r
        if (Pico_mcd->cdc.CTRL.B.B1 & 0x01)             // Sub-Header wanted ?\r
        {\r
@@ -270,7 +252,7 @@ void CDC_Update_Header(void)
 }\r
 \r
 \r
-unsigned char CDC_Read_Reg(void)\r
+PICO_INTERNAL unsigned char CDC_Read_Reg(void)\r
 {\r
        unsigned char ret;\r
 \r
@@ -393,7 +375,7 @@ unsigned char CDC_Read_Reg(void)
 }\r
 \r
 \r
-void CDC_Write_Reg(unsigned char Data)\r
+PICO_INTERNAL void CDC_Write_Reg(unsigned char Data)\r
 {\r
        cdprintf("CDC write reg%02d = %.2X", Pico_mcd->s68k_regs[5] & 0xF, Data);\r
 \r
@@ -511,7 +493,7 @@ static int bswapwrite(int a, unsigned short d)
        return d + (d >> 8);\r
 }\r
 \r
-void CDD_Export_Status(void)\r
+PICO_INTERNAL void CDD_Export_Status(void)\r
 {\r
        unsigned int csum;\r
 \r
@@ -527,7 +509,7 @@ void CDD_Export_Status(void)
 \r
        if (Pico_mcd->s68k_regs[0x33] & (1<<4))\r
        {\r
-               dprintf("cdd export irq 4");\r
+               elprintf(EL_INTS, "cdd export irq 4");\r
                SekInterruptS68k(4);\r
        }\r
 \r
@@ -541,7 +523,7 @@ void CDD_Export_Status(void)
 }\r
 \r
 \r
-void CDD_Import_Command(void)\r
+PICO_INTERNAL void CDD_Import_Command(void)\r
 {\r
 //     cdprintf("CDD importing command\n");\r
        cdprintf("in:  Command=%.4X, Minute=%.4X, Second=%.4X, Frame=%.4X  Checksum=%.4X",\r