Cyclone poll detection problem fixed
[picodrive.git] / Pico / cd / cd_sys.c
CommitLineData
6cadc2da 1/***********************************************************\r
2 * *\r
8b99ab90 3 * This source file was taken from the Gens project *\r
6cadc2da 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
cc68a136 10#include <stdio.h>\r
cc68a136 11\r
12#include "../PicoInt.h"\r
eff55556 13#include "cd_sys.h"\r
14#include "cd_file.h"\r
cc68a136 15\r
ca61ee42 16#define cdprintf(x...)\r
c459aefd 17#define DEBUG_CD\r
cc68a136 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
cc68a136 27\r
cc68a136 28static int CD_Present = 0;\r
cc68a136 29\r
30\r
31#define CHECK_TRAY_OPEN \\r
32if (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
51a902ae 41 Pico_mcd->scd.CDD_Complete = 1; \\r
cc68a136 42 \\r
43 return 2; \\r
44}\r
45\r
46\r
47#define CHECK_CD_PRESENT \\r
48if (!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
51a902ae 58 Pico_mcd->scd.CDD_Complete = 1; \\r
cc68a136 59 \\r
60 return 3; \\r
61}\r
62\r
63\r
cc68a136 64static 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
eff55556 70PICO_INTERNAL void LBA_to_MSF(int lba, _msf *MSF)\r
cc68a136 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
80static 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
75736070 86 for(i = 1; i <= (Pico_mcd->TOC.Last_Track + 1); i++)\r
cc68a136 87 {\r
75736070 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
cc68a136 91\r
92 if (Cur > Start) break;\r
93 }\r
94\r
95 --i;\r
96\r
75736070 97 if (i > Pico_mcd->TOC.Last_Track) return 100;\r
98 else if (i < 1) i = 1;\r
cc68a136 99\r
100 return (unsigned) i;\r
101}\r
102\r
103\r
104static 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
113static void Track_to_MSF(int track, _msf *MSF)\r
114{\r
75736070 115 if (track < 1) track = 1;\r
116 else if (track > Pico_mcd->TOC.Last_Track) track = Pico_mcd->TOC.Last_Track;\r
cc68a136 117\r
75736070 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
cc68a136 121}\r
122\r
123\r
eff55556 124PICO_INTERNAL int Track_to_LBA(int track)\r
cc68a136 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
eff55556 133PICO_INTERNAL void Check_CD_Command(void)\r
cc68a136 134{\r
c459aefd 135 cdprintf("CHECK CD COMMAND");\r
cc68a136 136\r
cc68a136 137 // Check CDC\r
cc68a136 138 if (Pico_mcd->scd.Status_CDC & 1) // CDC is reading data ...\r
139 {\r
c459aefd 140 cdprintf("Got a read command");\r
cc68a136 141\r
142 // DATA ?\r
75736070 143 if (Pico_mcd->scd.Cur_Track == 1)\r
cc68a136 144 Pico_mcd->s68k_regs[0x36] |= 0x01;\r
145 else Pico_mcd->s68k_regs[0x36] &= ~0x01; // AUDIO\r
146\r
51a902ae 147 if (Pico_mcd->scd.File_Add_Delay == 0)\r
cc68a136 148 {\r
cc68a136 149 FILE_Read_One_LBA_CDC();\r
cc68a136 150 }\r
51a902ae 151 else Pico_mcd->scd.File_Add_Delay--;\r
cc68a136 152 }\r
153\r
1cd356a3 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
cc68a136 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
eff55556 177PICO_INTERNAL int Init_CD_Driver(void)\r
cc68a136 178{\r
cc68a136 179 return 0;\r
180}\r
181\r
182\r
eff55556 183PICO_INTERNAL void End_CD_Driver(void)\r
cc68a136 184{\r
eff55556 185 Unload_ISO();\r
cc68a136 186}\r
187\r
188\r
eff55556 189PICO_INTERNAL void Reset_CD(void)\r
cc68a136 190{\r
191 Pico_mcd->scd.Cur_Track = 0;\r
192 Pico_mcd->scd.Cur_LBA = -150;\r
5c69a605 193 Pico_mcd->scd.Status_CDC &= ~1;\r
721cd396 194 Pico_mcd->scd.Status_CDD = CD_Present ? READY : NOCD;\r
51a902ae 195 Pico_mcd->scd.CDD_Complete = 0;\r
5c69a605 196 Pico_mcd->scd.File_Add_Delay = 0;\r
cc68a136 197}\r
198\r
199\r
bf098bc5 200int Insert_CD(char *iso_name, int is_bin)\r
cc68a136 201{\r
bf098bc5 202 int ret = 0;\r
203\r
bf098bc5 204 CD_Present = 0;\r
721cd396 205 Pico_mcd->scd.Status_CDD = NOCD;\r
bf098bc5 206\r
207 if (iso_name != NULL)\r
cc68a136 208 {\r
bf098bc5 209 ret = Load_ISO(iso_name, is_bin);\r
721cd396 210 if (ret == 0) {\r
bf098bc5 211 CD_Present = 1;\r
721cd396 212 Pico_mcd->scd.Status_CDD = READY;\r
213 }\r
cc68a136 214 }\r
215\r
bf098bc5 216 return ret;\r
cc68a136 217}\r
218\r
219\r
220void Stop_CD(void)\r
221{\r
cc68a136 222 Unload_ISO();\r
cc68a136 223 CD_Present = 0;\r
224}\r
225\r
226\r
eff55556 227/*\r
228PICO_INTERNAL void Change_CD(void)\r
cc68a136 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
eff55556 233*/\r
cc68a136 234\r
eff55556 235PICO_INTERNAL int Get_Status_CDD_c0(void)\r
cc68a136 236{\r
c459aefd 237 cdprintf("Status command : Cur LBA = %d", Pico_mcd->scd.Cur_LBA);\r
cc68a136 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
51a902ae 247 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 248\r
249 return 0;\r
250}\r
251\r
252\r
eff55556 253PICO_INTERNAL int Stop_CDD_c1(void)\r
cc68a136 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
51a902ae 270 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 271\r
272 return 0;\r
273}\r
274\r
275\r
eff55556 276PICO_INTERNAL int Get_Pos_CDD_c20(void)\r
cc68a136 277{\r
278 _msf MSF;\r
279\r
c459aefd 280 cdprintf("command 200 : Cur LBA = %d", Pico_mcd->scd.Cur_LBA);\r
cc68a136 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
c459aefd 293 cdprintf("Status CDD = %.4X Status = %.4X", Pico_mcd->scd.Status_CDD, Pico_mcd->cdd.Status);\r
cc68a136 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
51a902ae 302 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 303\r
304 return 0;\r
305}\r
306\r
307\r
eff55556 308PICO_INTERNAL int Get_Track_Pos_CDD_c21(void)\r
cc68a136 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
c459aefd 329 cdprintf(" elapsed = %d", elapsed_time);\r
cc68a136 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
51a902ae 336 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 337\r
338 return 0;\r
339}\r
340\r
341\r
eff55556 342PICO_INTERNAL int Get_Current_Track_CDD_c22(void)\r
cc68a136 343{\r
c459aefd 344 cdprintf("Status CDD = %.4X Status = %.4X", Pico_mcd->scd.Status_CDD, Pico_mcd->cdd.Status);\r
cc68a136 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
51a902ae 365 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 366\r
367 return 0;\r
368}\r
369\r
370\r
eff55556 371PICO_INTERNAL int Get_Total_Lenght_CDD_c23(void)\r
cc68a136 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
75736070 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
cc68a136 387 Pico_mcd->cdd.Ext = 0;\r
388\r
51a902ae 389 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 390\r
391 return 0;\r
392}\r
393\r
394\r
eff55556 395PICO_INTERNAL int Get_First_Last_Track_CDD_c24(void)\r
cc68a136 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
75736070 407 Pico_mcd->cdd.Minute = INT_TO_BCDW(1);\r
408 Pico_mcd->cdd.Seconde = INT_TO_BCDW(Pico_mcd->TOC.Last_Track);\r
cc68a136 409 Pico_mcd->cdd.Frame = 0;\r
410 Pico_mcd->cdd.Ext = 0;\r
411\r
51a902ae 412 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 413\r
414 return 0;\r
415}\r
416\r
417\r
eff55556 418PICO_INTERNAL int Get_Track_Adr_CDD_c25(void)\r
cc68a136 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
75736070 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
cc68a136 439\r
75736070 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
cc68a136 443 Pico_mcd->cdd.Ext = track_number % 10;\r
444\r
75736070 445 if (track_number == 1) Pico_mcd->cdd.Frame |= 0x0800; // data track\r
cc68a136 446\r
51a902ae 447 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 448 return 0;\r
449}\r
450\r
451\r
eff55556 452PICO_INTERNAL int Play_CDD_c3(void)\r
cc68a136 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
c459aefd 476 cdprintf("Read : Cur LBA = %d, M=%d, S=%d, F=%d", Pico_mcd->scd.Cur_LBA, MSF.M, MSF.S, MSF.F);\r
cc68a136 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
51a902ae 484 if (Pico_mcd->scd.File_Add_Delay == 0) Pico_mcd->scd.File_Add_Delay = delay;\r
cc68a136 485\r
75736070 486 if (Pico_mcd->scd.Cur_Track == 1)\r
cc68a136 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
cc68a136 494 FILE_Play_CD_LBA();\r
cc68a136 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
51a902ae 505 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 506 return 0;\r
507}\r
508\r
509\r
eff55556 510PICO_INTERNAL int Seek_CDD_c4(void)\r
cc68a136 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
75736070 533 if (Pico_mcd->scd.Cur_Track == 1)\r
cc68a136 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
51a902ae 542 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 543\r
544 return 0;\r
545}\r
546\r
547\r
eff55556 548PICO_INTERNAL int Pause_CDD_c6(void)\r
cc68a136 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
51a902ae 565 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 566\r
567 return 0;\r
568}\r
569\r
570\r
eff55556 571PICO_INTERNAL int Resume_CDD_c7(void)\r
cc68a136 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
c459aefd 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
cc68a136 583 }\r
584#endif\r
585\r
586 Pico_mcd->scd.Status_CDD = PLAYING;\r
587 Pico_mcd->cdd.Status = 0x0102;\r
588\r
75736070 589 if (Pico_mcd->scd.Cur_Track == 1)\r
cc68a136 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
cc68a136 597 FILE_Play_CD_LBA();\r
cc68a136 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
51a902ae 608 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 609 return 0;\r
610}\r
611\r
612\r
eff55556 613PICO_INTERNAL int Fast_Foward_CDD_c8(void)\r
cc68a136 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
51a902ae 628 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 629\r
630 return 0;\r
631}\r
632\r
633\r
eff55556 634PICO_INTERNAL int Fast_Rewind_CDD_c9(void)\r
cc68a136 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
51a902ae 649 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 650\r
651 return 0;\r
652}\r
653\r
654\r
eff55556 655PICO_INTERNAL int Close_Tray_CDD_cC(void)\r
cc68a136 656{\r
721cd396 657 CD_Present = 0;\r
cc68a136 658 //Clear_Sound_Buffer();\r
659\r
660 Pico_mcd->scd.Status_CDC &= ~1; // Stop CDC read\r
661\r
c6196c0f 662 elprintf(EL_STATUS, "tray close\n");\r
cc68a136 663\r
721cd396 664 if (PicoMCDcloseTray != NULL)\r
665 CD_Present = PicoMCDcloseTray();\r
cc68a136 666\r
721cd396 667 Pico_mcd->scd.Status_CDD = CD_Present ? STOPPED : NOCD;\r
668 Pico_mcd->cdd.Status = 0x0000;\r
cc68a136 669\r
721cd396 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
cc68a136 674\r
51a902ae 675 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 676\r
677 return 0;\r
678}\r
679\r
680\r
eff55556 681PICO_INTERNAL int Open_Tray_CDD_cD(void)\r
cc68a136 682{\r
683 CHECK_TRAY_OPEN\r
684\r
685 Pico_mcd->scd.Status_CDC &= ~1; // Stop CDC read\r
686\r
c6196c0f 687 elprintf(EL_STATUS, "tray open\n");\r
721cd396 688\r
cc68a136 689 Unload_ISO();\r
cc68a136 690 CD_Present = 0;\r
691\r
721cd396 692 if (PicoMCDopenTray != NULL)\r
693 PicoMCDopenTray();\r
694\r
cc68a136 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
51a902ae 703 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 704\r
705 return 0;\r
706}\r
707\r
708\r
eff55556 709PICO_INTERNAL int CDD_cA(void)\r
cc68a136 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
51a902ae 724 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 725\r
726 return 0;\r
727}\r
728\r
729\r
eff55556 730PICO_INTERNAL int CDD_Def(void)\r
cc68a136 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