platform ps2, handle audio similar to psp
[picodrive.git] / 3ds / 3ds_utils.c
... / ...
CommitLineData
1
2#include "3ds_utils.h"
3
4typedef int (*ctr_callback_type)(void);
5
6int srvGetServiceHandle(unsigned int* out, const char* name);
7int svcCloseHandle(unsigned int handle);
8int svcBackdoor(ctr_callback_type);
9
10
11static void ctr_enable_all_svc_kernel(void)
12{
13 __asm__ volatile("cpsid aif");
14
15 unsigned int* svc_access_control = *(*(unsigned int***)0xFFFF9000 + 0x22) - 0x6;
16
17 svc_access_control[0]=0xFFFFFFFE;
18 svc_access_control[1]=0xFFFFFFFF;
19 svc_access_control[2]=0xFFFFFFFF;
20 svc_access_control[3]=0x3FFFFFFF;
21}
22
23
24static void ctr_invalidate_ICache_kernel(void)
25{
26 __asm__ volatile(
27 "cpsid aif\n\t"
28 "mov r0, #0\n\t"
29 "mcr p15, 0, r0, c7, c5, 0\n\t");
30}
31
32static void ctr_flush_DCache_kernel(void)
33{
34 __asm__ volatile(
35 "cpsid aif\n\t"
36 "mov r0, #0\n\t"
37 "mcr p15, 0, r0, c7, c10, 0\n\t");
38
39}
40
41
42static void ctr_enable_all_svc(void)
43{
44 svcBackdoor((ctr_callback_type)ctr_enable_all_svc_kernel);
45}
46
47void ctr_invalidate_ICache(void)
48{
49// __asm__ volatile("svc 0x2E\n\t");
50 svcBackdoor((ctr_callback_type)ctr_invalidate_ICache_kernel);
51
52}
53
54void ctr_flush_DCache(void)
55{
56// __asm__ volatile("svc 0x4B\n\t");
57 svcBackdoor((ctr_callback_type)ctr_flush_DCache_kernel);
58}
59
60
61void ctr_flush_invalidate_cache(void)
62{
63 ctr_flush_DCache();
64 ctr_invalidate_ICache();
65}
66
67int ctr_svchack_init(void)
68{
69 extern unsigned int __service_ptr;
70
71 if(__service_ptr)
72 return 0;
73
74 /* CFW */
75 ctr_enable_all_svc();
76 return 1;
77}
78