amalgamation
[picodrive.git] / Pico / cd / LC89510.c
index 96d0966..31c3f64 100644 (file)
@@ -1,25 +1,20 @@
-#if 0\r
-#include <stdio.h>\r
-#include <windows.h>\r
-#include "misc.h"\r
-#include "lc89510.h"\r
-#include "cd_aspi.h"\r
-#include "Star_68k.h"\r
-#include "mem_S68k.h"\r
-#include "pcm.h"\r
-#endif\r
+/***********************************************************\r
+ *                                                         *\r
+ * This source 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
+ *                                                         *\r
+ ***********************************************************/\r
 \r
 #include "../PicoInt.h"\r
 \r
-#define cdprintf printf\r
+#define cdprintf dprintf\r
 //#define cdprintf(x...)\r
 \r
 \r
 #define CDC_DMA_SPEED 256\r
 \r
-int CDC_Decode_Reg_Read;\r
-static int Status_CDC;         // internal status\r
-\r
 \r
 static void CDD_Reset(void)\r
 {\r
@@ -42,9 +37,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,153 +51,141 @@ static void CDC_Reset(void)
        Pico_mcd->cdc.IFCTRL = 0;\r
        Pico_mcd->cdc.CTRL.N = 0;\r
 \r
-       CDC_Decode_Reg_Read = 0;\r
-       Status_CDC = 0;\r
+       Pico_mcd->cdc.Decode_Reg_Read = 0;\r
+       Pico_mcd->scd.Status_CDC &= ~0x08;\r
 }\r
 \r
 \r
-void LC89510_Reset(void)\r
+PICO_INTERNAL void LC89510_Reset(void)\r
 {\r
        CDD_Reset();\r
        CDC_Reset();\r
 \r
-       Pico_mcd->cdc.Host_Data = 0;\r
-       Pico_mcd->cdc.DMA_Adr = 0;\r
-       Pico_mcd->cdc.Stop_Watch = 0;\r
+       // clear DMA_Adr & Stop_Watch\r
+       memset(Pico_mcd->s68k_regs + 0xA, 0, 4);\r
 }\r
 \r
