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