PS2SDK
PS2 Homebrew Libraries
Loading...
Searching...
No Matches
cdvdfsv.c
1/*
2# _____ ___ ____ ___ ____
3# ____| | ____| | | |____|
4# | ___| |____ ___| ____| | \ PS2DEV Open Source Project.
5#-----------------------------------------------------------------------
6# Copyright ps2dev - http://www.ps2dev.org
7# Licenced under Academic Free License version 2.0
8# Review ps2sdk README & LICENSE files for further details.
9*/
10
11#include "irx_imports.h"
12
13#include <cdvd-ioctl.h>
14#include <kerr.h>
15#include <libcdvd-rpc.h>
16
17IRX_ID("cdvd_ee_driver", 2, 38);
18// Based on the module from SCE SDK 3.1.0.
19
20extern struct irx_export_table _exp_cdvdfsv;
21
22static int cdvdfsv_init(void);
23static void cdvdfsv_main_th(void *arg);
24extern int *cdvdfsv_dummyentry(int arg1);
25static void cdvdfsv_parseargs(int ac, char **av);
26static void cdvdfsv_poffloop(void);
27static void cdvdfsv_rpc1_th(void *arg);
28static void cdvdfsv_rpc3_th(void *arg);
29static void cdvdfsv_rpc2_th(void *arg);
30#ifdef CDVD_VARIANT_OSD
31static void cdvdfsv_rpc4_th(void *arg);
32static void cdvdfsv_rpc5_th(void *arg);
33#endif
34extern unsigned int optimized_memcpy(char *dst, const char *src, unsigned int n);
35
36static int g_cdvdfsv_def_pri = 81;
37static int g_verbose_level = 0;
38static int g_cdvdfsv_spinctl = -1;
39// Was non-const in XOSD
40static const int g_cdvdfsv_sectors = 0x10;
41// g_cdvdfsv_sectors_cdda is same as g_cdvdfsv_sectors; separated here for reference
42#ifdef CDVD_VARIANT_OSD
43static const int g_cdvdfsv_sectors_cdda = 0x10;
44#else
45static const int g_cdvdfsv_sectors_cdda = 8;
46#endif
47// Was non-const in XOSD
48static const int g_cdvdfsv_r2retry_initval = 3;
49static int g_cdvdfsv_plbreak = 0;
50static int g_cdvdfsv_nopocm = 0;
51static int g_cdvdfsv_rpc5flg = 0;
52static int g_cdvdfsv_rpc3flg = 0;
53#if 0
54static iop_library_t g_modload_libinfo = { NULL, NULL, 256, 0, "modload", { NULL } };
55#endif
56static int g_cdvdfsv_r2retry = 0;
57static int g_cdvdfsv_r2count = 0;
58static int g_cdvdfsv_sid_err_recover_cnt = 0;
59static int g_cdvdfsv_err_count = 0;
60static char *g_cdvdfsv_fsvrbuf[2];
61static char *g_cdvdfsv_rtocbuf;
62static SifDmaTransfer_t g_cdvdfsv_fssdd;
63static SifDmaTransfer_t g_cdvdfsv_iomrsdd;
64static SifDmaTransfer_t g_cdvdfsv_rdp2sdd;
65static SifDmaTransfer_t g_cdvdfsv_multi_dmat[16];
66static sceCdRMode g_cdvdfsv_rmodeee;
67static SifDmaTransfer_t g_cdvdfsv_datasdd;
68static SifDmaTransfer_t g_cdvdfsv_eerpsdd;
69static SifDmaTransfer_t g_cdvdfsv_chrdsdd;
70#ifdef CDVD_VARIANT_OSD
71static SifDmaTransfer_t g_cdvdfsv_readdvdv_dmat;
72#endif
73static SifDmaTransfer_t g_cdvdfsv_eereadfull_dma1;
74static SifDmaTransfer_t g_cdvdfsv_eereadfull_dma2;
75static SifDmaTransfer_t g_cdvdfsv_rtocsdd;
76static iop_sys_clock_t g_cdvdfsv_read_timeout;
77static int g_cdvdman_intr_evfid;
78static int g_scmd_evfid;
79#ifdef CDVD_VARIANT_OSD
80static int g_cdvdfsv_thids[6];
81#else
82static int g_cdvdfsv_thids[4];
83#endif
84static cdvdman_internal_struct_t *g_cdvdman_istruct_ptr;
85static cdvdfsv_rpc1_outpacket_t g_cdvdfsv_initres;
86static cdvdfsv_unaligned_data_outpacket_t g_cdvdfsv_eereadx;
87static SifRpcDataQueue_t g_rpc_qdata2;
88static SifRpcDataQueue_t g_rpc_qdata1;
89static SifRpcDataQueue_t g_rpc_qdata3;
90static SifRpcServerData_t g_rpc_sdata1;
91static SifRpcServerData_t g_rpc_sdata4;
92static SifRpcServerData_t g_rpc_sdata5;
93static SifRpcServerData_t g_rpc_sdata2;
94static SifRpcServerData_t g_rpc_sdata6;
95static SifRpcServerData_t g_rpc_sdata3;
96static cdvdfsv_rpc4_outpacket_t g_cdvdfsv_srchres;
97static int g_cdvdfsv_readpos;
98static int g_cdvdfsv_rderror;
99static cdvdfsv_rpc2_outpacket_t g_diskready_res;
100static cdvdfsv_rpc5_outpacket_t g_crr;
101static cdvdfsv_rpc3_outpacket_t g_outbuf;
102static int g_rpc_buffer3[260];
103static int g_rpc_buffer5[256];
104static int g_rpc_buffer1[4];
105static int g_rpc_buffer4[76];
106static int g_rpc_buffer2[4];
107static int g_rpc_buffer2[4];
108#ifdef CDVD_VARIANT_OSD
109static char g_extra_fsvrbuf[40256];
110#endif
111
112static int cdvdfsv_checkdmastat(int trid)
113{
114 int retval;
115 int state;
116
117 if ( QueryIntrContext() )
118 return sceSifDmaStat(trid);
119 CpuSuspendIntr(&state);
120 retval = sceSifDmaStat(trid);
121 CpuResumeIntr(state);
122 return retval;
123}
124
125static int cdvdfsv_cleanuprpc(void)
126{
127 unsigned int i;
128
129 sceSifRemoveRpc(&g_rpc_sdata1, &g_rpc_qdata1);
130 sceSifRemoveRpc(&g_rpc_sdata2, &g_rpc_qdata1);
131 sceSifRemoveRpc(&g_rpc_sdata3, &g_rpc_qdata1);
132 sceSifRemoveRpc(&g_rpc_sdata6, &g_rpc_qdata3);
133 sceSifRemoveRpc(&g_rpc_sdata4, &g_rpc_qdata2);
134 sceSifRemoveRpc(&g_rpc_sdata5, &g_rpc_qdata2);
135 sceSifRemoveRpcQueue(&g_rpc_qdata1);
136 sceSifRemoveRpcQueue(&g_rpc_qdata2);
137 sceSifRemoveRpcQueue(&g_rpc_qdata3);
138 g_cdvdfsv_nopocm = 1;
139 g_cdvdfsv_plbreak = 1;
140 for ( i = 0; i < (sizeof(g_cdvdfsv_thids) / sizeof(g_cdvdfsv_thids[0])); i += 1 )
141 {
142 TerminateThread(g_cdvdfsv_thids[i]);
143 DeleteThread(g_cdvdfsv_thids[i]);
144 }
145 return 1;
146}
147
148int _start(int ac, char *av[], void *startaddr, ModuleInfo_t *mi)
149{
150#if 0
151 const u16 *LibraryEntryTable;
152#endif
153 int state;
154
155 (void)startaddr;
156
157 if ( ac < 0 )
158 {
159 int error_code;
160
161 // cppcheck-suppress knownConditionTrueFalse
162 if ( g_cdvdfsv_rpc5flg || g_cdvdfsv_rpc3flg || !cdvdfsv_cleanuprpc() )
163 {
164 return MODULE_REMOVABLE_END;
165 }
166 CpuSuspendIntr(&state);
167 error_code = ReleaseLibraryEntries(&_exp_cdvdfsv);
168 CpuResumeIntr(state);
169 if ( error_code && error_code != KE_LIBRARY_NOTFOUND )
170 {
171 KPRINTF("ReleaseLibraryEntries Error code %d\n", error_code);
172 return MODULE_REMOVABLE_END;
173 }
174 return MODULE_NO_RESIDENT_END;
175 }
176 if ( RegisterLibraryEntries(&_exp_cdvdfsv) )
177 {
178 return MODULE_NO_RESIDENT_END;
179 }
180 g_cdvdfsv_fsvrbuf[0] = (char *)sceGetFsvRbuf();
181#ifdef CDVD_VARIANT_OSD
182 g_cdvdfsv_fsvrbuf[1] = &g_extra_fsvrbuf[0];
183#endif
184 g_cdvdfsv_rtocbuf = g_cdvdfsv_fsvrbuf[0];
185 // g_cdvdfsv_sectors was set in XOSD variant
186 // g_cdvdfsv_r2retry_initval was set in XOSD variant
187 cdvdfsv_parseargs(ac, av);
188 cdvdfsv_init();
189#if 0
190 CpuSuspendIntr(&state);
191 LibraryEntryTable = (u16 *)QueryLibraryEntryTable(&g_modload_libinfo);
192 CpuResumeIntr(state);
193 if ( !LibraryEntryTable || (*(LibraryEntryTable - 6) < 0x104) )
194 {
195 KPRINTF("Warning cdvdfsv.irx: Unload function can't be used.\n");
196 return MODULE_RESIDENT_END;
197 }
198 return MODULE_REMOVABLE_END;
199#else
200 if ( mi && ((mi->newflags & 2) != 0) )
201 mi->newflags |= 0x10;
202 return MODULE_RESIDENT_END;
203#endif
204}
205
206static int cdvdfsv_init(void)
207{
208 const int *BootMode;
209 iop_thread_t thparam;
210 int scres;
211
212 BootMode = QueryBootMode(3);
213 if ( BootMode && (BootMode[1] & 2) )
214 {
215 PRINTF(" No cdvd driver \n");
216 return 1;
217 }
218 sceCdSC(0xFFFFFFF2, (int *)&g_cdvdman_istruct_ptr);
219 g_scmd_evfid = sceCdSC(0xFFFFFFE7, &scres);
220 thparam.attr = TH_C;
221 thparam.thread = cdvdfsv_main_th;
222 thparam.stacksize = 0x800;
223 thparam.option = 0;
224 thparam.priority = g_cdvdfsv_def_pri - 1;
225 g_cdvdfsv_thids[0] = CreateThread(&thparam);
226 if ( g_cdvdfsv_thids[0] <= 0 )
227 {
228 return 1;
229 }
230 StartThread(g_cdvdfsv_thids[0], 0);
231 return 0;
232}
233
234static void cdvdfsv_main_th(void *arg)
235{
236 iop_thread_t thparam1;
237 iop_thread_t thparam2;
238
239 (void)arg;
240
241 if ( !sceSifCheckInit() )
242 sceSifInit();
243 sceSifInitRpc(0);
244 PRINTF("cdvd driver module version 0.1.1 (C)SCEI\n");
245 thparam2.thread = cdvdfsv_rpc1_th;
246 thparam2.attr = TH_C;
247 thparam2.stacksize = 0x1900;
248 thparam2.option = 0;
249 thparam2.priority = g_cdvdfsv_def_pri;
250 g_cdvdfsv_thids[1] = CreateThread(&thparam2);
251 StartThread(g_cdvdfsv_thids[1], 0);
252 thparam1.attr = TH_C;
253 thparam1.thread = cdvdfsv_rpc2_th;
254 thparam1.stacksize = 0x1900;
255 thparam1.option = 0;
256 thparam1.priority = g_cdvdfsv_def_pri;
257 g_cdvdfsv_thids[2] = CreateThread(&thparam1);
258 StartThread(g_cdvdfsv_thids[2], 0);
259 thparam1.thread = cdvdfsv_rpc3_th;
260 thparam1.attr = TH_C;
261 thparam1.stacksize = 0x800;
262 thparam1.option = 0;
263 thparam1.priority = g_cdvdfsv_def_pri;
264 g_cdvdfsv_thids[3] = CreateThread(&thparam1);
265 StartThread(g_cdvdfsv_thids[3], 0);
266#ifdef CDVD_VARIANT_OSD
267 thparam1.attr = TH_C;
268 thparam1.thread = cdvdfsv_rpc4_th;
269 thparam1.stacksize = 0x800;
270 thparam1.option = 0;
271 thparam1.priority = g_cdvdfsv_def_pri;
272 g_cdvdfsv_thids[4] = CreateThread(&thparam1);
273 StartThread(g_cdvdfsv_thids[4], 0);
274 thparam1.attr = TH_C;
275 thparam1.thread = cdvdfsv_rpc5_th;
276 thparam1.stacksize = 0x800;
277 thparam1.option = 0;
278 thparam1.priority = g_cdvdfsv_def_pri;
279 g_cdvdfsv_thids[5] = CreateThread(&thparam1);
280 StartThread(g_cdvdfsv_thids[5], 0);
281#endif
282 cdvdfsv_poffloop();
283 ExitDeleteThread();
284}
285
286int *cdvdfsv_dummyentry(int arg1)
287{
288 VERBOSE_PRINTF(1, "Dummy Entry Called\n");
289 if ( arg1 != 128 )
290 return 0;
291 return &g_verbose_level;
292}
293
294static void cdvdfsv_parseargs(int ac, char **av)
295{
296 int i;
297
298 g_cdvdfsv_def_pri = 81;
299 for ( i = 1; i < ac; i += 1 )
300 {
301 if ( !strncmp(av[i], "thpri=", 6) )
302 {
303 g_cdvdfsv_def_pri = strtol(av[i] + 6, 0, 10);
304 if ( (unsigned int)(g_cdvdfsv_def_pri - 9) >= 0x73 )
305 {
306 PRINTF("Cdvdfsv:thpri=%d Illegal priority\n", g_cdvdfsv_def_pri);
307 g_cdvdfsv_def_pri = 81;
308 }
309 if ( g_cdvdfsv_def_pri == 9 )
310 g_cdvdfsv_def_pri = 10;
311 }
312 }
313}
314
315int sceCdChangeThreadPriority(int priority)
316{
317 iop_thread_info_t thinfo;
318
319 if ( (unsigned int)(priority - 9) >= 0x73 )
320 return -403;
321 if ( priority == 9 )
322 priority = 10;
323 ReferThreadStatus(0, &thinfo);
324 ChangeThreadPriority(0, 8);
325 ChangeThreadPriority(g_cdvdfsv_thids[0], priority - 1);
326 ChangeThreadPriority(g_cdvdfsv_thids[2], priority);
327 ChangeThreadPriority(g_cdvdfsv_thids[1], priority);
328 ChangeThreadPriority(g_cdvdfsv_thids[3], priority);
329#ifdef CDVD_VARIANT_OSD
330 ChangeThreadPriority(g_cdvdfsv_thids[4], priority);
331 ChangeThreadPriority(g_cdvdfsv_thids[5], priority);
332#endif
333 return 0;
334}
335
336static void *cbrpc_rpc1_cdinit(int fno, void *buffer, int length)
337{
338 int scres_unused;
339
340 (void)fno;
341 (void)length;
342
343 VERBOSE_PRINTF(1, "sceCdInit call\n");
344 sceCdInit(((const cdvdfsv_rpc1_inpacket_t *)buffer)->m_mode);
345 g_cdvdfsv_spinctl = -1;
346 g_cdvdfsv_initres.m_debug_mode = g_verbose_level ? 254 : 0;
347 g_cdvdfsv_initres.m_cdvdfsv_ver = (u16)_irx_id.v;
348 g_cdvdfsv_initres.m_cdvdman_ver = sceCdSC(0xFFFFFFF7, &scres_unused);
349 VERBOSE_PRINTF(1, "sceCdInit end\n");
350 g_cdvdfsv_initres.m_retres = 1;
351 return (void *)&g_cdvdfsv_initres;
352}
353
354static void cdvdfsv_rpc3_16_break(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
355{
356 (void)inbuf;
357 (void)buflen;
358
359 VERBOSE_PRINTF(1, "sceCdAbort call\n");
360 sceCdBreak();
361 outbuf->m_retres = 1;
362}
363
364static void *cbrpc_rpc4_fscall(int fno, void *buffer, int length)
365{
366 int scres;
367 int state;
368 cdvdfsv_rpc4_inpacket_t *inbuf;
369
370 (void)fno;
371
372 inbuf = buffer;
373 scres = 255;
374 sceCdSC(0xFFFFFFF6, &scres);
375 VERBOSE_PRINTF(1, "search file name %s call struct_siz %d\n", inbuf->m_pkt_sz12c.m_path, length);
376 switch ( length )
377 {
378 case sizeof(inbuf->m_pkt_sz12c):
379 g_cdvdfsv_srchres.m_retres =
380 sceCdLayerSearchFile(&(inbuf->m_pkt_sz12c.m_fp), inbuf->m_pkt_sz12c.m_path, inbuf->m_pkt_sz12c.m_layer);
381 g_cdvdfsv_fssdd.src = buffer;
382 g_cdvdfsv_fssdd.dest = (void *)inbuf->m_pkt_sz12c.m_eedest;
383 g_cdvdfsv_fssdd.size = sizeof(sceCdlFILE) + 4;
384 break;
385 case sizeof(inbuf->m_pkt_sz128):
386 PRINTF("sceCdSearchFile: Called from Not_Dual_layer Version.\n");
387 g_cdvdfsv_srchres.m_retres = sceCdSearchFile(&(inbuf->m_pkt_sz128.m_fp), inbuf->m_pkt_sz128.m_path);
388 g_cdvdfsv_fssdd.src = buffer;
389 g_cdvdfsv_fssdd.dest = (void *)inbuf->m_pkt_sz128.m_eedest;
390 g_cdvdfsv_fssdd.size = sizeof(sceCdlFILE) + 4;
391 break;
392 default:
393 PRINTF("Warning sceCdSearchFile: Called from Old liblary.\n");
394 g_cdvdfsv_srchres.m_retres = sceCdSearchFile(&(inbuf->m_pkt_sz124.m_fp), inbuf->m_pkt_sz124.m_path);
395 g_cdvdfsv_fssdd.src = buffer;
396 g_cdvdfsv_fssdd.dest = (void *)inbuf->m_pkt_sz124.m_eedest;
397 g_cdvdfsv_fssdd.size = sizeof(sceCdlFILE);
398 break;
399 }
400 g_cdvdfsv_fssdd.attr = 0;
401 while ( 1 )
402 {
403 int trid;
404
405 CpuSuspendIntr(&state);
406 trid = sceSifSetDma(&g_cdvdfsv_fssdd, 1);
407 CpuResumeIntr(state);
408 if ( trid )
409 break;
410 DelayThread(500);
411 }
412 scres = 0;
413 sceCdSC(0xFFFFFFF6, &scres);
414 return (void *)&g_cdvdfsv_srchres;
415}
416
417static int read_timeout_alarm_cb(const iop_sys_clock_t *sys_clock)
418{
419 int read_timeout;
420
421 read_timeout = sys_clock->lo / 0x9000;
422 KPRINTF("Read Time Out %d(msec)\n", read_timeout);
423 sceCdSC(0xFFFFFFEE, &read_timeout);
424 return !sceCdBreak();
425}
426
427static void cdvdfsv_rpc5_0D_iopmread(const cdvdfsv_rpc5_inpacket_t *inbuf, int buflen, cdvdfsv_rpc5_outpacket_t *outbuf)
428{
429 int cmd_error;
430 int trid;
431 int scres_unused;
432 int error_code;
433 int state;
434
435 (void)buflen;
436 (void)outbuf;
437
438 g_cdvdfsv_rderror = SCECdErREADCFR;
439 g_cdvdfsv_read_timeout.hi = 0;
440 g_cdvdfsv_read_timeout.lo = 0x9000 * sceCdSC(0xFFFFFFF1, &scres_unused);
441 g_cdvdfsv_iomrsdd.src = &g_cdvdfsv_readpos;
442 g_cdvdfsv_iomrsdd.size = sizeof(g_cdvdfsv_readpos);
443 g_cdvdfsv_iomrsdd.attr = 0;
444 g_cdvdfsv_iomrsdd.dest = (void *)inbuf->m_pkt_0D.m_eedest;
445 VERBOSE_PRINTF(
446 1,
447 "sceCdReadIOPm addr= 0x%08x sector= %d\n",
448 (unsigned int)(uiptr)(inbuf->m_pkt_0D.m_buf),
449 (int)(inbuf->m_pkt_0D.m_sectors));
450 cmd_error = sceCdRE(
451 inbuf->m_pkt_0D.m_lbn, inbuf->m_pkt_0D.m_sectors, inbuf->m_pkt_0D.m_buf, (sceCdRMode *)&inbuf->m_pkt_0D.m_mode);
452 while ( sceCdSync(1) )
453 {
454 g_cdvdfsv_readpos = sceCdGetReadPos();
455 while ( 1 )
456 {
457 CpuSuspendIntr(&state);
458 trid = sceSifSetDma(&g_cdvdfsv_iomrsdd, 1);
459 CpuResumeIntr(state);
460 if ( trid )
461 break;
462 DelayThread(500);
463 }
464 DelayThread(8000);
465 while ( cdvdfsv_checkdmastat(trid) >= 0 )
466 ;
467 }
468 error_code = sceCdGetError();
469 if ( error_code != SCECdErNO || !cmd_error )
470 {
471 if ( !cmd_error )
472 sceCdSC(0xFFFFFFFE, &g_cdvdfsv_rderror);
473 VERBOSE_PRINTF(1, "Read error code %x cmd error %d\n", error_code, cmd_error);
474 }
475}
476
477static u8 cdvdfsv_syncdec(int flag, int xorkey, int arg2, u8 data)
478{
479 return flag ? (((data << (arg2 % 8)) | (data >> (8 - arg2 % 8))) ^ xorkey) : data;
480}
481
482static int cdvdfsv_cb_read(void)
483{
484 iSetEventFlag(g_cdvdman_intr_evfid, 0x20);
485 return 0;
486}
487
488static int cdvdfsv_checksid(u32 lsn, u32 sectors, u32 ps2dvd, void *buf, int decflag, int decshift, u32 *syncdec_mask)
489{
490 int scret;
491 u32 i;
492 u32 readlsn;
493 int syncdec;
494 u8 syncdec_4;
495 sceCdlLOCCD rpos;
496 int scres;
497 int ipi_emu;
498
499 ipi_emu = 0;
500 *syncdec_mask = 0;
501 scret = decflag ? sceCdSC(0xFFFFFFE8, &scres) : 0;
502 syncdec_4 = 0;
503 for ( i = 0; i < sectors; i += 1 )
504 {
505 if ( ps2dvd )
506 {
507 syncdec = cdvdfsv_syncdec(decflag, scret, decshift, ((u8 *)buf + (i * 0x810))[3]);
508 syncdec += cdvdfsv_syncdec(decflag, scret, decshift, ((u8 *)buf + (i * 0x810))[2]) << 8;
509 syncdec += cdvdfsv_syncdec(decflag, scret, decshift, ((u8 *)buf + (i * 0x810))[1]) << 16;
510 syncdec_4 = cdvdfsv_syncdec(decflag, scret, decshift, ((u8 *)buf + (i * 0x810))[0]);
511 if ( i && !*syncdec_mask )
512 {
513 ipi_emu = syncdec_4 & 0xC;
514 }
515 else if ( !i )
516 {
517 *syncdec_mask = syncdec_4 & 0xC;
518 }
519 readlsn = syncdec - 0x30000;
520 if (
521 g_cdvdman_istruct_ptr->m_opo_or_para && (lsn + i) >= g_cdvdman_istruct_ptr->m_layer_1_lsn
522 && g_cdvdman_istruct_ptr->m_opo_or_para == 1 )
523 {
524 readlsn += g_cdvdman_istruct_ptr->m_layer_1_lsn;
525 }
526 }
527 else
528 {
529 rpos.minute = cdvdfsv_syncdec(decflag, scret, decshift, ((u8 *)buf + (i * 0x924))[0]);
530 rpos.second = cdvdfsv_syncdec(decflag, scret, decshift, ((u8 *)buf + (i * 0x924))[1]);
531 rpos.sector = cdvdfsv_syncdec(decflag, scret, decshift, ((u8 *)buf + (i * 0x924))[2]);
532 readlsn = sceCdPosToInt(&rpos);
533 }
534 if ( readlsn != (lsn + i) || ipi_emu )
535 {
536 // The following printf was modified for ioprp300x
537 VERBOSE_PRINTF(
538 1,
539 "Read_EE Sector_ID error lsn= %d readlsn= %d layer= %d layer1_start %d ipi_emu %d\n",
540 (int)(lsn + i),
541 (int)readlsn,
542 (syncdec_4 & 1),
543 (int)(g_cdvdman_istruct_ptr->m_layer_1_lsn),
544 ipi_emu);
545 return 0;
546 }
547 }
548 if ( *syncdec_mask )
549 {
550 VERBOSE_PRINTF(
551 1, "Read_EE NO_Data_zone error lsn= %d layer= %d SecID %02x\n", (int)lsn, (syncdec_4 & 1), (int)(*syncdec_mask));
552 }
553 return 1;
554}
555
556static int readproc2(
557 u32 lsn,
558 u32 nsec,
559 sceCdRMode *mode,
560 u32 sector_size_selection,
561 int do_multi_retries,
562 int enable_dec_shift,
563 int dec_shift,
564 char *ee_addr,
565 int fssift,
566 int secsize,
567 int dmasize,
568 SifDmaTransfer_t *post_dmat)
569{
570 unsigned int i;
571 int csec;
572 int read_res_tmp;
573 int trid;
574 int j;
575 int size_2;
576 int sector_sizes[2];
577 int error_code;
578 int scres_unused;
579 int state;
580 u32 syncdec_mask;
581 u32 chcr;
582 int error_code_tmp;
583 char *ee_addr_tmp;
584 int dmasize_tmp;
585 int csec_comm;
586 int nsec_div_cdvdfsv_sectors;
587 int retry_flag1;
588 int retry_flag2;
589 int sector_size;
590
591 error_code_tmp = SCECdErNO;
592 sector_sizes[0] = 0x924;
593 sector_sizes[1] = 0x810;
594 g_cdvdfsv_read_timeout.hi = 0;
595 g_cdvdfsv_read_timeout.lo = 0x9000 * sceCdSC(0xFFFFFFF1, &scres_unused);
596 g_cdvdfsv_rderror = SCECdErREADCF;
597 g_cdvdfsv_r2retry = 0;
598 g_cdvdfsv_r2count = 0;
599 if ( secsize != 0x924 && !fssift )
600 {
601 for ( i = 0; i < (unsigned int)g_cdvdfsv_sectors; i += 1 )
602 {
603 g_cdvdfsv_multi_dmat[i].attr = 0;
604 g_cdvdfsv_multi_dmat[i].size = secsize;
605 }
606 }
607 // The following Kprintf was added for ioprp300x
608 VERBOSE_KPRINTF(1, "lsn= %d nsec= %d ee_addr= %08x fssift= %d secsize= %d\n", lsn, nsec, ee_addr, fssift, secsize);
609 sector_size = sector_sizes[sector_size_selection];
610 while ( 1 )
611 {
612 while ( 1 )
613 {
614 csec = (nsec <= (u32)g_cdvdfsv_sectors) ? nsec : (u32)g_cdvdfsv_sectors;
615#ifdef CDVD_VARIANT_OSD
616 if ( !g_cdvdfsv_sectors )
617 __builtin_trap();
618#endif
619 nsec_div_cdvdfsv_sectors = (nsec / g_cdvdfsv_sectors) + (!!((nsec & 0xF)));
620 retry_flag2 = 0;
621 ee_addr_tmp = ee_addr;
622 dmasize_tmp = dmasize;
623 g_cdvdman_istruct_ptr->m_dec_mode_set = 1;
624 g_cdvdman_istruct_ptr->m_dec_mode_last_set = 0;
625 CpuSuspendIntr(&state);
626 if ( enable_dec_shift )
627 {
628 g_cdvdman_istruct_ptr->m_dec_shift = dec_shift;
629 g_cdvdman_istruct_ptr->m_dec_state = 2;
630 }
631 if ( g_cdvdfsv_r2retry )
632 {
633 VERBOSE_KPRINTF(1, "Rty_Read\n");
634 read_res_tmp = (sector_size_selection ? sceCdRV : sceCdRead0)(
635 (lsn >= (u32)(6 * g_cdvdfsv_sectors)) ? (lsn - g_cdvdfsv_sectors * g_cdvdfsv_r2retry) :
636 (lsn + g_cdvdfsv_sectors * g_cdvdfsv_r2retry + 6 * g_cdvdfsv_sectors),
637 g_cdvdfsv_sectors,
638 &g_cdvdfsv_rtocbuf[0x1248],
639 mode,
640 0,
641 0);
642 CpuResumeIntr(state);
643 }
644 else
645 {
646 read_res_tmp = (sector_size_selection ? sceCdRV : sceCdRead0)(
647 lsn, nsec, &g_cdvdfsv_rtocbuf[0x1248], mode, csec, cdvdfsv_cb_read);
648 CpuResumeIntr(state);
649 if ( read_res_tmp )
650 {
651 SetAlarm(&g_cdvdfsv_read_timeout, (unsigned int (*)(void *))read_timeout_alarm_cb, &g_cdvdfsv_read_timeout);
652 csec_comm = 0;
653 retry_flag1 = 0;
654 break;
655 }
656 }
657 if ( !read_res_tmp )
658 {
659 g_cdvdman_istruct_ptr->m_dec_state = 0;
660 g_cdvdman_istruct_ptr->m_dec_mode_set = 0;
661 sceCdSC(0xFFFFFFFE, &g_cdvdfsv_rderror);
662 return 0;
663 }
664 sceCdSync(3);
665 g_cdvdfsv_r2retry -= 1;
666 }
667 for ( i = 0; (int)i < nsec_div_cdvdfsv_sectors; i += 1 )
668 {
669 sceCdSync(32);
670 if ( g_cdvdman_istruct_ptr->m_dec_mode_last_set )
671 break;
672 if ( sceCdGetError() == SCECdErNO )
673 {
674 if ( cdvdfsv_checksid(
675 lsn + csec_comm,
676 csec,
677 sector_size_selection,
678 &g_cdvdfsv_rtocbuf[0x1248],
679 enable_dec_shift,
680 dec_shift,
681 &syncdec_mask) )
682 {
683 if ( do_multi_retries && syncdec_mask && !i )
684 {
685 retry_flag1 = 1;
686 error_code_tmp = SCECdErIPI;
687 }
688 }
689 else if ( do_multi_retries )
690 {
691 retry_flag2 = 1;
692 retry_flag1 = 1;
693 }
694 if ( retry_flag1 || g_cdvdfsv_r2retry )
695 {
696 }
697 else if ( secsize == 0x924 && !sector_size_selection )
698 {
699 if ( fssift )
700 {
701 if ( i )
702 {
703 optimized_memcpy(&g_cdvdfsv_rtocbuf[secsize], &g_cdvdfsv_rtocbuf[fssift], secsize - fssift);
704 optimized_memcpy(g_cdvdfsv_rtocbuf, &g_cdvdfsv_rtocbuf[secsize + secsize * csec], secsize);
705 g_cdvdfsv_rdp2sdd.size =
706 ((int)i == nsec_div_cdvdfsv_sectors - 1) ? dmasize_tmp : (secsize * (csec - 1) + fssift);
707 optimized_memcpy(
708 &g_cdvdfsv_rtocbuf[secsize + secsize - fssift],
709 &g_cdvdfsv_rtocbuf[secsize * 2],
710 g_cdvdfsv_rdp2sdd.size);
711 }
712 else
713 {
714 optimized_memcpy(g_cdvdfsv_rtocbuf, &g_cdvdfsv_rtocbuf[secsize * 2 + secsize * (csec - 1)], secsize);
715 g_cdvdfsv_rdp2sdd.size = ((int)i == nsec_div_cdvdfsv_sectors - 1) ? dmasize_tmp : (secsize * (csec - 1));
716 optimized_memcpy(
717 &g_cdvdfsv_rtocbuf[secsize], &g_cdvdfsv_rtocbuf[secsize * 2 + fssift], g_cdvdfsv_rdp2sdd.size);
718 }
719 g_cdvdfsv_rdp2sdd.src = &g_cdvdfsv_rtocbuf[secsize];
720 }
721 else
722 {
723 g_cdvdfsv_rdp2sdd.src = &g_cdvdfsv_rtocbuf[secsize * 2];
724 g_cdvdfsv_rdp2sdd.size = secsize * csec;
725 }
726 g_cdvdfsv_rdp2sdd.attr = 0;
727 g_cdvdfsv_rdp2sdd.dest = ee_addr_tmp;
728 ee_addr_tmp += g_cdvdfsv_rdp2sdd.size;
729 dmasize_tmp -= g_cdvdfsv_rdp2sdd.size;
730 while ( 1 )
731 {
732 CpuSuspendIntr(&state);
733 trid = sceSifSetDma(&g_cdvdfsv_rdp2sdd, 1);
734 CpuResumeIntr(state);
735 if ( trid )
736 break;
737 DelayThread(500);
738 }
739 while ( cdvdfsv_checkdmastat(trid) >= 0 )
740 ;
741 }
742 else if ( !fssift )
743 {
744 for ( j = 0; j < csec; j += 1 )
745 {
746 g_cdvdfsv_multi_dmat[j].dest = &ee_addr[(csec_comm + j) * secsize];
747 g_cdvdfsv_multi_dmat[j].src = &g_cdvdfsv_rtocbuf[0x1248 + (j * sector_size) + 12];
748 }
749 while ( 1 )
750 {
751 CpuSuspendIntr(&state);
752 trid = sceSifSetDma(g_cdvdfsv_multi_dmat, csec);
753 CpuResumeIntr(state);
754 if ( trid )
755 break;
756 DelayThread(500);
757 }
758 while ( cdvdfsv_checkdmastat(trid) >= 0 )
759 ;
760 }
761 else
762 {
763 size_2 = ((int)i != nsec_div_cdvdfsv_sectors - 1) ? fssift : secsize;
764 g_cdvdfsv_rdp2sdd.size = dmasize_tmp;
765 if ( i )
766 {
767 optimized_memcpy(&g_cdvdfsv_rtocbuf[0x924], &g_cdvdfsv_rtocbuf[fssift + 12], secsize - fssift);
768 optimized_memcpy(g_cdvdfsv_rtocbuf, &g_cdvdfsv_rtocbuf[0x1248 + (csec - 1) * sector_size], sector_size);
769 for ( j = 0; j < csec - 1; j += 1 )
770 {
771 optimized_memcpy(
772 &g_cdvdfsv_rtocbuf[0x924 + secsize - fssift + (j * secsize)],
773 &g_cdvdfsv_rtocbuf[0x1248 + 12 + (j * sector_size)],
774 secsize);
775 }
776 optimized_memcpy(
777 &g_cdvdfsv_rtocbuf[0x924 + secsize - fssift + ((csec - 1) * secsize)],
778 &g_cdvdfsv_rtocbuf[0x1248 + 12 + ((csec - 1) * sector_size)],
779 size_2);
780 if ( (int)i != nsec_div_cdvdfsv_sectors - 1 )
781 {
782 g_cdvdfsv_rdp2sdd.size = secsize * csec;
783 }
784 }
785 else
786 {
787 optimized_memcpy(g_cdvdfsv_rtocbuf, &g_cdvdfsv_rtocbuf[0x1248 + (csec - 1) * sector_size], sector_size);
788 optimized_memcpy(&g_cdvdfsv_rtocbuf[0x924], &g_cdvdfsv_rtocbuf[0x1248 + fssift + 12], secsize - fssift);
789 for ( j = 0; j < csec - 2; j += 1 )
790 {
791 optimized_memcpy(
792 &g_cdvdfsv_rtocbuf[0x924 + secsize - fssift + (j * secsize)],
793 &g_cdvdfsv_rtocbuf[0x1248 + sector_size + 12 + (j * sector_size)],
794 secsize);
795 }
796 optimized_memcpy(
797 &g_cdvdfsv_rtocbuf[0x924 + secsize - fssift + ((csec - 2) * secsize)],
798 &g_cdvdfsv_rtocbuf[0x1248 + sector_size + 12 + ((csec - 2) * sector_size)],
799 size_2);
800 if ( (int)i != nsec_div_cdvdfsv_sectors - 1 )
801 {
802 g_cdvdfsv_rdp2sdd.size = secsize * (csec - 1);
803 }
804 }
805 g_cdvdfsv_rdp2sdd.src = &g_cdvdfsv_rtocbuf[0x924];
806 g_cdvdfsv_rdp2sdd.attr = 0;
807 g_cdvdfsv_rdp2sdd.dest = ee_addr_tmp;
808 ee_addr_tmp += g_cdvdfsv_rdp2sdd.size;
809 dmasize_tmp -= g_cdvdfsv_rdp2sdd.size;
810 while ( 1 )
811 {
812 CpuSuspendIntr(&state);
813 trid = sceSifSetDma(&g_cdvdfsv_rdp2sdd, 1);
814 CpuResumeIntr(state);
815 if ( trid )
816 break;
817 DelayThread(500);
818 }
819 while ( cdvdfsv_checkdmastat(trid) >= 0 )
820 ;
821 }
822 }
823 else
824 {
825 retry_flag1 = 1;
826 }
827 CpuSuspendIntr(&state);
828 if ( (int)i == nsec_div_cdvdfsv_sectors - 1 )
829 {
830 DisableIntr(IOP_IRQ_DMA_CDVD, (int *)&chcr);
831 }
832 else
833 {
834 csec_comm += csec;
835 csec = ((unsigned int)csec > nsec - (unsigned int)csec_comm) ? (nsec - (unsigned int)csec_comm) :
836 (unsigned int)g_cdvdfsv_sectors;
837 ClearEventFlag(g_cdvdman_intr_evfid, ~0x20);
838 dmac_ch_set_chcr(3, 0);
839 dmac_ch_get_chcr(3);
840 g_cdvdman_istruct_ptr->m_dma3_param.m_dma3_maddress = &g_cdvdfsv_rtocbuf[0x1248];
841 dmac_ch_set_madr(3, (uiptr)(&g_cdvdfsv_rtocbuf[0x1248]));
842 dmac_ch_set_bcr(
843 3,
844 g_cdvdman_istruct_ptr->m_dma3_param.m_dma3_blkwords
845 | ((g_cdvdman_istruct_ptr->m_dma3_param.m_dma3_blkcount * csec) << 16));
846 dmac_ch_set_chcr(3, 0x41000200);
847 chcr = dmac_ch_get_chcr(3);
848 if ( post_dmat )
849 {
850 g_cdvdfsv_readpos += secsize * csec;
851 sceSifSetDma(post_dmat, 1);
852 }
853 }
854 CpuResumeIntr(state);
855 }
856 sceCdSync(5);
857 CancelAlarm((unsigned int (*)(void *))read_timeout_alarm_cb, &g_cdvdfsv_read_timeout);
858 g_cdvdman_istruct_ptr->m_dec_mode_set = 0;
859 g_cdvdman_istruct_ptr->m_dec_state = 0;
860 error_code = sceCdGetError();
861 if ( (u16)g_cdvdman_istruct_ptr->m_dec_mode_last_set )
862 {
863 retry_flag2 = 1;
864 error_code = SCECdErNO;
865 mode->spindlctrl = 16;
866 }
867 if ( error_code != SCECdErNO || g_cdvdfsv_r2count >= 5 )
868 break;
869 if ( !retry_flag2 )
870 {
871 if ( error_code_tmp == SCECdErNO )
872 return 1;
873 sceCdSC(0xFFFFFFFE, &error_code_tmp);
874 VERBOSE_KPRINTF(1, "secid_chk_ee_trns lsn %d nsec %d IPI Err\n", lsn, nsec);
875 return 0;
876 }
877 if ( !g_cdvdfsv_r2retry )
878 {
879 g_cdvdfsv_r2count += 1;
880 VERBOSE_PRINTF(1, "Read_CD/DVD-ROM Error Recover Start\n");
881 g_cdvdfsv_r2retry = g_cdvdfsv_r2retry_initval;
882 }
883 }
884 if ( g_cdvdfsv_r2count >= 5 && error_code == SCECdErNO )
885 {
886 sceCdSC(0xFFFFFFFE, &g_cdvdfsv_rderror);
887 }
888 return 0;
889}
890
891static int readproc1(
892 unsigned int lsn,
893 u32 nsec,
894 void *retptr,
895 sceCdRMode *rmode,
896 int ps2dvd,
897 int enable_retries,
898 int dec_shift_enable,
899 int dec_shift_value)
900{
901 int scres_unused;
902 int state;
903 u32 syncdec_mask;
904 int error_code_tmp;
905
906 error_code_tmp = SCECdErNO;
907 g_cdvdfsv_read_timeout.hi = 0;
908 g_cdvdfsv_read_timeout.lo = 0x9000 * sceCdSC(0xFFFFFFF1, &scres_unused);
909 g_cdvdfsv_rderror = SCECdErREADCF;
910 g_cdvdfsv_sid_err_recover_cnt = 0;
911 g_cdvdfsv_err_count = 0;
912 while ( 1 )
913 {
914 int cmd_error;
915 int error_code;
916
917 CpuSuspendIntr(&state);
918 if ( dec_shift_enable )
919 {
920 g_cdvdman_istruct_ptr->m_dec_shift = dec_shift_value;
921 g_cdvdman_istruct_ptr->m_dec_state = 2;
922 }
923 cmd_error = (ps2dvd ? sceCdRV : sceCdRead0)(
924 (lsn >= 0x30) ? (lsn - 0x10 * g_cdvdfsv_sid_err_recover_cnt) : (lsn + 0x10 * g_cdvdfsv_sid_err_recover_cnt),
925 nsec,
926 retptr,
927 rmode,
928 0,
929 0);
930 CpuResumeIntr(state);
931 if ( cmd_error )
932 SetAlarm(&g_cdvdfsv_read_timeout, (unsigned int (*)(void *))read_timeout_alarm_cb, &g_cdvdfsv_read_timeout);
933 sceCdSync(5);
934 CancelAlarm((unsigned int (*)(void *))read_timeout_alarm_cb, &g_cdvdfsv_read_timeout);
935 g_cdvdman_istruct_ptr->m_dec_state = 0;
936 error_code = sceCdGetError();
937 if ( error_code != SCECdErNO || !cmd_error || g_cdvdfsv_err_count >= 5 )
938 {
939 VERBOSE_KPRINTF(1, "Read error error code %x cmd error %d\n", error_code, cmd_error);
940 if ( (!cmd_error || g_cdvdfsv_err_count >= 5) && error_code == SCECdErNO )
941 {
942 sceCdSC(0xFFFFFFFE, &g_cdvdfsv_rderror);
943 }
944 return 0;
945 }
946 if ( cdvdfsv_checksid(lsn, nsec, ps2dvd, retptr, dec_shift_enable, dec_shift_value, &syncdec_mask) )
947 {
948 if ( enable_retries && syncdec_mask )
949 error_code_tmp = SCECdErIPI;
950 break;
951 }
952 if ( !enable_retries )
953 break;
954 if ( !g_cdvdfsv_sid_err_recover_cnt )
955 {
956 g_cdvdfsv_err_count += 1;
957 VERBOSE_PRINTF(1, "Read_CD/DVD-ROM Sector_ID Error Recover Start\n");
958 g_cdvdfsv_sid_err_recover_cnt = 3;
959 }
960 g_cdvdfsv_sid_err_recover_cnt -= 1;
961 }
962 if ( error_code_tmp == SCECdErNO )
963 return 1;
964 sceCdSC(0xFFFFFFFE, &error_code_tmp);
965 VERBOSE_KPRINTF(1, "secid_chk lsn %d nsec %d IPI Err\n", lsn, nsec);
966 return 0;
967}
968
969static void cdvdfsv_rpc5_01_readee(
970 const cdvdfsv_rpc5_inpacket_t *inbuf, int buflen, cdvdfsv_rpc5_outpacket_t *outbuf, u32 ps2dvd, int sync, int decflag)
971{
972 unsigned int secsize;
973 unsigned int bsize;
974 unsigned int bsize_tmp;
975 unsigned int psize;
976 unsigned int ssize;
977 unsigned int i;
978 int sizestuff;
979 u32 needed_offset;
980 int sector_sizes[2];
981 int scres_unused;
982 int lsndualchg_res;
983 int state;
984 unsigned int buf_offs_sum;
985 unsigned int paddr;
986 int saddr;
987 int datapattern;
988 unsigned int len2_plus_sec2;
989 int trid;
990 int decval;
991 int early_break;
992
993 (void)buflen;
994
995 early_break = 0;
996 trid = 0;
997 buf_offs_sum = 0;
998 sector_sizes[0] = 0x924;
999 sector_sizes[1] = 0x810;
1000 g_cdvdfsv_rmodeee = inbuf->m_pkt_01.m_rmodeee;
1001 lsndualchg_res = inbuf->m_pkt_01.m_lbn;
1002 decval = decflag ? inbuf->m_pkt_01.m_decval : 0;
1003 g_cdvdfsv_eerpsdd.src = &g_cdvdfsv_readpos;
1004 g_cdvdfsv_eerpsdd.size = sizeof(g_cdvdfsv_readpos);
1005 g_cdvdfsv_eerpsdd.attr = 0;
1006 g_cdvdfsv_eerpsdd.dest = (void *)inbuf->m_pkt_01.m_eedest;
1007 if ( ps2dvd )
1008 {
1009 if ( !sceCdSC(0xFFFFFFEA, &scres_unused) )
1010 {
1011 g_cdvdfsv_rderror = SCECdErREADCFR;
1012 sceCdSC(0xFFFFFFFE, &g_cdvdfsv_rderror);
1013 bsize = 0;
1014 psize = 0;
1015 ssize = 0;
1016 saddr = 0;
1017 paddr = 0;
1018 early_break = 1;
1019 }
1020 else
1021 {
1022 lsndualchg_res = sceCdSC(0xFFFFFFE9, &lsndualchg_res);
1023 secsize = 0x800;
1024 datapattern = SCECdSecS2048;
1025 g_cdvdfsv_rmodeee.datapattern = SCECdSecS2048;
1026 }
1027 }
1028 else
1029 {
1030 datapattern = g_cdvdfsv_rmodeee.datapattern;
1031 switch ( datapattern )
1032 {
1033 case SCECdSecS2328:
1034 secsize = 0x918;
1035 break;
1036 case SCECdSecS2340:
1037 secsize = 0x924;
1038 break;
1039 case SCECdSecS2048:
1040 default:
1041 secsize = 0x800;
1042 break;
1043 }
1044 g_cdvdfsv_rmodeee.datapattern = SCECdSecS2340;
1045 }
1046 len2_plus_sec2 = lsndualchg_res + inbuf->m_pkt_01.m_sectors;
1047 if ( !early_break )
1048 {
1049 int all_sec_bytes;
1050
1051 all_sec_bytes = secsize * inbuf->m_pkt_01.m_sectors;
1052 if ( g_cdvdfsv_spinctl != -1 )
1053 g_cdvdfsv_rmodeee.spindlctrl = g_cdvdfsv_spinctl;
1054 paddr = inbuf->m_pkt_01.m_paddr;
1055 saddr = (paddr + all_sec_bytes) & ~0x3F;
1056 psize = ((paddr & 0x3F)) ? ((paddr & ~0x3F) - (paddr - 0x40)) : 0;
1057 bsize = saddr - (paddr + psize);
1058 ssize = paddr + all_sec_bytes - saddr;
1059 VERBOSE_KPRINTF(1, "CD/DVD-ROM lsn= %d sec= %d\n", lsndualchg_res, inbuf->m_pkt_01.m_sectors);
1060 VERBOSE_KPRINTF(1, "f psize= %d bsize= %d ssize= %d\n", psize, bsize, ssize);
1061 }
1062 if ( psize )
1063 {
1064 u32 sectors;
1065
1066 sectors = (len2_plus_sec2 < lsndualchg_res + buf_offs_sum / secsize + 2) ? 1 : 2;
1067 VERBOSE_PRINTF(
1068 1,
1069 "0 CD_READ LBN= %d sectors= %d all= %d\n",
1070 (int)(lsndualchg_res + buf_offs_sum / secsize),
1071 (int)sectors,
1072 (int)inbuf->m_pkt_01.m_sectors);
1073 if ( !readproc1(
1074 lsndualchg_res + buf_offs_sum / secsize,
1075 sectors,
1076 g_cdvdfsv_rtocbuf,
1077 &g_cdvdfsv_rmodeee,
1078 ps2dvd,
1079 sync,
1080 decflag,
1081 decval) )
1082 {
1083 ssize = 0;
1084 psize = 0;
1085 bsize = 0;
1086 }
1087 else
1088 {
1089 if ( datapattern != SCECdSecS2340 || ps2dvd )
1090 {
1091 int rtoc_ind;
1092
1093 rtoc_ind = 12;
1094 for ( i = 0; i < psize; i += 1 )
1095 {
1096 rtoc_ind += (i && !(i % secsize)) ? (sector_sizes[ps2dvd] - secsize) : 0;
1097 g_cdvdfsv_eereadx.m_pbuf1[i] = g_cdvdfsv_rtocbuf[rtoc_ind + i];
1098 }
1099 }
1100 else
1101 {
1102 for ( i = 0; i < psize; i += 1 )
1103 g_cdvdfsv_eereadx.m_pbuf1[i] = g_cdvdfsv_rtocbuf[i];
1104 }
1105 buf_offs_sum += psize;
1106 }
1107 }
1108 bsize_tmp = bsize;
1109 for ( i = 0; i < bsize; i += sizestuff )
1110 {
1111 u32 offs_sector_only;
1112
1113 bsize_tmp = bsize - i;
1114 if ( g_cdvdfsv_spinctl != -1 )
1115 g_cdvdfsv_rmodeee.spindlctrl = g_cdvdfsv_spinctl;
1116 offs_sector_only = lsndualchg_res + buf_offs_sum / secsize;
1117 if ( (unsigned int)(secsize << 6) >= bsize_tmp )
1118 {
1119 needed_offset = (bsize_tmp / secsize) + (!!(bsize_tmp % secsize));
1120 sizestuff = bsize_tmp;
1121 }
1122 else
1123 {
1124 needed_offset = (((offs_sector_only & 0xF)) && (!(secsize & 0xF))) ? (0x10 - (offs_sector_only & 0xF)) : 0x40;
1125 sizestuff = secsize * needed_offset;
1126 }
1127 needed_offset += !!((buf_offs_sum + i) % secsize);
1128 if ( len2_plus_sec2 < offs_sector_only + needed_offset )
1129 needed_offset = len2_plus_sec2 - (lsndualchg_res + (buf_offs_sum + i) / secsize);
1130 g_cdvdfsv_readpos = buf_offs_sum + i;
1131 if ( !readproc2(
1132 offs_sector_only,
1133 needed_offset,
1134 &g_cdvdfsv_rmodeee,
1135 ps2dvd,
1136 sync,
1137 decflag,
1138 decval,
1139 (char *)(inbuf->m_pkt_01.m_paddr + psize) + i,
1140 (buf_offs_sum + i) % secsize,
1141 secsize,
1142 sizestuff,
1143 &g_cdvdfsv_eerpsdd) )
1144 {
1145 bsize_tmp = 0;
1146 early_break = 1;
1147 break;
1148 }
1149 while ( cdvdfsv_checkdmastat(trid) >= 0 )
1150 ;
1151 CpuSuspendIntr(&state);
1152 trid = sceSifSetDma(&g_cdvdfsv_eerpsdd, 1);
1153 CpuResumeIntr(state);
1154 }
1155 buf_offs_sum += i;
1156 bsize = bsize_tmp;
1157 if ( !early_break && ssize )
1158 {
1159 u32 sectors_1;
1160 unsigned int buf_offs_sum_bytes_in_sector;
1161
1162 buf_offs_sum_bytes_in_sector = buf_offs_sum % secsize;
1163 sectors_1 = (len2_plus_sec2 < lsndualchg_res + buf_offs_sum / secsize + 2) ? 1 : 2;
1164 VERBOSE_PRINTF(
1165 1, "2 CD_READ LBN= %d sectors= %d\n", (int)(lsndualchg_res + buf_offs_sum / secsize), (int)sectors_1);
1166 if ( !readproc1(
1167 lsndualchg_res + buf_offs_sum / secsize,
1168 sectors_1,
1169 g_cdvdfsv_rtocbuf,
1170 &g_cdvdfsv_rmodeee,
1171 ps2dvd,
1172 sync,
1173 decflag,
1174 decval) )
1175 {
1176 bsize = 0;
1177 }
1178 else
1179 {
1180 if ( datapattern != SCECdSecS2340 || ps2dvd )
1181 {
1182 int i2_offs;
1183
1184 i2_offs = 12;
1185 for ( i = 0; i < ssize; i += 1 )
1186 {
1187 i2_offs +=
1188 ((i + buf_offs_sum_bytes_in_sector)
1189 && (i % secsize) == (secsize - (buf_offs_sum_bytes_in_sector ? buf_offs_sum_bytes_in_sector : secsize))) ?
1190 (sector_sizes[ps2dvd] - secsize) :
1191 0;
1192 g_cdvdfsv_eereadx.m_pbuf2[i] = g_cdvdfsv_rtocbuf[buf_offs_sum_bytes_in_sector + i2_offs + i];
1193 }
1194 }
1195 else
1196 {
1197 for ( i = 0; i < ssize; i += 1 )
1198 g_cdvdfsv_eereadx.m_pbuf2[i] = g_cdvdfsv_rtocbuf[buf_offs_sum_bytes_in_sector + i];
1199 }
1200 buf_offs_sum += ssize;
1201 }
1202 }
1203 g_cdvdfsv_eereadx.m_b1len = psize;
1204 g_cdvdfsv_eereadx.m_b2len = ssize;
1205 g_cdvdfsv_eereadx.m_b1dst = paddr;
1206 g_cdvdfsv_eereadx.m_b2dst = saddr;
1207 VERBOSE_PRINTF(
1208 1, "b psize= %d paddr= %08x bsize= %d ssize= %d saddr %08x\n", (int)psize, paddr, (int)bsize, (int)ssize, saddr);
1209 while ( cdvdfsv_checkdmastat(trid) >= 0 )
1210 ;
1211 g_cdvdfsv_datasdd.src = &g_cdvdfsv_eereadx;
1212 g_cdvdfsv_datasdd.size = sizeof(g_cdvdfsv_eereadx);
1213 g_cdvdfsv_datasdd.attr = 0;
1214 g_cdvdfsv_readpos = buf_offs_sum;
1215 g_cdvdfsv_datasdd.dest = (void *)inbuf->m_pkt_01.m_eeremaindest;
1216 while ( 1 )
1217 {
1218 CpuSuspendIntr(&state);
1219 trid = sceSifSetDma(&g_cdvdfsv_datasdd, 1);
1220 sceSifSetDma(&g_cdvdfsv_eerpsdd, 1);
1221 CpuResumeIntr(state);
1222 if ( trid )
1223 break;
1224 DelayThread(500);
1225 }
1226 while ( cdvdfsv_checkdmastat(trid) >= 0 )
1227 ;
1228 g_cdvdfsv_spinctl = -1;
1229 VERBOSE_PRINTF(1, "read end\n");
1230 outbuf->m_retres = buf_offs_sum;
1231}
1232
1233static int
1234cdvdfsv_chreadee(int secoffs, int seccount, char *ee_addr, const sceCdRMode *in_rmode, u32 disktype_14, int sync)
1235{
1236 unsigned int secsize;
1237 unsigned int i;
1238 int readsize_bytes;
1239 sceCdRMode rmode;
1240 int scres_unused;
1241 int lsndualchg_res;
1242
1243 lsndualchg_res = secoffs;
1244 rmode = *in_rmode;
1245 if ( disktype_14 )
1246 {
1247 if ( !sceCdSC(0xFFFFFFEA, &scres_unused) )
1248 {
1249 g_cdvdfsv_rderror = SCECdErREADCFR;
1250 sceCdSC(0xFFFFFFFE, &g_cdvdfsv_rderror);
1251 return 1;
1252 }
1253 secsize = 0x800;
1254 lsndualchg_res = sceCdSC(0xFFFFFFE9, &lsndualchg_res);
1255 rmode.datapattern = SCECdSecS2048;
1256 }
1257 else
1258 {
1259 switch ( rmode.datapattern )
1260 {
1261 case SCECdSecS2328:
1262 secsize = 0x918;
1263 break;
1264 case SCECdSecS2340:
1265 secsize = 0x924;
1266 break;
1267 case SCECdSecS2048:
1268 default:
1269 secsize = 0x800;
1270 break;
1271 }
1272 rmode.datapattern = SCECdSecS2340;
1273 }
1274 for ( i = 0; i < (unsigned int)(secsize * seccount); i += readsize_bytes )
1275 {
1276 unsigned int bytescount;
1277 int sectors_partial;
1278 int bytescount_in_sectors;
1279
1280 bytescount = (unsigned int)(secsize * seccount) - i;
1281 sectors_partial = (lsndualchg_res + i / secsize) & 0xF;
1282 bytescount_in_sectors = 0x10;
1283 readsize_bytes = secsize * bytescount_in_sectors;
1284 if ( (unsigned int)readsize_bytes >= bytescount )
1285 {
1286 bytescount_in_sectors = (bytescount / secsize) + (!!(bytescount % secsize));
1287 readsize_bytes = bytescount;
1288 }
1289 else if ( sectors_partial && !(secsize & 0xF) )
1290 {
1291 bytescount_in_sectors -= sectors_partial;
1292 }
1293 if ( !readproc2(
1294 lsndualchg_res + i / secsize,
1295 bytescount_in_sectors,
1296 &rmode,
1297 disktype_14,
1298 sync,
1299 0,
1300 0,
1301 ee_addr + i,
1302 0,
1303 secsize,
1304 readsize_bytes,
1305 0) )
1306 {
1307 break;
1308 }
1309 }
1310 return 1;
1311}
1312
1313static void
1314cdvdfsv_rpc5_0F_readchain(const cdvdfsv_rpc5_inpacket_t *inbuf, int buflen, cdvdfsv_rpc5_outpacket_t *outbuf)
1315{
1316 int sector_size;
1317 unsigned int i;
1318 const sceCdRChain *chain;
1319 void *buf;
1320 int re_result;
1321 int trid;
1322 int scres_unused;
1323 int state;
1324
1325 (void)buflen;
1326 (void)outbuf;
1327
1328 g_cdvdfsv_rderror = SCECdErREADCFR;
1329 g_cdvdfsv_readpos = 0;
1330 g_cdvdman_istruct_ptr->m_break_cdvdfsv_readchain = 0;
1331 g_cdvdfsv_chrdsdd.src = &g_cdvdfsv_readpos;
1332 g_cdvdfsv_chrdsdd.size = sizeof(g_cdvdfsv_readpos);
1333 g_cdvdfsv_chrdsdd.attr = 0;
1334 g_cdvdfsv_chrdsdd.dest = (void *)inbuf->m_pkt_0F.m_eedest;
1335 switch ( inbuf->m_pkt_0F.m_mode.datapattern )
1336 {
1337 case SCECdSecS2328:
1338 sector_size = 0x918;
1339 break;
1340 case SCECdSecS2340:
1341 sector_size = 0x924;
1342 break;
1343 case SCECdSecS2048:
1344 default:
1345 sector_size = 0x800;
1346 break;
1347 }
1348 chain = inbuf->m_pkt_0F.m_readChain;
1349 for ( i = 0; i < 0x40; i += 1 )
1350 {
1351 if ( g_cdvdman_istruct_ptr->m_break_cdvdfsv_readchain )
1352 {
1353 VERBOSE_PRINTF(1, "ReadChain cnt %d on sceCdBreak()\n", (int)i);
1354 return;
1355 }
1356 if ( chain[i].lbn == 0xFFFFFFFF || chain[i].sectors == 0xFFFFFFFF || chain[i].buffer == 0xFFFFFFFF )
1357 return;
1358 if ( (chain[i].buffer & 1) )
1359 {
1360 buf = (void *)(chain[i].buffer & ~1);
1361 VERBOSE_PRINTF(
1362 1,
1363 "ReadChain lsn= %d nsec= %d buf= %08x secsize= %d\n",
1364 (int)(chain[i].lbn),
1365 (int)(chain[i].sectors),
1366 (unsigned int)(uiptr)buf,
1367 inbuf->m_pkt_0F.m_mode.datapattern);
1368 re_result = sceCdRE(chain[i].lbn, chain[i].sectors, buf, (sceCdRMode *)&(inbuf->m_pkt_0F.m_mode));
1369 if ( re_result == 1 )
1370 {
1371 sceCdSync(0);
1372 re_result = sceCdGetError() == SCECdErNO;
1373 }
1374 else
1375 {
1376 sceCdSC(0xFFFFFFFE, &g_cdvdfsv_rderror);
1377 }
1378 }
1379 else
1380 {
1381 // The following printf was modified for ioprp300x
1382 VERBOSE_PRINTF(
1383 1, "ReadChain EE\t Memory addr= 0x%08x sector= %d\n", (unsigned int)(chain[i].lbn), (int)(chain[i].sectors));
1384 // The following call to sceCdGetDiskType was inlined
1385 re_result = cdvdfsv_chreadee(
1386 chain[i].lbn,
1387 chain[i].sectors,
1388 (char *)chain[i].buffer,
1389 &(inbuf->m_pkt_0F.m_mode),
1390 sceCdGetDiskType() == SCECdPS2DVD,
1391 !sceCdSC(0xFFFFFFFC, &scres_unused));
1392 }
1393 if ( !re_result )
1394 {
1395 VERBOSE_PRINTF(1, "ReadChain error code= 0x%02x\n", sceCdGetError());
1396 break;
1397 }
1398 g_cdvdfsv_readpos += chain[i].sectors * sector_size;
1399 while ( 1 )
1400 {
1401 CpuSuspendIntr(&state);
1402 trid = sceSifSetDma(&g_cdvdfsv_chrdsdd, 1);
1403 CpuResumeIntr(state);
1404 if ( trid )
1405 break;
1406 DelayThread(500);
1407 }
1408 while ( cdvdfsv_checkdmastat(trid) >= 0 )
1409 ;
1410 }
1411}
1412
1413#ifdef CDVD_VARIANT_OSD
1414static void cdvdfsv_rpc5_03_readdvdv(const cdvdfsv_rpc5_inpacket_t *inbuf, int buflen, cdvdfsv_rpc5_outpacket_t *outbuf)
1415{
1416 int all_sec_bytes;
1417 unsigned int buf_1_toalign;
1418 unsigned int buf_offs_mod_sector_size;
1419 unsigned int buf_aligned;
1420 u32 sectors;
1421 int lbn;
1422 int cmd_error;
1423 int error_code;
1424 unsigned int i;
1425 int readbuf;
1426 int cpysize;
1427 int trid;
1428 int state;
1429 unsigned int buf_offs;
1430 unsigned int buf_toalign;
1431 unsigned int buf_sec_tmp;
1432
1433 (void)buflen;
1434 error_code = SCECdErNO;
1435 cmd_error = 1;
1436 buf_offs = 0;
1437 g_cdvdfsv_rderror = SCECdErREADCFR;
1438 all_sec_bytes = 0x810 * inbuf->m_pkt_03.m_nsectors;
1439 buf_toalign = ((inbuf->m_pkt_03.m_buf & 0x3F)) ? (inbuf->m_pkt_03.m_buf & ~0x3F) - (inbuf->m_pkt_03.m_buf - 0x40) : 0;
1440 buf_1_toalign = (inbuf->m_pkt_03.m_buf + all_sec_bytes) & ~0x3F;
1441 buf_sec_tmp = all_sec_bytes - (buf_1_toalign - inbuf->m_pkt_03.m_buf);
1442 if ( buf_toalign )
1443 {
1444 lbn = inbuf->m_pkt_03.m_lbn + buf_offs / 0x810;
1445 sectors = 1 + (!!((inbuf->m_pkt_03.m_lbn + inbuf->m_pkt_03.m_nsectors) >= (unsigned int)(lbn + 2)));
1446 VERBOSE_PRINTF(1, "0 CD_READ LBN= %d sectors= %d all= %d\n", lbn, (int)sectors, (int)inbuf->m_pkt_03.m_nsectors);
1447 cmd_error = sceCdReadDVDV(lbn, sectors, g_cdvdfsv_fsvrbuf[0], (sceCdRMode *)&inbuf->m_pkt_03.m_mode);
1448 sceCdSync(0);
1449 error_code = sceCdGetError();
1450 if ( error_code != SCECdErNO || !cmd_error )
1451 {
1452 if ( !cmd_error )
1453 sceCdSC(0xFFFFFFFE, &g_cdvdfsv_rderror);
1454 VERBOSE_PRINTF(1, "Read error code %x cmd error %d\n", error_code, cmd_error);
1455 buf_toalign = 0;
1456 }
1457 for ( i = 0; i < buf_toalign; i += 1 )
1458 g_cdvdfsv_eereadx.m_pbuf1[i] = g_cdvdfsv_fsvrbuf[0][i];
1459 buf_offs += buf_toalign;
1460 }
1461 if ( error_code == SCECdErNO && cmd_error )
1462 {
1463 int firstflag;
1464 unsigned int sector_count_in_bytes;
1465
1466 buf_offs_mod_sector_size = 0;
1467 readbuf = 0;
1468 firstflag = 0;
1469 cpysize = 0;
1470 for ( buf_aligned = inbuf->m_pkt_03.m_buf + buf_toalign; buf_aligned < buf_1_toalign;
1471 buf_aligned += sector_count_in_bytes )
1472 {
1473 unsigned int buf_align_remain;
1474
1475 buf_align_remain = buf_1_toalign - buf_aligned;
1476 buf_offs_mod_sector_size = (buf_aligned - inbuf->m_pkt_03.m_buf) % 0x810;
1477 sector_count_in_bytes = (0x8100 >= buf_align_remain) ? buf_align_remain : 0x8100;
1478 sectors = (0x8100 >= buf_align_remain) ? (buf_align_remain / 0x810 + (!!(buf_align_remain % 0x810))) : 16;
1479 sectors += !!buf_offs_mod_sector_size;
1480 lbn = inbuf->m_pkt_03.m_lbn + (buf_aligned - inbuf->m_pkt_03.m_buf) / 0x810;
1481 if ( sectors > (inbuf->m_pkt_03.m_lbn + inbuf->m_pkt_03.m_nsectors) - lbn )
1482 sectors = (inbuf->m_pkt_03.m_lbn + inbuf->m_pkt_03.m_nsectors) - lbn;
1483 cmd_error = sceCdReadDVDV(lbn, sectors, g_cdvdfsv_fsvrbuf[readbuf], (sceCdRMode *)&inbuf->m_pkt_03.m_mode);
1484 if ( firstflag )
1485 {
1486 if ( buf_offs_mod_sector_size )
1487 optimized_memcpy(
1488 g_cdvdfsv_fsvrbuf[readbuf ^ 1], &g_cdvdfsv_fsvrbuf[readbuf ^ 1][buf_offs_mod_sector_size], cpysize);
1489 g_cdvdfsv_readdvdv_dmat.dest = (void *)(buf_aligned - cpysize);
1490 g_cdvdfsv_readdvdv_dmat.size = cpysize;
1491 g_cdvdfsv_readdvdv_dmat.attr = 0;
1492 g_cdvdfsv_readdvdv_dmat.src = g_cdvdfsv_fsvrbuf[readbuf ^ 1];
1493 while ( 1 )
1494 {
1495 CpuSuspendIntr(&state);
1496 trid = sceSifSetDma(&g_cdvdfsv_readdvdv_dmat, 1);
1497 CpuResumeIntr(state);
1498 if ( trid )
1499 break;
1500 DelayThread(500);
1501 }
1502 while ( cdvdfsv_checkdmastat(trid) >= 0 )
1503 ;
1504 }
1505 sceCdSync(0);
1506 error_code = sceCdGetError();
1507 if ( error_code != SCECdErNO || !cmd_error )
1508 {
1509 if ( !cmd_error )
1510 sceCdSC(0xFFFFFFFE, &g_cdvdfsv_rderror);
1511 VERBOSE_PRINTF(1, "Read error code %x cmd error %d\n", error_code, cmd_error);
1512 break;
1513 }
1514 firstflag = 1;
1515 readbuf ^= 1;
1516 cpysize = sector_count_in_bytes;
1517 buf_offs += sector_count_in_bytes;
1518 }
1519 }
1520 if ( error_code == SCECdErNO && cmd_error )
1521 {
1522 if ( buf_offs_mod_sector_size )
1523 optimized_memcpy(
1524 g_cdvdfsv_fsvrbuf[readbuf ^ 1], &g_cdvdfsv_fsvrbuf[readbuf ^ 1][buf_offs_mod_sector_size], cpysize);
1525 g_cdvdfsv_readdvdv_dmat.dest = (void *)buf_aligned;
1526 g_cdvdfsv_readdvdv_dmat.size = cpysize;
1527 g_cdvdfsv_readdvdv_dmat.attr = 0;
1528 g_cdvdfsv_readdvdv_dmat.src = g_cdvdfsv_fsvrbuf[readbuf ^ 1];
1529 while ( 1 )
1530 {
1531 CpuSuspendIntr(&state);
1532 trid = sceSifSetDma(&g_cdvdfsv_readdvdv_dmat, 1);
1533 CpuResumeIntr(state);
1534 if ( trid )
1535 break;
1536 DelayThread(500);
1537 }
1538 while ( cdvdfsv_checkdmastat(trid) >= 0 )
1539 ;
1540 if ( buf_sec_tmp )
1541 {
1542 lbn = inbuf->m_pkt_03.m_lbn + buf_offs / 0x810;
1543 sectors = 1 + (!!((inbuf->m_pkt_03.m_lbn + inbuf->m_pkt_03.m_nsectors) >= (unsigned int)(lbn + 2)));
1544 VERBOSE_PRINTF(1, "2 CD_READ LBN= %d sectors= %d\n", lbn, (int)sectors);
1545 cmd_error = sceCdReadDVDV(lbn, sectors, g_cdvdfsv_fsvrbuf[0], (sceCdRMode *)&inbuf->m_pkt_03.m_mode);
1546 sceCdSync(0);
1547 error_code = sceCdGetError();
1548 if ( error_code != SCECdErNO || !cmd_error )
1549 {
1550 if ( !cmd_error )
1551 sceCdSC(0xFFFFFFFE, &g_cdvdfsv_rderror);
1552 VERBOSE_PRINTF(1, "Read error code %x cmd error %d\n", error_code, cmd_error);
1553 buf_sec_tmp = 0;
1554 }
1555 for ( i = 0; i < buf_sec_tmp; i += 1 )
1556 g_cdvdfsv_eereadx.m_pbuf2[i] = g_cdvdfsv_fsvrbuf[0][(buf_offs % 0x810) + i];
1557 buf_offs += buf_sec_tmp;
1558 }
1559 }
1560 g_cdvdfsv_eereadx.m_b1len = buf_toalign;
1561 g_cdvdfsv_eereadx.m_b2len = buf_sec_tmp;
1562 g_cdvdfsv_eereadx.m_b1dst = inbuf->m_pkt_03.m_buf;
1563 g_cdvdfsv_eereadx.m_b2dst = buf_1_toalign;
1564 g_cdvdfsv_readdvdv_dmat.src = &g_cdvdfsv_eereadx;
1565 g_cdvdfsv_readdvdv_dmat.size = sizeof(g_cdvdfsv_eereadx);
1566 g_cdvdfsv_readdvdv_dmat.attr = 0;
1567 g_cdvdfsv_readdvdv_dmat.dest = (void *)inbuf->m_pkt_03.m_eedest;
1568 while ( 1 )
1569 {
1570 CpuSuspendIntr(&state);
1571 trid = sceSifSetDma(&g_cdvdfsv_readdvdv_dmat, 1);
1572 CpuResumeIntr(state);
1573 if ( trid )
1574 break;
1575 DelayThread(500);
1576 }
1577 while ( cdvdfsv_checkdmastat(trid) >= 0 )
1578 ;
1579 VERBOSE_PRINTF(1, "read end\n");
1580 outbuf->m_retres = buf_offs;
1581}
1582#endif
1583
1584// Note: in OSD variant, the do_read_full argument was added
1585static void cdvdfsv_rpc5_02_readcdda(
1586 const cdvdfsv_rpc5_inpacket_t *inbuf, int buflen, cdvdfsv_rpc5_outpacket_t *outbuf, int do_read_full)
1587{
1588 int trid;
1589 unsigned int sector_size;
1590 int all_sec_bytes;
1591 unsigned int buf_1_toalign;
1592 u32 sectors;
1593 int lbn;
1594 int cmd_error;
1595 int error_code;
1596 unsigned int i;
1597 int state;
1598 int error_code_tmp;
1599 unsigned int buf_offs;
1600 unsigned int buf_toalign;
1601 unsigned int buf_sec_tmp;
1602
1603#ifndef CDVD_VARIANT_OSD
1604 (void)do_read_full;
1605#endif
1606 trid = 0;
1607 g_cdvdfsv_rderror = SCECdErREADCFR;
1608 error_code_tmp = SCECdErNO;
1609 g_cdvdfsv_eereadfull_dma2.src = &g_cdvdfsv_readpos;
1610 g_cdvdfsv_eereadfull_dma2.size = sizeof(g_cdvdfsv_readpos);
1611 g_cdvdfsv_eereadfull_dma2.attr = 0;
1612 g_cdvdfsv_eereadfull_dma2.dest = (void *)inbuf->m_pkt_02.m_eedest;
1613 switch ( inbuf->m_pkt_02.m_mode.datapattern )
1614 {
1615 case SCECdSecS2368:
1616 sector_size = 0x940;
1617 break;
1618 case SCECdSecS2352:
1619 case SCECdSecS2448:
1620 default:
1621 sector_size = 0x930;
1622 break;
1623 }
1624 buf_offs = 0;
1625 all_sec_bytes = sector_size * inbuf->m_pkt_02.m_sectors;
1626 buf_toalign =
1627 ((inbuf->m_pkt_02.m_buf & 0x3F)) ? ((inbuf->m_pkt_02.m_buf & ~0x3F) - (inbuf->m_pkt_02.m_buf - 0x40)) : 0;
1628 buf_1_toalign = (inbuf->m_pkt_02.m_buf + all_sec_bytes) & ~0x3F;
1629 buf_sec_tmp = all_sec_bytes - (buf_1_toalign - inbuf->m_pkt_02.m_buf);
1630 if ( buf_toalign )
1631 {
1632 unsigned int buf_offs_sectors;
1633
1634 buf_offs_sectors = buf_offs / sector_size;
1635 lbn = inbuf->m_pkt_02.m_lbn + buf_offs_sectors;
1636 sectors = 1 + !!((inbuf->m_pkt_02.m_lbn + inbuf->m_pkt_02.m_sectors) >= (unsigned int)(lbn + 2));
1637 VERBOSE_PRINTF(
1638 1, "0 CD_READ LBN= %d sectors= %d all= %d\n", (int)lbn, (int)sectors, (int)inbuf->m_pkt_02.m_sectors);
1639#ifdef CDVD_VARIANT_OSD
1640 cmd_error = do_read_full ? sceCdReadFull(lbn, sectors, g_cdvdfsv_rtocbuf, (sceCdRMode *)&inbuf->m_pkt_02.m_mode) :
1641 sceCdReadCDDA(lbn, sectors, g_cdvdfsv_rtocbuf, (sceCdRMode *)&inbuf->m_pkt_02.m_mode);
1642#else
1643 cmd_error = sceCdReadCDDA(lbn, sectors, g_cdvdfsv_rtocbuf, (sceCdRMode *)&inbuf->m_pkt_02.m_mode);
1644#endif
1645 sceCdSync(3);
1646 error_code = sceCdGetError();
1647 if ( error_code != SCECdErNO || !cmd_error )
1648 {
1649 if ( !cmd_error )
1650 sceCdSC(0xFFFFFFFE, &g_cdvdfsv_rderror);
1651 VERBOSE_PRINTF(1, "Read error code %x cmd error %d\n", error_code, cmd_error);
1652 if ( error_code == SCECdErEOM || error_code == SCECdErSFRMTNG )
1653 error_code_tmp = error_code;
1654 else
1655 {
1656 buf_toalign = 0;
1657 }
1658 }
1659 if ( error_code_tmp != SCECdErNO && error_code_tmp != SCECdErEOM && error_code_tmp != SCECdErSFRMTNG )
1660 {
1661 for ( i = 0; i < buf_toalign; i += 1 )
1662 {
1663 g_cdvdfsv_eereadx.m_pbuf1[i] = g_cdvdfsv_rtocbuf[i];
1664 }
1665 buf_offs += buf_toalign;
1666 }
1667 }
1668 if ( error_code_tmp != SCECdErNO && error_code_tmp != SCECdErEOM && error_code_tmp != SCECdErSFRMTNG )
1669 {
1670 unsigned int sector_count_in_bytes;
1671 unsigned int buf_aligned;
1672
1673 for ( buf_aligned = inbuf->m_pkt_02.m_buf + buf_toalign; buf_aligned < buf_1_toalign;
1674 buf_aligned += sector_count_in_bytes )
1675 {
1676 unsigned int buf_align_remain;
1677 unsigned int buf_offs_mod_sector_size;
1678
1679 buf_align_remain = buf_1_toalign - buf_aligned;
1680 buf_offs_mod_sector_size = buf_offs % sector_size;
1681 lbn = inbuf->m_pkt_02.m_lbn + buf_offs / sector_size;
1682 sectors = (g_cdvdfsv_sectors_cdda * sector_size >= buf_align_remain) ?
1683 (buf_align_remain / sector_size) + (!!(buf_align_remain % sector_size)) :
1684 g_cdvdfsv_sectors_cdda;
1685 sectors += !!buf_offs_mod_sector_size;
1686 sector_count_in_bytes = (g_cdvdfsv_sectors_cdda * sector_size >= buf_align_remain) ?
1687 g_cdvdfsv_sectors_cdda * sector_size :
1688 buf_align_remain;
1689 if ( sectors > (inbuf->m_pkt_02.m_lbn + inbuf->m_pkt_02.m_sectors) - lbn )
1690 sectors = (inbuf->m_pkt_02.m_lbn + inbuf->m_pkt_02.m_sectors) - lbn;
1691 while ( cdvdfsv_checkdmastat(trid) >= 0 )
1692 ;
1693#ifdef CDVD_VARIANT_OSD
1694 cmd_error = do_read_full ? sceCdReadFull(lbn, sectors, g_cdvdfsv_rtocbuf, (sceCdRMode *)&inbuf->m_pkt_02.m_mode) :
1695 sceCdReadCDDA(lbn, sectors, g_cdvdfsv_rtocbuf, (sceCdRMode *)&inbuf->m_pkt_02.m_mode);
1696#else
1697 cmd_error = sceCdReadCDDA(lbn, sectors, g_cdvdfsv_rtocbuf, (sceCdRMode *)&inbuf->m_pkt_02.m_mode);
1698#endif
1699 sceCdSync(3);
1700 error_code = sceCdGetError();
1701 if ( error_code != SCECdErNO || !cmd_error )
1702 {
1703 if ( !cmd_error )
1704 sceCdSC(0xFFFFFFFE, &g_cdvdfsv_rderror);
1705 VERBOSE_PRINTF(1, "Read error code %x cmd error %d\n", error_code, cmd_error);
1706 if ( error_code == SCECdErEOM || error_code == SCECdErSFRMTNG )
1707 {
1708 error_code_tmp = error_code;
1709 break;
1710 }
1711 }
1712 if ( buf_offs_mod_sector_size )
1713 optimized_memcpy(g_cdvdfsv_rtocbuf, &g_cdvdfsv_rtocbuf[buf_offs_mod_sector_size], sector_count_in_bytes);
1714 g_cdvdfsv_eereadfull_dma1.src = g_cdvdfsv_rtocbuf;
1715 g_cdvdfsv_eereadfull_dma1.size = sector_count_in_bytes;
1716 g_cdvdfsv_eereadfull_dma1.attr = 0;
1717 g_cdvdfsv_eereadfull_dma1.dest = (char *)buf_aligned;
1718 g_cdvdfsv_readpos = buf_offs;
1719 while ( 1 )
1720 {
1721 CpuSuspendIntr(&state);
1722 trid = sceSifSetDma(&g_cdvdfsv_eereadfull_dma1, 1);
1723 CpuResumeIntr(state);
1724 if ( trid )
1725 break;
1726 DelayThread(500);
1727 }
1728 if ( (unsigned int)buflen >= 0x19 )
1729 {
1730 CpuSuspendIntr(&state);
1731 sceSifSetDma(&g_cdvdfsv_eereadfull_dma2, 1);
1732 CpuResumeIntr(state);
1733 }
1734 buf_offs += sector_count_in_bytes;
1735 }
1736 }
1737 if (
1738 (error_code_tmp != SCECdErNO && error_code_tmp != SCECdErEOM && error_code_tmp != SCECdErSFRMTNG) && buf_sec_tmp )
1739 {
1740 lbn = inbuf->m_pkt_02.m_lbn + buf_offs / sector_size;
1741 sectors = 1 + !!((inbuf->m_pkt_02.m_lbn + inbuf->m_pkt_02.m_sectors) >= (unsigned int)(lbn + 2));
1742 VERBOSE_PRINTF(
1743 1,
1744 "0 CD_READ LBN= %d sectors= %d all= %d\n",
1745 (int)(inbuf->m_pkt_02.m_lbn + buf_offs / sector_size),
1746 (int)sectors,
1747 (int)inbuf->m_pkt_02.m_sectors);
1748 VERBOSE_PRINTF(1, "2 CD_READ LBN= %d sectors= %d\n", (int)lbn, (int)sectors);
1749#ifdef CDVD_VARIANT_OSD
1750 cmd_error = do_read_full ? sceCdReadFull(lbn, sectors, g_cdvdfsv_rtocbuf, (sceCdRMode *)&inbuf->m_pkt_02.m_mode) :
1751 sceCdReadCDDA(lbn, sectors, g_cdvdfsv_rtocbuf, (sceCdRMode *)&inbuf->m_pkt_02.m_mode);
1752#else
1753 cmd_error = sceCdReadCDDA(lbn, sectors, g_cdvdfsv_rtocbuf, (sceCdRMode *)&inbuf->m_pkt_02.m_mode);
1754#endif
1755 sceCdSync(3);
1756 error_code = sceCdGetError();
1757 if ( error_code != SCECdErNO || !cmd_error )
1758 {
1759 if ( !cmd_error )
1760 sceCdSC(0xFFFFFFFE, &g_cdvdfsv_rderror);
1761 VERBOSE_PRINTF(1, "Read error code %x cmd error %d\n", error_code, cmd_error);
1762 if ( error_code == SCECdErEOM || error_code == SCECdErSFRMTNG )
1763 error_code_tmp = error_code;
1764 else
1765 buf_sec_tmp = 0;
1766 }
1767 for ( i = 0; i < buf_sec_tmp; i += 1 )
1768 {
1769 g_cdvdfsv_eereadx.m_pbuf2[i] = g_cdvdfsv_rtocbuf[(buf_offs % sector_size) + i];
1770 }
1771 buf_offs += buf_sec_tmp;
1772 }
1773 g_cdvdfsv_eereadx.m_b1len = buf_toalign;
1774 g_cdvdfsv_eereadx.m_b2len = buf_sec_tmp;
1775 g_cdvdfsv_eereadx.m_b1dst = inbuf->m_pkt_02.m_buf;
1776 g_cdvdfsv_eereadx.m_b2dst = buf_1_toalign;
1777 while ( cdvdfsv_checkdmastat(trid) >= 0 )
1778 ;
1779 g_cdvdfsv_eereadfull_dma1.src = &g_cdvdfsv_eereadx;
1780 g_cdvdfsv_eereadfull_dma1.size = sizeof(g_cdvdfsv_eereadx);
1781 g_cdvdfsv_eereadfull_dma1.attr = 0;
1782 g_cdvdfsv_readpos = buf_offs;
1783 g_cdvdfsv_eereadfull_dma1.dest = (void *)inbuf->m_pkt_02.m_eeremaindest;
1784 while ( 1 )
1785 {
1786 CpuSuspendIntr(&state);
1787 trid = sceSifSetDma(&g_cdvdfsv_eereadfull_dma1, 1);
1788 if ( (unsigned int)buflen >= 0x19 )
1789 sceSifSetDma(&g_cdvdfsv_eereadfull_dma2, 1);
1790 CpuResumeIntr(state);
1791 if ( trid )
1792 break;
1793 DelayThread(500);
1794 }
1795 while ( cdvdfsv_checkdmastat(trid) >= 0 )
1796 ;
1797 if ( error_code_tmp != SCECdErNO )
1798 sceCdSC(0xFFFFFFFE, &error_code_tmp);
1799 VERBOSE_PRINTF(1, "read end\n");
1800 outbuf->m_retres = buf_offs;
1801}
1802
1803static void *cbrpc_rpc2_diskready(int fno, void *buffer, int length)
1804{
1805 (void)fno;
1806 (void)length;
1807
1808 // The following call to sceCdStatus was inlined
1809 VERBOSE_KPRINTF(1, "DISK READY call 0x%02x\n", sceCdStatus());
1810 // The following call to sceCdDiskReady was inlined
1811 g_diskready_res.m_retres = sceCdDiskReady(((const cdvdfsv_rpc2_inpacket_t *)buffer)->m_mode);
1812 return (void *)&g_diskready_res;
1813}
1814
1815static void cdvdfsv_rpc5_04_gettoc(const cdvdfsv_rpc5_inpacket_t *inbuf, int buflen, cdvdfsv_rpc5_outpacket_t *outbuf)
1816{
1817 int trid;
1818 int state;
1819
1820 (void)buflen;
1821
1822 VERBOSE_PRINTF(1, "GET TOC call 0x%08x\n", (int)inbuf);
1823 outbuf->m_retres = sceCdGetToc((u8 *)g_cdvdfsv_rtocbuf);
1824 VERBOSE_PRINTF(1, "GET TOC called\n");
1825 g_cdvdfsv_rtocsdd.src = g_cdvdfsv_rtocbuf;
1826 g_cdvdfsv_rtocsdd.size = 0x810;
1827 g_cdvdfsv_rtocsdd.attr = 0;
1828 g_cdvdfsv_rtocsdd.dest = (void *)inbuf->m_pkt_04.m_eedest;
1829 while ( 1 )
1830 {
1831 CpuSuspendIntr(&state);
1832 trid = sceSifSetDma(&g_cdvdfsv_rtocsdd, 1);
1833 CpuResumeIntr(state);
1834 if ( trid )
1835 break;
1836 DelayThread(500);
1837 }
1838 while ( cdvdfsv_checkdmastat(trid) >= 0 )
1839 ;
1840 // The following call to sceCdGetDiskType was inlined
1841 switch ( sceCdGetDiskType() )
1842 {
1843 case SCECdPS2DVD:
1844 case SCECdDVDVR:
1845 case SCECdDVDV:
1846 outbuf->m_pkt_04.m_isdvd = 1;
1847 break;
1848 default:
1849 outbuf->m_pkt_04.m_isdvd = 0;
1850 break;
1851 }
1852}
1853
1854static void cdvdfsv_rpc3_03_disktype(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
1855{
1856 (void)inbuf;
1857 (void)buflen;
1858
1859 outbuf->m_retres = sceCdGetDiskType();
1860}
1861
1862static void cdvdfsv_rpc3_0C_cdstatus(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
1863{
1864 (void)inbuf;
1865 (void)buflen;
1866
1867 outbuf->m_retres = sceCdStatus();
1868}
1869
1870static void cdvdfsv_rpc3_06_ri(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
1871{
1872 int i;
1873 u32 efbits;
1874
1875 (void)inbuf;
1876 (void)buflen;
1877
1878 outbuf->m_retres = 0;
1879 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
1880 {
1881 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
1882 outbuf->m_retres = sceCdRI(outbuf->m_pkt_06.m_buffer, &outbuf->m_pkt_06.m_result);
1883 }
1884}
1885
1886static void cdvdfsv_rpc3_1A_rm(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
1887{
1888 int i;
1889 u32 efbits;
1890
1891 (void)inbuf;
1892 (void)buflen;
1893
1894 outbuf->m_retres = 0;
1895 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
1896 {
1897 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
1898 outbuf->m_retres = sceCdRM(outbuf->m_pkt_1A.m_buffer, &outbuf->m_pkt_1A.m_status);
1899 }
1900}
1901
1902#ifdef CDVD_VARIANT_DNAS
1903static void cdvdfsv_rpc3_24_readguid(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
1904{
1905 int i;
1906 u32 efbits;
1907
1908 (void)inbuf;
1909 (void)buflen;
1910
1911 outbuf->m_retres = 0;
1912 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
1913 {
1914 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
1915 outbuf->m_retres = sceCdReadGUID(&outbuf->m_pkt_24.m_guid);
1916 }
1917}
1918
1919static void
1920cdvdfsv_rpc3_26_readmodelid(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
1921{
1922 int i;
1923 u32 efbits;
1924
1925 (void)inbuf;
1926 (void)buflen;
1927
1928 outbuf->m_retres = 0;
1929 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
1930 {
1931 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
1932 outbuf->m_retres = sceCdReadModelID(&outbuf->m_pkt_26.m_id);
1933 }
1934}
1935#endif
1936
1937static void cdvdfsv_rpc3_22_mmode(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
1938{
1939 if ( buflen == 4 || !inbuf->m_pkt_22.m_char4 )
1940 {
1941 outbuf->m_retres = sceCdMmode(inbuf->m_pkt_22.m_media);
1942 }
1943}
1944
1945#ifdef CDVD_VARIANT_XOSD
1946static void cdvdfsv_rpc3_2D_chgsys(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
1947{
1948 (void)buflen;
1949 VERBOSE_KPRINTF(1, "EE call recv sceCdChgSys %d %08x\n", inbuf->m_pkt_2D.m_arg1, inbuf);
1950 outbuf->m_retres = sceCdChgSys(inbuf->m_pkt_2D.m_arg1);
1951}
1952#endif
1953
1954static void
1955cdvdfsv_rpc3_23_changethreadpriority(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
1956{
1957 (void)buflen;
1958
1959 outbuf->m_retres = sceCdChangeThreadPriority(inbuf->m_pkt_23.m_priority);
1960}
1961
1962#ifdef CDVD_VARIANT_OSD
1963static void cdvdfsv_rpc3_07_wi(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
1964{
1965 int i;
1966 u32 efbits;
1967
1968 (void)inbuf;
1969 (void)buflen;
1970 outbuf->m_retres = 0;
1971 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
1972 {
1973 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
1974 outbuf->m_retres = sceCdWI(inbuf->m_pkt_07.m_buffer, &outbuf->m_pkt_07.m_status);
1975 }
1976}
1977#endif
1978
1979#ifdef CDVD_VARIANT_OSD
1980static void cdvdfsv_rpc3_1B_wm(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
1981{
1982 int i;
1983 u32 efbits;
1984
1985 (void)inbuf;
1986 (void)buflen;
1987 outbuf->m_retres = 0;
1988 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
1989 {
1990 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
1991 outbuf->m_retres = sceCdWM(inbuf->m_pkt_1B.m_buffer, &outbuf->m_pkt_1B.m_status);
1992 }
1993}
1994#endif
1995
1996#ifdef CDVD_VARIANT_OSD
1997static void
1998cdvdfsv_rpc3_12_readconsoleid(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
1999{
2000 int i;
2001 u32 efbits;
2002
2003 (void)inbuf;
2004 (void)buflen;
2005 outbuf->m_retres = 0;
2006 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2007 {
2008 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2009 outbuf->m_retres = sceCdReadConsoleID(outbuf->m_pkt_12.m_buffer, &outbuf->m_pkt_12.m_status);
2010 }
2011}
2012#endif
2013
2014#ifdef CDVD_VARIANT_OSD
2015static void
2016cdvdfsv_rpc3_13_writeconsoleid(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2017{
2018 int i;
2019 u32 efbits;
2020
2021 (void)inbuf;
2022 (void)buflen;
2023 outbuf->m_retres = 0;
2024 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2025 {
2026 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2027 outbuf->m_retres = sceCdWriteConsoleID(inbuf->m_pkt_13.m_buffer, &outbuf->m_pkt_13.m_status);
2028 }
2029}
2030#endif
2031
2032#ifdef CDVD_VARIANT_OSD
2033static void
2034cdvdfsv_rpc3_14_getmversion(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2035{
2036 int i;
2037 u32 efbits;
2038
2039 (void)inbuf;
2040 (void)buflen;
2041 outbuf->m_retres = 0;
2042 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2043 {
2044 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2045 outbuf->m_retres = sceCdMV(outbuf->m_pkt_14.m_buffer, &outbuf->m_pkt_14.m_status);
2046 }
2047}
2048#endif
2049
2050#ifdef CDVD_VARIANT_OSD
2051static void cdvdfsv_rpc3_17_readsubq(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2052{
2053 int i;
2054 u32 efbits;
2055
2056 (void)inbuf;
2057 (void)buflen;
2058 outbuf->m_retres = 0;
2059 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2060 {
2061 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2062 outbuf->m_retres = sceCdReadSUBQ(outbuf->m_pkt_17.m_buffer, &outbuf->m_pkt_17.m_status);
2063 }
2064}
2065#endif
2066
2067#ifdef CDVD_VARIANT_OSD
2068static void
2069cdvdfsv_rpc3_18_forbiddvdp(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2070{
2071 int i;
2072 u32 efbits;
2073
2074 (void)inbuf;
2075 (void)buflen;
2076 outbuf->m_retres = 0;
2077 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2078 {
2079 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2080 outbuf->m_retres = sceCdForbidDVDP(&outbuf->m_pkt_18.m_status);
2081 }
2082}
2083#endif
2084
2085#ifdef CDVD_VARIANT_OSD
2086static void
2087cdvdfsv_rpc3_1C_forbidread(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2088{
2089 int i;
2090 u32 efbits;
2091
2092 (void)inbuf;
2093 (void)buflen;
2094 outbuf->m_retres = 0;
2095 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2096 {
2097 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2098 outbuf->m_retres = sceCdForbidRead(&outbuf->m_pkt_1C.m_status);
2099 }
2100}
2101#endif
2102
2103#ifdef CDVD_VARIANT_OSD
2104static void
2105cdvdfsv_rpc3_1E_bootcertify(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2106{
2107 int i;
2108 u32 efbits;
2109
2110 (void)buflen;
2111 outbuf->m_retres = 0;
2112 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2113 {
2114 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2115 outbuf->m_retres = sceCdBootCertify(inbuf->m_pkt_1E.m_romname);
2116 }
2117}
2118#endif
2119
2120#ifdef CDVD_VARIANT_OSD
2121static void
2122cdvdfsv_rpc3_1F_cancelpoffrdy(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2123{
2124 int i;
2125 u32 efbits;
2126
2127 (void)inbuf;
2128 (void)buflen;
2129 outbuf->m_retres = 0;
2130 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2131 {
2132 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2133 outbuf->m_retres = sceCdCancelPOffRdy(&outbuf->m_pkt_1F.m_status);
2134 }
2135}
2136#endif
2137
2138static void cdvdfsv_rpc3_21_poweroff(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2139{
2140 int i;
2141 u32 efbits;
2142
2143 (void)inbuf;
2144 (void)buflen;
2145
2146 outbuf->m_retres = 0;
2147 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2148 {
2149 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2150 outbuf->m_retres = sceCdPowerOff(&outbuf->m_pkt_21.m_result);
2151 }
2152}
2153
2154#ifdef CDVD_VARIANT_OSD
2155static void
2156cdvdfsv_rpc3_20_blueledctl(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2157{
2158 int i;
2159 u32 efbits;
2160
2161 (void)buflen;
2162 outbuf->m_retres = 0;
2163 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2164 {
2165 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2166 outbuf->m_retres = sceCdBlueLEDCtl(inbuf->m_pkt_20.m_control, &outbuf->m_pkt_20.m_status);
2167 }
2168}
2169#endif
2170
2171#ifdef CDVD_VARIANT_OSD
2172static void
2173cdvdfsv_rpc3_1D_sc_FFFFFFF8(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2174{
2175 (void)buflen;
2176 g_cdvdfsv_spinctl = inbuf->m_pkt_1D.m_spinctl;
2177 outbuf->m_retres = sceCdSC(0xFFFFFFF8, &g_cdvdfsv_spinctl);
2178}
2179#endif
2180
2181static void
2182cdvdfsv_rpc3_15_ctrladout(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2183{
2184 int i;
2185 u32 efbits;
2186
2187 (void)buflen;
2188
2189 outbuf->m_retres = 0;
2190 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2191 {
2192 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2193 outbuf->m_retres = sceCdCtrlADout(inbuf->m_pkt_15.m_mode, &outbuf->m_pkt_15.m_status);
2194 }
2195}
2196
2197#ifdef CDVD_VARIANT_OSD
2198static void
2199cdvdfsv_rpc3_19_autoadjustctrl(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2200{
2201 int i;
2202 u32 efbits;
2203
2204 (void)buflen;
2205 outbuf->m_retres = 0;
2206 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2207 {
2208 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2209 outbuf->m_retres = sceCdAutoAdjustCtrl(inbuf->m_pkt_19.m_mode, &outbuf->m_pkt_19.m_status);
2210 }
2211}
2212#endif
2213
2214#ifdef CDVD_VARIANT_OSD
2215static void
2216cdvdfsv_rpc3_29_readwakeuptime(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2217{
2218 int i;
2219 u32 efbits;
2220
2221 (void)inbuf;
2222 (void)buflen;
2223 outbuf->m_retres = 0;
2224 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2225 {
2226 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2227 outbuf->m_retres = sceCdReadWakeUpTime(
2228 &outbuf->m_pkt_29.m_clock,
2229 &outbuf->m_pkt_29.m_userdata,
2230 &outbuf->m_pkt_29.m_wakeupreason,
2231 &outbuf->m_pkt_29.m_flags);
2232 }
2233}
2234#endif
2235
2236#ifdef CDVD_VARIANT_OSD
2237static void
2238cdvdfsv_rpc3_28_writewakeuptime(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2239{
2240 int i;
2241 u32 efbits;
2242
2243 (void)buflen;
2244 outbuf->m_retres = 0;
2245 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2246 {
2247 // Unofficial: copy to output buffer then use it
2248 memcpy(&outbuf->m_pkt_28.m_clock, &inbuf->m_pkt_28.m_clock, sizeof(sceCdCLOCK));
2249 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2250 outbuf->m_retres =
2251 sceCdWriteWakeUpTime(&outbuf->m_pkt_28.m_clock, inbuf->m_pkt_28.m_userdata, inbuf->m_pkt_28.m_flags);
2252 }
2253}
2254#endif
2255
2256#ifdef CDVD_VARIANT_OSD
2257static void
2258cdvdfsv_rpc3_30_rcbypassctl(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2259{
2260 int i;
2261 u32 efbits;
2262
2263 (void)buflen;
2264 outbuf->m_retres = 0;
2265 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2266 {
2267 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2268 outbuf->m_retres = sceCdRcBypassCtl(inbuf->m_pkt_30.m_mode, &outbuf->m_pkt_30.m_status);
2269 }
2270}
2271#endif
2272
2273#ifdef CDVD_VARIANT_OSD
2274static void
2275cdvdfsv_rpc3_32_sendscmd1d(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2276{
2277 int i;
2278 u32 efbits;
2279
2280 (void)inbuf;
2281 (void)buflen;
2282 outbuf->m_retres = 0;
2283 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2284 {
2285 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2286 outbuf->m_retres = sceCdSendSCmd1D(
2287 (int *)&outbuf->m_pkt_32.m_arg1, &outbuf->m_pkt_32.m_arg2, &outbuf->m_pkt_32.m_arg3, &outbuf->m_pkt_32.m_arg4);
2288 }
2289}
2290#endif
2291
2292#ifdef CDVD_VARIANT_OSD
2293static void
2294cdvdfsv_rpc3_31_remote2_7(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2295{
2296 int i;
2297 u32 efbits;
2298
2299 (void)buflen;
2300 outbuf->m_retres = 0;
2301 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2302 {
2303 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2304 outbuf->m_retres = sceRemote2_7(inbuf->m_pkt_31.m_param, &outbuf->m_pkt_31.m_status);
2305 }
2306}
2307#endif
2308
2309#ifdef CDVD_VARIANT_OSD
2310static void
2311cdvdfsv_rpc3_38_remote2_7_get(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2312{
2313 int i;
2314 u32 efbits;
2315
2316 (void)inbuf;
2317 (void)buflen;
2318 outbuf->m_retres = 0;
2319 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2320 {
2321 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2322 outbuf->m_retres = sceRemote2_7Get(&outbuf->m_pkt_38.m_param, &outbuf->m_pkt_38.m_status);
2323 }
2324}
2325#endif
2326
2327#ifdef CDVD_VARIANT_OSD
2328static void
2329cdvdfsv_rpc3_2A_readps1bootparam(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2330{
2331 int i;
2332 u32 efbits;
2333
2334 (void)inbuf;
2335 (void)buflen;
2336 outbuf->m_retres = 0;
2337 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2338 {
2339 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2340 outbuf->m_retres = sceCdReadPS1BootParam(outbuf->m_pkt_2A.m_out, &outbuf->m_pkt_2A.m_status);
2341 }
2342}
2343#endif
2344
2345#ifdef CDVD_VARIANT_OSD
2346static void
2347cdvdfsv_rpc3_2B_setfanprofile(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2348{
2349 int i;
2350 u32 efbits;
2351
2352 (void)buflen;
2353 outbuf->m_retres = 0;
2354 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2355 {
2356 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2357 outbuf->m_retres = sceCdSetFanProfile(inbuf->m_pkt_2B.m_param, &outbuf->m_pkt_2B.m_status);
2358 }
2359}
2360#endif
2361
2362#ifdef CDVD_VARIANT_OSD
2363static void cdvdfsv_rpc3_2C_i_152(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2364{
2365 int i;
2366 u32 efbits;
2367
2368 (void)inbuf;
2369 (void)buflen;
2370 outbuf->m_retres = 0;
2371 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2372 {
2373 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2374#if 0
2375 // TODO FIXME IMPORT
2376 outbuf->m_retres = cdvdman_152(&outbuf->m_pkt_2C.m_arg1, &outbuf->m_pkt_2C.m_arg2);
2377#else
2378 outbuf->m_retres = 1;
2379#endif
2380 }
2381}
2382#endif
2383
2384#ifdef CDVD_VARIANT_OSD
2385static void
2386cdvdfsv_rpc3_43_readregionparams(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2387{
2388 int i;
2389 u32 efbits;
2390
2391 (void)inbuf;
2392 (void)buflen;
2393 outbuf->m_retres = 0;
2394 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2395 {
2396 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2397 outbuf->m_retres = sceCdReadRegionParams(outbuf->m_pkt_43.m_arg1, &outbuf->m_pkt_43.m_status);
2398 }
2399}
2400#endif
2401
2402#ifdef CDVD_VARIANT_OSD
2403static void
2404cdvdfsv_rpc3_44_writeregionparams(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2405{
2406 int i;
2407 u32 efbits;
2408
2409 (void)buflen;
2410 outbuf->m_retres = 0;
2411 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2412 {
2413 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2414 outbuf->m_retres = sceCdWriteRegionParams(
2415 inbuf->m_pkt_44.m_arg1, (u32 *)inbuf->m_pkt_44.m_arg2, (u8 *)inbuf->m_pkt_44.m_arg3, &outbuf->m_pkt_44.m_status);
2416 }
2417}
2418#endif
2419
2420#ifdef CDVD_VARIANT_XOSD
2421static void
2422cdvdfsv_rpc3_2F_noticegamestart(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2423{
2424 int i;
2425 u32 efbits;
2426
2427 (void)buflen;
2428 outbuf->m_retres = 0;
2429 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2430 {
2431 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2432 outbuf->m_retres = sceCdNoticeGameStart(inbuf->m_pkt_2F.m_arg1, &outbuf->m_pkt_2F.m_status);
2433 }
2434}
2435#endif
2436
2437#ifdef CDVD_VARIANT_OSD
2438static void
2439cdvdfsv_rpc3_35_setledsmode(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2440{
2441 int i;
2442 u32 efbits;
2443
2444 (void)buflen;
2445 outbuf->m_retres = 0;
2446 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2447 {
2448 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2449 outbuf->m_retres = sceCdSetLEDsMode(inbuf->m_pkt_35.m_param, &outbuf->m_pkt_35.m_status);
2450 }
2451}
2452#endif
2453
2454static void
2455cdvdfsv_rpc3_01_readclock(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2456{
2457 int i;
2458 u32 efbits;
2459
2460 (void)inbuf;
2461 (void)buflen;
2462
2463 outbuf->m_retres = 0;
2464 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2465 {
2466 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2467 outbuf->m_retres = sceCdReadClock(&outbuf->m_pkt_01.m_clock);
2468 }
2469}
2470
2471#ifdef CDVD_VARIANT_OSD
2472static void
2473cdvdfsv_rpc3_02_writeclock(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2474{
2475 int i;
2476 u32 efbits;
2477
2478 (void)buflen;
2479
2480 outbuf->m_retres = 0;
2481 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2482 {
2483 // Unofficial: copy to output buffer then use it
2484 memcpy(&outbuf->m_pkt_02.m_clock, &inbuf->m_pkt_02.m_clock, sizeof(sceCdCLOCK));
2485 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2486 outbuf->m_retres = sceCdWriteClock(&outbuf->m_pkt_02.m_clock);
2487 }
2488}
2489#endif
2490
2491#ifdef CDVD_VARIANT_OSD
2492static void cdvdfsv_rpc3_08_readnvm(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2493{
2494 int i;
2495 u32 efbits;
2496
2497 (void)buflen;
2498 outbuf->m_retres = 0;
2499 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2500 {
2501 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2502 // Unofficial: direct to outbuf
2503 outbuf->m_retres = sceCdReadNVM(inbuf->m_pkt_08.m_address, &outbuf->m_pkt_08.m_data, &outbuf->m_pkt_08.m_status);
2504 }
2505 outbuf->m_pkt_08.m_address = inbuf->m_pkt_08.m_address;
2506}
2507#endif
2508
2509#ifdef CDVD_VARIANT_OSD
2510static void cdvdfsv_rpc3_09_writenvm(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2511{
2512 int i;
2513 u32 efbits;
2514
2515 (void)buflen;
2516 outbuf->m_retres = 0;
2517 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2518 {
2519 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2520 outbuf->m_retres = sceCdWriteNVM(inbuf->m_pkt_09.m_address, inbuf->m_pkt_09.m_data, &outbuf->m_pkt_09.m_status);
2521 }
2522 outbuf->m_pkt_09.m_address = inbuf->m_pkt_09.m_address;
2523 outbuf->m_pkt_09.m_data = inbuf->m_pkt_09.m_data;
2524}
2525#endif
2526
2527#ifdef CDVD_VARIANT_OSD
2528static void
2529cdvdfsv_rpc3_0D_sethdmode(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2530{
2531 (void)buflen;
2532 outbuf->m_retres = sceCdSetHDMode(inbuf->m_pkt_0D.m_mode);
2533}
2534#endif
2535
2536#ifdef CDVD_VARIANT_XOSD
2537static void cdvdfsv_rpc3_2E_xledctl(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2538{
2539 int i;
2540 u32 efbits;
2541
2542 (void)buflen;
2543 outbuf->m_retres = 0;
2544 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2545 {
2546 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2547 outbuf->m_retres = sceCdXLEDCtl(
2548 inbuf->m_pkt_2E.m_arg1, inbuf->m_pkt_2E.m_arg2, &outbuf->m_pkt_2E.m_result1, &outbuf->m_pkt_2E.m_result2);
2549 }
2550}
2551#endif
2552
2553#ifdef CDVD_VARIANT_XOSD
2554static void
2555cdvdfsv_rpc3_39_buzzerctl(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2556{
2557 int i;
2558 u32 efbits;
2559
2560 (void)inbuf;
2561 (void)buflen;
2562 outbuf->m_retres = 0;
2563 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2564 {
2565 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2566 outbuf->m_retres = sceCdBuzzerCtl(&outbuf->m_pkt_39.m_status);
2567 }
2568}
2569#endif
2570
2571#ifdef CDVD_VARIANT_XOSD
2572static void
2573cdvdfsv_rpc3_3A_resetwakeupreason(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2574{
2575 int i;
2576 u32 efbits;
2577
2578 (void)buflen;
2579 outbuf->m_retres = 0;
2580 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2581 {
2582 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2583#if 0
2584 // TODO FIXME IMPORT
2585 outbuf->m_retres = sceCdResetWakeupReason((u32 *)inbuf, &outbuf->m_pkt_3A.m_arg2);
2586#else
2587 (void)inbuf;
2588 outbuf->m_retres = 1;
2589#endif
2590 }
2591}
2592#endif
2593
2594#ifdef CDVD_VARIANT_XOSD
2595static void cdvdfsv_rpc3_3B_i_169(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2596{
2597 int i;
2598 u32 efbits;
2599
2600 (void)inbuf;
2601 (void)buflen;
2602 outbuf->m_retres = 0;
2603 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2604 {
2605 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2606#if 0
2607 // TODO FIXME IMPORT
2608 outbuf->m_retres = cdvdman_169(&outbuf->m_pkt_3B.m_arg1, &outbuf->m_pkt_3B.m_arg2);
2609#else
2610 outbuf->m_retres = 1;
2611#endif
2612 }
2613}
2614#endif
2615
2616#ifdef CDVD_VARIANT_XOSD
2617static void
2618cdvdfsv_rpc3_3C_xbspowerctl(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2619{
2620 int i;
2621 u32 efbits;
2622
2623 (void)buflen;
2624 outbuf->m_retres = 0;
2625 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2626 {
2627 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2628 outbuf->m_retres = sceCdXBSPowerCtl(
2629 inbuf->m_pkt_3C.m_arg1, inbuf->m_pkt_3C.m_arg2, &outbuf->m_pkt_3C.m_result1, &outbuf->m_pkt_3C.m_result2);
2630 }
2631}
2632#endif
2633
2634#ifdef CDVD_VARIANT_XOSD
2635static void
2636cdvdfsv_rpc3_3D_setmediumremoval(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2637{
2638 int i;
2639 u32 efbits;
2640
2641 (void)buflen;
2642 outbuf->m_retres = 0;
2643 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2644 {
2645 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2646 outbuf->m_retres = sceCdSetMediumRemoval(inbuf->m_pkt_3D.m_arg1, &outbuf->m_pkt_3D.m_status);
2647 }
2648}
2649#endif
2650
2651#ifdef CDVD_VARIANT_XOSD
2652static void
2653cdvdfsv_rpc3_3E_getmediumremoval(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2654{
2655 int i;
2656 u32 efbits;
2657
2658 (void)inbuf;
2659 (void)buflen;
2660 outbuf->m_retres = 0;
2661 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2662 {
2663 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2664 outbuf->m_retres = sceCdGetMediumRemoval(&outbuf->m_pkt_3E.m_result1, &outbuf->m_pkt_3E.m_result2);
2665 }
2666}
2667#endif
2668
2669#ifdef CDVD_VARIANT_XOSD
2670static void
2671cdvdfsv_rpc3_3F_xdvrpreset(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2672{
2673 int i;
2674 u32 efbits;
2675
2676 (void)buflen;
2677 outbuf->m_retres = 0;
2678 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2679 {
2680 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2681 outbuf->m_retres = sceCdXDVRPReset(inbuf->m_pkt_3F.m_arg1, &outbuf->m_pkt_3F.m_status);
2682 }
2683}
2684#endif
2685
2686#ifdef CDVD_VARIANT_XOSD
2687static void
2688cdvdfsv_rpc3_40_getwakeupreason(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2689{
2690 (void)inbuf;
2691 (void)buflen;
2692 outbuf->m_retres = sceCdGetWakeUpReason();
2693}
2694#endif
2695
2696#ifdef CDVD_VARIANT_OSD
2697static void
2698cdvdfsv_rpc3_0E_openconfig(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2699{
2700 int i;
2701 u32 efbits;
2702
2703 (void)buflen;
2704 outbuf->m_retres = 0;
2705 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2706 {
2707 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2708 outbuf->m_retres = sceCdOpenConfig(
2709 inbuf->m_pkt_0E.m_block, inbuf->m_pkt_0E.m_mode, inbuf->m_pkt_0E.m_NumBlocks, &outbuf->m_pkt_0E.m_status);
2710 }
2711}
2712#endif
2713
2714#ifdef CDVD_VARIANT_OSD
2715static void
2716cdvdfsv_rpc3_0F_closeconfig(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2717{
2718 int i;
2719 u32 efbits;
2720
2721 (void)inbuf;
2722 (void)buflen;
2723 outbuf->m_retres = 0;
2724 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2725 {
2726 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2727 outbuf->m_retres = sceCdCloseConfig(&outbuf->m_pkt_0F.m_status);
2728 }
2729}
2730#endif
2731
2732#ifdef CDVD_VARIANT_OSD
2733static void
2734cdvdfsv_rpc3_10_readconfig(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2735{
2736 int i;
2737 u32 efbits;
2738
2739 (void)inbuf;
2740 (void)buflen;
2741 outbuf->m_retres = 0;
2742 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2743 {
2744 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2745 outbuf->m_retres = sceCdReadConfig(outbuf->m_pkt_10.m_buffer, &outbuf->m_pkt_10.m_status);
2746 }
2747}
2748#endif
2749
2750#ifdef CDVD_VARIANT_OSD
2751static void
2752cdvdfsv_rpc3_11_writeconfig(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2753{
2754 int i;
2755 u32 efbits;
2756
2757 (void)buflen;
2758 outbuf->m_retres = 0;
2759 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2760 {
2761 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2762 outbuf->m_retres = sceCdWriteConfig(inbuf->m_pkt_11.m_buffer, &outbuf->m_pkt_11.m_status);
2763 }
2764}
2765#endif
2766
2767#ifdef CDVD_VARIANT_DNAS
2768static void
2769cdvdfsv_rpc5_11_readdiskid(const cdvdfsv_rpc5_inpacket_t *inbuf, int buflen, cdvdfsv_rpc5_outpacket_t *outbuf)
2770{
2771 (void)inbuf;
2772 (void)buflen;
2773
2774 outbuf->m_retres = sceCdReadDiskID((unsigned int *)&(outbuf->m_pkt_11.m_diskid));
2775}
2776
2777static void
2778cdvdfsv_rpc5_17_doesuniquekeyexist(const cdvdfsv_rpc5_inpacket_t *inbuf, int buflen, cdvdfsv_rpc5_outpacket_t *outbuf)
2779{
2780 (void)inbuf;
2781 (void)buflen;
2782
2783 outbuf->m_retres = sceCdDoesUniqueKeyExist(&outbuf->m_pkt_17.m_status);
2784}
2785#endif
2786
2787#ifdef CDVD_VARIANT_OSD
2788static void cdvdfsv_rpc5_0B_dg(const cdvdfsv_rpc5_inpacket_t *inbuf, int buflen, cdvdfsv_rpc5_outpacket_t *outbuf)
2789{
2790 (void)buflen;
2791 // Unofficial: write directly to output buffer
2792 outbuf->m_retres = sceCdReadKey(
2793 inbuf->m_pkt_0B.m_arg1, inbuf->m_pkt_0B.m_arg2, inbuf->m_pkt_0B.m_command, (u8 *)outbuf->m_pkt_0B.m_dg_buf);
2794}
2795#endif
2796
2797#ifdef CDVD_VARIANT_OSD
2798static void cdvdfsv_rpc3_0A_decset(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2799{
2800 (void)buflen;
2801 outbuf->m_retres =
2802 sceCdDecSet(inbuf->m_pkt_0A.m_enable_xor, inbuf->m_pkt_0A.m_enable_shift, inbuf->m_pkt_0A.m_shiftval);
2803}
2804#endif
2805
2806static void
2807cdvdfsv_rpc3_0B_applyscmd(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2808{
2809 (void)buflen;
2810
2811 sceCdApplySCmd(
2812 inbuf->m_pkt_0B.m_cmdNum, &inbuf->m_pkt_0B.m_inBuff, inbuf->m_pkt_0B.m_inBuffSize, &(outbuf->m_pkt_0B.m_outbuf));
2813}
2814
2815static void
2816cdvdfsv_rpc5_0C_applyncmd(const cdvdfsv_rpc5_inpacket_t *inbuf, int buflen, cdvdfsv_rpc5_outpacket_t *outbuf)
2817{
2818 (void)buflen;
2819
2820 outbuf->m_retres = sceCdApplyNCmd(inbuf->m_pkt_0C.m_cmdNum, &inbuf->m_pkt_0C.m_inBuff, inbuf->m_pkt_0C.m_inBuffSize);
2821 sceCdSync(2);
2822}
2823
2824static void cdvdfsv_rpc3_04_geterror(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2825{
2826 (void)inbuf;
2827 (void)buflen;
2828
2829 outbuf->m_retres = sceCdGetError();
2830}
2831
2832static void cdvdfsv_rpc3_05_trayreq(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2833{
2834 int i;
2835 u32 efbits;
2836
2837 (void)buflen;
2838
2839 outbuf->m_retres = 0;
2840 for ( i = 0; i < 3 && !outbuf->m_retres; i += 1 )
2841 {
2842 WaitEventFlag(g_scmd_evfid, 1, WEF_AND, &efbits);
2843 outbuf->m_retres = sceCdTrayReq(inbuf->m_pkt_05.m_param, &outbuf->m_pkt_05.m_traychk);
2844 }
2845}
2846
2847static void
2848cdvdfsv_rpc3_25_settimeout(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2849{
2850 (void)buflen;
2851
2852 outbuf->m_retres = sceCdSetTimeout(inbuf->m_pkt_25.m_param, inbuf->m_pkt_25.m_timeout);
2853}
2854
2855static void
2856cdvdfsv_rpc3_27_readdvddualinfo(const cdvdfsv_rpc3_inpacket_t *inbuf, int buflen, cdvdfsv_rpc3_outpacket_t *outbuf)
2857{
2858 (void)inbuf;
2859 (void)buflen;
2860
2861 outbuf->m_retres = sceCdReadDvdDualInfo(&outbuf->m_pkt_27.m_on_dual, &outbuf->m_pkt_27.m_layer1_start);
2862}
2863
2864static int cdvdfsv_rpc5_0E_diskready(void)
2865{
2866 int is_detecting;
2867 int scres_unused;
2868
2869 is_detecting = 0;
2870 // The following printf was added for ioprp300x
2871 VERBOSE_PRINTF(1, "sceCdNcmddiskready call\n");
2872 // The following call to sceCdGetDiskType was inlined
2873 switch ( sceCdGetDiskType() )
2874 {
2875 case SCECdDETCT:
2876 case SCECdDETCTCD:
2877 case SCECdDETCTDVDS:
2878 case SCECdDETCTDVDD:
2879 is_detecting = 1;
2880 break;
2881 default:
2882 break;
2883 }
2884 // The following call to sceCdDiskReady was inlined
2885 if (
2886 (sceCdDiskReady(8) & 0xC0) != 0x40 || sceCdSC(0xFFFFFFFD, &scres_unused) || !sceCdSC(0xFFFFFFF4, &scres_unused)
2887 || is_detecting )
2888 {
2889 VERBOSE_PRINTF(1, "Drive Not Ready\n");
2890 return 6;
2891 }
2892 // The following printf was added for ioprp300x
2893 VERBOSE_PRINTF(1, "sceCdNcmddiskready call OKend\n");
2894 return 2;
2895}
2896
2897static void *cbrpc_rpc5_cdvdncmds(int fno, void *buffer, int length)
2898{
2899 int scres_unused;
2900 int fno_1;
2901
2902 fno_1 = fno;
2903 // Note: in ioprp300x, the following was changed from printf to Kprintf
2904 VERBOSE_KPRINTF(1, "sce_cdvd N cmd start %d\n", fno);
2905 g_cdvdfsv_rpc5flg = 1;
2906 sceCdSC(0xFFFFFFF6, &fno_1);
2907 switch ( fno )
2908 {
2909 case 1:
2910 // The following call to sceCdGetDiskType was inlined
2911 cdvdfsv_rpc5_01_readee(
2912 buffer, length, &g_crr, !(sceCdGetDiskType() ^ SCECdPS2DVD), !sceCdSC(0xFFFFFFFC, &scres_unused), 0);
2913 break;
2914 case 2:
2915 cdvdfsv_rpc5_02_readcdda(buffer, length, &g_crr, 0);
2916 break;
2917#ifdef CDVD_VARIANT_OSD
2918 case 3:
2919 cdvdfsv_rpc5_03_readdvdv(buffer, length, &g_crr);
2920 break;
2921#endif
2922 case 4:
2923 cdvdfsv_rpc5_04_gettoc(buffer, length, &g_crr);
2924 break;
2925 case 5:
2926 VERBOSE_PRINTF(1, "Call Seek lsn= %d\n", (int)(((const cdvdfsv_rpc5_inpacket_t *)buffer)->m_pkt_05.m_lbn));
2927 g_crr.m_retres = sceCdSeek(((const cdvdfsv_rpc5_inpacket_t *)buffer)->m_pkt_05.m_lbn);
2928 VERBOSE_PRINTF(1, "Call Seek end\n");
2929 sceCdSync(6);
2930 break;
2931 case 6:
2932 VERBOSE_PRINTF(1, "Call Standby\n");
2933 g_crr.m_retres = sceCdStandby();
2934 sceCdSync(4);
2935 VERBOSE_PRINTF(1, "Call Standby called\n");
2936 break;
2937 case 7:
2938 VERBOSE_PRINTF(1, "Call Stop\n");
2939 g_crr.m_retres = sceCdStop();
2940 sceCdSync(4);
2941 break;
2942 case 8:
2943 VERBOSE_PRINTF(1, "Call Pause\n");
2944 g_crr.m_retres = sceCdPause();
2945 sceCdSync(6);
2946 break;
2947 case 9:
2948 if ( devctl("cdrom_stm0:", 0x4396, buffer, length, &g_crr.m_retres, sizeof(g_crr.m_retres)) < 0 )
2949 g_crr.m_retres = 0;
2950 break;
2951 case 10:
2952 if ( devctl("cdrom_stm0:", 0x4398, buffer, length, &g_crr.m_retres, sizeof(g_crr.m_retres)) < 0 )
2953 g_crr.m_retres = 0;
2954 break;
2955#ifdef CDVD_VARIANT_OSD
2956 case 11:
2957 cdvdfsv_rpc5_0B_dg(buffer, length, &g_crr);
2958 break;
2959#endif
2960 case 12:
2961 cdvdfsv_rpc5_0C_applyncmd(buffer, length, &g_crr);
2962 break;
2963 case 13:
2964 cdvdfsv_rpc5_0D_iopmread(buffer, length, &g_crr);
2965 break;
2966 case 14:
2967 g_crr.m_retres = cdvdfsv_rpc5_0E_diskready();
2968 break;
2969 case 15:
2970 cdvdfsv_rpc5_0F_readchain(buffer, length, &g_crr);
2971 break;
2972#ifdef CDVD_VARIANT_OSD
2973 case 16:
2974 cdvdfsv_rpc5_02_readcdda(buffer, length, &g_crr, 1);
2975 break;
2976#endif
2977#ifdef CDVD_VARIANT_DNAS
2978 case 17:
2979 cdvdfsv_rpc5_11_readdiskid(buffer, length, &g_crr);
2980 break;
2981#endif
2982 case 19:
2983 // The following call to sceCdGetDiskType was inlined
2984 cdvdfsv_rpc5_01_readee(
2985 buffer, length, &g_crr, !(sceCdGetDiskType() ^ SCECdPS2DVD), 1, !g_cdvdman_istruct_ptr->m_no_dec_flag);
2986 break;
2987#ifdef CDVD_VARIANT_DNAS
2988 case 23:
2989 cdvdfsv_rpc5_17_doesuniquekeyexist(buffer, length, &g_crr);
2990 break;
2991#endif
2992 default:
2993 VERBOSE_PRINTF(1, "sce_cdvd no block IO :unrecognized code %x\n", fno);
2994 g_crr.m_retres = 0;
2995 break;
2996 }
2997 fno_1 = 0;
2998 sceCdSC(0xFFFFFFF6, &fno_1);
2999 g_cdvdfsv_rpc5flg = 0;
3000 // Note: in ioprp300x, the following was changed from printf to Kprintf
3001 VERBOSE_KPRINTF(1, "sce_cdvd N cmd end\n");
3002 return (void *)&g_crr;
3003}
3004
3005// cppcheck-suppress constParameterCallback
3006static void *cbrpc_rpc3_cdvdscmds(int fno, void *buffer, int length)
3007{
3008 VERBOSE_PRINTF(1, "sce_cdvd S cmd start %d\n", fno);
3009 g_cdvdfsv_rpc3flg = 1;
3010 switch ( fno )
3011 {
3012 case 1:
3013 cdvdfsv_rpc3_01_readclock(buffer, length, &g_outbuf);
3014 break;
3015#ifdef CDVD_VARIANT_OSD
3016 case 2:
3017 cdvdfsv_rpc3_02_writeclock(buffer, length, &g_outbuf);
3018 break;
3019#endif
3020 case 3:
3021 cdvdfsv_rpc3_03_disktype(buffer, length, &g_outbuf);
3022 break;
3023 case 4:
3024 cdvdfsv_rpc3_04_geterror(buffer, length, &g_outbuf);
3025 break;
3026 case 5:
3027 cdvdfsv_rpc3_05_trayreq(buffer, length, &g_outbuf);
3028 break;
3029 case 6:
3030 cdvdfsv_rpc3_06_ri(buffer, length, &g_outbuf);
3031 break;
3032#ifdef CDVD_VARIANT_OSD
3033 // Not in XOSD or DVD Player 3.11
3034 case 7:
3035 cdvdfsv_rpc3_07_wi(buffer, length, &g_outbuf);
3036 break;
3037 case 8:
3038 cdvdfsv_rpc3_08_readnvm(buffer, length, &g_outbuf);
3039 break;
3040 case 9:
3041 cdvdfsv_rpc3_09_writenvm(buffer, length, &g_outbuf);
3042 break;
3043 case 10:
3044 cdvdfsv_rpc3_0A_decset(buffer, length, &g_outbuf);
3045 break;
3046#endif
3047 case 11:
3048 cdvdfsv_rpc3_0B_applyscmd(buffer, length, &g_outbuf);
3049 break;
3050 case 12:
3051 cdvdfsv_rpc3_0C_cdstatus(buffer, length, &g_outbuf);
3052 break;
3053#ifdef CDVD_VARIANT_OSD
3054 case 13:
3055 cdvdfsv_rpc3_0D_sethdmode(buffer, length, &g_outbuf);
3056 break;
3057 case 14:
3058 cdvdfsv_rpc3_0E_openconfig(buffer, length, &g_outbuf);
3059 break;
3060 case 15:
3061 cdvdfsv_rpc3_0F_closeconfig(buffer, length, &g_outbuf);
3062 break;
3063 case 16:
3064 cdvdfsv_rpc3_10_readconfig(buffer, length, &g_outbuf);
3065 break;
3066 case 17:
3067 cdvdfsv_rpc3_11_writeconfig(buffer, length, &g_outbuf);
3068 break;
3069 case 18:
3070 cdvdfsv_rpc3_12_readconsoleid(buffer, length, &g_outbuf);
3071 break;
3072 // Not in XOSD or DVD Player 3.11
3073 case 19:
3074 cdvdfsv_rpc3_13_writeconsoleid(buffer, length, &g_outbuf);
3075 break;
3076 case 20:
3077 cdvdfsv_rpc3_14_getmversion(buffer, length, &g_outbuf);
3078 break;
3079#endif
3080 case 21:
3081 cdvdfsv_rpc3_15_ctrladout(buffer, length, &g_outbuf);
3082 break;
3083 case 22:
3084 cdvdfsv_rpc3_16_break(buffer, length, &g_outbuf);
3085 break;
3086#ifdef CDVD_VARIANT_OSD
3087 case 23:
3088 cdvdfsv_rpc3_17_readsubq(buffer, length, &g_outbuf);
3089 break;
3090 case 24:
3091 cdvdfsv_rpc3_18_forbiddvdp(buffer, length, &g_outbuf);
3092 break;
3093 case 25:
3094 cdvdfsv_rpc3_19_autoadjustctrl(buffer, length, &g_outbuf);
3095 break;
3096#endif
3097 case 26:
3098 cdvdfsv_rpc3_1A_rm(buffer, length, &g_outbuf);
3099 break;
3100#ifdef CDVD_VARIANT_OSD
3101 // Not in XOSD or DVD Player 3.11
3102 case 27:
3103 cdvdfsv_rpc3_1B_wm(buffer, length, &g_outbuf);
3104 break;
3105 case 28:
3106 cdvdfsv_rpc3_1C_forbidread(buffer, length, &g_outbuf);
3107 break;
3108 case 29:
3109 cdvdfsv_rpc3_1D_sc_FFFFFFF8(buffer, length, &g_outbuf);
3110 break;
3111 case 30:
3112 cdvdfsv_rpc3_1E_bootcertify(buffer, length, &g_outbuf);
3113 break;
3114 case 31:
3115 cdvdfsv_rpc3_1F_cancelpoffrdy(buffer, length, &g_outbuf);
3116 break;
3117 case 32:
3118 cdvdfsv_rpc3_20_blueledctl(buffer, length, &g_outbuf);
3119 break;
3120#endif
3121 case 33:
3122 cdvdfsv_rpc3_21_poweroff(buffer, length, &g_outbuf);
3123 break;
3124 case 34:
3125 cdvdfsv_rpc3_22_mmode(buffer, length, &g_outbuf);
3126 break;
3127 case 35:
3128 cdvdfsv_rpc3_23_changethreadpriority(buffer, length, &g_outbuf);
3129 break;
3130#ifdef CDVD_VARIANT_DNAS
3131 case 36:
3132 cdvdfsv_rpc3_24_readguid(buffer, length, &g_outbuf);
3133 break;
3134#endif
3135 case 37:
3136 cdvdfsv_rpc3_25_settimeout(buffer, length, &g_outbuf);
3137 break;
3138#ifdef CDVD_VARIANT_DNAS
3139 case 38:
3140 cdvdfsv_rpc3_26_readmodelid(buffer, length, &g_outbuf);
3141 break;
3142#endif
3143 case 39:
3144 cdvdfsv_rpc3_27_readdvddualinfo(buffer, length, &g_outbuf);
3145 break;
3146#ifdef CDVD_VARIANT_OSD
3147 case 40:
3148 cdvdfsv_rpc3_28_writewakeuptime(buffer, length, &g_outbuf);
3149 break;
3150 case 41:
3151 cdvdfsv_rpc3_29_readwakeuptime(buffer, length, &g_outbuf);
3152 break;
3153 case 42:
3154 cdvdfsv_rpc3_2A_readps1bootparam(buffer, length, &g_outbuf);
3155 break;
3156 case 43:
3157 cdvdfsv_rpc3_2B_setfanprofile(buffer, length, &g_outbuf);
3158 break;
3159 case 44:
3160 cdvdfsv_rpc3_2C_i_152(buffer, length, &g_outbuf);
3161 break;
3162#endif
3163#ifdef CDVD_VARIANT_XOSD
3164 case 45:
3165 cdvdfsv_rpc3_2D_chgsys(buffer, length, &g_outbuf);
3166 break;
3167 case 46:
3168 cdvdfsv_rpc3_2E_xledctl(buffer, length, &g_outbuf);
3169 break;
3170 case 47:
3171 cdvdfsv_rpc3_2F_noticegamestart(buffer, length, &g_outbuf);
3172 break;
3173#endif
3174#ifdef CDVD_VARIANT_OSD
3175 case 48:
3176 cdvdfsv_rpc3_30_rcbypassctl(buffer, length, &g_outbuf);
3177 break;
3178 case 49:
3179 cdvdfsv_rpc3_31_remote2_7(buffer, length, &g_outbuf);
3180 break;
3181 case 50:
3182 cdvdfsv_rpc3_32_sendscmd1d(buffer, length, &g_outbuf);
3183 break;
3184 case 53:
3185 cdvdfsv_rpc3_35_setledsmode(buffer, length, &g_outbuf);
3186 break;
3187 case 56:
3188 cdvdfsv_rpc3_38_remote2_7_get(buffer, length, &g_outbuf);
3189 break;
3190#endif
3191#ifdef CDVD_VARIANT_XOSD
3192 case 57:
3193 cdvdfsv_rpc3_39_buzzerctl(buffer, length, &g_outbuf);
3194 break;
3195 case 58:
3196 cdvdfsv_rpc3_3A_resetwakeupreason(buffer, length, &g_outbuf);
3197 break;
3198 case 59:
3199 cdvdfsv_rpc3_3B_i_169(buffer, length, &g_outbuf);
3200 break;
3201 case 60:
3202 cdvdfsv_rpc3_3C_xbspowerctl(buffer, length, &g_outbuf);
3203 break;
3204 case 61:
3205 cdvdfsv_rpc3_3D_setmediumremoval(buffer, length, &g_outbuf);
3206 break;
3207 case 62:
3208 cdvdfsv_rpc3_3E_getmediumremoval(buffer, length, &g_outbuf);
3209 break;
3210 case 63:
3211 cdvdfsv_rpc3_3F_xdvrpreset(buffer, length, &g_outbuf);
3212 break;
3213 case 64:
3214 cdvdfsv_rpc3_40_getwakeupreason(buffer, length, &g_outbuf);
3215 break;
3216#endif
3217#ifdef CDVD_VARIANT_OSD
3218 case 67:
3219 cdvdfsv_rpc3_43_readregionparams(buffer, length, &g_outbuf);
3220 break;
3221 // Not in XOSD or DVD Player 3.11
3222 case 68:
3223 cdvdfsv_rpc3_44_writeregionparams(buffer, length, &g_outbuf);
3224 break;
3225#endif
3226 default:
3227 VERBOSE_PRINTF(1, "sce_cdvd block IO :unrecognized code 0x%02x\n", fno);
3228 g_outbuf.m_retres = 0;
3229 break;
3230 }
3231 VERBOSE_PRINTF(1, "sce_cdvd S cmd end\n");
3232 g_cdvdfsv_rpc3flg = 0;
3233 return (void *)&g_outbuf;
3234}
3235
3236static void cdvdfsv_poffloop(void)
3237{
3238 int trid;
3239 char cmdpkt[16];
3240 int scres;
3241 u32 efbits;
3242
3243 g_cdvdman_intr_evfid = sceCdSC(0xFFFFFFF5, &scres);
3244 while ( 1 )
3245 {
3246 ClearEventFlag(g_cdvdman_intr_evfid, ~4);
3247 WaitEventFlag(g_cdvdman_intr_evfid, 4, WEF_AND, &efbits);
3248 if ( g_cdvdfsv_nopocm )
3249 break;
3250 if ( !g_cdvdfsv_plbreak )
3251 {
3252 while ( 1 )
3253 {
3254 trid = sceSifSendCmd(0x80000012, cmdpkt, sizeof(cmdpkt), 0, 0, 0);
3255 if ( trid )
3256 break;
3257 DelayThread(500);
3258 }
3259 while ( cdvdfsv_checkdmastat(trid) >= 0 )
3260 ;
3261 }
3262 }
3263}
3264
3265#ifdef CDVD_VARIANT_OSD
3266static void cdvdfsv_rpc4_th(void *arg)
3267{
3268 int trid;
3269 char cmdpkt[16];
3270 int scres;
3271 u32 efbits;
3272
3273 (void)arg;
3274 g_cdvdman_intr_evfid = sceCdSC(0xFFFFFFF5, &scres);
3275 while ( 1 )
3276 {
3277 ClearEventFlag(g_cdvdman_intr_evfid, ~0x40);
3278 WaitEventFlag(g_cdvdman_intr_evfid, 0x40, WEF_AND, &efbits);
3279 if ( g_cdvdfsv_nopocm )
3280 break;
3281 if ( !g_cdvdfsv_plbreak )
3282 {
3283 while ( 1 )
3284 {
3285 trid = sceSifSendCmd(0x80000015, cmdpkt, sizeof(cmdpkt), 0, 0, 0);
3286 if ( trid )
3287 break;
3288 DelayThread(500);
3289 }
3290 while ( cdvdfsv_checkdmastat(trid) >= 0 )
3291 ;
3292 }
3293 }
3294 ExitDeleteThread();
3295}
3296#endif
3297
3298#ifdef CDVD_VARIANT_OSD
3299static void cdvdfsv_rpc5_th(void *arg)
3300{
3301 int trid;
3302 char cmdpkt[16];
3303 int scres;
3304 u32 efbits;
3305
3306 (void)arg;
3307 g_cdvdman_intr_evfid = sceCdSC(0xFFFFFFF5, &scres);
3308 while ( 1 )
3309 {
3310 ClearEventFlag(g_cdvdman_intr_evfid, ~0x80);
3311 WaitEventFlag(g_cdvdman_intr_evfid, 0x80, WEF_AND, &efbits);
3312 if ( g_cdvdfsv_nopocm )
3313 break;
3314 if ( !g_cdvdfsv_plbreak )
3315 {
3316 while ( 1 )
3317 {
3318 trid = sceSifSendCmd(0x80000016, cmdpkt, sizeof(cmdpkt), 0, 0, 0);
3319 if ( trid )
3320 break;
3321 DelayThread(500);
3322 }
3323 while ( cdvdfsv_checkdmastat(trid) >= 0 )
3324 ;
3325 }
3326 }
3327 ExitDeleteThread();
3328}
3329#endif
3330
3331static void cdvdfsv_rpc1_th(void *arg)
3332{
3333 (void)arg;
3334
3335 sceSifSetRpcQueue(&g_rpc_qdata1, GetThreadId());
3336 sceSifRegisterRpc(&g_rpc_sdata1, 0x80000592, cbrpc_rpc1_cdinit, g_rpc_buffer1, 0, 0, &g_rpc_qdata1);
3337 sceSifRegisterRpc(&g_rpc_sdata2, 0x8000059A, cbrpc_rpc2_diskready, g_rpc_buffer2, 0, 0, &g_rpc_qdata1);
3338 sceSifRegisterRpc(&g_rpc_sdata3, 0x80000593, cbrpc_rpc3_cdvdscmds, g_rpc_buffer3, 0, 0, &g_rpc_qdata1);
3339 sceSifRpcLoop(&g_rpc_qdata1);
3340 ExitDeleteThread();
3341}
3342
3343static void cdvdfsv_rpc3_th(void *arg)
3344{
3345 (void)arg;
3346
3347 sceSifSetRpcQueue(&g_rpc_qdata3, GetThreadId());
3348 sceSifRegisterRpc(&g_rpc_sdata6, 0x8000059C, cbrpc_rpc2_diskready, g_rpc_buffer2, 0, 0, &g_rpc_qdata3);
3349 sceSifRpcLoop(&g_rpc_qdata3);
3350 ExitDeleteThread();
3351}
3352
3353static void cdvdfsv_rpc2_th(void *arg)
3354{
3355 (void)arg;
3356
3357 sceSifSetRpcQueue(&g_rpc_qdata2, GetThreadId());
3358 sceSifRegisterRpc(&g_rpc_sdata4, 0x80000597, cbrpc_rpc4_fscall, g_rpc_buffer4, 0, 0, &g_rpc_qdata2);
3359 sceSifRegisterRpc(&g_rpc_sdata5, 0x80000595, cbrpc_rpc5_cdvdncmds, g_rpc_buffer5, 0, 0, &g_rpc_qdata2);
3360 sceSifRpcLoop(&g_rpc_qdata2);
3361 ExitDeleteThread();
3362}
3363
3364// Unofficial: unused obfuscation code was removed
3365
3366// clang-format off
3367__asm__ (
3368 "\t" ".set push" "\n"
3369 "\t" ".set noat" "\n"
3370 "\t" ".set noreorder" "\n"
3371 "\t" ".global optimized_memcpy" "\n"
3372 "\t" "optimized_memcpy:" "\n"
3373 "\t" " srl $a3, $a2, 2" "\n"
3374 "\t" " beqz $a3, .Loptimized_memcpy_12" "\n"
3375 "\t" " or $a3, $a0, $a1" "\n"
3376 "\t" " andi $a3, $a3, 0x3" "\n"
3377 "\t" " bnez $a3, .Loptimized_memcpy_3" "\n"
3378 "\t" " nop" "\n"
3379 "\t" " srl $a3, $a2, 2" "\n"
3380 "\t" " addiu $at, $zero, 0xC" "\n"
3381 "\t" " div $zero, $a3, $at" "\n"
3382 "\t" " mflo $a3" "\n"
3383 "\t" " mfhi $v1" "\n"
3384 "\t" " beqz $v1, .Loptimized_memcpy_2" "\n"
3385 "\t" " nop" "\n"
3386 "\t" ".Loptimized_memcpy_1:" "\n"
3387 "\t" " lw $v0, 0x0($a1)" "\n"
3388 "\t" " addiu $v1, $v1, -0x1" "\n"
3389 "\t" " sw $v0, 0x0($a0)" "\n"
3390 "\t" " addiu $a1, $a1, 0x4" "\n"
3391 "\t" " bnez $v1, .Loptimized_memcpy_1" "\n"
3392 "\t" " addiu $a0, $a0, 0x4" "\n"
3393 "\t" " beqz $a3, .Loptimized_memcpy_12" "\n"
3394 "\t" " nop" "\n"
3395 "\t" ".Loptimized_memcpy_2:" "\n"
3396 "\t" " lw $v0, 0x0($a1)" "\n"
3397 "\t" " lw $v1, 0x4($a1)" "\n"
3398 "\t" " lw $t0, 0x8($a1)" "\n"
3399 "\t" " lw $t1, 0xC($a1)" "\n"
3400 "\t" " lw $t2, 0x10($a1)" "\n"
3401 "\t" " lw $t3, 0x14($a1)" "\n"
3402 "\t" " lw $t4, 0x18($a1)" "\n"
3403 "\t" " lw $t5, 0x1C($a1)" "\n"
3404 "\t" " lw $t6, 0x20($a1)" "\n"
3405 "\t" " lw $t7, 0x24($a1)" "\n"
3406 "\t" " lw $t8, 0x28($a1)" "\n"
3407 "\t" " lw $t9, 0x2C($a1)" "\n"
3408 "\t" " addiu $a3, $a3, -0x1" "\n"
3409 "\t" " sw $v0, 0x0($a0)" "\n"
3410 "\t" " sw $v1, 0x4($a0)" "\n"
3411 "\t" " sw $t0, 0x8($a0)" "\n"
3412 "\t" " sw $t1, 0xC($a0)" "\n"
3413 "\t" " sw $t2, 0x10($a0)" "\n"
3414 "\t" " sw $t3, 0x14($a0)" "\n"
3415 "\t" " sw $t4, 0x18($a0)" "\n"
3416 "\t" " sw $t5, 0x1C($a0)" "\n"
3417 "\t" " sw $t6, 0x20($a0)" "\n"
3418 "\t" " sw $t7, 0x24($a0)" "\n"
3419 "\t" " sw $t8, 0x28($a0)" "\n"
3420 "\t" " sw $t9, 0x2C($a0)" "\n"
3421 "\t" " addiu $a1, $a1, 0x30" "\n"
3422 "\t" " bnez $a3, .Loptimized_memcpy_2" "\n"
3423 "\t" " addiu $a0, $a0, 0x30" "\n"
3424 "\t" " j .Loptimized_memcpy_12" "\n"
3425 "\t" " nop" "\n"
3426 "\t" ".Loptimized_memcpy_3:" "\n"
3427 "\t" " andi $a3, $a0, 0x3" "\n"
3428 "\t" " beqz $a3, .Loptimized_memcpy_6" "\n"
3429 "\t" " andi $a3, $a1, 0x3" "\n"
3430 "\t" " beqz $a3, .Loptimized_memcpy_6" "\n"
3431 "\t" " nop" "\n"
3432 "\t" " srl $a3, $a2, 2" "\n"
3433 "\t" " addiu $at, $zero, 0xC" "\n"
3434 "\t" " div $zero, $a3, $at" "\n"
3435 "\t" " mflo $a3" "\n"
3436 "\t" " mfhi $v1" "\n"
3437 "\t" " beqz $v1, .Loptimized_memcpy_5" "\n"
3438 "\t" " nop" "\n"
3439 "\t" ".Loptimized_memcpy_4:" "\n"
3440 "\t" " lwl $v0, 0x3($a1)" "\n"
3441 "\t" " lwr $v0, 0x0($a1)" "\n"
3442 "\t" " addiu $v1, $v1, -0x1" "\n"
3443 "\t" " swl $v0, 0x3($a0)" "\n"
3444 "\t" " swr $v0, 0x0($a0)" "\n"
3445 "\t" " addiu $a1, $a1, 0x4" "\n"
3446 "\t" " bnez $v1, .Loptimized_memcpy_4" "\n"
3447 "\t" " addiu $a0, $a0, 0x4" "\n"
3448 "\t" " beqz $a3, .Loptimized_memcpy_12" "\n"
3449 "\t" " nop" "\n"
3450 "\t" ".Loptimized_memcpy_5:" "\n"
3451 "\t" " lwl $v0, 0x3($a1)" "\n"
3452 "\t" " lwr $v0, 0x0($a1)" "\n"
3453 "\t" " lwl $v1, 0x7($a1)" "\n"
3454 "\t" " lwr $v1, 0x4($a1)" "\n"
3455 "\t" " lwl $t0, 0xB($a1)" "\n"
3456 "\t" " lwr $t0, 0x8($a1)" "\n"
3457 "\t" " lwl $t1, 0xF($a1)" "\n"
3458 "\t" " lwr $t1, 0xC($a1)" "\n"
3459 "\t" " lwl $t2, 0x13($a1)" "\n"
3460 "\t" " lwr $t2, 0x10($a1)" "\n"
3461 "\t" " lwl $t3, 0x17($a1)" "\n"
3462 "\t" " lwr $t3, 0x14($a1)" "\n"
3463 "\t" " lwl $t4, 0x1B($a1)" "\n"
3464 "\t" " lwr $t4, 0x18($a1)" "\n"
3465 "\t" " lwl $t5, 0x1F($a1)" "\n"
3466 "\t" " lwr $t5, 0x1C($a1)" "\n"
3467 "\t" " lwl $t6, 0x23($a1)" "\n"
3468 "\t" " lwr $t6, 0x20($a1)" "\n"
3469 "\t" " lwl $t7, 0x27($a1)" "\n"
3470 "\t" " lwr $t7, 0x24($a1)" "\n"
3471 "\t" " lwl $t8, 0x2B($a1)" "\n"
3472 "\t" " lwr $t8, 0x28($a1)" "\n"
3473 "\t" " lwl $t9, 0x2F($a1)" "\n"
3474 "\t" " lwr $t9, 0x2C($a1)" "\n"
3475 "\t" " addiu $a3, $a3, -0x1" "\n"
3476 "\t" " swl $v0, 0x3($a0)" "\n"
3477 "\t" " swr $v0, 0x0($a0)" "\n"
3478 "\t" " swl $v1, 0x7($a0)" "\n"
3479 "\t" " swr $v1, 0x4($a0)" "\n"
3480 "\t" " swl $t0, 0xB($a0)" "\n"
3481 "\t" " swr $t0, 0x8($a0)" "\n"
3482 "\t" " swl $t1, 0xF($a0)" "\n"
3483 "\t" " swr $t1, 0xC($a0)" "\n"
3484 "\t" " swl $t2, 0x13($a0)" "\n"
3485 "\t" " swr $t2, 0x10($a0)" "\n"
3486 "\t" " swl $t3, 0x17($a0)" "\n"
3487 "\t" " swr $t3, 0x14($a0)" "\n"
3488 "\t" " swl $t4, 0x1B($a0)" "\n"
3489 "\t" " swr $t4, 0x18($a0)" "\n"
3490 "\t" " swl $t5, 0x1F($a0)" "\n"
3491 "\t" " swr $t5, 0x1C($a0)" "\n"
3492 "\t" " swl $t6, 0x23($a0)" "\n"
3493 "\t" " swr $t6, 0x20($a0)" "\n"
3494 "\t" " swl $t7, 0x27($a0)" "\n"
3495 "\t" " swr $t7, 0x24($a0)" "\n"
3496 "\t" " swl $t8, 0x2B($a0)" "\n"
3497 "\t" " swr $t8, 0x28($a0)" "\n"
3498 "\t" " swl $t9, 0x2F($a0)" "\n"
3499 "\t" " swr $t9, 0x2C($a0)" "\n"
3500 "\t" " addiu $a1, $a1, 0x30" "\n"
3501 "\t" " bnez $a3, .Loptimized_memcpy_5" "\n"
3502 "\t" " addiu $a0, $a0, 0x30" "\n"
3503 "\t" " j .Loptimized_memcpy_12" "\n"
3504 "\t" " nop" "\n"
3505 "\t" ".Loptimized_memcpy_6:" "\n"
3506 "\t" " andi $a3, $a0, 0x3" "\n"
3507 "\t" " beqz $a3, .Loptimized_memcpy_9" "\n"
3508 "\t" " nop" "\n"
3509 "\t" " srl $a3, $a2, 2" "\n"
3510 "\t" " addiu $at, $zero, 0xC" "\n"
3511 "\t" " div $zero, $a3, $at" "\n"
3512 "\t" " mflo $a3" "\n"
3513 "\t" " mfhi $v1" "\n"
3514 "\t" " beqz $v1, .Loptimized_memcpy_8" "\n"
3515 "\t" " nop" "\n"
3516 "\t" ".Loptimized_memcpy_7:" "\n"
3517 "\t" " lw $v0, 0x0($a1)" "\n"
3518 "\t" " addiu $v1, $v1, -0x1" "\n"
3519 "\t" " swl $v0, 0x3($a0)" "\n"
3520 "\t" " swr $v0, 0x0($a0)" "\n"
3521 "\t" " addiu $a1, $a1, 0x4" "\n"
3522 "\t" " bnez $v1, .Loptimized_memcpy_7" "\n"
3523 "\t" " addiu $a0, $a0, 0x4" "\n"
3524 "\t" " beqz $a3, .Loptimized_memcpy_12" "\n"
3525 "\t" " nop" "\n"
3526 "\t" ".Loptimized_memcpy_8:" "\n"
3527 "\t" " lw $v0, 0x0($a1)" "\n"
3528 "\t" " lw $v1, 0x4($a1)" "\n"
3529 "\t" " lw $t0, 0x8($a1)" "\n"
3530 "\t" " lw $t1, 0xC($a1)" "\n"
3531 "\t" " lw $t2, 0x10($a1)" "\n"
3532 "\t" " lw $t3, 0x14($a1)" "\n"
3533 "\t" " lw $t4, 0x18($a1)" "\n"
3534 "\t" " lw $t5, 0x1C($a1)" "\n"
3535 "\t" " lw $t6, 0x20($a1)" "\n"
3536 "\t" " lw $t7, 0x24($a1)" "\n"
3537 "\t" " lw $t8, 0x28($a1)" "\n"
3538 "\t" " lw $t9, 0x2C($a1)" "\n"
3539 "\t" " addiu $a3, $a3, -0x1" "\n"
3540 "\t" " swl $v0, 0x3($a0)" "\n"
3541 "\t" " swr $v0, 0x0($a0)" "\n"
3542 "\t" " swl $v1, 0x7($a0)" "\n"
3543 "\t" " swr $v1, 0x4($a0)" "\n"
3544 "\t" " swl $t0, 0xB($a0)" "\n"
3545 "\t" " swr $t0, 0x8($a0)" "\n"
3546 "\t" " swl $t1, 0xF($a0)" "\n"
3547 "\t" " swr $t1, 0xC($a0)" "\n"
3548 "\t" " swl $t2, 0x13($a0)" "\n"
3549 "\t" " swr $t2, 0x10($a0)" "\n"
3550 "\t" " swl $t3, 0x17($a0)" "\n"
3551 "\t" " swr $t3, 0x14($a0)" "\n"
3552 "\t" " swl $t4, 0x1B($a0)" "\n"
3553 "\t" " swr $t4, 0x18($a0)" "\n"
3554 "\t" " swl $t5, 0x1F($a0)" "\n"
3555 "\t" " swr $t5, 0x1C($a0)" "\n"
3556 "\t" " swl $t6, 0x23($a0)" "\n"
3557 "\t" " swr $t6, 0x20($a0)" "\n"
3558 "\t" " swl $t7, 0x27($a0)" "\n"
3559 "\t" " swr $t7, 0x24($a0)" "\n"
3560 "\t" " swl $t8, 0x2B($a0)" "\n"
3561 "\t" " swr $t8, 0x28($a0)" "\n"
3562 "\t" " swl $t9, 0x2F($a0)" "\n"
3563 "\t" " swr $t9, 0x2C($a0)" "\n"
3564 "\t" " addiu $a1, $a1, 0x30" "\n"
3565 "\t" " bnez $a3, .Loptimized_memcpy_8" "\n"
3566 "\t" " addiu $a0, $a0, 0x30" "\n"
3567 "\t" " j .Loptimized_memcpy_12" "\n"
3568 "\t" " nop" "\n"
3569 "\t" ".Loptimized_memcpy_9:" "\n"
3570 "\t" " srl $a3, $a2, 2" "\n"
3571 "\t" " addiu $at, $zero, 0xC" "\n"
3572 "\t" " div $zero, $a3, $at" "\n"
3573 "\t" " mflo $a3" "\n"
3574 "\t" " mfhi $v1" "\n"
3575 "\t" " beqz $v1, .Loptimized_memcpy_11" "\n"
3576 "\t" " nop" "\n"
3577 "\t" ".Loptimized_memcpy_10:" "\n"
3578 "\t" " lwl $v0, 0x3($a1)" "\n"
3579 "\t" " lwr $v0, 0x0($a1)" "\n"
3580 "\t" " addiu $v1, $v1, -0x1" "\n"
3581 "\t" " sw $v0, 0x0($a0)" "\n"
3582 "\t" " addiu $a1, $a1, 0x4" "\n"
3583 "\t" " bnez $v1, .Loptimized_memcpy_10" "\n"
3584 "\t" " addiu $a0, $a0, 0x4" "\n"
3585 "\t" " beqz $a3, .Loptimized_memcpy_12" "\n"
3586 "\t" " nop" "\n"
3587 "\t" ".Loptimized_memcpy_11:" "\n"
3588 "\t" " lwl $v0, 0x3($a1)" "\n"
3589 "\t" " lwr $v0, 0x0($a1)" "\n"
3590 "\t" " lwl $v1, 0x7($a1)" "\n"
3591 "\t" " lwr $v1, 0x4($a1)" "\n"
3592 "\t" " lwl $t0, 0xB($a1)" "\n"
3593 "\t" " lwr $t0, 0x8($a1)" "\n"
3594 "\t" " lwl $t1, 0xF($a1)" "\n"
3595 "\t" " lwr $t1, 0xC($a1)" "\n"
3596 "\t" " lwl $t2, 0x13($a1)" "\n"
3597 "\t" " lwr $t2, 0x10($a1)" "\n"
3598 "\t" " lwl $t3, 0x17($a1)" "\n"
3599 "\t" " lwr $t3, 0x14($a1)" "\n"
3600 "\t" " lwl $t4, 0x1B($a1)" "\n"
3601 "\t" " lwr $t4, 0x18($a1)" "\n"
3602 "\t" " lwl $t5, 0x1F($a1)" "\n"
3603 "\t" " lwr $t5, 0x1C($a1)" "\n"
3604 "\t" " lwl $t6, 0x23($a1)" "\n"
3605 "\t" " lwr $t6, 0x20($a1)" "\n"
3606 "\t" " lwl $t7, 0x27($a1)" "\n"
3607 "\t" " lwr $t7, 0x24($a1)" "\n"
3608 "\t" " lwl $t8, 0x2B($a1)" "\n"
3609 "\t" " lwr $t8, 0x28($a1)" "\n"
3610 "\t" " lwl $t9, 0x2F($a1)" "\n"
3611 "\t" " lwr $t9, 0x2C($a1)" "\n"
3612 "\t" " addiu $a3, $a3, -0x1" "\n"
3613 "\t" " sw $v0, 0x0($a0)" "\n"
3614 "\t" " sw $v1, 0x4($a0)" "\n"
3615 "\t" " sw $t0, 0x8($a0)" "\n"
3616 "\t" " sw $t1, 0xC($a0)" "\n"
3617 "\t" " sw $t2, 0x10($a0)" "\n"
3618 "\t" " sw $t3, 0x14($a0)" "\n"
3619 "\t" " sw $t4, 0x18($a0)" "\n"
3620 "\t" " sw $t5, 0x1C($a0)" "\n"
3621 "\t" " sw $t6, 0x20($a0)" "\n"
3622 "\t" " sw $t7, 0x24($a0)" "\n"
3623 "\t" " sw $t8, 0x28($a0)" "\n"
3624 "\t" " sw $t9, 0x2C($a0)" "\n"
3625 "\t" " addiu $a1, $a1, 0x30" "\n"
3626 "\t" " bnez $a3, .Loptimized_memcpy_11" "\n"
3627 "\t" " addiu $a0, $a0, 0x30" "\n"
3628 "\t" ".Loptimized_memcpy_12:" "\n"
3629 "\t" " andi $v1, $a2, 0x3" "\n"
3630 "\t" " beqz $v1, .Loptimized_memcpy_14" "\n"
3631 "\t" " nop" "\n"
3632 "\t" ".Loptimized_memcpy_13:" "\n"
3633 "\t" " lb $v0, 0x0($a1)" "\n"
3634 "\t" " addiu $v1, $v1, -0x1" "\n"
3635 "\t" " sb $v0, 0x0($a0)" "\n"
3636 "\t" " addiu $a1, $a1, 0x1" "\n"
3637 "\t" " bnez $v1, .Loptimized_memcpy_13" "\n"
3638 "\t" " addiu $a0, $a0, 0x1" "\n"
3639 "\t" ".Loptimized_memcpy_14:" "\n"
3640 "\t" " addu $v0, $a2, $zero" "\n"
3641 "\t" " jr $ra" "\n"
3642 "\t" " nop" "\n"
3643 "\t" ".set pop" "\n"
3644);
3645// clang-format on
sceCdRV
int sceCdRV(u32 lsn, u32 sectors, void *buf, sceCdRMode *mode, int arg5, void *cb)
Definition cdvdman.c:7136
sceCdReadDiskID
int sceCdReadDiskID(unsigned int *id)
cdvdman_internal_struct_
Definition cdvdman.h:65
CpuResumeIntr
int CpuResumeIntr(int state)
Definition intrman.c:227
QueryIntrContext
int QueryIntrContext(void)
DisableIntr
int DisableIntr(int irq, int *res)
Definition intrman.c:395
CpuSuspendIntr
int CpuSuspendIntr(int *state)
Definition intrman.c:205
irx_export_table
Definition irx.h:90
sceCdBreak
int sceCdBreak(void)
Definition cdi.c:25
sceCdReadModelID
int sceCdReadModelID(unsigned int *id)
sceCdSearchFile
int sceCdSearchFile(sceCdlFILE *file, const char *name)
Definition cdi.c:114
sceCdXLEDCtl
int sceCdXLEDCtl(u8 arg1, u8 arg2, u32 *result1, u32 *result2)
sceCdGetError
int sceCdGetError(void)
Definition cdi.c:40
sceCdRcBypassCtl
int sceCdRcBypassCtl(int mode, u32 *status)
sceCdCancelPOffRdy
int sceCdCancelPOffRdy(u32 *result)
Definition cdvdman.c:7540
sceCdReadRegionParams
int sceCdReadRegionParams(u32 *arg1, u32 *result)
sceCdPowerOff
int sceCdPowerOff(u32 *result)
Definition cdvdman.c:7569
sceRemote2_7
int sceRemote2_7(u16 param, u32 *status)
sceCdSetFanProfile
int sceCdSetFanProfile(u8 param, u32 *result)
sceCdDoesUniqueKeyExist
int sceCdDoesUniqueKeyExist(u32 *status)
sceCdGetMediumRemoval
int sceCdGetMediumRemoval(u32 *result1, u32 *result2)
sceCdReadSUBQ
int sceCdReadSUBQ(void *buffer, u32 *status)
sceCdSetHDMode
int sceCdSetHDMode(u32 mode)
sceCdReadKey
int sceCdReadKey(unsigned char arg1, unsigned char arg2, unsigned int command, unsigned char *key)
sceCdGetToc
int sceCdGetToc(u8 *toc)
Definition cdi.c:57
sceCdInit
int sceCdInit(int mode)
Definition cdi.c:64
sceCdReadNVM
int sceCdReadNVM(u32 address, u16 *data, u8 *result)
sceCdReadPS1BootParam
int sceCdReadPS1BootParam(u8 *out, u32 *result)
sceCdXDVRPReset
int sceCdXDVRPReset(u8 arg1, u32 *result)
sceCdSetMediumRemoval
int sceCdSetMediumRemoval(u8 arg1, u32 *result)
sceCdSendSCmd1D
int sceCdSendSCmd1D(int *arg1, unsigned int *arg2, unsigned int *arg3, u32 *status)
sceCdReadDvdDualInfo
int sceCdReadDvdDualInfo(int *on_dual, unsigned int *layer1_start)
Definition cdvdman.c:4526
sceCdCloseConfig
int sceCdCloseConfig(u32 *result)
sceCdStatus
int sceCdStatus(void)
Definition cdi.c:152
sceCdReadGUID
int sceCdReadGUID(u64 *guid)
sceCdChangeThreadPriority
int sceCdChangeThreadPriority(int priority)
Definition cdvdfsv.c:315
sceCdDiskReady
int sceCdDiskReady(int mode)
Definition cdi.c:30
sceCdForbidRead
int sceCdForbidRead(u32 *result)
sceCdPause
int sceCdPause(void)
Definition cdi.c:93
sceCdRM
int sceCdRM(char *buffer, u32 *status)
Definition cdvdman.c:7288
sceCdPosToInt
u32 sceCdPosToInt(sceCdlLOCCD *p)
Definition cdvdman.c:2420
sceCdReadConsoleID
int sceCdReadConsoleID(u8 *buffer, u32 *result)
sceCdLayerSearchFile
int sceCdLayerSearchFile(sceCdlFILE *fp, const char *path, int layer)
Definition cdvdman.c:2199
sceCdReadClock
int sceCdReadClock(sceCdCLOCK *clock)
Definition cdvdman.c:7943
sceCdWriteConfig
int sceCdWriteConfig(const void *buffer, u32 *result)
sceCdWM
int sceCdWM(const char *buffer, u32 *status)
sceCdWriteConsoleID
int sceCdWriteConsoleID(const u8 *buffer, u32 *status)
sceCdGetReadPos
u32 sceCdGetReadPos(void)
Definition cdi.c:45
sceCdGetDiskType
int sceCdGetDiskType(void)
Definition cdi.c:35
sceCdGetWakeUpReason
int sceCdGetWakeUpReason(void)
sceCdMmode
int sceCdMmode(int media)
Definition cdi.c:86
sceCdSync
int sceCdSync(int mode)
Definition cdi.c:109
sceCdWI
int sceCdWI(const u8 *buffer, u32 *result)
sceCdAutoAdjustCtrl
int sceCdAutoAdjustCtrl(int mode, u32 *result)
sceCdApplySCmd
int sceCdApplySCmd(u8 cmdNum, const void *inBuff, u16 inBuffSize, void *outBuff)
Definition cdvdman.c:5414
sceCdXBSPowerCtl
int sceCdXBSPowerCtl(u8 arg1, u8 arg2, u32 *result1, u32 *result2)
sceRemote2_7Get
int sceRemote2_7Get(u32 *param, u32 *status)
sceCdSeek
int sceCdSeek(u32 lbn)
Definition cdi.c:142
sceCdSetTimeout
int sceCdSetTimeout(int param, int timeout)
Definition cdvdman.c:2075
sceCdBootCertify
int sceCdBootCertify(const u8 *romname)
sceCdChgSys
int sceCdChgSys(u32 arg1)
sceCdReadConfig
int sceCdReadConfig(void *buffer, u32 *result)
sceCdMV
int sceCdMV(u8 *buffer, u32 *status)
Definition cdvdman.c:7395
sceCdWriteNVM
int sceCdWriteNVM(u32 address, u16 data, u8 *result)
sceCdReadFull
int sceCdReadFull(unsigned int lsn, unsigned int sectors, void *buf, sceCdRMode *mode)
sceCdDecSet
int sceCdDecSet(unsigned char enable_xor, unsigned char enable_shift, unsigned char shiftval)
Definition cdvdman.c:8477
sceCdBuzzerCtl
int sceCdBuzzerCtl(u32 *result)
sceCdRI
int sceCdRI(u8 *buffer, u32 *result)
Definition cdvdman.c:7277
SCECdDETCT
@ SCECdDETCT
Definition libcdvd-common.h:114
SCECdDVDV
@ SCECdDVDV
Definition libcdvd-common.h:137
SCECdDVDVR
@ SCECdDVDVR
Definition libcdvd-common.h:133
SCECdPS2DVD
@ SCECdPS2DVD
Definition libcdvd-common.h:130
SCECdErEOM
@ SCECdErEOM
Definition libcdvd-common.h:100
SCECdErIPI
@ SCECdErIPI
Definition libcdvd-common.h:89
SCECdErNO
@ SCECdErNO
Definition libcdvd-common.h:73
SCECdErREADCF
@ SCECdErREADCF
Definition libcdvd-common.h:104
SCECdErREADCFR
@ SCECdErREADCFR
Definition libcdvd-common.h:106
sceCdNoticeGameStart
int sceCdNoticeGameStart(u8 arg1, u32 *result)
sceCdReadWakeUpTime
int sceCdReadWakeUpTime(sceCdCLOCK *clock, u16 *userdata, u32 *wakeupreason, int *flags)
sceCdForbidDVDP
int sceCdForbidDVDP(u32 *result)
sceCdApplyNCmd
int sceCdApplyNCmd(u8 cmdNum, const void *inBuff, u16 inBuffSize)
Definition cdvdman.c:6088
sceCdWriteWakeUpTime
int sceCdWriteWakeUpTime(const sceCdCLOCK *clock, u16 userdata, int flags)
sceCdStandby
int sceCdStandby(void)
Definition cdi.c:147
sceCdRE
int sceCdRE(unsigned int lsn, unsigned int sectors, void *buf, sceCdRMode *mode)
Definition cdvdman.c:6862
sceCdStop
int sceCdStop(void)
Definition cdi.c:157
sceCdOpenConfig
int sceCdOpenConfig(int block, int mode, int NumBlocks, u32 *status)
sceCdTrayReq
int sceCdTrayReq(int param, u32 *traychk)
Definition cdi.c:162
sceCdSetLEDsMode
int sceCdSetLEDsMode(u32 param, u32 *result)
sceCdWriteClock
int sceCdWriteClock(sceCdCLOCK *clock)
sceCdWriteRegionParams
int sceCdWriteRegionParams(u8 arg1, u32 *arg2, u8 *arg3, u32 *result)
sceCdBlueLEDCtl
int sceCdBlueLEDCtl(u8 control, u32 *result)
sceCdCtrlADout
int sceCdCtrlADout(int mode, u32 *status)
Definition cdvdman.c:7601
cdvdfsv_rpc1_inpacket_
Definition libcdvd-rpc.h:65
cdvdfsv_rpc1_outpacket_
Definition libcdvd-rpc.h:70
cdvdfsv_rpc2_inpacket_
Definition libcdvd-rpc.h:78
cdvdfsv_rpc2_outpacket_
Definition libcdvd-rpc.h:83
cdvdfsv_rpc4_outpacket_
Definition libcdvd-rpc.h:129
cdvdfsv_unaligned_data_outpacket_
Definition libcdvd-rpc.h:88
cdvdfsv_rpc3_inpacket_
Definition libcdvd-rpc.h:319
cdvdfsv_rpc3_outpacket_
Definition libcdvd-rpc.h:685
cdvdfsv_rpc4_inpacket_
Definition libcdvd-rpc.h:122
cdvdfsv_rpc5_inpacket_
Definition libcdvd-rpc.h:823
cdvdfsv_rpc5_outpacket_
Definition libcdvd-rpc.h:864
_ModuleInfo::newflags
u16 newflags
Definition loadcore.h:36
_ModuleInfo
Definition loadcore.h:31
_iop_library
Definition loadcore.h:68
t_SifDmaTransfer
Definition sifdma.h:53
t_SifRpcDataQueue
Definition sifrpc-common.h:154
t_SifRpcServerData
Definition sifrpc-common.h:99
_iop_sys_clock
Definition thbase.h:88
_iop_thread
Definition thbase.h:40
_iop_thread_status
Definition thbase.h:69