cd/Memory.s improvements, reset fixed?
[picodrive.git] / Pico / cd / cd_sys.c
index d754424..6d4cb43 100644 (file)
@@ -101,19 +101,19 @@ static unsigned int MSF_to_Track(_msf *MSF)
 \r
        Start = (MSF->M << 16) + (MSF->S << 8) + MSF->F;\r
 \r
-       for(i = Pico_mcd->scd.TOC.First_Track; i <= (Pico_mcd->scd.TOC.Last_Track + 1); i++)\r
+       for(i = 1; i <= (Pico_mcd->TOC.Last_Track + 1); i++)\r
        {\r
-               Cur = Pico_mcd->scd.TOC.Tracks[i - Pico_mcd->scd.TOC.First_Track].MSF.M << 16;\r
-               Cur += Pico_mcd->scd.TOC.Tracks[i - Pico_mcd->scd.TOC.First_Track].MSF.S << 8;\r
-               Cur += Pico_mcd->scd.TOC.Tracks[i - Pico_mcd->scd.TOC.First_Track].MSF.F;\r
+               Cur = Pico_mcd->TOC.Tracks[i - 1].MSF.M << 16;\r
+               Cur += Pico_mcd->TOC.Tracks[i - 1].MSF.S << 8;\r
+               Cur += Pico_mcd->TOC.Tracks[i - 1].MSF.F;\r
 \r
                if (Cur > Start) break;\r
        }\r
 \r
        --i;\r
 \r
-       if (i > Pico_mcd->scd.TOC.Last_Track) return 100;\r
-       if (i < Pico_mcd->scd.TOC.First_Track) i = Pico_mcd->scd.TOC.First_Track;\r
+       if (i > Pico_mcd->TOC.Last_Track) return 100;\r
+       else if (i < 1) i = 1;\r
 \r
        return (unsigned) i;\r
 }\r
@@ -130,12 +130,12 @@ static unsigned int LBA_to_Track(int lba)
 \r
 static void Track_to_MSF(int track, _msf *MSF)\r
 {\r
-       if (track < Pico_mcd->scd.TOC.First_Track) track = Pico_mcd->scd.TOC.First_Track;\r
-       else if (track > Pico_mcd->scd.TOC.Last_Track) track = Pico_mcd->scd.TOC.Last_Track;\r
+       if (track < 1) track = 1;\r
+       else if (track > Pico_mcd->TOC.Last_Track) track = Pico_mcd->TOC.Last_Track;\r
 \r
-       MSF->M = Pico_mcd->scd.TOC.Tracks[track - Pico_mcd->scd.TOC.First_Track].MSF.M;\r
-       MSF->S = Pico_mcd->scd.TOC.Tracks[track - Pico_mcd->scd.TOC.First_Track].MSF.S;\r
-       MSF->F = Pico_mcd->scd.TOC.Tracks[track - Pico_mcd->scd.TOC.First_Track].MSF.F;\r
+       MSF->M = Pico_mcd->TOC.Tracks[track - 1].MSF.M;\r
+       MSF->S = Pico_mcd->TOC.Tracks[track - 1].MSF.S;\r
+       MSF->F = Pico_mcd->TOC.Tracks[track - 1].MSF.F;\r
 }\r
 \r
 \r