-#if 0 // TODO\r
-void Update_CDC_TRansfer(void)\r
-{\r
-       unsigned int i, dep, lenght, add_dest;\r
-       unsigned char *dest;\r
-\r
-       if ((Status_CDC & 0x08) == 0) return;\r
-\r
-       switch(Pico_mcd->s68k_regs[4] & 7)\r
-       {\r
-               case 0x0200:                            // MAIN CPU\r
-               case 0x0300:                            // SUB CPU\r
-                       Pico_mcd->s68k_regs[4] |= 0x40; // Data ready in host port\r
-                       return;\r
-\r
-               case 0x0400:            // PCM RAM\r
-                       dest = (unsigned char *) Ram_PCM;\r
-                       dep = ((Pico_mcd->cdc.DMA_Adr & 0x03FF) << 2) + PCM_Chip.Bank;\r
-                       add_dest = 2;\r
-                       break;\r
-\r
-               case 0x0500:            // PRG RAM\r
-                       dest = (unsigned char *) Ram_Prg;\r
-                       dep = (Pico_mcd->cdc.DMA_Adr & 0xFFFF) << 3;\r
-                       add_dest = 2;\r
-//                     cdprintf("DMA transfer PRG RAM : adr = %.8X  ", dep);\r
-                       break;\r
-\r
-               case 0x0700:            // WORD RAM\r
-                       if (Ram_Word_State >= 2)\r
-                       {\r
-                               dest = (unsigned char *) Ram_Word_1M;\r
-                               add_dest = 2;\r
-                               if (Ram_Word_State & 1) dep = ((Pico_mcd->cdc.DMA_Adr & 0x3FFF) << 3);\r
-                               else dep = ((Pico_mcd->cdc.DMA_Adr & 0x3FFF) << 3) + 0x20000;\r
-                       }\r
-                       else\r
-                       {\r
-                               dest = (unsigned char *) Ram_Word_2M;\r
-                               dep = ((Pico_mcd->cdc.DMA_Adr & 0x7FFF) << 3);\r
-                               add_dest = 2;\r
-                       }\r
-                       break;\r
 \r
-               default:\r
-                       return;\r
-       }\r
+PICO_INTERNAL void Update_CDC_TRansfer(int which)\r
+{\r
+       unsigned int DMA_Adr, dep, length;\r
+       unsigned short *dest;\r
+       unsigned char  *src;\r
 \r
        if (Pico_mcd->cdc.DBC.N <= (CDC_DMA_SPEED * 2))\r
        {\r
-               lenght = (Pico_mcd->cdc.DBC.N + 1) >> 1;\r
-               Status_CDC &= ~0x08;                            // Last transfer\r
-               Pico_mcd->s68k_regs[4] |=  0x80;                // End data transfer\r
-               Pico_mcd->s68k_regs[4] &= ~0x40;                // no more data ready\r
-               Pico_mcd->cdc.IFSTAT |= 0x08;                   // No more data transfer in progress\r
+               length = (Pico_mcd->cdc.DBC.N + 1) >> 1;\r
+               Pico_mcd->scd.Status_CDC &= ~0x08;      // Last transfer\r
+               Pico_mcd->s68k_regs[4] |=  0x80;        // End data transfer\r
+               Pico_mcd->s68k_regs[4] &= ~0x40;        // no more data ready\r
+               Pico_mcd->cdc.IFSTAT |= 0x08;           // No more data transfer in progress\r
 \r
-               if (Pico_mcd->cdc.IFCTRL & 0x40)                // DTEIEN = Data Trasnfer End Interrupt Enable ?\r
+               if (Pico_mcd->cdc.IFCTRL & 0x40)        // DTEIEN = Data Trasnfer End Interrupt Enable ?\r
                {\r
                        Pico_mcd->cdc.IFSTAT &= ~0x40;\r
 \r
-                       if (Int_Mask_S68K & 0x20) sub68k_interrupt(5, -1);\r
-\r
-                       cdprintf("CDC - DTE interrupt\n");\r
+                       if (Pico_mcd->s68k_regs[0x33] & (1<<5))\r
+                       {\r
+                               dprintf("cdc DTE irq 5");\r
+                               SekInterruptS68k(5);\r
+                       }\r
                }\r
        }\r
-       else lenght = CDC_DMA_SPEED;\r
+       else length = CDC_DMA_SPEED;\r
 \r
-//     cdprintf("DMA lenght = %.4X\n", lenght);\r
 \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
-       if ((Pico_mcd->s68k_regs[4] & 7) == 4)          // PCM DMA\r
+       if (which == 7) // WORD RAM\r
        {\r
-       __asm\r
+               if (Pico_mcd->s68k_regs[3] & 4)\r
                {\r
-                       mov ecx, lenght\r
-                       mov edi, dest\r
-                       lea esi, Pico_mcd->cdc.Buffer\r
-                       add edi, dep\r
-                       add esi, Pico_mcd->cdc.DAC.N\r
-                       mov ebx, add_dest\r
-\r
-               Loop_DMA_PCM:\r
-                       mov ax, [esi]\r
-                       add esi, 2\r
-                       mov [edi], ax\r
-                       add edi, ebx\r
-                       dec ecx\r
-                       jnz Loop_DMA_PCM\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
+                       dest = (unsigned short *) (Pico_mcd->word_ram1M[bank] + dep);\r
+\r
+                       memcpy16bswap(dest, src, length);\r
+\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
-               lenght <<= 1;\r
-               Pico_mcd->cdc.DMA_Adr += lenght >> 2;\r
-       }\r
-       else                                                                    // OTHER DMA\r
-       {\r
-               __asm\r
+               else\r
                {\r
-                       mov ecx, lenght\r
-                       mov edi, dest\r
-                       lea esi, Pico_mcd->cdc.Buffer\r
-                       add edi, dep\r
-                       add esi, Pico_mcd->cdc.DAC.N\r
-                       mov ebx, add_dest\r
-\r
-               Loop_DMA:\r
-                       mov ax, [esi]\r
-                       add esi, 2\r
-                       rol ax, 8\r
-                       mov [edi], ax\r
-                       add edi, ebx\r
-                       dec ecx\r
-                       jnz Loop_DMA\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_ram2M + dep);\r
+\r
+                       memcpy16bswap(dest, src, length);\r
+\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
-               lenght <<= 1;\r
-               Pico_mcd->cdc.DMA_Adr += lenght >> 3;\r
+       }\r
+       else if (which == 4) // PCM RAM (check: popful Mail)\r
+       {\r
+               dep = (DMA_Adr & 0x03FF) << 2;\r
+               dprintf("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
+               dep = DMA_Adr << 3;\r
+               dest = (unsigned short *) (Pico_mcd->prg_ram + dep);\r
+               cdprintf("CD DMA # %04x -> prg_ram # %06x, len=%i",\r
+                               Pico_mcd->cdc.DAC.N, dep, length);\r
+\r
+               memcpy16bswap(dest, src, length);\r
+\r
+               /*{ // debug\r
+                       unsigned char *b1 = Pico_mcd->prg_ram + 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
-       Pico_mcd->cdc.DAC.N = (Pico_mcd->cdc.DAC.N + lenght) & 0xFFFF;\r
-       if (Status_CDC & 0x08) Pico_mcd->cdc.DBC.N -= lenght;\r
+       length <<= 1;\r
+       Pico_mcd->cdc.DAC.N = (Pico_mcd->cdc.DAC.N + length) & 0xFFFF;\r
+       if (Pico_mcd->scd.Status_CDC & 0x08) Pico_mcd->cdc.DBC.N -= length;\r
        else Pico_mcd->cdc.DBC.N = 0;\r
+\r
+       // update DMA_Adr\r
+       length >>= 2;\r
+       if (which != 4) length >>= 1;\r
+       DMA_Adr += length;\r
+       Pico_mcd->s68k_regs[0xA] = DMA_Adr >> 8;\r
+       Pico_mcd->s68k_regs[0xB] = DMA_Adr;\r
 }\r
-#endif\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 (!(Status_CDC & 0x08))\r
+       if (!(Pico_mcd->scd.Status_CDC & 0x08))\r
        {\r
                // Transfer data disabled\r
+               cdprintf("Read_CDC_Host FIXME: Transfer data disabled");\r
                return 0;\r
        }\r
 \r
@@ -212,6 +193,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 FIXME: Wrong setting");\r
                return 0;\r
        }\r
 \r
@@ -220,7 +202,7 @@ unsigned short Read_CDC_Host(int is_sub)
        if (Pico_mcd->cdc.DBC.N <= 0)\r
        {\r
                Pico_mcd->cdc.DBC.N = 0;\r
-               Status_CDC &= ~0x08;                            // Last transfer\r
+               Pico_mcd->scd.Status_CDC &= ~0x08;              // Last transfer\r
                Pico_mcd->s68k_regs[4] |=  0x80;                // End data transfer\r
                Pico_mcd->s68k_regs[4] &= ~0x40;                // no more data ready\r
                Pico_mcd->cdc.IFSTAT |= 0x08;                   // No more data transfer in progress\r
@@ -234,31 +216,21 @@ unsigned short Read_CDC_Host(int is_sub)
                                SekInterruptS68k(5);\r
                        }\r
 \r
-                       cdprintf("CDC - DTE interrupt\n");\r
+                       cdprintf("CDC - DTE interrupt");\r
                }\r
        }\r
 \r
        addr = Pico_mcd->cdc.DAC.N;\r
        Pico_mcd->cdc.DAC.N += 2;\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
+       cdprintf("Read_CDC_Host sub=%i d=%04x dac=%04x dbc=%04x", is_sub,\r
+               (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
 \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
@@ -281,122 +253,120 @@ 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
-       cdprintf("CDC read reg %.2d = ", Pico_mcd->s68k_regs[5] & 0xF);\r
-\r
        switch(Pico_mcd->s68k_regs[5] & 0xF)\r
        {\r
                case 0x0: // COMIN\r
-                       cdprintf("%.2X\n", Pico_mcd->cdc.COMIN);\r
+                       cdprintf("CDC read reg 00 = %.2X", Pico_mcd->cdc.COMIN);\r
 \r
                        Pico_mcd->s68k_regs[5] = 0x1;\r
                        return Pico_mcd->cdc.COMIN;\r
 \r
                case 0x1: // IFSTAT\r
-                       cdprintf("%.2X\n", Pico_mcd->cdc.IFSTAT);\r
+                       cdprintf("CDC read reg 01 = %.2X", Pico_mcd->cdc.IFSTAT);\r
 \r
-                       CDC_Decode_Reg_Read |= (1 << 1);                // Reg 1 (decoding)\r
+                       Pico_mcd->cdc.Decode_Reg_Read |= (1 << 1);              // Reg 1 (decoding)\r
                        Pico_mcd->s68k_regs[5] = 0x2;\r
                        return Pico_mcd->cdc.IFSTAT;\r
 \r
                case 0x2: // DBCL\r
-                       cdprintf("%.2X\n", Pico_mcd->cdc.DBC.B.L);\r
+                       cdprintf("CDC read reg 02 = %.2X", Pico_mcd->cdc.DBC.B.L);\r
 \r
                        Pico_mcd->s68k_regs[5] = 0x3;\r
                        return Pico_mcd->cdc.DBC.B.L;\r
 \r
                case 0x3: // DBCH\r
-                       cdprintf("%.2X\n", Pico_mcd->cdc.DBC.B.H);\r
+                       cdprintf("CDC read reg 03 = %.2X", Pico_mcd->cdc.DBC.B.H);\r
 \r
                        Pico_mcd->s68k_regs[5] = 0x4;\r
                        return Pico_mcd->cdc.DBC.B.H;\r
 \r
                case 0x4: // HEAD0\r
-                       cdprintf("%.2X\n", Pico_mcd->cdc.HEAD.B.B0);\r
+                       cdprintf("CDC read reg 04 = %.2X", Pico_mcd->cdc.HEAD.B.B0);\r
 \r
-                       CDC_Decode_Reg_Read |= (1 << 4);                // Reg 4 (decoding)\r
+                       Pico_mcd->cdc.Decode_Reg_Read |= (1 << 4);              // Reg 4 (decoding)\r
                        Pico_mcd->s68k_regs[5] = 0x5;\r
                        return Pico_mcd->cdc.HEAD.B.B0;\r
 \r
                case 0x5: // HEAD1\r
-                       cdprintf("%.2X\n", Pico_mcd->cdc.HEAD.B.B1);\r
+                       cdprintf("CDC read reg 05 = %.2X", Pico_mcd->cdc.HEAD.B.B1);\r
 \r
-                       CDC_Decode_Reg_Read |= (1 << 5);                // Reg 5 (decoding)\r
+                       Pico_mcd->cdc.Decode_Reg_Read |= (1 << 5);              // Reg 5 (decoding)\r
                        Pico_mcd->s68k_regs[5] = 0x6;\r
                        return Pico_mcd->cdc.HEAD.B.B1;\r
 \r
                case 0x6: // HEAD2\r
-                       cdprintf("%.2X\n", Pico_mcd->cdc.HEAD.B.B2);\r
+                       cdprintf("CDC read reg 06 = %.2X", Pico_mcd->cdc.HEAD.B.B2);\r
 \r
-                       CDC_Decode_Reg_Read |= (1 << 6);                // Reg 6 (decoding)\r
+                       Pico_mcd->cdc.Decode_Reg_Read |= (1 << 6);              // Reg 6 (decoding)\r
                        Pico_mcd->s68k_regs[5] = 0x7;\r
                        return Pico_mcd->cdc.HEAD.B.B2;\r
 \r
                case 0x7: // HEAD3\r
-                       cdprintf("%.2X\n", Pico_mcd->cdc.HEAD.B.B3);\r
+                       cdprintf("CDC read reg 07 = %.2X", Pico_mcd->cdc.HEAD.B.B3);\r
 \r
-                       CDC_Decode_Reg_Read |= (1 << 7);                // Reg 7 (decoding)\r
+                       Pico_mcd->cdc.Decode_Reg_Read |= (1 << 7);              // Reg 7 (decoding)\r
                        Pico_mcd->s68k_regs[5] = 0x8;\r
                        return Pico_mcd->cdc.HEAD.B.B3;\r
 \r
                case 0x8: // PTL\r
-                       cdprintf("%.2X\n", Pico_mcd->cdc.PT.B.L);\r
+                       cdprintf("CDC read reg 08 = %.2X", Pico_mcd->cdc.PT.B.L);\r
 \r
-                       CDC_Decode_Reg_Read |= (1 << 8);                // Reg 8 (decoding)\r
+                       Pico_mcd->cdc.Decode_Reg_Read |= (1 << 8);              // Reg 8 (decoding)\r
                        Pico_mcd->s68k_regs[5] = 0x9;\r
                        return Pico_mcd->cdc.PT.B.L;\r
 \r
                case 0x9: // PTH\r
-                       cdprintf("%.2X\n", Pico_mcd->cdc.PT.B.H);\r
+                       cdprintf("CDC read reg 09 = %.2X", Pico_mcd->cdc.PT.B.H);\r
 \r
-                       CDC_Decode_Reg_Read |= (1 << 9);                // Reg 9 (decoding)\r
+                       Pico_mcd->cdc.Decode_Reg_Read |= (1 << 9);              // Reg 9 (decoding)\r
                        Pico_mcd->s68k_regs[5] = 0xA;\r
                        return Pico_mcd->cdc.PT.B.H;\r
 \r
                case 0xA: // WAL\r
-                       cdprintf("%.2X\n", Pico_mcd->cdc.WA.B.L);\r
+                       cdprintf("CDC read reg 10 = %.2X", Pico_mcd->cdc.WA.B.L);\r
 \r
                        Pico_mcd->s68k_regs[5] = 0xB;\r
                        return Pico_mcd->cdc.WA.B.L;\r
 \r
                case 0xB: // WAH\r
-                       cdprintf("%.2X\n", Pico_mcd->cdc.WA.B.H);\r
+                       cdprintf("CDC read reg 11 = %.2X", Pico_mcd->cdc.WA.B.H);\r
 \r
                        Pico_mcd->s68k_regs[5] = 0xC;\r
                        return Pico_mcd->cdc.WA.B.H;\r
 \r
                case 0xC: // STAT0\r
-                       cdprintf("%.2X\n", Pico_mcd->cdc.STAT.B.B0);\r
+                       cdprintf("CDC read reg 12 = %.2X", Pico_mcd->cdc.STAT.B.B0);\r
 \r
-                       CDC_Decode_Reg_Read |= (1 << 12);               // Reg 12 (decoding)\r
+                       Pico_mcd->cdc.Decode_Reg_Read |= (1 << 12);             // Reg 12 (decoding)\r
                        Pico_mcd->s68k_regs[5] = 0xD;\r
                        return Pico_mcd->cdc.STAT.B.B0;\r
 \r
                case 0xD: // STAT1\r
-                       cdprintf("%.2X\n", Pico_mcd->cdc.STAT.B.B1);\r
+                       cdprintf("CDC read reg 13 = %.2X", Pico_mcd->cdc.STAT.B.B1);\r
 \r
-                       CDC_Decode_Reg_Read |= (1 << 13);               // Reg 13 (decoding)\r
+                       Pico_mcd->cdc.Decode_Reg_Read |= (1 << 13);             // Reg 13 (decoding)\r
                        Pico_mcd->s68k_regs[5] = 0xE;\r
                        return Pico_mcd->cdc.STAT.B.B1;\r
 \r
                case 0xE: // STAT2\r
-                       cdprintf("%.2X\n", Pico_mcd->cdc.STAT.B.B2);\r
+                       cdprintf("CDC read reg 14 = %.2X", Pico_mcd->cdc.STAT.B.B2);\r
 \r
-                       CDC_Decode_Reg_Read |= (1 << 14);               // Reg 14 (decoding)\r
+                       Pico_mcd->cdc.Decode_Reg_Read |= (1 << 14);             // Reg 14 (decoding)\r
                        Pico_mcd->s68k_regs[5] = 0xF;\r
                        return Pico_mcd->cdc.STAT.B.B2;\r
 \r
                case 0xF: // STAT3\r
-                       cdprintf("%.2X\n", Pico_mcd->cdc.STAT.B.B3);\r
+                       cdprintf("CDC read reg 15 = %.2X", Pico_mcd->cdc.STAT.B.B3);\r
 \r
                        ret = Pico_mcd->cdc.STAT.B.B3;\r
                        Pico_mcd->cdc.IFSTAT |= 0x20;                   // decoding interrupt flag cleared\r
                        if ((Pico_mcd->cdc.CTRL.B.B0 & 0x80) && (Pico_mcd->cdc.IFCTRL & 0x20))\r
                        {\r
-                               if ((CDC_Decode_Reg_Read & 0x73F2) == 0x73F2)\r
+                               if ((Pico_mcd->cdc.Decode_Reg_Read & 0x73F2) == 0x73F2)\r
                                        Pico_mcd->cdc.STAT.B.B3 = 0x80;\r
                        }\r
                        return ret;\r
@@ -406,9 +376,9 @@ 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%d = %.2X\n", Pico_mcd->s68k_regs[5] & 0xF, Data);\r
+       cdprintf("CDC write reg%02d = %.2X", Pico_mcd->s68k_regs[5] & 0xF, Data);\r
 \r
        switch (Pico_mcd->s68k_regs[5] & 0xF)\r
        {\r
@@ -425,7 +395,7 @@ void CDC_Write_Reg(unsigned char Data)
                        if ((Pico_mcd->cdc.IFCTRL & 0x02) == 0)         // Stop data transfer\r
                        {\r
                                Pico_mcd->cdc.DBC.N = 0;\r
-                               Status_CDC &= ~0x08;\r
+                               Pico_mcd->scd.Status_CDC &= ~0x08;\r
                                Pico_mcd->cdc.IFSTAT |= 0x08;           // No more data transfer in progress\r
                        }\r
                        break;\r
@@ -458,12 +428,12 @@ void CDC_Write_Reg(unsigned char Data)
                        if (Pico_mcd->cdc.IFCTRL & 0x02)                // Data transfer enable ?\r
                        {\r
                                Pico_mcd->cdc.IFSTAT &= ~0x08;          // Data transfer in progress\r
-                               Status_CDC |= 0x08;                     // Data transfer in progress\r
+                               Pico_mcd->scd.Status_CDC |= 0x08;       // Data transfer in progress\r
                                Pico_mcd->s68k_regs[4] &= 0x7F;         // A data transfer start\r
 \r
-                               cdprintf("\n************** Starting Data Transfer ***********\n");\r
+                               cdprintf("************** Starting Data Transfer ***********");\r
                                cdprintf("RS0 = %.4X  DAC = %.4X  DBC = %.4X  DMA adr = %.4X\n\n", Pico_mcd->s68k_regs[4]<<8,\r
-                                       Pico_mcd->cdc.DAC.N, Pico_mcd->cdc.DBC.N, Pico_mcd->cdc.DMA_Adr);\r
+                                       Pico_mcd->cdc.DAC.N, Pico_mcd->cdc.DBC.N, (Pico_mcd->s68k_regs[0xA]<<8) | Pico_mcd->s68k_regs[0xB]);\r
                        }\r
                        break;\r
 \r
@@ -524,7 +494,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
@@ -544,8 +514,8 @@ void CDD_Export_Status(void)
                SekInterruptS68k(4);\r
        }\r
 \r
-       cdprintf("CDD exported status\n");\r
-       cdprintf("Status =%.4X, Minute=%.4X, Second=%.4X, Frame=%.4X  Checksum=%.4X\n",\r
+//     cdprintf("CDD exported status\n");\r
+       cdprintf("out:  Status=%.4X, Minute=%.4X, Second=%.4X, Frame=%.4X  Checksum=%.4X",\r
                (Pico_mcd->s68k_regs[0x38+0] << 8) | Pico_mcd->s68k_regs[0x38+1],\r
                (Pico_mcd->s68k_regs[0x38+2] << 8) | Pico_mcd->s68k_regs[0x38+3],\r
                (Pico_mcd->s68k_regs[0x38+4] << 8) | Pico_mcd->s68k_regs[0x38+5],\r
@@ -554,10 +524,10 @@ 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("Command=%.4X, Minute=%.4X, Second=%.4X, Frame=%.4X  Checksum=%.4X\n",\r
+//     cdprintf("CDD importing command\n");\r
+       cdprintf("in:  Command=%.4X, Minute=%.4X, Second=%.4X, Frame=%.4X  Checksum=%.4X",\r
                (Pico_mcd->s68k_regs[0x38+10+0] << 8) | Pico_mcd->s68k_regs[0x38+10+1],\r
                (Pico_mcd->s68k_regs[0x38+10+2] << 8) | Pico_mcd->s68k_regs[0x38+10+3],\r
                (Pico_mcd->s68k_regs[0x38+10+4] << 8) | Pico_mcd->s68k_regs[0x38+10+5],\r
@@ -592,7 +562,7 @@ void CDD_Import_Command(void)
                                        Get_Current_Track_CDD_c22();\r
                                        break;\r
 \r
-                               case 0x3:       // get total lenght (MSF format)\r
+                               case 0x3:       // get total length (MSF format)\r
                                        Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 3;\r
                                        Get_Total_Lenght_CDD_c23();\r
                                        break;\r