1 files changed, 48 insertions, 1 deletions
diff --git a/src/core/hle/kernel/svc/svc_secure_monitor_call.cpp b/src/core/hle/kernel/svc/svc_secure_monitor_call.cpp
index 299e22ae6..20f6ec643 100644
--- a/src/core/hle/kernel/svc/svc_secure_monitor_call.cpp
+++ b/src/core/hle/kernel/svc/svc_secure_monitor_call.cpp
@@ -1,6 +1,53 @@
 // SPDX-FileCopyrightText: Copyright 2023 yuzu Emulator Project
 // SPDX-License-Identifier: GPL-2.0-or-later
 
+#include "core/core.h"
+#include "core/hle/kernel/physical_core.h"
 #include "core/hle/kernel/svc.h"
 
-namespace Kernel::Svc {} // namespace Kernel::Svc
+namespace Kernel::Svc {
+
+void CallSecureMonitor(Core::System& system, lp64::SecureMonitorArguments* args) {
+    UNIMPLEMENTED();
+}
+
+void CallSecureMonitor64(Core::System& system, lp64::SecureMonitorArguments* args) {
+    CallSecureMonitor(system, args);
+}
+
+void CallSecureMonitor64From32(Core::System& system, ilp32::SecureMonitorArguments* args) {
+    // CallSecureMonitor64From32 is not supported.
+    UNIMPLEMENTED_MSG("CallSecureMonitor64From32");
+}
+
+// Custom ABI for CallSecureMonitor.
+
+void SvcWrap_CallSecureMonitor64(Core::System& system) {
+    auto& core = system.CurrentPhysicalCore().ArmInterface();
+    lp64::SecureMonitorArguments args{};
+    for (int i = 0; i < 8; i++) {
+        args.r[i] = core.GetReg(i);
+    }
+
+    CallSecureMonitor64(system, &args);
+
+    for (int i = 0; i < 8; i++) {
+        core.SetReg(i, args.r[i]);
+    }
+}
+
+void SvcWrap_CallSecureMonitor64From32(Core::System& system) {
+    auto& core = system.CurrentPhysicalCore().ArmInterface();
+    ilp32::SecureMonitorArguments args{};
+    for (int i = 0; i < 8; i++) {
+        args.r[i] = static_cast<u32>(core.GetReg(i));
+    }
+
+    CallSecureMonitor64From32(system, &args);
+
+    for (int i = 0; i < 8; i++) {
+        core.SetReg(i, args.r[i]);
+    }
+}
+
+} // namespace Kernel::Svc