Pico/cd/cd_sys.c

   1 /***********************************************************\r
   2  *                                                         *\r
   3  * This source file was taken from the Gens project        *\r
   4  * Written by Stéphane Dallongeville                       *\r
   5  * Copyright (c) 2002 by Stéphane Dallongeville            *\r
   6  * Modified/adapted for PicoDrive by notaz, 2007           *\r
   7  *                                                         *\r
   8  ***********************************************************/\r
   9 \r
  10 #include <stdio.h>\r
  11 \r
  12 #include "../PicoInt.h"\r
  13 #include "cd_sys.h"\r
  14 #include "cd_file.h"\r
  15 \r
  16 #define cdprintf(x...)\r
  17 #define DEBUG_CD\r
  18 \r
  19 #define TRAY_OPEN       0x0500          // TRAY OPEN CDD status\r
  20 #define NOCD            0x0000          // CD removed CDD status\r
  21 #define STOPPED         0x0900          // STOPPED CDD status (happen after stop or close tray command)\r
  22 #define READY           0x0400          // READY CDD status (also used for seeking)\r
  23 #define FAST_FOW        0x0300          // FAST FORWARD track CDD status\r
  24 #define FAST_REV        0x10300         // FAST REVERSE track CDD status\r
  25 #define PLAYING         0x0100          // PLAYING audio track CDD status\r
  26 \r
  27 \r
  28 static int CD_Present = 0;\r
  29 \r
  30 \r
  31 #define CHECK_TRAY_OPEN                         \\r
  32 if (Pico_mcd->scd.Status_CDD == TRAY_OPEN)      \\r
  33 {                                                                       \\r
  34         Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD;        \\r
  35                                                                         \\r
  36         Pico_mcd->cdd.Minute = 0;                                       \\r
  37         Pico_mcd->cdd.Seconde = 0;                              \\r
  38         Pico_mcd->cdd.Frame = 0;                                        \\r
  39         Pico_mcd->cdd.Ext = 0;                                  \\r
  40                                                                         \\r
  41         Pico_mcd->scd.CDD_Complete = 1;                         \\r
  42                                                                         \\r
  43         return 2;                                               \\r
  44 }\r
  45 \r
  46 \r
  47 #define CHECK_CD_PRESENT                        \\r
  48 if (!CD_Present)                                        \\r
  49 {                                                                       \\r
  50         Pico_mcd->scd.Status_CDD = NOCD;                        \\r
  51         Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD;        \\r
  52                                                                         \\r
  53         Pico_mcd->cdd.Minute = 0;                                       \\r
  54         Pico_mcd->cdd.Seconde = 0;                              \\r
  55         Pico_mcd->cdd.Frame = 0;                                        \\r
  56         Pico_mcd->cdd.Ext = 0;                                  \\r
  57                                                                         \\r
  58         Pico_mcd->scd.CDD_Complete = 1;                         \\r
  59                                                                         \\r
  60         return 3;                                               \\r
  61 }\r
  62 \r
  63 \r
  64 static int MSF_to_LBA(_msf *MSF)\r
  65 {\r
  66         return (MSF->M * 60 * 75) + (MSF->S * 75) + MSF->F - 150;\r
  67 }\r
  68 \r
  69 \r
  70 PICO_INTERNAL void LBA_to_MSF(int lba, _msf *MSF)\r
  71 {\r
  72         if (lba < -150) lba = 0;\r
  73         else lba += 150;\r
  74         MSF->M = lba / (60 * 75);\r
  75         MSF->S = (lba / 75) % 60;\r
  76         MSF->F = lba % 75;\r
  77 }\r
  78 \r
  79 \r
  80 static unsigned int MSF_to_Track(_msf *MSF)\r
  81 {\r
  82         int i, Start, Cur;\r
  83 \r
  84         Start = (MSF->M << 16) + (MSF->S << 8) + MSF->F;\r
  85 \r
  86         for(i = 1; i <= (Pico_mcd->TOC.Last_Track + 1); i++)\r
  87         {\r
  88                 Cur = Pico_mcd->TOC.Tracks[i - 1].MSF.M << 16;\r
  89                 Cur += Pico_mcd->TOC.Tracks[i - 1].MSF.S << 8;\r
  90                 Cur += Pico_mcd->TOC.Tracks[i - 1].MSF.F;\r
  91 \r
  92                 if (Cur > Start) break;\r
  93         }\r
  94 \r
  95         --i;\r
  96 \r
  97         if (i > Pico_mcd->TOC.Last_Track) return 100;\r
  98         else if (i < 1) i = 1;\r
  99 \r
 100         return (unsigned) i;\r
 101 }\r
 102 \r
 103 \r
 104 static unsigned int LBA_to_Track(int lba)\r
 105 {\r
 106         _msf MSF;\r
 107 \r
 108         LBA_to_MSF(lba, &MSF);\r
 109         return MSF_to_Track(&MSF);\r
 110 }\r
 111 \r
 112 \r
 113 static void Track_to_MSF(int track, _msf *MSF)\r
 114 {\r
 115         if (track < 1) track = 1;\r
 116         else if (track > Pico_mcd->TOC.Last_Track) track = Pico_mcd->TOC.Last_Track;\r
 117 \r
 118         MSF->M = Pico_mcd->TOC.Tracks[track - 1].MSF.M;\r
 119         MSF->S = Pico_mcd->TOC.Tracks[track - 1].MSF.S;\r
 120         MSF->F = Pico_mcd->TOC.Tracks[track - 1].MSF.F;\r
 121 }\r
 122 \r
 123 \r
 124 PICO_INTERNAL int Track_to_LBA(int track)\r
 125 {\r
 126         _msf MSF;\r
 127 \r
 128         Track_to_MSF(track, &MSF);\r
 129         return MSF_to_LBA(&MSF);\r
 130 }\r
 131 \r
 132 \r
 133 PICO_INTERNAL void Check_CD_Command(void)\r
 134 {\r
 135         cdprintf("CHECK CD COMMAND");\r
 136 \r
 137         // Check CDC\r
 138         if (Pico_mcd->scd.Status_CDC & 1)                       // CDC is reading data ...\r
 139         {\r
 140                 cdprintf("Got a read command");\r
 141 \r
 142                 // DATA ?\r
 143                 if (Pico_mcd->scd.Cur_Track == 1)\r
 144                      Pico_mcd->s68k_regs[0x36] |=  0x01;\r
 145                 else Pico_mcd->s68k_regs[0x36] &= ~0x01;                        // AUDIO\r
 146 \r
 147                 if (Pico_mcd->scd.File_Add_Delay == 0)\r
 148                 {\r
 149                         FILE_Read_One_LBA_CDC();\r
 150                 }\r
 151                 else Pico_mcd->scd.File_Add_Delay--;\r
 152         }\r
 153 \r
 154         // Check CDD\r
 155         if (Pico_mcd->scd.CDD_Complete)\r
 156         {\r
 157                 Pico_mcd->scd.CDD_Complete = 0;\r
 158 \r
 159                 CDD_Export_Status();\r
 160         }\r
 161 \r
 162         if (Pico_mcd->scd.Status_CDD == FAST_FOW)\r
 163         {\r
 164                 Pico_mcd->scd.Cur_LBA += 10;\r
 165                 CDC_Update_Header();\r
 166 \r
 167         }\r
 168         else if (Pico_mcd->scd.Status_CDD == FAST_REV)\r
 169         {\r
 170                 Pico_mcd->scd.Cur_LBA -= 10;\r
 171                 if (Pico_mcd->scd.Cur_LBA < -150) Pico_mcd->scd.Cur_LBA = -150;\r
 172                 CDC_Update_Header();\r
 173         }\r
 174 }\r
 175 \r
 176 \r
 177 PICO_INTERNAL int Init_CD_Driver(void)\r
 178 {\r
 179         return 0;\r
 180 }\r
 181 \r
 182 \r
 183 PICO_INTERNAL void End_CD_Driver(void)\r
 184 {\r
 185         Unload_ISO();\r
 186 }\r
 187 \r
 188 \r
 189 PICO_INTERNAL void Reset_CD(void)\r
 190 {\r
 191         Pico_mcd->scd.Cur_Track = 0;\r
 192         Pico_mcd->scd.Cur_LBA = -150;\r
 193         Pico_mcd->scd.Status_CDC &= ~1;\r
 194         Pico_mcd->scd.Status_CDD = CD_Present ? READY : NOCD;\r
 195         Pico_mcd->scd.CDD_Complete = 0;\r
 196         Pico_mcd->scd.File_Add_Delay = 0;\r
 197 }\r
 198 \r
 199 \r
 200 int Insert_CD(char *iso_name, int is_bin)\r
 201 {\r
 202         int ret = 0;\r
 203 \r
 204         CD_Present = 0;\r
 205         Pico_mcd->scd.Status_CDD = NOCD;\r
 206 \r
 207         if (iso_name != NULL)\r
 208         {\r
 209                 ret = Load_ISO(iso_name, is_bin);\r
 210                 if (ret == 0) {\r
 211                         CD_Present = 1;\r
 212                         Pico_mcd->scd.Status_CDD = READY;\r
 213                 }\r
 214         }\r
 215 \r
 216         return ret;\r
 217 }\r
 218 \r
 219 \r
 220 void Stop_CD(void)\r
 221 {\r
 222         Unload_ISO();\r
 223         CD_Present = 0;\r
 224 }\r
 225 \r
 226 \r
 227 /*\r
 228 PICO_INTERNAL void Change_CD(void)\r
 229 {\r
 230         if (Pico_mcd->scd.Status_CDD == TRAY_OPEN) Close_Tray_CDD_cC();\r
 231         else Open_Tray_CDD_cD();\r
 232 }\r
 233 */\r
 234 \r
 235 PICO_INTERNAL int Get_Status_CDD_c0(void)\r
 236 {\r
 237         cdprintf("Status command : Cur LBA = %d", Pico_mcd->scd.Cur_LBA);\r
 238 \r
 239         // Clear immediat status\r
 240         if ((Pico_mcd->cdd.Status & 0x0F00) == 0x0200)\r
 241                 Pico_mcd->cdd.Status = (Pico_mcd->scd.Status_CDD & 0xFF00) | (Pico_mcd->cdd.Status & 0x00FF);\r
 242         else if ((Pico_mcd->cdd.Status & 0x0F00) == 0x0700)\r
 243                 Pico_mcd->cdd.Status = (Pico_mcd->scd.Status_CDD & 0xFF00) | (Pico_mcd->cdd.Status & 0x00FF);\r
 244         else if ((Pico_mcd->cdd.Status & 0x0F00) == 0x0E00)\r
 245                 Pico_mcd->cdd.Status = (Pico_mcd->scd.Status_CDD & 0xFF00) | (Pico_mcd->cdd.Status & 0x00FF);\r
 246 \r
 247         Pico_mcd->scd.CDD_Complete = 1;\r
 248 \r
 249         return 0;\r
 250 }\r
 251 \r
 252 \r
 253 PICO_INTERNAL int Stop_CDD_c1(void)\r
 254 {\r
 255         CHECK_TRAY_OPEN\r
 256 \r
 257         Pico_mcd->scd.Status_CDC &= ~1;                         // Stop CDC read\r
 258 \r
 259         if (CD_Present) Pico_mcd->scd.Status_CDD = STOPPED;\r
 260         else Pico_mcd->scd.Status_CDD = NOCD;\r
 261         Pico_mcd->cdd.Status = 0x0000;\r
 262 \r
 263         Pico_mcd->s68k_regs[0x36] |= 0x01;                      // Data bit set because stopped\r
 264 \r
 265         Pico_mcd->cdd.Minute = 0;\r
 266         Pico_mcd->cdd.Seconde = 0;\r
 267         Pico_mcd->cdd.Frame = 0;\r
 268         Pico_mcd->cdd.Ext = 0;\r
 269 \r
 270         Pico_mcd->scd.CDD_Complete = 1;\r
 271 \r
 272         return 0;\r
 273 }\r
 274 \r
 275 \r
 276 PICO_INTERNAL int Get_Pos_CDD_c20(void)\r
 277 {\r
 278         _msf MSF;\r
 279 \r
 280         cdprintf("command 200 : Cur LBA = %d", Pico_mcd->scd.Cur_LBA);\r
 281 \r
 282         CHECK_TRAY_OPEN\r
 283 \r
 284         Pico_mcd->cdd.Status &= 0xFF;\r
 285         if (!CD_Present)\r
 286         {\r
 287                 Pico_mcd->scd.Status_CDD = NOCD;\r
 288                 Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 289         }\r
 290 //      else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 291         Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 292 \r
 293         cdprintf("Status CDD = %.4X  Status = %.4X", Pico_mcd->scd.Status_CDD, Pico_mcd->cdd.Status);\r
 294 \r
 295         LBA_to_MSF(Pico_mcd->scd.Cur_LBA, &MSF);\r
 296 \r
 297         Pico_mcd->cdd.Minute = INT_TO_BCDW(MSF.M);\r
 298         Pico_mcd->cdd.Seconde = INT_TO_BCDW(MSF.S);\r
 299         Pico_mcd->cdd.Frame = INT_TO_BCDW(MSF.F);\r
 300         Pico_mcd->cdd.Ext = 0;\r
 301 \r
 302         Pico_mcd->scd.CDD_Complete = 1;\r
 303 \r
 304         return 0;\r
 305 }\r
 306 \r
 307 \r
 308 PICO_INTERNAL int Get_Track_Pos_CDD_c21(void)\r
 309 {\r
 310         int elapsed_time;\r
 311         _msf MSF;\r
 312 \r
 313         cdprintf("command 201 : Cur LBA = %d", Pico_mcd->scd.Cur_LBA);\r
 314 \r
 315         CHECK_TRAY_OPEN\r
 316 \r
 317         Pico_mcd->cdd.Status &= 0xFF;\r
 318         if (!CD_Present)\r
 319         {\r
 320                 Pico_mcd->scd.Status_CDD = NOCD;\r
 321                 Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 322         }\r
 323 //      else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 324         Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 325 \r
 326         elapsed_time = Pico_mcd->scd.Cur_LBA - Track_to_LBA(LBA_to_Track(Pico_mcd->scd.Cur_LBA));\r
 327         LBA_to_MSF(elapsed_time - 150, &MSF);\r
 328 \r
 329         cdprintf("   elapsed = %d", elapsed_time);\r
 330 \r
 331         Pico_mcd->cdd.Minute = INT_TO_BCDW(MSF.M);\r
 332         Pico_mcd->cdd.Seconde = INT_TO_BCDW(MSF.S);\r
 333         Pico_mcd->cdd.Frame = INT_TO_BCDW(MSF.F);\r
 334         Pico_mcd->cdd.Ext = 0;\r
 335 \r
 336         Pico_mcd->scd.CDD_Complete = 1;\r
 337 \r
 338         return 0;\r
 339 }\r
 340 \r
 341 \r
 342 PICO_INTERNAL int Get_Current_Track_CDD_c22(void)\r
 343 {\r
 344         cdprintf("Status CDD = %.4X  Status = %.4X", Pico_mcd->scd.Status_CDD, Pico_mcd->cdd.Status);\r
 345 \r
 346         CHECK_TRAY_OPEN\r
 347 \r
 348         Pico_mcd->cdd.Status &= 0xFF;\r
 349         if (!CD_Present)\r
 350         {\r
 351                 Pico_mcd->scd.Status_CDD = NOCD;\r
 352                 Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 353         }\r
 354 //      else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 355         Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 356 \r
 357         Pico_mcd->scd.Cur_Track = LBA_to_Track(Pico_mcd->scd.Cur_LBA);\r
 358 \r
 359         if (Pico_mcd->scd.Cur_Track == 100) Pico_mcd->cdd.Minute = 0x0A02;\r
 360         else Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.Cur_Track);\r
 361         Pico_mcd->cdd.Seconde = 0;\r
 362         Pico_mcd->cdd.Frame = 0;\r
 363         Pico_mcd->cdd.Ext = 0;\r
 364 \r
 365         Pico_mcd->scd.CDD_Complete = 1;\r
 366 \r
 367         return 0;\r
 368 }\r
 369 \r
 370 \r
 371 PICO_INTERNAL int Get_Total_Lenght_CDD_c23(void)\r
 372 {\r
 373         CHECK_TRAY_OPEN\r
 374 \r
 375         Pico_mcd->cdd.Status &= 0xFF;\r
 376         if (!CD_Present)\r
 377         {\r
 378                 Pico_mcd->scd.Status_CDD = NOCD;\r
 379                 Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 380         }\r
 381 //      else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 382         Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 383 \r
 384         Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->TOC.Tracks[Pico_mcd->TOC.Last_Track].MSF.M);\r
 385         Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->TOC.Tracks[Pico_mcd->TOC.Last_Track].MSF.S);\r
 386         Pico_mcd->cdd.Frame = INT_TO_BCDW(Pico_mcd->TOC.Tracks[Pico_mcd->TOC.Last_Track].MSF.F);\r
 387         Pico_mcd->cdd.Ext = 0;\r
 388 \r
 389         Pico_mcd->scd.CDD_Complete = 1;\r
 390 \r
 391         return 0;\r
 392 }\r
 393 \r
 394 \r
 395 PICO_INTERNAL int Get_First_Last_Track_CDD_c24(void)\r
 396 {\r
 397         CHECK_TRAY_OPEN\r
 398 \r
 399         Pico_mcd->cdd.Status &= 0xFF;\r
 400         if (!CD_Present)\r
 401         {\r
 402                 Pico_mcd->scd.Status_CDD = NOCD;\r
 403         }\r
 404 //      else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 405         Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 406 \r
 407         Pico_mcd->cdd.Minute = INT_TO_BCDW(1);\r
 408         Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->TOC.Last_Track);\r
 409         Pico_mcd->cdd.Frame = 0;\r
 410         Pico_mcd->cdd.Ext = 0;\r
 411 \r
 412         Pico_mcd->scd.CDD_Complete = 1;\r
 413 \r
 414         return 0;\r
 415 }\r
 416 \r
 417 \r
 418 PICO_INTERNAL int Get_Track_Adr_CDD_c25(void)\r
 419 {\r
 420         int track_number;\r
 421 \r
 422         CHECK_TRAY_OPEN\r
 423 \r
 424         // track number in TC4 & TC5\r
 425 \r
 426         track_number = (Pico_mcd->s68k_regs[0x38+10+4] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+5] & 0xF);\r
 427 \r
 428         Pico_mcd->cdd.Status &= 0xFF;\r
 429         if (!CD_Present)\r
 430         {\r
 431                 Pico_mcd->scd.Status_CDD = NOCD;\r
 432                 Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 433         }\r
 434 //      else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 435         Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 436 \r
 437         if (track_number > Pico_mcd->TOC.Last_Track) track_number = Pico_mcd->TOC.Last_Track;\r
 438         else if (track_number < 1) track_number = 1;\r
 439 \r
 440         Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->TOC.Tracks[track_number - 1].MSF.M);\r
 441         Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->TOC.Tracks[track_number - 1].MSF.S);\r
 442         Pico_mcd->cdd.Frame = INT_TO_BCDW(Pico_mcd->TOC.Tracks[track_number - 1].MSF.F);\r
 443         Pico_mcd->cdd.Ext = track_number % 10;\r
 444 \r
 445         if (track_number == 1) Pico_mcd->cdd.Frame |= 0x0800; // data track\r
 446 \r
 447         Pico_mcd->scd.CDD_Complete = 1;\r
 448         return 0;\r
 449 }\r
 450 \r
 451 \r
 452 PICO_INTERNAL int Play_CDD_c3(void)\r
 453 {\r
 454         _msf MSF;\r
 455         int delay, new_lba;\r
 456 \r
 457         CHECK_TRAY_OPEN\r
 458         CHECK_CD_PRESENT\r
 459 \r
 460         // MSF of the track to play in TC buffer\r
 461 \r
 462         MSF.M = (Pico_mcd->s68k_regs[0x38+10+2] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+3] & 0xF);\r
 463         MSF.S = (Pico_mcd->s68k_regs[0x38+10+4] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+5] & 0xF);\r
 464         MSF.F = (Pico_mcd->s68k_regs[0x38+10+6] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+7] & 0xF);\r
 465 \r
 466         Pico_mcd->scd.Cur_Track = MSF_to_Track(&MSF);\r
 467 \r
 468         new_lba = MSF_to_LBA(&MSF);\r
 469         delay = new_lba - Pico_mcd->scd.Cur_LBA;\r
 470         if (delay < 0) delay = -delay;\r
 471         delay >>= 12;\r
 472 \r
 473         Pico_mcd->scd.Cur_LBA = new_lba;\r
 474         CDC_Update_Header();\r
 475 \r
 476         cdprintf("Read : Cur LBA = %d, M=%d, S=%d, F=%d", Pico_mcd->scd.Cur_LBA, MSF.M, MSF.S, MSF.F);\r
 477 \r
 478         if (Pico_mcd->scd.Status_CDD != PLAYING) delay += 20;\r
 479 \r
 480         Pico_mcd->scd.Status_CDD = PLAYING;\r
 481         Pico_mcd->cdd.Status = 0x0102;\r
 482 //      Pico_mcd->cdd.Status = COMM_OK;\r
 483 \r
 484         if (Pico_mcd->scd.File_Add_Delay == 0) Pico_mcd->scd.File_Add_Delay = delay;\r
 485 \r
 486         if (Pico_mcd->scd.Cur_Track == 1)\r
 487         {\r
 488                 Pico_mcd->s68k_regs[0x36] |=  0x01;                             // DATA\r
 489         }\r
 490         else\r
 491         {\r
 492                 Pico_mcd->s68k_regs[0x36] &= ~0x01;                             // AUDIO\r
 493                 //CD_Audio_Starting = 1;\r
 494                 FILE_Play_CD_LBA();\r
 495         }\r
 496 \r
 497         if (Pico_mcd->scd.Cur_Track == 100) Pico_mcd->cdd.Minute = 0x0A02;\r
 498         else Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.Cur_Track);\r
 499         Pico_mcd->cdd.Seconde = 0;\r
 500         Pico_mcd->cdd.Frame = 0;\r
 501         Pico_mcd->cdd.Ext = 0;\r
 502 \r
 503         Pico_mcd->scd.Status_CDC |= 1;                  // Read data with CDC\r
 504 \r
 505         Pico_mcd->scd.CDD_Complete = 1;\r
 506         return 0;\r
 507 }\r
 508 \r
 509 \r
 510 PICO_INTERNAL int Seek_CDD_c4(void)\r
 511 {\r
 512         _msf MSF;\r
 513 \r
 514         CHECK_TRAY_OPEN\r
 515         CHECK_CD_PRESENT\r
 516 \r
 517         // MSF to seek in TC buffer\r
 518 \r
 519         MSF.M = (Pico_mcd->s68k_regs[0x38+10+2] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+3] & 0xF);\r
 520         MSF.S = (Pico_mcd->s68k_regs[0x38+10+4] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+5] & 0xF);\r
 521         MSF.F = (Pico_mcd->s68k_regs[0x38+10+6] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+7] & 0xF);\r
 522 \r
 523         Pico_mcd->scd.Cur_Track = MSF_to_Track(&MSF);\r
 524         Pico_mcd->scd.Cur_LBA = MSF_to_LBA(&MSF);\r
 525         CDC_Update_Header();\r
 526 \r
 527         Pico_mcd->scd.Status_CDC &= ~1;                         // Stop CDC read\r
 528 \r
 529         Pico_mcd->scd.Status_CDD = READY;\r
 530         Pico_mcd->cdd.Status = 0x0200;\r
 531 \r
 532         // DATA ?\r
 533         if (Pico_mcd->scd.Cur_Track == 1)\r
 534              Pico_mcd->s68k_regs[0x36] |=  0x01;\r
 535         else Pico_mcd->s68k_regs[0x36] &= ~0x01;                // AUDIO\r
 536 \r
 537         Pico_mcd->cdd.Minute = 0;\r
 538         Pico_mcd->cdd.Seconde = 0;\r
 539         Pico_mcd->cdd.Frame = 0;\r
 540         Pico_mcd->cdd.Ext = 0;\r
 541 \r
 542         Pico_mcd->scd.CDD_Complete = 1;\r
 543 \r
 544         return 0;\r
 545 }\r
 546 \r
 547 \r
 548 PICO_INTERNAL int Pause_CDD_c6(void)\r
 549 {\r
 550         CHECK_TRAY_OPEN\r
 551         CHECK_CD_PRESENT\r
 552 \r
 553         Pico_mcd->scd.Status_CDC &= ~1;                 // Stop CDC read to start a new one if raw data\r
 554 \r
 555         Pico_mcd->scd.Status_CDD = READY;\r
 556         Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD;\r
 557 \r
 558         Pico_mcd->s68k_regs[0x36] |= 0x01;              // Data bit set because stopped\r
 559 \r
 560         Pico_mcd->cdd.Minute = 0;\r
 561         Pico_mcd->cdd.Seconde = 0;\r
 562         Pico_mcd->cdd.Frame = 0;\r
 563         Pico_mcd->cdd.Ext = 0;\r
 564 \r
 565         Pico_mcd->scd.CDD_Complete = 1;\r
 566 \r
 567         return 0;\r
 568 }\r
 569 \r
 570 \r
 571 PICO_INTERNAL int Resume_CDD_c7(void)\r
 572 {\r
 573         CHECK_TRAY_OPEN\r
 574         CHECK_CD_PRESENT\r
 575 \r
 576         Pico_mcd->scd.Cur_Track = LBA_to_Track(Pico_mcd->scd.Cur_LBA);\r
 577 \r
 578 #ifdef DEBUG_CD\r
 579         {\r
 580                 _msf MSF;\r
 581                 LBA_to_MSF(Pico_mcd->scd.Cur_LBA, &MSF);\r
 582                 cdprintf("Resume read : Cur LBA = %d, M=%d, S=%d, F=%d", Pico_mcd->scd.Cur_LBA, MSF.M, MSF.S, MSF.F);\r
 583         }\r
 584 #endif\r
 585 \r
 586         Pico_mcd->scd.Status_CDD = PLAYING;\r
 587         Pico_mcd->cdd.Status = 0x0102;\r
 588 \r
 589         if (Pico_mcd->scd.Cur_Track == 1)\r
 590         {\r
 591                 Pico_mcd->s68k_regs[0x36] |=  0x01;                             // DATA\r
 592         }\r
 593         else\r
 594         {\r
 595                 Pico_mcd->s68k_regs[0x36] &= ~0x01;                             // AUDIO\r
 596                 //CD_Audio_Starting = 1;\r
 597                 FILE_Play_CD_LBA();\r
 598         }\r
 599 \r
 600         if (Pico_mcd->scd.Cur_Track == 100) Pico_mcd->cdd.Minute = 0x0A02;\r
 601         else Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.Cur_Track);\r
 602         Pico_mcd->cdd.Seconde = 0;\r
 603         Pico_mcd->cdd.Frame = 0;\r
 604         Pico_mcd->cdd.Ext = 0;\r
 605 \r
 606         Pico_mcd->scd.Status_CDC |= 1;                  // Read data with CDC\r
 607 \r
 608         Pico_mcd->scd.CDD_Complete = 1;\r
 609         return 0;\r
 610 }\r
 611 \r
 612 \r
 613 PICO_INTERNAL int Fast_Foward_CDD_c8(void)\r
 614 {\r
 615         CHECK_TRAY_OPEN\r
 616         CHECK_CD_PRESENT\r
 617 \r
 618         Pico_mcd->scd.Status_CDC &= ~1;                         // Stop CDC read\r
 619 \r
 620         Pico_mcd->scd.Status_CDD = FAST_FOW;\r
 621         Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD | 2;\r
 622 \r
 623         Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.Cur_Track);\r
 624         Pico_mcd->cdd.Seconde = 0;\r
 625         Pico_mcd->cdd.Frame = 0;\r
 626         Pico_mcd->cdd.Ext = 0;\r
 627 \r
 628         Pico_mcd->scd.CDD_Complete = 1;\r
 629 \r
 630         return 0;\r
 631 }\r
 632 \r
 633 \r
 634 PICO_INTERNAL int Fast_Rewind_CDD_c9(void)\r
 635 {\r
 636         CHECK_TRAY_OPEN\r
 637         CHECK_CD_PRESENT\r
 638 \r
 639         Pico_mcd->scd.Status_CDC &= ~1;                         // Stop CDC read\r
 640 \r
 641         Pico_mcd->scd.Status_CDD = FAST_REV;\r
 642         Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD | 2;\r
 643 \r
 644         Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.Cur_Track);\r
 645         Pico_mcd->cdd.Seconde = 0;\r
 646         Pico_mcd->cdd.Frame = 0;\r
 647         Pico_mcd->cdd.Ext = 0;\r
 648 \r
 649         Pico_mcd->scd.CDD_Complete = 1;\r
 650 \r
 651         return 0;\r
 652 }\r
 653 \r
 654 \r
 655 PICO_INTERNAL int Close_Tray_CDD_cC(void)\r
 656 {\r
 657         CD_Present = 0;\r
 658         //Clear_Sound_Buffer();\r
 659 \r
 660         Pico_mcd->scd.Status_CDC &= ~1;                 // Stop CDC read\r
 661 \r
 662         elprintf(EL_STATUS, "tray close\n");\r
 663 \r
 664         if (PicoMCDcloseTray != NULL)\r
 665                 CD_Present = PicoMCDcloseTray();\r
 666 \r
 667         Pico_mcd->scd.Status_CDD = CD_Present ? STOPPED : NOCD;\r
 668         Pico_mcd->cdd.Status = 0x0000;\r
 669 \r
 670         Pico_mcd->cdd.Minute = 0;\r
 671         Pico_mcd->cdd.Seconde = 0;\r
 672         Pico_mcd->cdd.Frame = 0;\r
 673         Pico_mcd->cdd.Ext = 0;\r
 674 \r
 675         Pico_mcd->scd.CDD_Complete = 1;\r
 676 \r
 677         return 0;\r
 678 }\r
 679 \r
 680 \r
 681 PICO_INTERNAL int Open_Tray_CDD_cD(void)\r
 682 {\r
 683         CHECK_TRAY_OPEN\r
 684 \r
 685         Pico_mcd->scd.Status_CDC &= ~1;                 // Stop CDC read\r
 686 \r
 687         elprintf(EL_STATUS, "tray open\n");\r
 688 \r
 689         Unload_ISO();\r
 690         CD_Present = 0;\r
 691 \r
 692         if (PicoMCDopenTray != NULL)\r
 693                 PicoMCDopenTray();\r
 694 \r
 695         Pico_mcd->scd.Status_CDD = TRAY_OPEN;\r
 696         Pico_mcd->cdd.Status = 0x0E00;\r
 697 \r
 698         Pico_mcd->cdd.Minute = 0;\r
 699         Pico_mcd->cdd.Seconde = 0;\r
 700         Pico_mcd->cdd.Frame = 0;\r
 701         Pico_mcd->cdd.Ext = 0;\r
 702 \r
 703         Pico_mcd->scd.CDD_Complete = 1;\r
 704 \r
 705         return 0;\r
 706 }\r
 707 \r
 708 \r
 709 PICO_INTERNAL int CDD_cA(void)\r
 710 {\r
 711         CHECK_TRAY_OPEN\r
 712         CHECK_CD_PRESENT\r
 713 \r
 714         Pico_mcd->scd.Status_CDC &= ~1;\r
 715 \r
 716         Pico_mcd->scd.Status_CDD = READY;\r
 717         Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD;\r
 718 \r
 719         Pico_mcd->cdd.Minute = 0;\r
 720         Pico_mcd->cdd.Seconde = INT_TO_BCDW(1);\r
 721         Pico_mcd->cdd.Frame = INT_TO_BCDW(1);\r
 722         Pico_mcd->cdd.Ext = 0;\r
 723 \r
 724         Pico_mcd->scd.CDD_Complete = 1;\r
 725 \r
 726         return 0;\r
 727 }\r
 728 \r
 729 \r
 730 PICO_INTERNAL int CDD_Def(void)\r
 731 {\r
 732         Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD;\r
 733 \r
 734         Pico_mcd->cdd.Minute = 0;\r
 735         Pico_mcd->cdd.Seconde = 0;\r
 736         Pico_mcd->cdd.Frame = 0;\r
 737         Pico_mcd->cdd.Ext = 0;\r
 738 \r
 739         return 0;\r
 740 }\r
 741 \r
 742 \r