3ds_utils.c 1.9 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586
  1. #include "3ds_utils.h"
  2. #define GET_VERSION_MAJOR(version) ((version) >>24)
  3. typedef int (*ctr_callback_type)(void);
  4. int srvGetServiceHandle(unsigned int* out, const char* name);
  5. int svcCloseHandle(unsigned int handle);
  6. int svcBackdoor(ctr_callback_type);
  7. int32_t svcGetSystemInfo(int64_t* out, uint32_t type, int32_t param);
  8. void ctr_clear_cache(void);
  9. static int has_rosalina;
  10. void check_rosalina(void) {
  11. int64_t version;
  12. uint32_t major;
  13. has_rosalina = 0;
  14. if (!svcGetSystemInfo(&version, 0x10000, 0)) {
  15. major = GET_VERSION_MAJOR(version);
  16. if (major >= 8)
  17. has_rosalina = 1;
  18. }
  19. }
  20. static void ctr_enable_all_svc_kernel(void)
  21. {
  22. __asm__ volatile("cpsid aif");
  23. unsigned int* svc_access_control = *(*(unsigned int***)0xFFFF9000 + 0x22) - 0x6;
  24. svc_access_control[0]=0xFFFFFFFE;
  25. svc_access_control[1]=0xFFFFFFFF;
  26. svc_access_control[2]=0xFFFFFFFF;
  27. svc_access_control[3]=0x3FFFFFFF;
  28. }
  29. static void ctr_enable_all_svc(void)
  30. {
  31. svcBackdoor((ctr_callback_type)ctr_enable_all_svc_kernel);
  32. }
  33. static void ctr_clean_invalidate_kernel(void)
  34. {
  35. __asm__ volatile(
  36. "mrs r1, cpsr\n"
  37. "cpsid aif\n" // disable interrupts
  38. "mov r0, #0\n"
  39. "mcr p15, 0, r0, c7, c10, 0\n" // clean dcache
  40. "mcr p15, 0, r0, c7, c10, 4\n" // DSB
  41. "mcr p15, 0, r0, c7, c5, 0\n" // invalidate icache+BTAC
  42. "msr cpsr_cx, r1\n" // restore interrupts
  43. ::: "r0", "r1");
  44. }
  45. void ctr_flush_invalidate_cache(void)
  46. {
  47. if (has_rosalina) {
  48. ctr_clear_cache();
  49. } else {
  50. // __asm__ volatile("svc 0x2E\n\t");
  51. // __asm__ volatile("svc 0x4B\n\t");
  52. svcBackdoor((ctr_callback_type)ctr_clean_invalidate_kernel);
  53. }
  54. }
  55. int ctr_svchack_init(void)
  56. {
  57. extern unsigned int __ctr_svchax;
  58. extern unsigned int __service_ptr;
  59. if(__ctr_svchax)
  60. return 1; /* All services have already been enabled */
  61. if(__service_ptr)
  62. return 0;
  63. /* CFW */
  64. ctr_enable_all_svc();
  65. return 1;
  66. }