1 files changed, 57 insertions, 13 deletions

diff --git a/src/core/hle/service/service.cpp b/src/core/hle/service/service.cpp
index 91f13cd7e..64185c62e 100644
--- a/src/core/hle/service/service.cpp
+++ b/src/core/hle/service/service.cpp
@@ -2,7 +2,7 @@
 // Licensed under GPLv2 or any later version
 // Refer to the license.txt file included.
 
-#include "common/common.h"
+#include "common/logging/log.h"
 #include "common/string_util.h"
 
 #include "core/hle/service/service.h"
@@ -24,14 +24,13 @@
 #include "core/hle/service/gsp_gpu.h"
 #include "core/hle/service/gsp_lcd.h"
 #include "core/hle/service/http_c.h"
-#include "core/hle/service/ir_rst.h"
-#include "core/hle/service/ir_u.h"
 #include "core/hle/service/ldr_ro.h"
 #include "core/hle/service/mic_u.h"
 #include "core/hle/service/ndm_u.h"
 #include "core/hle/service/news_s.h"
 #include "core/hle/service/news_u.h"
 #include "core/hle/service/nim_aoc.h"
+#include "core/hle/service/nim_u.h"
 #include "core/hle/service/ns_s.h"
 #include "core/hle/service/nwm_uds.h"
 #include "core/hle/service/pm_app.h"
@@ -44,6 +43,7 @@
 #include "core/hle/service/fs/archive.h"
 #include "core/hle/service/cfg/cfg.h"
 #include "core/hle/service/hid/hid.h"
+#include "core/hle/service/ir/ir.h"
 #include "core/hle/service/ptm/ptm.h"
 
 namespace Service {
@@ -51,6 +51,49 @@ namespace Service {
 std::unordered_map<std::string, Kernel::SharedPtr<Interface>> g_kernel_named_ports;
 std::unordered_map<std::string, Kernel::SharedPtr<Interface>> g_srv_services;
 
+/**
+ * Creates a function string for logging, complete with the name (or header code, depending 
+ * on what's passed in) the port name, and all the cmd_buff arguments.
+ */
+static std::string MakeFunctionString(const char* name, const char* port_name, const u32* cmd_buff) {
+    // Number of params == bits 0-5 + bits 6-11
+    int num_params = (cmd_buff[0] & 0x3F) + ((cmd_buff[0] >> 6) & 0x3F);
+
+    std::string function_string = Common::StringFromFormat("function '%s': port=%s", name, port_name);
+    for (int i = 1; i <= num_params; ++i) {
+        function_string += Common::StringFromFormat(", cmd_buff[%i]=%u", i, cmd_buff[i]);
+    }
+    return function_string;
+}
+
+ResultVal<bool> Interface::SyncRequest() {
+    u32* cmd_buff = Kernel::GetCommandBuffer();
+    auto itr = m_functions.find(cmd_buff[0]);
+
+    if (itr == m_functions.end() || itr->second.func == nullptr) {
+        std::string function_name = (itr == m_functions.end()) ? Common::StringFromFormat("0x%08X", cmd_buff[0]) : itr->second.name;
+        LOG_ERROR(Service, "unknown / unimplemented %s", MakeFunctionString(function_name.c_str(), GetPortName().c_str(), cmd_buff).c_str());
+
+        // TODO(bunnei): Hack - ignore error
+        cmd_buff[1] = 0;
+        return MakeResult<bool>(false);
+    } else {
+        LOG_TRACE(Service, "%s", MakeFunctionString(itr->second.name, GetPortName().c_str(), cmd_buff).c_str());
+    }
+
+    itr->second.func(this);
+
+    return MakeResult<bool>(false); // TODO: Implement return from actual function
+}
+
+void Interface::Register(const FunctionInfo* functions, size_t n) {
+    m_functions.reserve(n);
+    for (size_t i = 0; i < n; ++i) {
+        // Usually this array is sorted by id already, so hint to instead at the end
+        m_functions.emplace_hint(m_functions.cend(), functions[i].id, functions[i]);
+    }
+}
+
 ////////////////////////////////////////////////////////////////////////////////////////////////////
 // Module interface
 
@@ -68,10 +111,11 @@ void Init() {
     AddNamedPort(new ERR_F::Interface);
 
     Service::FS::ArchiveInit();
-    Service::CFG::CFGInit();
-    Service::APT::APTInit();
-    Service::PTM::PTMInit();
-    Service::HID::HIDInit();
+    Service::CFG::Init();
+    Service::APT::Init();
+    Service::PTM::Init();
+    Service::HID::Init();
+    Service::IR::Init();
 
     AddService(new AC_U::Interface);
     AddService(new ACT_U::Interface);
@@ -90,14 +134,13 @@ void Init() {
     AddService(new GSP_GPU::Interface);
     AddService(new GSP_LCD::Interface);
     AddService(new HTTP_C::Interface);
-    AddService(new IR_RST::Interface);
-    AddService(new IR_U::Interface);
     AddService(new LDR_RO::Interface);
     AddService(new MIC_U::Interface);
     AddService(new NDM_U::Interface);
     AddService(new NEWS_S::Interface);
     AddService(new NEWS_U::Interface);
     AddService(new NIM_AOC::Interface);
+    AddService(new NIM_U::Interface);
     AddService(new NS_S::Interface);
     AddService(new NWM_UDS::Interface);
     AddService(new PM_APP::Interface);
@@ -110,10 +153,11 @@ void Init() {
 
 /// Shutdown ServiceManager
 void Shutdown() {
-    Service::HID::HIDShutdown();
-    Service::PTM::PTMShutdown();
-    Service::APT::APTShutdown();
-    Service::CFG::CFGShutdown();
+    Service::IR::Shutdown();
+    Service::HID::Shutdown();
+    Service::PTM::Shutdown();
+    Service::APT::Shutdown();
+    Service::CFG::Shutdown();
     Service::FS::ArchiveShutdown();
 
     g_srv_services.clear();