+++ /dev/null
-/***********************************************************\r
- * *\r
- * This source file was taken from the Gens project *\r
- * Written by Stéphane Dallongeville *\r
- * Copyright (c) 2002 by Stéphane Dallongeville *\r
- * Modified/adapted for PicoDrive by notaz, 2007 *\r
- * *\r
- ***********************************************************/\r
-\r
-#include <stdio.h>\r
-\r
-#include "../pico_int.h"\r
-#include "cd_sys.h"\r
-#include "cd_file.h"\r
-\r
-#define DEBUG_CD\r
-\r
-#define TRAY_OPEN 0x0500 // TRAY OPEN CDD status\r
-#define NOCD 0x0000 // CD removed CDD status\r
-#define STOPPED 0x0900 // STOPPED CDD status (happen after stop or close tray command)\r
-#define READY 0x0400 // READY CDD status (also used for seeking)\r
-#define FAST_FOW 0x0300 // FAST FORWARD track CDD status\r
-#define FAST_REV 0x10300 // FAST REVERSE track CDD status\r
-#define PLAYING 0x0100 // PLAYING audio track CDD status\r
-\r
-//#undef cdprintf\r
-//#define cdprintf(x, ...) elprintf(EL_STATUS, x, ##__VA_ARGS__)\r
-\r
-#define CDC_Update_Header()\r
-\r
-static int CD_Present = 0;\r
-\r
-\r
-#define CHECK_TRAY_OPEN \\r
-if (Pico_mcd->scd.Status_CDD == TRAY_OPEN) \\r
-{ \\r
- Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD; \\r
- \\r
- Pico_mcd->cdd.Minute = 0; \\r
- Pico_mcd->cdd.Seconde = 0; \\r
- Pico_mcd->cdd.Frame = 0; \\r
- Pico_mcd->cdd.Ext = 0; \\r
- \\r
- Pico_mcd->scd.CDD_Complete = 1; \\r
- \\r
- return 2; \\r
-}\r
-\r
-\r
-#define CHECK_CD_PRESENT \\r
-if (!CD_Present) \\r
-{ \\r
- Pico_mcd->scd.Status_CDD = NOCD; \\r
- Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD; \\r
- \\r
- Pico_mcd->cdd.Minute = 0; \\r
- Pico_mcd->cdd.Seconde = 0; \\r
- Pico_mcd->cdd.Frame = 0; \\r
- Pico_mcd->cdd.Ext = 0; \\r
- \\r
- Pico_mcd->scd.CDD_Complete = 1; \\r
- \\r
- return 3; \\r
-}\r
-\r
-\r
-static int MSF_to_LBA(_msf *MSF)\r
-{\r
- return (MSF->M * 60 * 75) + (MSF->S * 75) + MSF->F - 150;\r
-}\r
-\r
-\r
-PICO_INTERNAL void LBA_to_MSF(int lba, _msf *MSF)\r
-{\r
- if (lba < -150) lba = 0;\r
- else lba += 150;\r
- MSF->M = lba / (60 * 75);\r
- MSF->S = (lba / 75) % 60;\r
- MSF->F = lba % 75;\r
-}\r
-\r
-\r
-static unsigned int MSF_to_Track(_msf *MSF)\r
-{\r
- int i, Start, Cur;\r
-\r
- Start = (MSF->M << 16) + (MSF->S << 8) + MSF->F;\r
-\r
- for(i = 1; i <= (Pico_mcd->TOC.Last_Track + 1); i++)\r
- {\r
- Cur = Pico_mcd->TOC.Tracks[i - 1].MSF.M << 16;\r
- Cur += Pico_mcd->TOC.Tracks[i - 1].MSF.S << 8;\r
- Cur += Pico_mcd->TOC.Tracks[i - 1].MSF.F;\r
-\r
- if (Cur > Start) break;\r
- }\r
-\r
- --i;\r
-\r
- if (i > Pico_mcd->TOC.Last_Track) return 100;\r
- else if (i < 1) i = 1;\r
-\r
- return (unsigned) i;\r
-}\r
-\r
-\r
-static unsigned int LBA_to_Track(int lba)\r
-{\r
- _msf MSF;\r
-\r
- LBA_to_MSF(lba, &MSF);\r
- return MSF_to_Track(&MSF);\r
-}\r
-\r
-\r
-static void Track_to_MSF(int track, _msf *MSF)\r
-{\r
- if (track < 1) track = 1;\r
- else if (track > Pico_mcd->TOC.Last_Track) track = Pico_mcd->TOC.Last_Track;\r
-\r
- MSF->M = Pico_mcd->TOC.Tracks[track - 1].MSF.M;\r
- MSF->S = Pico_mcd->TOC.Tracks[track - 1].MSF.S;\r
- MSF->F = Pico_mcd->TOC.Tracks[track - 1].MSF.F;\r
-}\r
-\r
-\r
-PICO_INTERNAL int Track_to_LBA(int track)\r
-{\r
- _msf MSF;\r
-\r
- Track_to_MSF(track, &MSF);\r
- return MSF_to_LBA(&MSF);\r
-}\r
-\r
-\r
-PICO_INTERNAL void Check_CD_Command(void)\r
-{\r
- cdprintf("CHECK CD COMMAND");\r
-\r
- // Check CDC\r
- if (Pico_mcd->scd.Status_CDC & 1) // CDC is reading data ...\r
- {\r
- cdprintf("Got a read command");\r
-\r
- // DATA ?\r
- if (Pico_mcd->scd.Cur_Track == 1) {\r
- Pico_mcd->s68k_regs[0x36] |= 0x01;\r
-\r
- if (Pico_mcd->scd.File_Add_Delay == 0)\r
- {\r
- unsigned char header[4];\r
- _msf MSF;\r
-\r
- LBA_to_MSF(Pico_mcd->scd.Cur_LBA, &MSF);\r
-\r
- header[0] = INT_TO_BCDB(MSF.M);\r
- header[1] = INT_TO_BCDB(MSF.S);\r
- header[2] = INT_TO_BCDB(MSF.F);\r
- header[3] = 0x01;\r
-\r
- //FILE_Read_One_LBA_CDC();\r
- Pico_mcd->scd.Cur_LBA +=\r
- cdc_decoder_update(header);\r
- }\r
- else Pico_mcd->scd.File_Add_Delay--;\r
- }\r
- else {\r
- Pico_mcd->s68k_regs[0x36] &= ~0x01; // AUDIO\r
- unsigned char header[4] = { 0, };\r
- cdc_decoder_update(header);\r
- }\r
- }\r
-\r
- // Check CDD\r
- if (Pico_mcd->scd.CDD_Complete)\r
- {\r
- Pico_mcd->scd.CDD_Complete = 0;\r
-\r
- CDD_Export_Status();\r
- }\r
-\r
- if (Pico_mcd->scd.Status_CDD == FAST_FOW)\r
- {\r
- Pico_mcd->scd.Cur_LBA += 10;\r
- CDC_Update_Header();\r
-\r
- }\r
- else if (Pico_mcd->scd.Status_CDD == FAST_REV)\r
- {\r
- Pico_mcd->scd.Cur_LBA -= 10;\r
- if (Pico_mcd->scd.Cur_LBA < -150) Pico_mcd->scd.Cur_LBA = -150;\r
- CDC_Update_Header();\r
- }\r
-}\r
-\r
-\r
-PICO_INTERNAL int Init_CD_Driver(void)\r
-{\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL void End_CD_Driver(void)\r
-{\r
- Unload_ISO();\r
-}\r
-\r
-\r
-PICO_INTERNAL void Reset_CD(void)\r
-{\r
- Pico_mcd->scd.Cur_Track = 0;\r
- Pico_mcd->scd.Cur_LBA = -150;\r
- Pico_mcd->scd.Status_CDC &= ~1;\r
- if (Pico_mcd->scd.Status_CDD != TRAY_OPEN)\r
- Pico_mcd->scd.Status_CDD = CD_Present ? READY : NOCD;\r
- Pico_mcd->scd.CDD_Complete = 0;\r
- Pico_mcd->scd.File_Add_Delay = 0;\r
-}\r
-\r
-\r
-int Insert_CD(const char *cdimg_name, int type)\r
-{\r
- int ret = 1;\r
-\r
- CD_Present = 0;\r
-\r
- if (cdimg_name != NULL && type != CIT_NOT_CD)\r
- {\r
- ret = Load_CD_Image(cdimg_name, type);\r
- if (ret == 0) {\r
- CD_Present = 1;\r
-\r
- if (Pico_mcd->scd.Status_CDD == TRAY_OPEN)\r
- {\r
- if (Pico_mcd->bios[0x122 ^ 1] == '2')\r
- Close_Tray_CDD_cC();\r
- // else bios will issue it\r
- }\r
- else\r
- {\r
- Pico_mcd->scd.Status_CDD = READY;\r
- }\r
- }\r
- }\r
-\r
- if (Pico_mcd->scd.Status_CDD != TRAY_OPEN && !CD_Present)\r
- Pico_mcd->scd.Status_CDD = NOCD;\r
-\r
- return ret;\r
-}\r
-\r
-\r
-int Stop_CD(void)\r
-{\r
- int ret = CD_Present;\r
-\r
- Unload_ISO();\r
- CD_Present = 0;\r
-\r
- return ret;\r
-}\r
-\r
-\r
-/*\r
-PICO_INTERNAL void Change_CD(void)\r
-{\r
- if (Pico_mcd->scd.Status_CDD == TRAY_OPEN) Close_Tray_CDD_cC();\r
- else Open_Tray_CDD_cD();\r
-}\r
-*/\r
-\r
-PICO_INTERNAL int Get_Status_CDD_c0(void)\r
-{\r
- cdprintf("Status command : Cur LBA = %d", Pico_mcd->scd.Cur_LBA);\r
-\r
- // Clear immediat status\r
- if ((Pico_mcd->cdd.Status & 0x0F00) == 0x0200)\r
- Pico_mcd->cdd.Status = (Pico_mcd->scd.Status_CDD & 0xFF00) | (Pico_mcd->cdd.Status & 0x00FF);\r
- else if ((Pico_mcd->cdd.Status & 0x0F00) == 0x0700)\r
- Pico_mcd->cdd.Status = (Pico_mcd->scd.Status_CDD & 0xFF00) | (Pico_mcd->cdd.Status & 0x00FF);\r
- else if ((Pico_mcd->cdd.Status & 0x0F00) == 0x0E00)\r
- Pico_mcd->cdd.Status = (Pico_mcd->scd.Status_CDD & 0xFF00) | (Pico_mcd->cdd.Status & 0x00FF);\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
-\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int Stop_CDD_c1(void)\r
-{\r
- CHECK_TRAY_OPEN\r
-\r
- Pico_mcd->scd.Status_CDC &= ~1; // Stop CDC read\r
-\r
- if (CD_Present) Pico_mcd->scd.Status_CDD = STOPPED;\r
- else Pico_mcd->scd.Status_CDD = NOCD;\r
- Pico_mcd->cdd.Status = 0x0000;\r
-\r
- Pico_mcd->s68k_regs[0x36] |= 0x01; // Data bit set because stopped\r
-\r
- Pico_mcd->cdd.Minute = 0;\r
- Pico_mcd->cdd.Seconde = 0;\r
- Pico_mcd->cdd.Frame = 0;\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
-\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int Get_Pos_CDD_c20(void)\r
-{\r
- _msf MSF;\r
-\r
- cdprintf("command 200 : Cur LBA = %d", Pico_mcd->scd.Cur_LBA);\r
-\r
- CHECK_TRAY_OPEN\r
-\r
- Pico_mcd->cdd.Status &= 0xFF;\r
- if (!CD_Present)\r
- {\r
- Pico_mcd->scd.Status_CDD = NOCD;\r
- Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
- }\r
-// else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
- Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
-\r
- cdprintf("Status CDD = %.4X Status = %.4X", Pico_mcd->scd.Status_CDD, Pico_mcd->cdd.Status);\r
-\r
- LBA_to_MSF(Pico_mcd->scd.Cur_LBA, &MSF);\r
-\r
- Pico_mcd->cdd.Minute = INT_TO_BCDW(MSF.M);\r
- Pico_mcd->cdd.Seconde = INT_TO_BCDW(MSF.S);\r
- Pico_mcd->cdd.Frame = INT_TO_BCDW(MSF.F);\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
-\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int Get_Track_Pos_CDD_c21(void)\r
-{\r
- int elapsed_time;\r
- _msf MSF;\r
-\r
- cdprintf("command 201 : Cur LBA = %d", Pico_mcd->scd.Cur_LBA);\r
-\r
- CHECK_TRAY_OPEN\r
-\r
- Pico_mcd->cdd.Status &= 0xFF;\r
- if (!CD_Present)\r
- {\r
- Pico_mcd->scd.Status_CDD = NOCD;\r
- Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
- }\r
-// else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
- Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
-\r
- elapsed_time = Pico_mcd->scd.Cur_LBA - Track_to_LBA(LBA_to_Track(Pico_mcd->scd.Cur_LBA));\r
- LBA_to_MSF(elapsed_time - 150, &MSF);\r
-\r
- cdprintf(" elapsed = %d", elapsed_time);\r
-\r
- Pico_mcd->cdd.Minute = INT_TO_BCDW(MSF.M);\r
- Pico_mcd->cdd.Seconde = INT_TO_BCDW(MSF.S);\r
- Pico_mcd->cdd.Frame = INT_TO_BCDW(MSF.F);\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
-\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int Get_Current_Track_CDD_c22(void)\r
-{\r
- cdprintf("Status CDD = %.4X Status = %.4X", Pico_mcd->scd.Status_CDD, Pico_mcd->cdd.Status);\r
-\r
- CHECK_TRAY_OPEN\r
-\r
- Pico_mcd->cdd.Status &= 0xFF;\r
- if (!CD_Present)\r
- {\r
- Pico_mcd->scd.Status_CDD = NOCD;\r
- Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
- }\r
-// else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
- Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
-\r
- Pico_mcd->scd.Cur_Track = LBA_to_Track(Pico_mcd->scd.Cur_LBA);\r
-\r
- if (Pico_mcd->scd.Cur_Track == 100) Pico_mcd->cdd.Minute = 0x0A02;\r
- else Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.Cur_Track);\r
- Pico_mcd->cdd.Seconde = 0;\r
- Pico_mcd->cdd.Frame = 0;\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
-\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int Get_Total_Lenght_CDD_c23(void)\r
-{\r
- CHECK_TRAY_OPEN\r
-\r
- Pico_mcd->cdd.Status &= 0xFF;\r
- if (!CD_Present)\r
- {\r
- Pico_mcd->scd.Status_CDD = NOCD;\r
- Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
- }\r
-// else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
- Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
-\r
- Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->TOC.Tracks[Pico_mcd->TOC.Last_Track].MSF.M);\r
- Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->TOC.Tracks[Pico_mcd->TOC.Last_Track].MSF.S);\r
- Pico_mcd->cdd.Frame = INT_TO_BCDW(Pico_mcd->TOC.Tracks[Pico_mcd->TOC.Last_Track].MSF.F);\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
-\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int Get_First_Last_Track_CDD_c24(void)\r
-{\r
- CHECK_TRAY_OPEN\r
-\r
- Pico_mcd->cdd.Status &= 0xFF;\r
- if (!CD_Present)\r
- {\r
- Pico_mcd->scd.Status_CDD = NOCD;\r
- }\r
-// else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
- Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
-\r
- Pico_mcd->cdd.Minute = INT_TO_BCDW(1);\r
- Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->TOC.Last_Track);\r
- Pico_mcd->cdd.Frame = 0;\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
-\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int Get_Track_Adr_CDD_c25(void)\r
-{\r
- int track_number;\r
-\r
- CHECK_TRAY_OPEN\r
-\r
- // track number in TC4 & TC5\r
-\r
- track_number = (Pico_mcd->s68k_regs[0x38+10+4] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+5] & 0xF);\r
-\r
- Pico_mcd->cdd.Status &= 0xFF;\r
- if (!CD_Present)\r
- {\r
- Pico_mcd->scd.Status_CDD = NOCD;\r
- Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
- }\r
-// else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
- Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
-\r
- if (track_number > Pico_mcd->TOC.Last_Track) track_number = Pico_mcd->TOC.Last_Track;\r
- else if (track_number < 1) track_number = 1;\r
-\r
- Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->TOC.Tracks[track_number - 1].MSF.M);\r
- Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->TOC.Tracks[track_number - 1].MSF.S);\r
- Pico_mcd->cdd.Frame = INT_TO_BCDW(Pico_mcd->TOC.Tracks[track_number - 1].MSF.F);\r
- Pico_mcd->cdd.Ext = track_number % 10;\r
-\r
- if (track_number == 1) Pico_mcd->cdd.Frame |= 0x0800; // data track\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int Play_CDD_c3(void)\r
-{\r
- _msf MSF;\r
- int delay, new_lba;\r
-\r
- CHECK_TRAY_OPEN\r
- CHECK_CD_PRESENT\r
-\r
- // MSF of the track to play in TC buffer\r
-\r
- MSF.M = (Pico_mcd->s68k_regs[0x38+10+2] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+3] & 0xF);\r
- MSF.S = (Pico_mcd->s68k_regs[0x38+10+4] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+5] & 0xF);\r
- MSF.F = (Pico_mcd->s68k_regs[0x38+10+6] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+7] & 0xF);\r
-\r
- Pico_mcd->scd.Cur_Track = MSF_to_Track(&MSF);\r
-\r
- new_lba = MSF_to_LBA(&MSF);\r
- delay = new_lba - Pico_mcd->scd.Cur_LBA;\r
- if (delay < 0) delay = -delay;\r
- delay >>= 12;\r
-\r
- if (Pico_mcd->scd.Cur_LBA > 0 && delay < 13)\r
- // based on genplus GX\r
- delay = 13;\r
-\r
- Pico_mcd->scd.Cur_LBA = new_lba;\r
- CDC_Update_Header();\r
-\r
- cdprintf("Read : Cur LBA = %d, M=%d, S=%d, F=%d", Pico_mcd->scd.Cur_LBA, MSF.M, MSF.S, MSF.F);\r
-\r
- if (Pico_mcd->scd.Status_CDD != PLAYING) delay += 20;\r
-\r
- Pico_mcd->scd.Status_CDD = PLAYING;\r
- Pico_mcd->cdd.Status = 0x0102;\r
-// Pico_mcd->cdd.Status = COMM_OK;\r
-\r
- if (Pico_mcd->scd.File_Add_Delay == 0) Pico_mcd->scd.File_Add_Delay = delay;\r
-\r
- if (Pico_mcd->scd.Cur_Track == 1)\r
- {\r
- Pico_mcd->s68k_regs[0x36] |= 0x01; // DATA\r
- }\r
- else\r
- {\r
- Pico_mcd->s68k_regs[0x36] &= ~0x01; // AUDIO\r
- cdda_start_play();\r
- }\r
-\r
- if (Pico_mcd->scd.Cur_Track == 100) Pico_mcd->cdd.Minute = 0x0A02;\r
- else Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.Cur_Track);\r
- Pico_mcd->cdd.Seconde = 0;\r
- Pico_mcd->cdd.Frame = 0;\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- Pico_mcd->scd.Status_CDC |= 1; // Read data with CDC\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int Seek_CDD_c4(void)\r
-{\r
- _msf MSF;\r
-\r
- CHECK_TRAY_OPEN\r
- CHECK_CD_PRESENT\r
-\r
- // MSF to seek in TC buffer\r
-\r
- MSF.M = (Pico_mcd->s68k_regs[0x38+10+2] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+3] & 0xF);\r
- MSF.S = (Pico_mcd->s68k_regs[0x38+10+4] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+5] & 0xF);\r
- MSF.F = (Pico_mcd->s68k_regs[0x38+10+6] & 0xF) * 10 + (Pico_mcd->s68k_regs[0x38+10+7] & 0xF);\r
-\r
- Pico_mcd->scd.Cur_Track = MSF_to_Track(&MSF);\r
- Pico_mcd->scd.Cur_LBA = MSF_to_LBA(&MSF);\r
- CDC_Update_Header();\r
-\r
- Pico_mcd->scd.Status_CDC &= ~1; // Stop CDC read\r
-\r
- Pico_mcd->scd.Status_CDD = READY;\r
- Pico_mcd->cdd.Status = 0x0200;\r
-\r
- // DATA ?\r
- if (Pico_mcd->scd.Cur_Track == 1)\r
- Pico_mcd->s68k_regs[0x36] |= 0x01;\r
- else Pico_mcd->s68k_regs[0x36] &= ~0x01; // AUDIO\r
-\r
- Pico_mcd->cdd.Minute = 0;\r
- Pico_mcd->cdd.Seconde = 0;\r
- Pico_mcd->cdd.Frame = 0;\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
-\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int Pause_CDD_c6(void)\r
-{\r
- CHECK_TRAY_OPEN\r
- CHECK_CD_PRESENT\r
-\r
- Pico_mcd->scd.Status_CDC &= ~1; // Stop CDC read to start a new one if raw data\r
-\r
- Pico_mcd->scd.Status_CDD = READY;\r
- Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD;\r
-\r
- Pico_mcd->s68k_regs[0x36] |= 0x01; // Data bit set because stopped\r
-\r
- Pico_mcd->cdd.Minute = 0;\r
- Pico_mcd->cdd.Seconde = 0;\r
- Pico_mcd->cdd.Frame = 0;\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
-\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int Resume_CDD_c7(void)\r
-{\r
- CHECK_TRAY_OPEN\r
- CHECK_CD_PRESENT\r
-\r
- Pico_mcd->scd.Cur_Track = LBA_to_Track(Pico_mcd->scd.Cur_LBA);\r
-\r
-#ifdef DEBUG_CD\r
- {\r
- _msf MSF;\r
- LBA_to_MSF(Pico_mcd->scd.Cur_LBA, &MSF);\r
- cdprintf("Resume read : Cur LBA = %d, M=%d, S=%d, F=%d", Pico_mcd->scd.Cur_LBA, MSF.M, MSF.S, MSF.F);\r
- }\r
-#endif\r
-\r
- Pico_mcd->scd.Status_CDD = PLAYING;\r
- Pico_mcd->cdd.Status = 0x0102;\r
-\r
- if (Pico_mcd->scd.Cur_Track == 1)\r
- {\r
- Pico_mcd->s68k_regs[0x36] |= 0x01; // DATA\r
- }\r
- else\r
- {\r
- Pico_mcd->s68k_regs[0x36] &= ~0x01; // AUDIO\r
- cdda_start_play();\r
- }\r
-\r
- if (Pico_mcd->scd.Cur_Track == 100) Pico_mcd->cdd.Minute = 0x0A02;\r
- else Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.Cur_Track);\r
- Pico_mcd->cdd.Seconde = 0;\r
- Pico_mcd->cdd.Frame = 0;\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- Pico_mcd->scd.Status_CDC |= 1; // Read data with CDC\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int Fast_Foward_CDD_c8(void)\r
-{\r
- CHECK_TRAY_OPEN\r
- CHECK_CD_PRESENT\r
-\r
- Pico_mcd->scd.Status_CDC &= ~1; // Stop CDC read\r
-\r
- Pico_mcd->scd.Status_CDD = FAST_FOW;\r
- Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD | 2;\r
-\r
- Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.Cur_Track);\r
- Pico_mcd->cdd.Seconde = 0;\r
- Pico_mcd->cdd.Frame = 0;\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
-\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int Fast_Rewind_CDD_c9(void)\r
-{\r
- CHECK_TRAY_OPEN\r
- CHECK_CD_PRESENT\r
-\r
- Pico_mcd->scd.Status_CDC &= ~1; // Stop CDC read\r
-\r
- Pico_mcd->scd.Status_CDD = FAST_REV;\r
- Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD | 2;\r
-\r
- Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.Cur_Track);\r
- Pico_mcd->cdd.Seconde = 0;\r
- Pico_mcd->cdd.Frame = 0;\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
-\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int Close_Tray_CDD_cC(void)\r
-{\r
- Pico_mcd->scd.Status_CDC &= ~1; // Stop CDC read\r
-\r
- elprintf(EL_STATUS, "tray close\n");\r
-\r
- if (PicoMCDcloseTray != NULL)\r
- PicoMCDcloseTray();\r
-\r
- Pico_mcd->scd.Status_CDD = CD_Present ? STOPPED : NOCD;\r
- Pico_mcd->cdd.Status = 0x0000;\r
-\r
- Pico_mcd->cdd.Minute = 0;\r
- Pico_mcd->cdd.Seconde = 0;\r
- Pico_mcd->cdd.Frame = 0;\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
-\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int Open_Tray_CDD_cD(void)\r
-{\r
- CHECK_TRAY_OPEN\r
-\r
- Pico_mcd->scd.Status_CDC &= ~1; // Stop CDC read\r
-\r
- elprintf(EL_STATUS, "tray open\n");\r
-\r
- Unload_ISO();\r
- CD_Present = 0;\r
-\r
- if (PicoMCDopenTray != NULL)\r
- PicoMCDopenTray();\r
-\r
- Pico_mcd->scd.Status_CDD = TRAY_OPEN;\r
- Pico_mcd->cdd.Status = 0x0E00;\r
-\r
- Pico_mcd->cdd.Minute = 0;\r
- Pico_mcd->cdd.Seconde = 0;\r
- Pico_mcd->cdd.Frame = 0;\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
-\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int CDD_cA(void)\r
-{\r
- CHECK_TRAY_OPEN\r
- CHECK_CD_PRESENT\r
-\r
- Pico_mcd->scd.Status_CDC &= ~1;\r
-\r
- Pico_mcd->scd.Status_CDD = READY;\r
- Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD;\r
-\r
- Pico_mcd->cdd.Minute = 0;\r
- Pico_mcd->cdd.Seconde = INT_TO_BCDW(1);\r
- Pico_mcd->cdd.Frame = INT_TO_BCDW(1);\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- Pico_mcd->scd.CDD_Complete = 1;\r
-\r
- return 0;\r
-}\r
-\r
-\r
-PICO_INTERNAL int CDD_Def(void)\r
-{\r
- Pico_mcd->cdd.Status = Pico_mcd->scd.Status_CDD;\r
-\r
- Pico_mcd->cdd.Minute = 0;\r
- Pico_mcd->cdd.Seconde = 0;\r
- Pico_mcd->cdd.Frame = 0;\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- return 0;\r
-}\r
-\r
-\r
-static int bswapwrite(int a, unsigned short d)\r
-{\r
- *(unsigned short *)(Pico_mcd->s68k_regs + a) = (d>>8)|(d<<8);\r
- return d + (d >> 8);\r
-}\r
-\r
-PICO_INTERNAL void CDD_Export_Status(void)\r
-{\r
- unsigned int csum;\r
-\r
- csum = bswapwrite( 0x38+0, Pico_mcd->cdd.Status);\r
- csum += bswapwrite( 0x38+2, Pico_mcd->cdd.Minute);\r
- csum += bswapwrite( 0x38+4, Pico_mcd->cdd.Seconde);\r
- csum += bswapwrite( 0x38+6, Pico_mcd->cdd.Frame);\r
- Pico_mcd->s68k_regs[0x38+8] = Pico_mcd->cdd.Ext;\r
- csum += Pico_mcd->cdd.Ext;\r
- Pico_mcd->s68k_regs[0x38+9] = ~csum & 0xf;\r
-\r
- Pico_mcd->s68k_regs[0x37] &= 3; // CDD.Control\r
-\r
- if (Pico_mcd->s68k_regs[0x33] & PCDS_IEN4)\r
- {\r
- elprintf(EL_INTS, "cdd export irq 4");\r
- SekInterruptS68k(4);\r
- }\r
-\r
-// cdprintf("CDD exported status\n");\r
- cdprintf("out: Status=%.4X, Minute=%.4X, Second=%.4X, Frame=%.4X Checksum=%.4X",\r
- (Pico_mcd->s68k_regs[0x38+0] << 8) | Pico_mcd->s68k_regs[0x38+1],\r
- (Pico_mcd->s68k_regs[0x38+2] << 8) | Pico_mcd->s68k_regs[0x38+3],\r
- (Pico_mcd->s68k_regs[0x38+4] << 8) | Pico_mcd->s68k_regs[0x38+5],\r
- (Pico_mcd->s68k_regs[0x38+6] << 8) | Pico_mcd->s68k_regs[0x38+7],\r
- (Pico_mcd->s68k_regs[0x38+8] << 8) | Pico_mcd->s68k_regs[0x38+9]);\r
-}\r
-\r
-\r
-PICO_INTERNAL void CDD_Import_Command(void)\r
-{\r
-// cdprintf("CDD importing command\n");\r
- cdprintf("in: Command=%.4X, Minute=%.4X, Second=%.4X, Frame=%.4X Checksum=%.4X",\r
- (Pico_mcd->s68k_regs[0x38+10+0] << 8) | Pico_mcd->s68k_regs[0x38+10+1],\r
- (Pico_mcd->s68k_regs[0x38+10+2] << 8) | Pico_mcd->s68k_regs[0x38+10+3],\r
- (Pico_mcd->s68k_regs[0x38+10+4] << 8) | Pico_mcd->s68k_regs[0x38+10+5],\r
- (Pico_mcd->s68k_regs[0x38+10+6] << 8) | Pico_mcd->s68k_regs[0x38+10+7],\r
- (Pico_mcd->s68k_regs[0x38+10+8] << 8) | Pico_mcd->s68k_regs[0x38+10+9]);\r
-\r
- switch (Pico_mcd->s68k_regs[0x38+10+0])\r
- {\r
- case 0x0: // STATUS (?)\r
- Get_Status_CDD_c0();\r
- break;\r
-\r
- case 0x1: // STOP ALL (?)\r
- Stop_CDD_c1();\r
- break;\r
-\r
- case 0x2: // GET TOC INFORMATIONS\r
- switch(Pico_mcd->s68k_regs[0x38+10+3])\r
- {\r
- case 0x0: // get current position (MSF format)\r
- Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00);\r
- Get_Pos_CDD_c20();\r
- break;\r
-\r
- case 0x1: // get elapsed time of current track played/scanned (relative MSF format)\r
- Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 1;\r
- Get_Track_Pos_CDD_c21();\r
- break;\r
-\r
- case 0x2: // get current track in RS2-RS3\r
- Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 2;\r
- Get_Current_Track_CDD_c22();\r
- break;\r
-\r
- case 0x3: // get total length (MSF format)\r
- Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 3;\r
- Get_Total_Lenght_CDD_c23();\r
- break;\r
-\r
- case 0x4: // first & last track number\r
- Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 4;\r
- Get_First_Last_Track_CDD_c24();\r
- break;\r
-\r
- case 0x5: // get track addresse (MSF format)\r
- Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 5;\r
- Get_Track_Adr_CDD_c25();\r
- break;\r
-\r
- default : // invalid, then we return status\r
- Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 0xF;\r
- Get_Status_CDD_c0();\r
- break;\r
- }\r
- break;\r
-\r
- case 0x3: // READ\r
- Play_CDD_c3();\r
- break;\r
-\r
- case 0x4: // SEEK\r
- Seek_CDD_c4();\r
- break;\r
-\r
- case 0x6: // PAUSE/STOP\r
- Pause_CDD_c6();\r
- break;\r
-\r
- case 0x7: // RESUME\r
- Resume_CDD_c7();\r
- break;\r
-\r
- case 0x8: // FAST FOWARD\r
- Fast_Foward_CDD_c8();\r
- break;\r
-\r
- case 0x9: // FAST REWIND\r
- Fast_Rewind_CDD_c9();\r
- break;\r
-\r
- case 0xA: // RECOVER INITIAL STATE (?)\r
- CDD_cA();\r
- break;\r
-\r
- case 0xC: // CLOSE TRAY\r
- Close_Tray_CDD_cC();\r
- break;\r
-\r
- case 0xD: // OPEN TRAY\r
- Open_Tray_CDD_cD();\r
- break;\r
-\r
- default: // UNKNOWN\r
- CDD_Def();\r
- break;\r
- }\r
-}\r
-\r
-void CDD_Reset(void)\r
-{\r
- // Reseting CDD\r
-\r
- memset(Pico_mcd->s68k_regs+0x34, 0, 2*2); // CDD.Fader, CDD.Control\r
- Pico_mcd->cdd.Status = 0;\r
- Pico_mcd->cdd.Minute = 0;\r
- Pico_mcd->cdd.Seconde = 0;\r
- Pico_mcd->cdd.Frame = 0;\r
- Pico_mcd->cdd.Ext = 0;\r
-\r
- // clear receive status and transfer command\r
- memset(Pico_mcd->s68k_regs+0x38, 0, 20);\r
- Pico_mcd->s68k_regs[0x38+9] = 0xF; // Default checksum\r
-}\r
-\r
-\r
notaz.gp2x.de / picodrive.git / blobdiff