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