notaz.gp2x.de / picodrive.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
region detection, cd states wip, fixes, stuff
[picodrive.git] / Pico / cd / cd_sys.c
CommitLineData
cc68a136 1#include <stdio.h>\r
2#include "cd_sys.h"\r
bf098bc5 3#include "cd_file.h"\r
cc68a136 4\r
5#include "../PicoInt.h"\r
6\r
c459aefd 7#define cdprintf dprintf\r
cc68a136 8//#define cdprintf(x...)\r
c459aefd 9#define DEBUG_CD\r
cc68a136 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
cc68a136 19\r
20/*\r
21int CDDA_Enable;\r
22\r
23int CD_Audio_Buffer_L[8192];\r
24int CD_Audio_Buffer_R[8192];\r
25int CD_Audio_Buffer_Read_Pos = 0;\r
26int CD_Audio_Buffer_Write_Pos = 2000;\r
27int CD_Audio_Starting;\r
28*/\r
29\r
30static int CD_Present = 0;\r
51a902ae 31// int CD_Timer_Counter = 0; // TODO: check refs\r
cc68a136 32\r
cc68a136 33\r
34\r
35#define CHECK_TRAY_OPEN \\r
36if (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
51a902ae 45 Pico_mcd->scd.CDD_Complete = 1; \\r
cc68a136 46 \\r
47 return 2; \\r
48}\r
49\r
50\r
51#define CHECK_CD_PRESENT \\r
52if (!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
51a902ae 62 Pico_mcd->scd.CDD_Complete = 1; \\r
cc68a136 63 \\r
64 return 3; \\r
65}\r
66\r
67\r
68#if 0\r
69static 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
82static 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
88void 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
98static 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
122static 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
131static 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
142int 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
151void Check_CD_Command(void)\r
152{\r
c459aefd 153 cdprintf("CHECK CD COMMAND");\r
cc68a136 154\r
155 // Check CDD\r
156\r
51a902ae 157 if (Pico_mcd->scd.CDD_Complete)\r
cc68a136 158 {\r
51a902ae 159 Pico_mcd->scd.CDD_Complete = 0;\r
cc68a136 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
c459aefd 168 cdprintf("Got a read command");\r
cc68a136 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
51a902ae 175 if (Pico_mcd->scd.File_Add_Delay == 0)\r
cc68a136 176 {\r
cc68a136 177 FILE_Read_One_LBA_CDC();\r
cc68a136 178 }\r
51a902ae 179 else Pico_mcd->scd.File_Add_Delay--;\r
cc68a136 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
197int Init_CD_Driver(void)\r
198{\r
cc68a136 199 FILE_Init();\r
cc68a136 200\r
201 return 0;\r
202}\r
203\r
204\r
205void End_CD_Driver(void)\r
206{\r
cc68a136 207 FILE_End();\r
cc68a136 208}\r
209\r
210\r
211void 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
51a902ae 216 Pico_mcd->scd.CDD_Complete = 0;\r
cc68a136 217}\r
218\r
219\r
bf098bc5 220int Insert_CD(char *iso_name, int is_bin)\r
cc68a136 221{\r
bf098bc5 222 int ret = 0;\r
223\r
cc68a136 224// memset(CD_Audio_Buffer_L, 0, 4096 * 4);\r
225// memset(CD_Audio_Buffer_R, 0, 4096 * 4);\r
226\r
bf098bc5 227 CD_Present = 0;\r
228\r
229 if (iso_name != NULL)\r
cc68a136 230 {\r
bf098bc5 231 ret = Load_ISO(iso_name, is_bin);\r
232 if (ret == 0)\r
233 CD_Present = 1;\r
cc68a136 234 }\r
235\r
bf098bc5 236 return ret;\r
cc68a136 237}\r
238\r
239\r
240void Stop_CD(void)\r
241{\r
cc68a136 242 Unload_ISO();\r
cc68a136 243 CD_Present = 0;\r
244}\r
245\r
246\r
247void 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
254int Get_Status_CDD_c0(void)\r
255{\r
c459aefd 256 cdprintf("Status command : Cur LBA = %d", Pico_mcd->scd.Cur_LBA);\r
cc68a136 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
51a902ae 266 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 267\r
268 return 0;\r
269}\r
270\r
271\r
272int 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
51a902ae 289 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 290\r
291 return 0;\r
292}\r
293\r
294\r
295int Get_Pos_CDD_c20(void)\r
296{\r
297 _msf MSF;\r
298\r
c459aefd 299 cdprintf("command 200 : Cur LBA = %d", Pico_mcd->scd.Cur_LBA);\r
cc68a136 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
c459aefd 312 cdprintf("Status CDD = %.4X Status = %.4X", Pico_mcd->scd.Status_CDD, Pico_mcd->cdd.Status);\r
cc68a136 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
51a902ae 321 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 322\r
323 return 0;\r
324}\r
325\r
326\r
327int 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
c459aefd 348 cdprintf(" elapsed = %d", elapsed_time);\r
cc68a136 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
51a902ae 355 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 356\r
357 return 0;\r
358}\r
359\r
360\r
361int Get_Current_Track_CDD_c22(void)\r
362{\r
c459aefd 363 cdprintf("Status CDD = %.4X Status = %.4X", Pico_mcd->scd.Status_CDD, Pico_mcd->cdd.Status);\r
cc68a136 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
51a902ae 384 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 385\r
386 return 0;\r
387}\r
388\r
389\r
390int 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
bf098bc5 412//Pico_mcd->cdd.Seconde = 2;\r
cc68a136 413\r
51a902ae 414 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 415\r
416 return 0;\r
417}\r
418\r
419\r
420int 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
bf098bc5 438//Pico_mcd->cdd.Minute = Pico_mcd->cdd.Seconde = 1;\r
cc68a136 439\r
51a902ae 440 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 441\r
442 return 0;\r
443}\r
444\r
445\r
446int 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
51a902ae 475 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 476 return 0;\r
477}\r
478\r
479\r
480int 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
c459aefd 504 cdprintf("Read : Cur LBA = %d, M=%d, S=%d, F=%d", Pico_mcd->scd.Cur_LBA, MSF.M, MSF.S, MSF.F);\r
cc68a136 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
51a902ae 512 if (Pico_mcd->scd.File_Add_Delay == 0) Pico_mcd->scd.File_Add_Delay = delay;\r
cc68a136 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
cc68a136 522 FILE_Play_CD_LBA();\r
cc68a136 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
51a902ae 533 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 534 return 0;\r
535}\r
536\r
537\r
538int 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
51a902ae 570 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 571\r
572 return 0;\r
573}\r
574\r
575\r
576int 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
51a902ae 593 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 594\r
595 return 0;\r
596}\r
597\r
598\r
599int 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
c459aefd 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
cc68a136 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
cc68a136 625 FILE_Play_CD_LBA();\r
cc68a136 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
51a902ae 636 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 637 return 0;\r
638}\r
639\r
640\r
bf098bc5 641int Fast_Foward_CDD_c8(void)\r
cc68a136 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
51a902ae 656 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 657\r
658 return 0;\r
659}\r
660\r
661\r
bf098bc5 662int Fast_Rewind_CDD_c9(void)\r
cc68a136 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
51a902ae 677 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 678\r
679 return 0;\r
680}\r
681\r
682\r
683int 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
51a902ae 711 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 712\r
713 return 0;\r
714}\r
715\r
716\r
717int 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
cc68a136 723 Unload_ISO();\r
cc68a136 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
51a902ae 734 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 735\r
736 return 0;\r
737}\r
738\r
739\r
740int 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
51a902ae 755 Pico_mcd->scd.CDD_Complete = 1;\r
cc68a136 756\r
757 return 0;\r
758}\r
759\r
760\r
761int 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
783void 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
822align 16\r
823\r
824loop_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
854align 16\r
855\r
856loop_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
879void 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
926loop_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
940loop_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
fast MegaDrive/MegaCD/32X emulator