Pico/cd/cd_sys.c

   1 #include <stdio.h>\r
   2 #include "cd_sys.h"\r
   3 #include "cd_file.h"\r
   4 \r
   5 #include "../PicoInt.h"\r
   6 \r
   7 #define cdprintf dprintf\r
   8 //#define cdprintf(x...)\r
   9 #define DEBUG_CD\r
  10 \r
  11 #define TRAY_OPEN       0x0500          // TRAY OPEN CDD status\r
  12 #define NOCD            0x0000          // CD removed CDD status\r
  13 #define STOPPED         0x0900          // STOPPED CDD status (happen after stop or close tray command)\r
  14 #define READY           0x0400          // READY CDD status (also used for seeking)\r
  15 #define FAST_FOW        0x0300          // FAST FORWARD track CDD status\r
  16 #define FAST_REV        0x10300         // FAST REVERSE track CDD status\r
  17 #define PLAYING         0x0100          // PLAYING audio track CDD status\r
  18 \r
  19 \r
  20 /*\r
  21 int CDDA_Enable;\r
  22 \r
  23 int CD_Audio_Buffer_L[8192];\r
  24 int CD_Audio_Buffer_R[8192];\r
  25 int CD_Audio_Buffer_Read_Pos = 0;\r
  26 int CD_Audio_Buffer_Write_Pos = 2000;\r
  27 int CD_Audio_Starting;\r
  28 */\r
  29 \r
  30 static int CD_Present = 0;\r
  31 // int CD_Timer_Counter = 0; // TODO: check refs\r
  32 \r
  33 \r
  34 \r
  35 #define CHECK_TRAY_OPEN                         \\r
  36 if (Pico_mcd->scd.Status_CDD == TRAY_OPEN)      \\r
  37 {                                                                       \\r
  38         Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD;        \\r
  39                                                                         \\r
  40         Pico_mcd->cdd.Minute = 0;                                       \\r
  41         Pico_mcd->cdd.Seconde = 0;                              \\r
  42         Pico_mcd->cdd.Frame = 0;                                        \\r
  43         Pico_mcd->cdd.Ext = 0;                                  \\r
  44                                                                         \\r
  45         Pico_mcd->scd.CDD_Complete = 1;                         \\r
  46                                                                         \\r
  47         return 2;                                               \\r
  48 }\r
  49 \r
  50 \r
  51 #define CHECK_CD_PRESENT                        \\r
  52 if (!CD_Present)                                        \\r
  53 {                                                                       \\r
  54         Pico_mcd->scd.Status_CDD = NOCD;                        \\r
  55         Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD;        \\r
  56                                                                         \\r
  57         Pico_mcd->cdd.Minute = 0;                                       \\r
  58         Pico_mcd->cdd.Seconde = 0;                              \\r
  59         Pico_mcd->cdd.Frame = 0;                                        \\r
  60         Pico_mcd->cdd.Ext = 0;                                  \\r
  61                                                                         \\r
  62         Pico_mcd->scd.CDD_Complete = 1;                         \\r
  63                                                                         \\r
  64         return 3;                                               \\r
  65 }\r
  66 \r
  67 \r
  68 #if 0\r
  69 static void MSB2DWORD(unsigned int *d, unsigned char *b)\r
  70 {\r
  71         unsigned int  retVal;\r
  72 \r
  73         retVal = (unsigned int )b[0];\r
  74         retVal = (retVal<<8) + (unsigned int )b[1];\r
  75         retVal = (retVal<<8) + (unsigned int )b[2];\r
  76         retVal = (retVal<<8) + (unsigned int )b[3];\r
  77 \r
  78         *d = retVal;\r
  79 }\r
  80 #endif\r
  81 \r
  82 static int MSF_to_LBA(_msf *MSF)\r
  83 {\r
  84         return (MSF->M * 60 * 75) + (MSF->S * 75) + MSF->F - 150;\r
  85 }\r
  86 \r
  87 \r
  88 void LBA_to_MSF(int lba, _msf *MSF)\r
  89 {\r
  90         if (lba < -150) lba = 0;\r
  91         else lba += 150;\r
  92         MSF->M = lba / (60 * 75);\r
  93         MSF->S = (lba / 75) % 60;\r
  94         MSF->F = lba % 75;\r
  95 }\r
  96 \r
  97 \r
  98 static unsigned int MSF_to_Track(_msf *MSF)\r
  99 {\r
 100         int i, Start, Cur;\r
 101 \r
 102         Start = (MSF->M << 16) + (MSF->S << 8) + MSF->F;\r
 103 \r
 104         for(i = 1; i <= (Pico_mcd->TOC.Last_Track + 1); i++)\r
 105         {\r
 106                 Cur = Pico_mcd->TOC.Tracks[i - 1].MSF.M << 16;\r
 107                 Cur += Pico_mcd->TOC.Tracks[i - 1].MSF.S << 8;\r
 108                 Cur += Pico_mcd->TOC.Tracks[i - 1].MSF.F;\r
 109 \r
 110                 if (Cur > Start) break;\r
 111         }\r
 112 \r
 113         --i;\r
 114 \r
 115         if (i > Pico_mcd->TOC.Last_Track) return 100;\r
 116         else if (i < 1) i = 1;\r
 117 \r
 118         return (unsigned) i;\r
 119 }\r
 120 \r
 121 \r
 122 static unsigned int LBA_to_Track(int lba)\r
 123 {\r
 124         _msf MSF;\r
 125 \r
 126         LBA_to_MSF(lba, &MSF);\r
 127         return MSF_to_Track(&MSF);\r
 128 }\r
 129 \r
 130 \r
 131 static void Track_to_MSF(int track, _msf *MSF)\r
 132 {\r
 133         if (track < 1) track = 1;\r
 134         else if (track > Pico_mcd->TOC.Last_Track) track = Pico_mcd->TOC.Last_Track;\r
 135 \r
 136         MSF->M = Pico_mcd->TOC.Tracks[track - 1].MSF.M;\r
 137         MSF->S = Pico_mcd->TOC.Tracks[track - 1].MSF.S;\r
 138         MSF->F = Pico_mcd->TOC.Tracks[track - 1].MSF.F;\r
 139 }\r
 140 \r
 141 \r
 142 int Track_to_LBA(int track)\r
 143 {\r
 144         _msf MSF;\r
 145 \r
 146         Track_to_MSF(track, &MSF);\r
 147         return MSF_to_LBA(&MSF);\r
 148 }\r
 149 \r
 150 \r
 151 void Check_CD_Command(void)\r
 152 {\r
 153         cdprintf("CHECK CD COMMAND");\r
 154 \r
 155         // Check CDC\r
 156         if (Pico_mcd->scd.Status_CDC & 1)                       // CDC is reading data ...\r
 157         {\r
 158                 cdprintf("Got a read command");\r
 159 \r
 160                 // DATA ?\r
 161                 if (Pico_mcd->scd.Cur_Track == 1)\r
 162                      Pico_mcd->s68k_regs[0x36] |=  0x01;\r
 163                 else Pico_mcd->s68k_regs[0x36] &= ~0x01;                        // AUDIO\r
 164 \r
 165                 if (Pico_mcd->scd.File_Add_Delay == 0)\r
 166                 {\r
 167                         FILE_Read_One_LBA_CDC();\r
 168                 }\r
 169                 else Pico_mcd->scd.File_Add_Delay--;\r
 170         }\r
 171 \r
 172         // Check CDD\r
 173         if (Pico_mcd->scd.CDD_Complete)\r
 174         {\r
 175                 Pico_mcd->scd.CDD_Complete = 0;\r
 176 \r
 177                 CDD_Export_Status();\r
 178         }\r
 179 \r
 180         if (Pico_mcd->scd.Status_CDD == FAST_FOW)\r
 181         {\r
 182                 Pico_mcd->scd.Cur_LBA += 10;\r
 183                 CDC_Update_Header();\r
 184 \r
 185         }\r
 186         else if (Pico_mcd->scd.Status_CDD == FAST_REV)\r
 187         {\r
 188                 Pico_mcd->scd.Cur_LBA -= 10;\r
 189                 if (Pico_mcd->scd.Cur_LBA < -150) Pico_mcd->scd.Cur_LBA = -150;\r
 190                 CDC_Update_Header();\r
 191         }\r
 192 }\r
 193 \r
 194 \r
 195 int Init_CD_Driver(void)\r
 196 {\r
 197         return 0;\r
 198 }\r
 199 \r
 200 \r
 201 void End_CD_Driver(void)\r
 202 {\r
 203         FILE_End();\r
 204 }\r
 205 \r
 206 \r
 207 void Reset_CD(void)\r
 208 {\r
 209         Pico_mcd->scd.Cur_Track = 0;\r
 210         Pico_mcd->scd.Cur_LBA = -150;\r
 211         Pico_mcd->scd.Status_CDD = READY;\r
 212         Pico_mcd->scd.CDD_Complete = 0;\r
 213 }\r
 214 \r
 215 \r
 216 int Insert_CD(char *iso_name, int is_bin)\r
 217 {\r
 218         int ret = 0;\r
 219 \r
 220 //      memset(CD_Audio_Buffer_L, 0, 4096 * 4);\r
 221 //      memset(CD_Audio_Buffer_R, 0, 4096 * 4);\r
 222 \r
 223         CD_Present = 0;\r
 224 \r
 225         if (iso_name != NULL)\r
 226         {\r
 227                 ret = Load_ISO(iso_name, is_bin);\r
 228                 if (ret == 0)\r
 229                         CD_Present = 1;\r
 230         }\r
 231 \r
 232         return ret;\r
 233 }\r
 234 \r
 235 \r
 236 void Stop_CD(void)\r
 237 {\r
 238         Unload_ISO();\r
 239         CD_Present = 0;\r
 240 }\r
 241 \r
 242 \r
 243 void Change_CD(void)\r
 244 {\r
 245         if (Pico_mcd->scd.Status_CDD == TRAY_OPEN) Close_Tray_CDD_cC();\r
 246         else Open_Tray_CDD_cD();\r
 247 }\r
 248 \r
 249 \r
 250 int Get_Status_CDD_c0(void)\r
 251 {\r
 252         cdprintf("Status command : Cur LBA = %d", Pico_mcd->scd.Cur_LBA);\r
 253 \r
 254         // Clear immediat status\r
 255         if ((Pico_mcd->cdd.Status & 0x0F00) == 0x0200)\r
 256                 Pico_mcd->cdd.Status = (Pico_mcd->scd.Status_CDD & 0xFF00) | (Pico_mcd->cdd.Status & 0x00FF);\r
 257         else if ((Pico_mcd->cdd.Status & 0x0F00) == 0x0700)\r
 258                 Pico_mcd->cdd.Status = (Pico_mcd->scd.Status_CDD & 0xFF00) | (Pico_mcd->cdd.Status & 0x00FF);\r
 259         else if ((Pico_mcd->cdd.Status & 0x0F00) == 0x0E00)\r
 260                 Pico_mcd->cdd.Status = (Pico_mcd->scd.Status_CDD & 0xFF00) | (Pico_mcd->cdd.Status & 0x00FF);\r
 261 \r
 262         Pico_mcd->scd.CDD_Complete = 1;\r
 263 \r
 264         return 0;\r
 265 }\r
 266 \r
 267 \r
 268 int Stop_CDD_c1(void)\r
 269 {\r
 270         CHECK_TRAY_OPEN\r
 271 \r
 272         Pico_mcd->scd.Status_CDC &= ~1;                         // Stop CDC read\r
 273 \r
 274         if (CD_Present) Pico_mcd->scd.Status_CDD = STOPPED;\r
 275         else Pico_mcd->scd.Status_CDD = NOCD;\r
 276         Pico_mcd->cdd.Status = 0x0000;\r
 277 \r
 278         Pico_mcd->s68k_regs[0x36] |= 0x01;                      // Data bit set because stopped\r
 279 \r
 280         Pico_mcd->cdd.Minute = 0;\r
 281         Pico_mcd->cdd.Seconde = 0;\r
 282         Pico_mcd->cdd.Frame = 0;\r
 283         Pico_mcd->cdd.Ext = 0;\r
 284 \r
 285         Pico_mcd->scd.CDD_Complete = 1;\r
 286 \r
 287         return 0;\r
 288 }\r
 289 \r
 290 \r
 291 int Get_Pos_CDD_c20(void)\r
 292 {\r
 293         _msf MSF;\r
 294 \r
 295         cdprintf("command 200 : Cur LBA = %d", Pico_mcd->scd.Cur_LBA);\r
 296 \r
 297         CHECK_TRAY_OPEN\r
 298 \r
 299         Pico_mcd->cdd.Status &= 0xFF;\r
 300         if (!CD_Present)\r
 301         {\r
 302                 Pico_mcd->scd.Status_CDD = NOCD;\r
 303                 Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 304         }\r
 305 //      else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 306         Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 307 \r
 308         cdprintf("Status CDD = %.4X  Status = %.4X", Pico_mcd->scd.Status_CDD, Pico_mcd->cdd.Status);\r
 309 \r
 310         LBA_to_MSF(Pico_mcd->scd.Cur_LBA, &MSF);\r
 311 \r
 312         Pico_mcd->cdd.Minute = INT_TO_BCDW(MSF.M);\r
 313         Pico_mcd->cdd.Seconde = INT_TO_BCDW(MSF.S);\r
 314         Pico_mcd->cdd.Frame = INT_TO_BCDW(MSF.F);\r
 315         Pico_mcd->cdd.Ext = 0;\r
 316 \r
 317         Pico_mcd->scd.CDD_Complete = 1;\r
 318 \r
 319         return 0;\r
 320 }\r
 321 \r
 322 \r
 323 int Get_Track_Pos_CDD_c21(void)\r
 324 {\r
 325         int elapsed_time;\r
 326         _msf MSF;\r
 327 \r
 328         cdprintf("command 201 : Cur LBA = %d", Pico_mcd->scd.Cur_LBA);\r
 329 \r
 330         CHECK_TRAY_OPEN\r
 331 \r
 332         Pico_mcd->cdd.Status &= 0xFF;\r
 333         if (!CD_Present)\r
 334         {\r
 335                 Pico_mcd->scd.Status_CDD = NOCD;\r
 336                 Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 337         }\r
 338 //      else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 339         Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 340 \r
 341         elapsed_time = Pico_mcd->scd.Cur_LBA - Track_to_LBA(LBA_to_Track(Pico_mcd->scd.Cur_LBA));\r
 342         LBA_to_MSF(elapsed_time - 150, &MSF);\r
 343 \r
 344         cdprintf("   elapsed = %d", elapsed_time);\r
 345 \r
 346         Pico_mcd->cdd.Minute = INT_TO_BCDW(MSF.M);\r
 347         Pico_mcd->cdd.Seconde = INT_TO_BCDW(MSF.S);\r
 348         Pico_mcd->cdd.Frame = INT_TO_BCDW(MSF.F);\r
 349         Pico_mcd->cdd.Ext = 0;\r
 350 \r
 351         Pico_mcd->scd.CDD_Complete = 1;\r
 352 \r
 353         return 0;\r
 354 }\r
 355 \r
 356 \r
 357 int Get_Current_Track_CDD_c22(void)\r
 358 {\r
 359         cdprintf("Status CDD = %.4X  Status = %.4X", Pico_mcd->scd.Status_CDD, Pico_mcd->cdd.Status);\r
 360 \r
 361         CHECK_TRAY_OPEN\r
 362 \r
 363         Pico_mcd->cdd.Status &= 0xFF;\r
 364         if (!CD_Present)\r
 365         {\r
 366                 Pico_mcd->scd.Status_CDD = NOCD;\r
 367                 Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 368         }\r
 369 //      else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 370         Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 371 \r
 372         Pico_mcd->scd.Cur_Track = LBA_to_Track(Pico_mcd->scd.Cur_LBA);\r
 373 \r
 374         if (Pico_mcd->scd.Cur_Track == 100) Pico_mcd->cdd.Minute = 0x0A02;\r
 375         else Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.Cur_Track);\r
 376         Pico_mcd->cdd.Seconde = 0;\r
 377         Pico_mcd->cdd.Frame = 0;\r
 378         Pico_mcd->cdd.Ext = 0;\r
 379 \r
 380         Pico_mcd->scd.CDD_Complete = 1;\r
 381 \r
 382         return 0;\r
 383 }\r
 384 \r
 385 \r
 386 int Get_Total_Lenght_CDD_c23(void)\r
 387 {\r
 388         CHECK_TRAY_OPEN\r
 389 \r
 390         Pico_mcd->cdd.Status &= 0xFF;\r
 391         if (!CD_Present)\r
 392         {\r
 393                 Pico_mcd->scd.Status_CDD = NOCD;\r
 394                 Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 395         }\r
 396 //      else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 397         Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 398 \r
 399         Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->TOC.Tracks[Pico_mcd->TOC.Last_Track].MSF.M);\r
 400         Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->TOC.Tracks[Pico_mcd->TOC.Last_Track].MSF.S);\r
 401         Pico_mcd->cdd.Frame = INT_TO_BCDW(Pico_mcd->TOC.Tracks[Pico_mcd->TOC.Last_Track].MSF.F);\r
 402         Pico_mcd->cdd.Ext = 0;\r
 403 \r
 404         Pico_mcd->scd.CDD_Complete = 1;\r
 405 \r
 406         return 0;\r
 407 }\r
 408 \r
 409 \r
 410 int Get_First_Last_Track_CDD_c24(void)\r
 411 {\r
 412         CHECK_TRAY_OPEN\r
 413 \r
 414         Pico_mcd->cdd.Status &= 0xFF;\r
 415         if (!CD_Present)\r
 416         {\r
 417                 Pico_mcd->scd.Status_CDD = NOCD;\r
 418         }\r
 419 //      else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 420         Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 421 \r
 422         Pico_mcd->cdd.Minute = INT_TO_BCDW(1);\r
 423         Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->TOC.Last_Track);\r
 424         Pico_mcd->cdd.Frame = 0;\r
 425         Pico_mcd->cdd.Ext = 0;\r
 426 \r
 427         Pico_mcd->scd.CDD_Complete = 1;\r
 428 \r
 429         return 0;\r
 430 }\r
 431 \r
 432 \r
 433 int Get_Track_Adr_CDD_c25(void)\r
 434 {\r
 435         int track_number;\r
 436 \r
 437         CHECK_TRAY_OPEN\r
 438 \r
 439         // track number in TC4 & TC5\r
 440 \r
 441         track_number = (Pico_mcd->s68k_regs[0x38+10+4] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+5] & 0xF);\r
 442 \r
 443         Pico_mcd->cdd.Status &= 0xFF;\r
 444         if (!CD_Present)\r
 445         {\r
 446                 Pico_mcd->scd.Status_CDD = NOCD;\r
 447                 Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 448         }\r
 449 //      else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 450         Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 451 \r
 452         if (track_number > Pico_mcd->TOC.Last_Track) track_number = Pico_mcd->TOC.Last_Track;\r
 453         else if (track_number < 1) track_number = 1;\r
 454 \r
 455         Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->TOC.Tracks[track_number - 1].MSF.M);\r
 456         Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->TOC.Tracks[track_number - 1].MSF.S);\r
 457         Pico_mcd->cdd.Frame = INT_TO_BCDW(Pico_mcd->TOC.Tracks[track_number - 1].MSF.F);\r
 458         Pico_mcd->cdd.Ext = track_number % 10;\r
 459 \r
 460         if (track_number == 1) Pico_mcd->cdd.Frame |= 0x0800; // data track\r
 461 \r
 462         Pico_mcd->scd.CDD_Complete = 1;\r
 463         return 0;\r
 464 }\r
 465 \r
 466 \r
 467 int Play_CDD_c3(void)\r
 468 {\r
 469         _msf MSF;\r
 470         int delay, new_lba;\r
 471 \r
 472         CHECK_TRAY_OPEN\r
 473         CHECK_CD_PRESENT\r
 474 \r
 475         // MSF of the track to play in TC buffer\r
 476 \r
 477         MSF.M = (Pico_mcd->s68k_regs[0x38+10+2] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+3] & 0xF);\r
 478         MSF.S = (Pico_mcd->s68k_regs[0x38+10+4] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+5] & 0xF);\r
 479         MSF.F = (Pico_mcd->s68k_regs[0x38+10+6] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+7] & 0xF);\r
 480 \r
 481         Pico_mcd->scd.Cur_Track = MSF_to_Track(&MSF);\r
 482 \r
 483         new_lba = MSF_to_LBA(&MSF);\r
 484         delay = new_lba - Pico_mcd->scd.Cur_LBA;\r
 485         if (delay < 0) delay = -delay;\r
 486         delay >>= 12;\r
 487 \r
 488         Pico_mcd->scd.Cur_LBA = new_lba;\r
 489         CDC_Update_Header();\r
 490 \r
 491         cdprintf("Read : Cur LBA = %d, M=%d, S=%d, F=%d", Pico_mcd->scd.Cur_LBA, MSF.M, MSF.S, MSF.F);\r
 492 \r
 493         if (Pico_mcd->scd.Status_CDD != PLAYING) delay += 20;\r
 494 \r
 495         Pico_mcd->scd.Status_CDD = PLAYING;\r
 496         Pico_mcd->cdd.Status = 0x0102;\r
 497 //      Pico_mcd->cdd.Status = COMM_OK;\r
 498 \r
 499         if (Pico_mcd->scd.File_Add_Delay == 0) Pico_mcd->scd.File_Add_Delay = delay;\r
 500 \r
 501         if (Pico_mcd->scd.Cur_Track == 1)\r
 502         {\r
 503                 Pico_mcd->s68k_regs[0x36] |=  0x01;                             // DATA\r
 504         }\r
 505         else\r
 506         {\r
 507                 Pico_mcd->s68k_regs[0x36] &= ~0x01;                             // AUDIO\r
 508                 //CD_Audio_Starting = 1;\r
 509                 FILE_Play_CD_LBA();\r
 510         }\r
 511 \r
 512         if (Pico_mcd->scd.Cur_Track == 100) Pico_mcd->cdd.Minute = 0x0A02;\r
 513         else Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.Cur_Track);\r
 514         Pico_mcd->cdd.Seconde = 0;\r
 515         Pico_mcd->cdd.Frame = 0;\r
 516         Pico_mcd->cdd.Ext = 0;\r
 517 \r
 518         Pico_mcd->scd.Status_CDC |= 1;                  // Read data with CDC\r
 519 \r
 520         Pico_mcd->scd.CDD_Complete = 1;\r
 521         return 0;\r
 522 }\r
 523 \r
 524 \r
 525 int Seek_CDD_c4(void)\r
 526 {\r
 527         _msf MSF;\r
 528 \r
 529         CHECK_TRAY_OPEN\r
 530         CHECK_CD_PRESENT\r
 531 \r
 532         // MSF to seek in TC buffer\r
 533 \r
 534         MSF.M = (Pico_mcd->s68k_regs[0x38+10+2] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+3] & 0xF);\r
 535         MSF.S = (Pico_mcd->s68k_regs[0x38+10+4] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+5] & 0xF);\r
 536         MSF.F = (Pico_mcd->s68k_regs[0x38+10+6] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+7] & 0xF);\r
 537 \r
 538         Pico_mcd->scd.Cur_Track = MSF_to_Track(&MSF);\r
 539         Pico_mcd->scd.Cur_LBA = MSF_to_LBA(&MSF);\r
 540         CDC_Update_Header();\r
 541 \r
 542         Pico_mcd->scd.Status_CDC &= ~1;                         // Stop CDC read\r
 543 \r
 544         Pico_mcd->scd.Status_CDD = READY;\r
 545         Pico_mcd->cdd.Status = 0x0200;\r
 546 \r
 547         // DATA ?\r
 548         if (Pico_mcd->scd.Cur_Track == 1)\r
 549              Pico_mcd->s68k_regs[0x36] |=  0x01;\r
 550         else Pico_mcd->s68k_regs[0x36] &= ~0x01;                // AUDIO\r
 551 \r
 552         Pico_mcd->cdd.Minute = 0;\r
 553         Pico_mcd->cdd.Seconde = 0;\r
 554         Pico_mcd->cdd.Frame = 0;\r
 555         Pico_mcd->cdd.Ext = 0;\r
 556 \r
 557         Pico_mcd->scd.CDD_Complete = 1;\r
 558 \r
 559         return 0;\r
 560 }\r
 561 \r
 562 \r
 563 int Pause_CDD_c6(void)\r
 564 {\r
 565         CHECK_TRAY_OPEN\r
 566         CHECK_CD_PRESENT\r
 567 \r
 568         Pico_mcd->scd.Status_CDC &= ~1;                 // Stop CDC read to start a new one if raw data\r
 569 \r
 570         Pico_mcd->scd.Status_CDD = READY;\r
 571         Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD;\r
 572 \r
 573         Pico_mcd->s68k_regs[0x36] |= 0x01;              // Data bit set because stopped\r
 574 \r
 575         Pico_mcd->cdd.Minute = 0;\r
 576         Pico_mcd->cdd.Seconde = 0;\r
 577         Pico_mcd->cdd.Frame = 0;\r
 578         Pico_mcd->cdd.Ext = 0;\r
 579 \r
 580         Pico_mcd->scd.CDD_Complete = 1;\r
 581 \r
 582         return 0;\r
 583 }\r
 584 \r
 585 \r
 586 int Resume_CDD_c7(void)\r
 587 {\r
 588         CHECK_TRAY_OPEN\r
 589         CHECK_CD_PRESENT\r
 590 \r
 591         Pico_mcd->scd.Cur_Track = LBA_to_Track(Pico_mcd->scd.Cur_LBA);\r
 592 \r
 593 #ifdef DEBUG_CD\r
 594         {\r
 595                 _msf MSF;\r
 596                 LBA_to_MSF(Pico_mcd->scd.Cur_LBA, &MSF);\r
 597                 cdprintf("Resume read : Cur LBA = %d, M=%d, S=%d, F=%d", Pico_mcd->scd.Cur_LBA, MSF.M, MSF.S, MSF.F);\r
 598         }\r
 599 #endif\r
 600 \r
 601         Pico_mcd->scd.Status_CDD = PLAYING;\r
 602         Pico_mcd->cdd.Status = 0x0102;\r
 603 \r
 604         if (Pico_mcd->scd.Cur_Track == 1)\r
 605         {\r
 606                 Pico_mcd->s68k_regs[0x36] |=  0x01;                             // DATA\r
 607         }\r
 608         else\r
 609         {\r
 610                 Pico_mcd->s68k_regs[0x36] &= ~0x01;                             // AUDIO\r
 611                 //CD_Audio_Starting = 1;\r
 612                 FILE_Play_CD_LBA();\r
 613         }\r
 614 \r
 615         if (Pico_mcd->scd.Cur_Track == 100) Pico_mcd->cdd.Minute = 0x0A02;\r
 616         else Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.Cur_Track);\r
 617         Pico_mcd->cdd.Seconde = 0;\r
 618         Pico_mcd->cdd.Frame = 0;\r
 619         Pico_mcd->cdd.Ext = 0;\r
 620 \r
 621         Pico_mcd->scd.Status_CDC |= 1;                  // Read data with CDC\r
 622 \r
 623         Pico_mcd->scd.CDD_Complete = 1;\r
 624         return 0;\r
 625 }\r
 626 \r
 627 \r
 628 int Fast_Foward_CDD_c8(void)\r
 629 {\r
 630         CHECK_TRAY_OPEN\r
 631         CHECK_CD_PRESENT\r
 632 \r
 633         Pico_mcd->scd.Status_CDC &= ~1;                         // Stop CDC read\r
 634 \r
 635         Pico_mcd->scd.Status_CDD = FAST_FOW;\r
 636         Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD | 2;\r
 637 \r
 638         Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.Cur_Track);\r
 639         Pico_mcd->cdd.Seconde = 0;\r
 640         Pico_mcd->cdd.Frame = 0;\r
 641         Pico_mcd->cdd.Ext = 0;\r
 642 \r
 643         Pico_mcd->scd.CDD_Complete = 1;\r
 644 \r
 645         return 0;\r
 646 }\r
 647 \r
 648 \r
 649 int Fast_Rewind_CDD_c9(void)\r
 650 {\r
 651         CHECK_TRAY_OPEN\r
 652         CHECK_CD_PRESENT\r
 653 \r
 654         Pico_mcd->scd.Status_CDC &= ~1;                         // Stop CDC read\r
 655 \r
 656         Pico_mcd->scd.Status_CDD = FAST_REV;\r
 657         Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD | 2;\r
 658 \r
 659         Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.Cur_Track);\r
 660         Pico_mcd->cdd.Seconde = 0;\r
 661         Pico_mcd->cdd.Frame = 0;\r
 662         Pico_mcd->cdd.Ext = 0;\r
 663 \r
 664         Pico_mcd->scd.CDD_Complete = 1;\r
 665 \r
 666         return 0;\r
 667 }\r
 668 \r
 669 \r
 670 int Close_Tray_CDD_cC(void)\r
 671 {\r
 672         //Clear_Sound_Buffer();\r
 673 \r
 674         Pico_mcd->scd.Status_CDC &= ~1;                 // Stop CDC read\r
 675 \r
 676         {\r
 677 #if 0 // TODO\r
 678                 char new_iso[1024];\r
 679 \r
 680                 memset(new_iso, 0, 1024);\r
 681 \r
 682                 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
 683                 Reload_SegaCD(new_iso);\r
 684 \r
 685                 CD_Present = 1;\r
 686 #else\r
 687                 CD_Present = 0;\r
 688 #endif\r
 689                 Pico_mcd->scd.Status_CDD = STOPPED;\r
 690                 Pico_mcd->cdd.Status = 0x0000;\r
 691 \r
 692                 Pico_mcd->cdd.Minute = 0;\r
 693                 Pico_mcd->cdd.Seconde = 0;\r
 694                 Pico_mcd->cdd.Frame = 0;\r
 695                 Pico_mcd->cdd.Ext = 0;\r
 696         }\r
 697 \r
 698         Pico_mcd->scd.CDD_Complete = 1;\r
 699 \r
 700         return 0;\r
 701 }\r
 702 \r
 703 \r
 704 int Open_Tray_CDD_cD(void)\r
 705 {\r
 706         CHECK_TRAY_OPEN\r
 707 \r
 708         Pico_mcd->scd.Status_CDC &= ~1;                 // Stop CDC read\r
 709 \r
 710         Unload_ISO();\r
 711         CD_Present = 0;\r
 712 \r
 713         Pico_mcd->scd.Status_CDD = TRAY_OPEN;\r
 714         Pico_mcd->cdd.Status = 0x0E00;\r
 715 \r
 716         Pico_mcd->cdd.Minute = 0;\r
 717         Pico_mcd->cdd.Seconde = 0;\r
 718         Pico_mcd->cdd.Frame = 0;\r
 719         Pico_mcd->cdd.Ext = 0;\r
 720 \r
 721         Pico_mcd->scd.CDD_Complete = 1;\r
 722 \r
 723         return 0;\r
 724 }\r
 725 \r
 726 \r
 727 int CDD_cA(void)\r
 728 {\r
 729         CHECK_TRAY_OPEN\r
 730         CHECK_CD_PRESENT\r
 731 \r
 732         Pico_mcd->scd.Status_CDC &= ~1;\r
 733 \r
 734         Pico_mcd->scd.Status_CDD = READY;\r
 735         Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD;\r
 736 \r
 737         Pico_mcd->cdd.Minute = 0;\r
 738         Pico_mcd->cdd.Seconde = INT_TO_BCDW(1);\r
 739         Pico_mcd->cdd.Frame = INT_TO_BCDW(1);\r
 740         Pico_mcd->cdd.Ext = 0;\r
 741 \r
 742         Pico_mcd->scd.CDD_Complete = 1;\r
 743 \r
 744         return 0;\r
 745 }\r
 746 \r
 747 \r
 748 int CDD_Def(void)\r
 749 {\r
 750         Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD;\r
 751 \r
 752         Pico_mcd->cdd.Minute = 0;\r
 753         Pico_mcd->cdd.Seconde = 0;\r
 754         Pico_mcd->cdd.Frame = 0;\r
 755         Pico_mcd->cdd.Ext = 0;\r
 756 \r
 757         return 0;\r
 758 }\r
 759 \r
 760 \r
 761 \r
 762 \r
 763 /***************************\r
 764  *   Others CD functions   *\r
 765  **************************/\r
 766 \r
 767 \r
 768 // do we need them?\r
 769 #if 0\r
 770 void Write_CD_Audio(short *Buf, int rate, int channel, int lenght)\r
 771 {\r
 772         unsigned int lenght_src, lenght_dst;\r
 773         unsigned int pos_src, pas_src;\r
 774 \r
 775         if (rate == 0) return;\r
 776         if (Sound_Rate == 0) return;\r
 777 \r
 778         if (CD_Audio_Starting)\r
 779         {\r
 780                 CD_Audio_Starting = 0;\r
 781                 memset(CD_Audio_Buffer_L, 0, 4096 * 4);\r
 782                 memset(CD_Audio_Buffer_R, 0, 4096 * 4);\r
 783                 CD_Audio_Buffer_Write_Pos = (CD_Audio_Buffer_Read_Pos + 2000) & 0xFFF;\r
 784         }\r
 785 \r
 786         lenght_src = rate / 75;                         // 75th of a second\r
 787         lenght_dst = Sound_Rate / 75;           // 75th of a second\r
 788 \r
 789         pas_src = (lenght_src << 16) / lenght_dst;\r
 790         pos_src = 0;\r
 791 \r
 792 #ifdef DEBUG_CD\r
 793         fprintf(debug_SCD_file, "\n*********  Write Pos = %d    ", CD_Audio_Buffer_Write_Pos);\r
 794 #endif\r
 795 \r
 796         if (channel == 2)\r
 797         {\r
 798                 __asm\r
 799                 {\r
 800                         mov edi, CD_Audio_Buffer_Write_Pos\r
 801                         mov ebx, Buf\r
 802                         xor esi, esi\r
 803                         mov ecx, lenght_dst\r
 804                         xor eax, eax\r
 805                         mov edx, pas_src\r
 806                         dec ecx\r
 807                         jmp short loop_stereo\r
 808 \r
 809 align 16\r
 810 \r
 811 loop_stereo:\r
 812                         movsx eax, word ptr [ebx + esi * 4]\r
 813                         mov CD_Audio_Buffer_L[edi * 4], eax\r
 814                         movsx eax, word ptr [ebx + esi * 4 + 2]\r
 815                         mov CD_Audio_Buffer_R[edi * 4], eax\r
 816                         mov esi, dword ptr pos_src\r
 817                         inc edi\r
 818                         add esi, edx\r
 819                         and edi, 0xFFF\r
 820                         mov dword ptr pos_src, esi\r
 821                         shr esi, 16\r
 822                         dec ecx\r
 823                         jns short loop_stereo\r
 824 \r
 825                         mov CD_Audio_Buffer_Write_Pos, edi\r
 826                 }\r
 827         }\r
 828         else\r
 829         {\r
 830                 __asm\r
 831                 {\r
 832                         mov edi, CD_Audio_Buffer_Write_Pos\r
 833                         mov ebx, Buf\r
 834                         xor esi, esi\r
 835                         mov ecx, lenght_dst\r
 836                         xor eax, eax\r
 837                         mov edx, pas_src\r
 838                         dec ecx\r
 839                         jmp short loop_mono\r
 840 \r
 841 align 16\r
 842 \r
 843 loop_mono:\r
 844                         movsx eax, word ptr [ebx + esi * 2]\r
 845                         mov CD_Audio_Buffer_L[edi * 4], eax\r
 846                         mov CD_Audio_Buffer_R[edi * 4], eax\r
 847                         mov esi, dword ptr pos_src\r
 848                         inc edi\r
 849                         add esi, edx\r
 850                         and edi, 0xFFF\r
 851                         mov dword ptr pos_src, esi\r
 852                         shr esi, 16\r
 853                         dec ecx\r
 854                         jns short loop_mono\r
 855 \r
 856                         mov CD_Audio_Buffer_Write_Pos, edi\r
 857                 }\r
 858         }\r
 859 \r
 860 #ifdef DEBUG_CD\r
 861         fprintf(debug_SCD_file, "Write Pos 2 = %d\n\n", CD_Audio_Buffer_Write_Pos);\r
 862 #endif\r
 863 }\r
 864 \r
 865 \r
 866 void Update_CD_Audio(int **buf, int lenght)\r
 867 {\r
 868         int *Buf_L, *Buf_R;\r
 869         int diff;\r
 870 \r
 871         Buf_L = buf[0];\r
 872         Buf_R = buf[1];\r
 873 \r
 874         if (Pico_mcd->s68k_regs[0x36] & 0x01) return;\r
 875         if (!(Pico_mcd->scd.Status_CDC & 1))  return;\r
 876         if (CD_Audio_Starting) return;\r
 877 \r
 878 #ifdef DEBUG_CD\r
 879         fprintf(debug_SCD_file, "\n*********  Read Pos Normal = %d     ", CD_Audio_Buffer_Read_Pos);\r
 880 #endif\r
 881 \r
 882         if (CD_Audio_Buffer_Write_Pos < CD_Audio_Buffer_Read_Pos)\r
 883         {\r
 884                 diff = CD_Audio_Buffer_Write_Pos + (4096) - CD_Audio_Buffer_Read_Pos;\r
 885         }\r
 886         else\r
 887         {\r
 888                 diff = CD_Audio_Buffer_Write_Pos - CD_Audio_Buffer_Read_Pos;\r
 889         }\r
 890 \r
 891         if (diff < 500) CD_Audio_Buffer_Read_Pos -= 2000;\r
 892         else if (diff > 3500) CD_Audio_Buffer_Read_Pos += 2000;\r
 893 \r
 894 #ifdef DEBUG_CD\r
 895         else fprintf(debug_SCD_file, " pas de modifs   ");\r
 896 #endif\r
 897 \r
 898         CD_Audio_Buffer_Read_Pos &= 0xFFF;\r
 899 \r
 900 #ifdef DEBUG_CD\r
 901         fprintf(debug_SCD_file, "Read Pos = %d   ", CD_Audio_Buffer_Read_Pos);\r
 902 #endif\r
 903 \r
 904         if (CDDA_Enable)\r
 905         {\r
 906                 __asm\r
 907                 {\r
 908                         mov ecx, lenght\r
 909                         mov esi, CD_Audio_Buffer_Read_Pos\r
 910                         mov edi, Buf_L\r
 911                         dec ecx\r
 912 \r
 913 loop_L:\r
 914                         mov eax, CD_Audio_Buffer_L[esi * 4]\r
 915                         add [edi], eax\r
 916                         inc esi\r
 917                         add edi, 4\r
 918                         and esi, 0xFFF\r
 919                         dec ecx\r
 920                         jns short loop_L\r
 921 \r
 922                         mov ecx, lenght\r
 923                         mov esi, CD_Audio_Buffer_Read_Pos\r
 924                         mov edi, Buf_R\r
 925                         dec ecx\r
 926 \r
 927 loop_R:\r
 928                         mov eax, CD_Audio_Buffer_R[esi * 4]\r
 929                         add [edi], eax\r
 930                         inc esi\r
 931                         add edi, 4\r
 932                         and esi, 0xFFF\r
 933                         dec ecx\r
 934                         jns short loop_R\r
 935 \r
 936                         mov CD_Audio_Buffer_Read_Pos, esi\r
 937                 }\r
 938         }\r
 939         else\r
 940         {\r
 941                 CD_Audio_Buffer_Read_Pos += lenght;\r
 942                 CD_Audio_Buffer_Read_Pos &= 0xFFF;\r
 943         }\r
 944 \r
 945 #ifdef DEBUG_CD\r
 946         fprintf(debug_SCD_file, "Read Pos 2 = %d\n\n", CD_Audio_Buffer_Read_Pos);\r
 947 #endif\r
 948 }\r
 949 #endif\r
 950 \r