+/***********************************************************\r
+ * *\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
+ * *\r
+ ***********************************************************/\r
+\r
#include <stdio.h>\r
-#include "cd_sys.h"\r
-#include "cd_file.h"\r
\r
#include "../PicoInt.h"\r
+#include "cd_sys.h"\r
+#include "cd_file.h"\r
\r
-#define cdprintf dprintf\r
-//#define cdprintf(x...)\r
#define DEBUG_CD\r
\r
#define TRAY_OPEN 0x0500 // TRAY OPEN CDD status\r
#define PLAYING 0x0100 // PLAYING audio track CDD status\r
\r
\r
-/*\r
-int CDDA_Enable;\r
-\r
-int CD_Audio_Buffer_L[8192];\r
-int CD_Audio_Buffer_R[8192];\r
-int CD_Audio_Buffer_Read_Pos = 0;\r
-int CD_Audio_Buffer_Write_Pos = 2000;\r
-int CD_Audio_Starting;\r
-*/\r
-\r
static int CD_Present = 0;\r
-// int CD_Timer_Counter = 0; // TODO: check refs\r
-\r
\r
\r
#define CHECK_TRAY_OPEN \\r
}\r
\r
\r
-#if 0\r
-static void MSB2DWORD(unsigned int *d, unsigned char *b)\r
-{\r
- unsigned int retVal;\r
-\r
- retVal = (unsigned int )b[0];\r
- retVal = (retVal<<8) + (unsigned int )b[1];\r
- retVal = (retVal<<8) + (unsigned int )b[2];\r
- retVal = (retVal<<8) + (unsigned int )b[3];\r
-\r
- *d = retVal;\r
-}\r
-#endif\r
-\r
static int MSF_to_LBA(_msf *MSF)\r
{\r
return (MSF->M * 60 * 75) + (MSF->S * 75) + MSF->F - 150;\r
}\r
\r
\r
-void LBA_to_MSF(int lba, _msf *MSF)\r
+PICO_INTERNAL void LBA_to_MSF(int lba, _msf *MSF)\r
{\r
if (lba < -150) lba = 0;\r
else lba += 150;\r
\r
Start = (MSF->M << 16) + (MSF->S << 8) + MSF->F;\r
\r
- for(i = Pico_mcd->scd.TOC.First_Track; i <= (Pico_mcd->scd.TOC.Last_Track + 1); i++)\r
+ for(i = 1; i <= (Pico_mcd->TOC.Last_Track + 1); i++)\r
{\r
- Cur = Pico_mcd->scd.TOC.Tracks[i - Pico_mcd->scd.TOC.First_Track].MSF.M << 16;\r
- Cur += Pico_mcd->scd.TOC.Tracks[i - Pico_mcd->scd.TOC.First_Track].MSF.S << 8;\r
- Cur += Pico_mcd->scd.TOC.Tracks[i - Pico_mcd->scd.TOC.First_Track].MSF.F;\r
+ Cur = Pico_mcd->TOC.Tracks[i - 1].MSF.M << 16;\r
+ Cur += Pico_mcd->TOC.Tracks[i - 1].MSF.S << 8;\r
+ Cur += Pico_mcd->TOC.Tracks[i - 1].MSF.F;\r
\r
if (Cur > Start) break;\r
}\r
\r
--i;\r
\r
- if (i > Pico_mcd->scd.TOC.Last_Track) return 100;\r
- if (i < Pico_mcd->scd.TOC.First_Track) i = Pico_mcd->scd.TOC.First_Track;\r
+ if (i > Pico_mcd->TOC.Last_Track) return 100;\r
+ else if (i < 1) i = 1;\r
\r
return (unsigned) i;\r
}\r
\r
static void Track_to_MSF(int track, _msf *MSF)\r
{\r
- if (track < Pico_mcd->scd.TOC.First_Track) track = Pico_mcd->scd.TOC.First_Track;\r
- else if (track > Pico_mcd->scd.TOC.Last_Track) track = Pico_mcd->scd.TOC.Last_Track;\r
+ if (track < 1) track = 1;\r
+ else if (track > Pico_mcd->TOC.Last_Track) track = Pico_mcd->TOC.Last_Track;\r
\r
- MSF->M = Pico_mcd->scd.TOC.Tracks[track - Pico_mcd->scd.TOC.First_Track].MSF.M;\r
- MSF->S = Pico_mcd->scd.TOC.Tracks[track - Pico_mcd->scd.TOC.First_Track].MSF.S;\r
- MSF->F = Pico_mcd->scd.TOC.Tracks[track - Pico_mcd->scd.TOC.First_Track].MSF.F;\r
+ MSF->M = Pico_mcd->TOC.Tracks[track - 1].MSF.M;\r
+ MSF->S = Pico_mcd->TOC.Tracks[track - 1].MSF.S;\r
+ MSF->F = Pico_mcd->TOC.Tracks[track - 1].MSF.F;\r
}\r
\r
\r
-int Track_to_LBA(int track)\r
+PICO_INTERNAL int Track_to_LBA(int track)\r
{\r
_msf MSF;\r
\r
}\r
\r
\r
-void Check_CD_Command(void)\r
+PICO_INTERNAL void Check_CD_Command(void)\r
{\r
cdprintf("CHECK CD COMMAND");\r
\r
- // Check CDD\r
-\r
- if (Pico_mcd->scd.CDD_Complete)\r
- {\r
- Pico_mcd->scd.CDD_Complete = 0;\r
-\r
- CDD_Export_Status();\r
- }\r
-\r
// Check CDC\r
-\r
if (Pico_mcd->scd.Status_CDC & 1) // CDC is reading data ...\r
{\r
cdprintf("Got a read command");\r
\r
// DATA ?\r
- if (Pico_mcd->scd.TOC.Tracks[Pico_mcd->scd.Cur_Track - Pico_mcd->scd.TOC.First_Track].Type)\r
+ if (Pico_mcd->scd.Cur_Track == 1)\r
Pico_mcd->s68k_regs[0x36] |= 0x01;\r
else Pico_mcd->s68k_regs[0x36] &= ~0x01; // AUDIO\r
\r
else Pico_mcd->scd.File_Add_Delay--;\r
}\r
\r
+ // Check CDD\r
+ if (Pico_mcd->scd.CDD_Complete)\r
+ {\r
+ Pico_mcd->scd.CDD_Complete = 0;\r
+\r
+ CDD_Export_Status();\r
+ }\r
+\r
if (Pico_mcd->scd.Status_CDD == FAST_FOW)\r
{\r
Pico_mcd->scd.Cur_LBA += 10;\r
}\r
\r
\r
-int Init_CD_Driver(void)\r
+PICO_INTERNAL int Init_CD_Driver(void)\r
{\r
- FILE_Init();\r
-\r
return 0;\r
}\r
\r
\r
-void End_CD_Driver(void)\r
+PICO_INTERNAL void End_CD_Driver(void)\r
{\r
- FILE_End();\r
+ Unload_ISO();\r
}\r
\r
\r
-void Reset_CD(void)\r
+PICO_INTERNAL void Reset_CD(void)\r
{\r
Pico_mcd->scd.Cur_Track = 0;\r
Pico_mcd->scd.Cur_LBA = -150;\r
- Pico_mcd->scd.Status_CDD = READY;\r
+ Pico_mcd->scd.Status_CDC &= ~1;\r
+ Pico_mcd->scd.Status_CDD = CD_Present ? READY : NOCD;\r
Pico_mcd->scd.CDD_Complete = 0;\r
+ Pico_mcd->scd.File_Add_Delay = 0;\r
}\r
\r
\r
{\r
int ret = 0;\r
\r
-// memset(CD_Audio_Buffer_L, 0, 4096 * 4);\r
-// memset(CD_Audio_Buffer_R, 0, 4096 * 4);\r
-\r
CD_Present = 0;\r
+ Pico_mcd->scd.Status_CDD = NOCD;\r
\r
if (iso_name != NULL)\r
{\r
ret = Load_ISO(iso_name, is_bin);\r
- if (ret == 0)\r
+ if (ret == 0) {\r
CD_Present = 1;\r
+ Pico_mcd->scd.Status_CDD = READY;\r
+ }\r
}\r
\r
return ret;\r
}\r
\r
\r
-void Change_CD(void)\r
+/*\r
+PICO_INTERNAL void Change_CD(void)\r
{\r
if (Pico_mcd->scd.Status_CDD == TRAY_OPEN) Close_Tray_CDD_cC();\r
else Open_Tray_CDD_cD();\r
}\r
+*/\r
\r
-\r
-int Get_Status_CDD_c0(void)\r
+PICO_INTERNAL int Get_Status_CDD_c0(void)\r
{\r
cdprintf("Status command : Cur LBA = %d", Pico_mcd->scd.Cur_LBA);\r
\r
}\r
\r
\r
-int Stop_CDD_c1(void)\r
+PICO_INTERNAL int Stop_CDD_c1(void)\r
{\r
CHECK_TRAY_OPEN\r
\r
}\r
\r
\r
-int Get_Pos_CDD_c20(void)\r
+PICO_INTERNAL int Get_Pos_CDD_c20(void)\r
{\r
_msf MSF;\r
\r
}\r
\r
\r
-int Get_Track_Pos_CDD_c21(void)\r
+PICO_INTERNAL int Get_Track_Pos_CDD_c21(void)\r
{\r
int elapsed_time;\r
_msf MSF;\r
}\r
\r
\r
-int Get_Current_Track_CDD_c22(void)\r
+PICO_INTERNAL int Get_Current_Track_CDD_c22(void)\r
{\r
cdprintf("Status CDD = %.4X Status = %.4X", Pico_mcd->scd.Status_CDD, Pico_mcd->cdd.Status);\r
\r
}\r
\r
\r
-int Get_Total_Lenght_CDD_c23(void)\r
+PICO_INTERNAL int Get_Total_Lenght_CDD_c23(void)\r
{\r
CHECK_TRAY_OPEN\r
\r
// else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
\r
- Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.TOC.Tracks[Pico_mcd->scd.TOC.Last_Track -\r
- Pico_mcd->scd.TOC.First_Track + 1].MSF.M);\r
- Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->scd.TOC.Tracks[Pico_mcd->scd.TOC.Last_Track -\r
- Pico_mcd->scd.TOC.First_Track + 1].MSF.S);\r
- Pico_mcd->cdd.Frame = INT_TO_BCDW(Pico_mcd->scd.TOC.Tracks[Pico_mcd->scd.TOC.Last_Track -\r
- Pico_mcd->scd.TOC.First_Track + 1].MSF.F);\r
+ Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->TOC.Tracks[Pico_mcd->TOC.Last_Track].MSF.M);\r
+ Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->TOC.Tracks[Pico_mcd->TOC.Last_Track].MSF.S);\r
+ Pico_mcd->cdd.Frame = INT_TO_BCDW(Pico_mcd->TOC.Tracks[Pico_mcd->TOC.Last_Track].MSF.F);\r
Pico_mcd->cdd.Ext = 0;\r
\r
-// FIXME: remove\r
-//Pico_mcd->cdd.Seconde = 2;\r
-\r
Pico_mcd->scd.CDD_Complete = 1;\r
\r
return 0;\r
}\r
\r
\r
-int Get_First_Last_Track_CDD_c24(void)\r
+PICO_INTERNAL int Get_First_Last_Track_CDD_c24(void)\r
{\r
CHECK_TRAY_OPEN\r
\r
// else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
\r
- Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.TOC.First_Track);\r
- Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->scd.TOC.Last_Track);\r
+ Pico_mcd->cdd.Minute = INT_TO_BCDW(1);\r
+ Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->TOC.Last_Track);\r
Pico_mcd->cdd.Frame = 0;\r
Pico_mcd->cdd.Ext = 0;\r
\r
-// FIXME: remove\r
-//Pico_mcd->cdd.Minute = Pico_mcd->cdd.Seconde = 1;\r
-\r
Pico_mcd->scd.CDD_Complete = 1;\r
\r
return 0;\r
}\r
\r
\r
-int Get_Track_Adr_CDD_c25(void)\r
+PICO_INTERNAL int Get_Track_Adr_CDD_c25(void)\r
{\r
int track_number;\r
\r
// else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
\r
- if (track_number > Pico_mcd->scd.TOC.Last_Track) track_number = Pico_mcd->scd.TOC.Last_Track;\r
- else if (track_number < Pico_mcd->scd.TOC.First_Track) track_number = Pico_mcd->scd.TOC.First_Track;\r
+ if (track_number > Pico_mcd->TOC.Last_Track) track_number = Pico_mcd->TOC.Last_Track;\r
+ else if (track_number < 1) track_number = 1;\r
\r
- Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.TOC.Tracks[track_number - Pico_mcd->scd.TOC.First_Track].MSF.M);\r
- Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->scd.TOC.Tracks[track_number - Pico_mcd->scd.TOC.First_Track].MSF.S);\r
- Pico_mcd->cdd.Frame = INT_TO_BCDW(Pico_mcd->scd.TOC.Tracks[track_number - Pico_mcd->scd.TOC.First_Track].MSF.F);\r
+ Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->TOC.Tracks[track_number - 1].MSF.M);\r
+ Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->TOC.Tracks[track_number - 1].MSF.S);\r
+ Pico_mcd->cdd.Frame = INT_TO_BCDW(Pico_mcd->TOC.Tracks[track_number - 1].MSF.F);\r
Pico_mcd->cdd.Ext = track_number % 10;\r
\r
- if (Pico_mcd->scd.TOC.Tracks[track_number - Pico_mcd->scd.TOC.First_Track].Type) Pico_mcd->cdd.Frame |= 0x0800;\r
+ if (track_number == 1) Pico_mcd->cdd.Frame |= 0x0800; // data track\r
\r
Pico_mcd->scd.CDD_Complete = 1;\r
return 0;\r
}\r
\r
\r
-int Play_CDD_c3(void)\r
+PICO_INTERNAL int Play_CDD_c3(void)\r
{\r
_msf MSF;\r
int delay, new_lba;\r
\r
if (Pico_mcd->scd.File_Add_Delay == 0) Pico_mcd->scd.File_Add_Delay = delay;\r
\r
- if (Pico_mcd->scd.TOC.Tracks[Pico_mcd->scd.Cur_Track - Pico_mcd->scd.TOC.First_Track].Type)\r
+ if (Pico_mcd->scd.Cur_Track == 1)\r
{\r
Pico_mcd->s68k_regs[0x36] |= 0x01; // DATA\r
}\r
}\r
\r
\r
-int Seek_CDD_c4(void)\r
+PICO_INTERNAL int Seek_CDD_c4(void)\r
{\r
_msf MSF;\r
\r
Pico_mcd->cdd.Status = 0x0200;\r
\r
// DATA ?\r
- if (Pico_mcd->scd.TOC.Tracks[Pico_mcd->scd.Cur_Track - Pico_mcd->scd.TOC.First_Track].Type)\r
+ if (Pico_mcd->scd.Cur_Track == 1)\r
Pico_mcd->s68k_regs[0x36] |= 0x01;\r
else Pico_mcd->s68k_regs[0x36] &= ~0x01; // AUDIO\r
\r
}\r
\r
\r
-int Pause_CDD_c6(void)\r
+PICO_INTERNAL int Pause_CDD_c6(void)\r
{\r
CHECK_TRAY_OPEN\r
CHECK_CD_PRESENT\r
}\r
\r
\r
-int Resume_CDD_c7(void)\r
+PICO_INTERNAL int Resume_CDD_c7(void)\r
{\r
CHECK_TRAY_OPEN\r
CHECK_CD_PRESENT\r
Pico_mcd->scd.Status_CDD = PLAYING;\r
Pico_mcd->cdd.Status = 0x0102;\r
\r
- if (Pico_mcd->scd.TOC.Tracks[Pico_mcd->scd.Cur_Track - Pico_mcd->scd.TOC.First_Track].Type)\r
+ if (Pico_mcd->scd.Cur_Track == 1)\r
{\r
Pico_mcd->s68k_regs[0x36] |= 0x01; // DATA\r
}\r
}\r
\r
\r
-int Fast_Foward_CDD_c8(void)\r
+PICO_INTERNAL int Fast_Foward_CDD_c8(void)\r
{\r
CHECK_TRAY_OPEN\r
CHECK_CD_PRESENT\r
}\r
\r
\r
-int Fast_Rewind_CDD_c9(void)\r
+PICO_INTERNAL int Fast_Rewind_CDD_c9(void)\r
{\r
CHECK_TRAY_OPEN\r
CHECK_CD_PRESENT\r
}\r
\r
\r
-int Close_Tray_CDD_cC(void)\r
+PICO_INTERNAL int Close_Tray_CDD_cC(void)\r
{\r
+ CD_Present = 0;\r
//Clear_Sound_Buffer();\r
\r
Pico_mcd->scd.Status_CDC &= ~1; // Stop CDC read\r
\r
- {\r
-#if 0 // TODO\r
- char new_iso[1024];\r
-\r
- memset(new_iso, 0, 1024);\r
+ elprintf(EL_STATUS, "tray close\n");\r
\r
- while (!Change_File_L(new_iso, Rom_Dir, "Load SegaCD image file", "SegaCD image file\0*.bin;*.iso;*.raw\0All files\0*.*\0\0", ""));\r
- Reload_SegaCD(new_iso);\r
+ if (PicoMCDcloseTray != NULL)\r
+ CD_Present = PicoMCDcloseTray();\r
\r
- CD_Present = 1;\r
-#else\r
- CD_Present = 0;\r
-#endif\r
- Pico_mcd->scd.Status_CDD = STOPPED;\r
- Pico_mcd->cdd.Status = 0x0000;\r
+ Pico_mcd->scd.Status_CDD = CD_Present ? STOPPED : NOCD;\r
+ Pico_mcd->cdd.Status = 0x0000;\r
\r
- Pico_mcd->cdd.Minute = 0;\r
- Pico_mcd->cdd.Seconde = 0;\r
- Pico_mcd->cdd.Frame = 0;\r
- Pico_mcd->cdd.Ext = 0;\r
- }\r
+ Pico_mcd->cdd.Minute = 0;\r
+ Pico_mcd->cdd.Seconde = 0;\r
+ Pico_mcd->cdd.Frame = 0;\r
+ Pico_mcd->cdd.Ext = 0;\r
\r
Pico_mcd->scd.CDD_Complete = 1;\r
\r
}\r
\r
\r
-int Open_Tray_CDD_cD(void)\r
+PICO_INTERNAL int Open_Tray_CDD_cD(void)\r
{\r
CHECK_TRAY_OPEN\r
\r
Pico_mcd->scd.Status_CDC &= ~1; // Stop CDC read\r
\r
+ elprintf(EL_STATUS, "tray open\n");\r
+\r
Unload_ISO();\r
CD_Present = 0;\r
\r
+ if (PicoMCDopenTray != NULL)\r
+ PicoMCDopenTray();\r
+\r
Pico_mcd->scd.Status_CDD = TRAY_OPEN;\r
Pico_mcd->cdd.Status = 0x0E00;\r
\r
}\r
\r
\r
-int CDD_cA(void)\r
+PICO_INTERNAL int CDD_cA(void)\r
{\r
CHECK_TRAY_OPEN\r
CHECK_CD_PRESENT\r
}\r
\r
\r
-int CDD_Def(void)\r
+PICO_INTERNAL int CDD_Def(void)\r
{\r
Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD;\r
\r
}\r
\r
\r
-\r
-\r
-/***************************\r
- * Others CD functions *\r
- **************************/\r
-\r
-\r
-// do we need them?\r
-#if 0\r
-void Write_CD_Audio(short *Buf, int rate, int channel, int lenght)\r
-{\r
- unsigned int lenght_src, lenght_dst;\r
- unsigned int pos_src, pas_src;\r
-\r
- if (rate == 0) return;\r
- if (Sound_Rate == 0) return;\r
-\r
- if (CD_Audio_Starting)\r
- {\r
- CD_Audio_Starting = 0;\r
- memset(CD_Audio_Buffer_L, 0, 4096 * 4);\r
- memset(CD_Audio_Buffer_R, 0, 4096 * 4);\r
- CD_Audio_Buffer_Write_Pos = (CD_Audio_Buffer_Read_Pos + 2000) & 0xFFF;\r
- }\r
-\r
- lenght_src = rate / 75; // 75th of a second\r
- lenght_dst = Sound_Rate / 75; // 75th of a second\r
-\r
- pas_src = (lenght_src << 16) / lenght_dst;\r
- pos_src = 0;\r
-\r
-#ifdef DEBUG_CD\r
- fprintf(debug_SCD_file, "\n********* Write Pos = %d ", CD_Audio_Buffer_Write_Pos);\r
-#endif\r
-\r
- if (channel == 2)\r
- {\r
- __asm\r
- {\r
- mov edi, CD_Audio_Buffer_Write_Pos\r
- mov ebx, Buf\r
- xor esi, esi\r
- mov ecx, lenght_dst\r
- xor eax, eax\r
- mov edx, pas_src\r
- dec ecx\r
- jmp short loop_stereo\r
-\r
-align 16\r
-\r
-loop_stereo:\r
- movsx eax, word ptr [ebx + esi * 4]\r
- mov CD_Audio_Buffer_L[edi * 4], eax\r
- movsx eax, word ptr [ebx + esi * 4 + 2]\r
- mov CD_Audio_Buffer_R[edi * 4], eax\r
- mov esi, dword ptr pos_src\r
- inc edi\r
- add esi, edx\r
- and edi, 0xFFF\r
- mov dword ptr pos_src, esi\r
- shr esi, 16\r
- dec ecx\r
- jns short loop_stereo\r
-\r
- mov CD_Audio_Buffer_Write_Pos, edi\r
- }\r
- }\r
- else\r
- {\r
- __asm\r
- {\r
- mov edi, CD_Audio_Buffer_Write_Pos\r
- mov ebx, Buf\r
- xor esi, esi\r
- mov ecx, lenght_dst\r
- xor eax, eax\r
- mov edx, pas_src\r
- dec ecx\r
- jmp short loop_mono\r
-\r
-align 16\r
-\r
-loop_mono:\r
- movsx eax, word ptr [ebx + esi * 2]\r
- mov CD_Audio_Buffer_L[edi * 4], eax\r
- mov CD_Audio_Buffer_R[edi * 4], eax\r
- mov esi, dword ptr pos_src\r
- inc edi\r
- add esi, edx\r
- and edi, 0xFFF\r
- mov dword ptr pos_src, esi\r
- shr esi, 16\r
- dec ecx\r
- jns short loop_mono\r
-\r
- mov CD_Audio_Buffer_Write_Pos, edi\r
- }\r
- }\r
-\r
-#ifdef DEBUG_CD\r
- fprintf(debug_SCD_file, "Write Pos 2 = %d\n\n", CD_Audio_Buffer_Write_Pos);\r
-#endif\r
-}\r
-\r
-\r
-void Update_CD_Audio(int **buf, int lenght)\r
-{\r
- int *Buf_L, *Buf_R;\r
- int diff;\r
-\r
- Buf_L = buf[0];\r
- Buf_R = buf[1];\r
-\r
- if (Pico_mcd->s68k_regs[0x36] & 0x01) return;\r
- if (!(Pico_mcd->scd.Status_CDC & 1)) return;\r
- if (CD_Audio_Starting) return;\r
-\r
-#ifdef DEBUG_CD\r
- fprintf(debug_SCD_file, "\n********* Read Pos Normal = %d ", CD_Audio_Buffer_Read_Pos);\r
-#endif\r
-\r
- if (CD_Audio_Buffer_Write_Pos < CD_Audio_Buffer_Read_Pos)\r
- {\r
- diff = CD_Audio_Buffer_Write_Pos + (4096) - CD_Audio_Buffer_Read_Pos;\r
- }\r
- else\r
- {\r
- diff = CD_Audio_Buffer_Write_Pos - CD_Audio_Buffer_Read_Pos;\r
- }\r
-\r
- if (diff < 500) CD_Audio_Buffer_Read_Pos -= 2000;\r
- else if (diff > 3500) CD_Audio_Buffer_Read_Pos += 2000;\r
-\r
-#ifdef DEBUG_CD\r
- else fprintf(debug_SCD_file, " pas de modifs ");\r
-#endif\r
-\r
- CD_Audio_Buffer_Read_Pos &= 0xFFF;\r
-\r
-#ifdef DEBUG_CD\r
- fprintf(debug_SCD_file, "Read Pos = %d ", CD_Audio_Buffer_Read_Pos);\r
-#endif\r
-\r
- if (CDDA_Enable)\r
- {\r
- __asm\r
- {\r
- mov ecx, lenght\r
- mov esi, CD_Audio_Buffer_Read_Pos\r
- mov edi, Buf_L\r
- dec ecx\r
-\r
-loop_L:\r
- mov eax, CD_Audio_Buffer_L[esi * 4]\r
- add [edi], eax\r
- inc esi\r
- add edi, 4\r
- and esi, 0xFFF\r
- dec ecx\r
- jns short loop_L\r
-\r
- mov ecx, lenght\r
- mov esi, CD_Audio_Buffer_Read_Pos\r
- mov edi, Buf_R\r
- dec ecx\r
-\r
-loop_R:\r
- mov eax, CD_Audio_Buffer_R[esi * 4]\r
- add [edi], eax\r
- inc esi\r
- add edi, 4\r
- and esi, 0xFFF\r
- dec ecx\r
- jns short loop_R\r
-\r
- mov CD_Audio_Buffer_Read_Pos, esi\r
- }\r
- }\r
- else\r
- {\r
- CD_Audio_Buffer_Read_Pos += lenght;\r
- CD_Audio_Buffer_Read_Pos &= 0xFFF;\r
- }\r
-\r
-#ifdef DEBUG_CD\r
- fprintf(debug_SCD_file, "Read Pos 2 = %d\n\n", CD_Audio_Buffer_Read_Pos);\r
-#endif\r
-}\r
-#endif\r
-\r