@@ -152,23 +152,13 @@ void Check_CD_Command(void)
 {\r
        cdprintf("CHECK CD COMMAND");\r
 \r
-       // Check CDD\r
-\r
-       if (Pico_mcd->scd.CDD_Complete)\r
-       {\r
-               Pico_mcd->scd.CDD_Complete = 0;\r
-\r
-               CDD_Export_Status();\r
-       }\r
-\r
        // Check CDC\r
-\r
        if (Pico_mcd->scd.Status_CDC & 1)                       // CDC is reading data ...\r
        {\r
                cdprintf("Got a read command");\r
 \r
                // DATA ?\r
-               if (Pico_mcd->scd.TOC.Tracks[Pico_mcd->scd.Cur_Track - Pico_mcd->scd.TOC.First_Track].Type)\r
+               if (Pico_mcd->scd.Cur_Track == 1)\r
                     Pico_mcd->s68k_regs[0x36] |=  0x01;\r
                else Pico_mcd->s68k_regs[0x36] &= ~0x01;                        // AUDIO\r
 \r
@@ -179,6 +169,14 @@ void Check_CD_Command(void)
                else Pico_mcd->scd.File_Add_Delay--;\r
        }\r
 \r
+       // Check CDD\r
+       if (Pico_mcd->scd.CDD_Complete)\r
+       {\r
+               Pico_mcd->scd.CDD_Complete = 0;\r
+\r
+               CDD_Export_Status();\r
+       }\r
+\r
        if (Pico_mcd->scd.Status_CDD == FAST_FOW)\r
        {\r
                Pico_mcd->scd.Cur_LBA += 10;\r
@@ -196,8 +194,6 @@ void Check_CD_Command(void)
 \r
 int Init_CD_Driver(void)\r
 {\r
-       FILE_Init();\r
-\r
        return 0;\r
 }\r
 \r
@@ -212,8 +208,10 @@ void Reset_CD(void)
 {\r
        Pico_mcd->scd.Cur_Track = 0;\r
        Pico_mcd->scd.Cur_LBA = -150;\r
+       Pico_mcd->scd.Status_CDC &= ~1;\r
        Pico_mcd->scd.Status_CDD = READY;\r
        Pico_mcd->scd.CDD_Complete = 0;\r
+       Pico_mcd->scd.File_Add_Delay = 0;\r
 }\r
 \r
 \r
@@ -400,17 +398,11 @@ int Get_Total_Lenght_CDD_c23(void)
 //     else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
        Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 \r
-       Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.TOC.Tracks[Pico_mcd->scd.TOC.Last_Track -\r
-                               Pico_mcd->scd.TOC.First_Track + 1].MSF.M);\r
-       Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->scd.TOC.Tracks[Pico_mcd->scd.TOC.Last_Track -\r
-                               Pico_mcd->scd.TOC.First_Track + 1].MSF.S);\r
-       Pico_mcd->cdd.Frame = INT_TO_BCDW(Pico_mcd->scd.TOC.Tracks[Pico_mcd->scd.TOC.Last_Track -\r
-                               Pico_mcd->scd.TOC.First_Track + 1].MSF.F);\r
+       Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->TOC.Tracks[Pico_mcd->TOC.Last_Track].MSF.M);\r
+       Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->TOC.Tracks[Pico_mcd->TOC.Last_Track].MSF.S);\r
+       Pico_mcd->cdd.Frame = INT_TO_BCDW(Pico_mcd->TOC.Tracks[Pico_mcd->TOC.Last_Track].MSF.F);\r
        Pico_mcd->cdd.Ext = 0;\r
 \r
-// FIXME: remove\r
-//Pico_mcd->cdd.Seconde = 2;\r
-\r
        Pico_mcd->scd.CDD_Complete = 1;\r
 \r
        return 0;\r
@@ -429,14 +421,11 @@ int Get_First_Last_Track_CDD_c24(void)
 //     else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
        Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 \r
-       Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.TOC.First_Track);\r
-       Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->scd.TOC.Last_Track);\r
+       Pico_mcd->cdd.Minute = INT_TO_BCDW(1);\r
+       Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->TOC.Last_Track);\r
        Pico_mcd->cdd.Frame = 0;\r
        Pico_mcd->cdd.Ext = 0;\r
 \r
-// FIXME: remove\r
-//Pico_mcd->cdd.Minute = Pico_mcd->cdd.Seconde = 1;\r
-\r
        Pico_mcd->scd.CDD_Complete = 1;\r
 \r
        return 0;\r
@@ -462,15 +451,15 @@ int Get_Track_Adr_CDD_c25(void)
 //     else if (!(CDC.CTRL.B.B0 & 0x80)) Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
        Pico_mcd->cdd.Status |= Pico_mcd->scd.Status_CDD;\r
 \r
-       if (track_number > Pico_mcd->scd.TOC.Last_Track) track_number = Pico_mcd->scd.TOC.Last_Track;\r
-       else if (track_number < Pico_mcd->scd.TOC.First_Track) track_number = Pico_mcd->scd.TOC.First_Track;\r
+       if (track_number > Pico_mcd->TOC.Last_Track) track_number = Pico_mcd->TOC.Last_Track;\r
+       else if (track_number < 1) track_number = 1;\r
 \r
-       Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->scd.TOC.Tracks[track_number - Pico_mcd->scd.TOC.First_Track].MSF.M);\r
-       Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->scd.TOC.Tracks[track_number - Pico_mcd->scd.TOC.First_Track].MSF.S);\r
-       Pico_mcd->cdd.Frame = INT_TO_BCDW(Pico_mcd->scd.TOC.Tracks[track_number - Pico_mcd->scd.TOC.First_Track].MSF.F);\r
+       Pico_mcd->cdd.Minute = INT_TO_BCDW(Pico_mcd->TOC.Tracks[track_number - 1].MSF.M);\r
+       Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->TOC.Tracks[track_number - 1].MSF.S);\r
+       Pico_mcd->cdd.Frame = INT_TO_BCDW(Pico_mcd->TOC.Tracks[track_number - 1].MSF.F);\r
        Pico_mcd->cdd.Ext = track_number % 10;\r
 \r
-       if (Pico_mcd->scd.TOC.Tracks[track_number - Pico_mcd->scd.TOC.First_Track].Type) Pico_mcd->cdd.Frame |= 0x0800;\r
+       if (track_number == 1) Pico_mcd->cdd.Frame |= 0x0800; // data track\r
 \r
        Pico_mcd->scd.CDD_Complete = 1;\r
        return 0;\r
@@ -511,7 +500,7 @@ int Play_CDD_c3(void)
 \r
        if (Pico_mcd->scd.File_Add_Delay == 0) Pico_mcd->scd.File_Add_Delay = delay;\r
 \r
-       if (Pico_mcd->scd.TOC.Tracks[Pico_mcd->scd.Cur_Track - Pico_mcd->scd.TOC.First_Track].Type)\r
+       if (Pico_mcd->scd.Cur_Track == 1)\r
        {\r
                Pico_mcd->s68k_regs[0x36] |=  0x01;                             // DATA\r
        }\r
@@ -558,7 +547,7 @@ int Seek_CDD_c4(void)
        Pico_mcd->cdd.Status = 0x0200;\r
 \r
        // DATA ?\r
-       if (Pico_mcd->scd.TOC.Tracks[Pico_mcd->scd.Cur_Track - Pico_mcd->scd.TOC.First_Track].Type)\r
+       if (Pico_mcd->scd.Cur_Track == 1)\r
             Pico_mcd->s68k_regs[0x36] |=  0x01;\r
        else Pico_mcd->s68k_regs[0x36] &= ~0x01;                // AUDIO\r
 \r
@@ -614,7 +603,7 @@ int Resume_CDD_c7(void)
        Pico_mcd->scd.Status_CDD = PLAYING;\r
        Pico_mcd->cdd.Status = 0x0102;\r
 \r
-       if (Pico_mcd->scd.TOC.Tracks[Pico_mcd->scd.Cur_Track - Pico_mcd->scd.TOC.First_Track].Type)\r
+       if (Pico_mcd->scd.Cur_Track == 1)\r
        {\r
                Pico_mcd->s68k_regs[0x36] |=  0x01;                             // DATA\r
        }\r