aroma-wip, untested

include/controller_patcher/ControllerPatcher.hpp

@@ -108,6 +108,8 @@ public:
     **/
     static CONTROLLER_PATCHER_RESULT_OR_ERROR enableControllerMapping();
 
+    static CONTROLLER_PATCHER_RESULT_OR_ERROR UpdateSamplingFunctionAddress();
+
     /**
         Disbale the Controller mapping. Afterwards all connected controllers will be used for the gamepad.
         @return When the functions failed result < 0 is returned. If the result is == 0 the function was successful.

source/ConfigReader.cpp

@@ -102,8 +102,10 @@ void ConfigReader::processFileList(std::vector<std::string> path) {
 std::string ConfigReader::loadFileToString(std::string path) {
     std::string strBuffer = "";
     uint8_t *buffer       = NULL;
-    if (FSUtils::LoadFileToMem(path.c_str(), &buffer, NULL) > 0) {
+    uint32_t outLen = 0;
-        strBuffer = std::string((char *) buffer);
+    if (FSUtils::LoadFileToMem(path.c_str(), &buffer, &outLen) > 0) {
+        strBuffer = std::string((char *) buffer, outLen);
+        free(buffer);
         strBuffer = StringTools::removeCharFromString(strBuffer, '\r');
         strBuffer = StringTools::removeCharFromString(strBuffer, ' ');
         strBuffer = StringTools::removeCharFromString(strBuffer, '\t');

source/ControllerPatcher.cpp

@@ -485,22 +485,35 @@ void ControllerPatcher::ResetConfig() {
     ControllerPatcherUtils::setConfigValue((uint8_t *) &config_controller[xinput_slot][CONTRPS_VPAD_BUTTON_R_STICK_Y_INVERT], CONTROLLER_PATCHER_VALUE_SET, HID_XINPUT_STICK_R_Y[STICK_CONF_INVERT]);
 }
 
-BOOL ControllerPatcher::Init(const char *pathToConfig) {
+CONTROLLER_PATCHER_RESULT_OR_ERROR ControllerPatcher::UpdateSamplingFunctionAddress() {
-    OSDynLoad_Module handle;
+    OSDynLoad_Module handle      = nullptr;
-    void *kpad_ptr;
+    WPADSamplingCallback newAddr = nullptr;
-    OSDynLoad_Acquire("padscore", &handle);
+    auto err                     = OSDynLoad_IsModuleLoaded("padscore", &handle);
-    OSDynLoad_FindExport(handle, OS_DYNLOAD_EXPORT_FUNC, "KPADRead", &kpad_ptr);
+    if (err == OS_DYNLOAD_OK && handle != nullptr) {
-
+        void *kpad_ptr = nullptr;
-    gSamplingCallback = (WPADSamplingCallback) ((uint32_t) kpad_ptr + 0x1F0);
+        if (OSDynLoad_FindExport(handle, OS_DYNLOAD_EXPORT_FUNC, "KPADRead", &kpad_ptr) == OS_DYNLOAD_OK) {
-    if (*(uint32_t *) gSamplingCallback != FIRST_INSTRUCTION_IN_SAMPLING_CALLBACK) {
+            newAddr = (WPADSamplingCallback) ((uint32_t) kpad_ptr + 0x1F0);
-        //In Firmware <= 5.1.2 the offset changes
+            if (*(uint32_t *) newAddr != FIRST_INSTRUCTION_IN_SAMPLING_CALLBACK) {
-        gSamplingCallback = (WPADSamplingCallback) ((uint32_t) kpad_ptr + 0x1F8);
+                //In Firmware <= 5.1.2 the offset changes
-        if (*(uint32_t *) gSamplingCallback != FIRST_INSTRUCTION_IN_SAMPLING_CALLBACK) {
+                newAddr = (WPADSamplingCallback) ((uint32_t) kpad_ptr + 0x1F8);
-            //Should never happen. I looked into the padscore.rpl of ALL firmwares.
+                if (*(uint32_t *) newAddr != FIRST_INSTRUCTION_IN_SAMPLING_CALLBACK) {
-            gSamplingCallback = NULL;
+                    //Should never happen. I looked into the padscore.rpl of ALL firmwares.
+                    newAddr = nullptr;
+                }
+            }
         }
+    } else {
+        OSReport("Failed to update sampling addr\n");
+    }
+    gSamplingCallback = newAddr;
+    return CONTROLLER_PATCHER_ERROR_NONE;
+}
+
+BOOL ControllerPatcher::Init(const char *pathToConfig) {
+    gSamplingCallback = nullptr;
+    if (gSamplingCallback != nullptr) {
+        DEBUG_FUNCTION_LINE("Found the gSamplingCallback at %08X ", gSamplingCallback);
     }
-    DEBUG_FUNCTION_LINE("Found the gSamplingCallback at %08X ", gSamplingCallback);
 
     if (HID_DEBUG) {
         DEBUG_FUNCTION_LINE("Init called! ");
@@ -519,7 +532,6 @@ BOOL ControllerPatcher::Init(const char *pathToConfig) {
     }
 
     if (pathToConfig != NULL && gConfig_done != HID_SDCARD_READ) {
-        DEBUG_FUNCTION_LINE("Reading config files from SD Card");
         DEBUG_FUNCTION_LINE("Reading config files from SD Card");
         ConfigReader *reader = ConfigReader::getInstance();
 
@@ -547,9 +559,11 @@ void ControllerPatcher::startNetworkServer() {
 }
 
 void ControllerPatcher::stopNetworkServer() {
-    DEBUG_FUNCTION_LINE("called! ");
+    DEBUG_FUNCTION_LINE("called!!");
     UDPServer::destroyInstance();
+    DEBUG_FUNCTION_LINE("called! ");
     UDPClient::destroyInstance();
+    DEBUG_FUNCTION_LINE("called! ");
     CPTCPServer::destroyInstance();
 }
 
@@ -1138,7 +1152,7 @@ CONTROLLER_PATCHER_RESULT_OR_ERROR ControllerPatcher::resetCallbackData() {
     memset(gWPADConnectCallback, 0, sizeof(gWPADConnectCallback));
     memset(gKPADConnectCallback, 0, sizeof(gKPADConnectCallback));
     memset(gExtensionCallback, 0, sizeof(gExtensionCallback));
-    gSamplingCallback = 0;
+    gSamplingCallback = nullptr;
     gCallbackCooldown = 0;
     return CONTROLLER_PATCHER_ERROR_NONE;
 }
@@ -1199,15 +1213,15 @@ CONTROLLER_PATCHER_RESULT_OR_ERROR ControllerPatcher::handleCallbackData(BOOL bu
 
 CONTROLLER_PATCHER_RESULT_OR_ERROR ControllerPatcher::handleCallbackDataInternal(WPADChan chan) {
     if (gWPADConnectCallback[chan] != NULL) {
-        log_printf("Called WPAD connect callback for pro controller in slot %d!", chan + 1);
+        DEBUG_FUNCTION_LINE("Called WPAD connect callback for pro controller in slot %d!", chan + 1);
         gWPADConnectCallback[chan](chan, 0);
     }
     if (gKPADConnectCallback[chan] != NULL) {
-        log_printf("Called KPAD connect callback for pro controller in slot %d!", chan + 1);
+        DEBUG_FUNCTION_LINE("Called KPAD connect callback for pro controller in slot %d!", chan + 1);
         gKPADConnectCallback[chan](chan, 0);
     }
     if (gExtensionCallback[chan] != NULL) {
-        log_printf("Called extension callback for pro controller in slot %d!", chan + 1);
+        DEBUG_FUNCTION_LINE("Called extension callback for pro controller in slot %d!", chan + 1);
         gExtensionCallback[chan](chan, WPAD_EXT_PRO_CONTROLLER);
     }
     return CONTROLLER_PATCHER_ERROR_NONE;

source/config/ConfigParser.cpp

@@ -23,7 +23,7 @@
 
 ConfigParser::ConfigParser(std::string configData) {
     this->content      = configData;
-    this->contentLines = StringTools::stringSplit(content, "");
+    this->contentLines = StringTools::stringSplit(content, "\n");
 
     if (contentLines.empty()) {
         return;

source/config/ConfigValues.cpp

@@ -53,7 +53,7 @@ BOOL ConfigValues::setIfValueIsAControllerPresetEx(std::string value, int32_t sl
 
 //We need this function here so we can use preset sticks.
 BOOL ConfigValues::setIfValueIsPreset(std::map<std::string, const uint8_t *> values, std::string possibleValue, int32_t slot, int32_t keyslot) {
-    if (slot > gHIDMaxDevices || slot < 0 || keyslot < 0 || keyslot >= CONTRPS_MAX_VALUE) {
+    if (slot >= gHIDMaxDevices || slot < 0 || keyslot < 0 || keyslot >= CONTRPS_MAX_VALUE) {
         return false;
     }
     const uint8_t *values_ = NULL;
@@ -127,7 +127,7 @@ std::string ConfigValues::getStringByVIDPIDEx(uint16_t vid, uint16_t pid) {
     if (it != deviceNames.end()) {
         result = it->second;
     } else {
-        result = StringTools::strfmt("VID: 0x%04X\nPID: 0x%04X", vid, pid);
+        result = StringTools::strfmt("0x%04X / 0x%04X", vid, pid);
     }
     return result;
 }

source/config/ConfigValues.hpp

@@ -128,7 +128,7 @@ private:
     **/
     static std::string getStringByVIDPID(uint16_t vid, uint16_t pid) {
         ConfigValues *cur_instance = getInstance();
-        if (cur_instance == NULL) return "";
+        if (cur_instance == nullptr) return StringTools::strfmt("0x%04X / 0x%04X", vid, pid);
         return cur_instance->getStringByVIDPIDEx(vid, pid);
     }
 

source/fs/FSUtils.cpp

@@ -26,7 +26,7 @@ int32_t FSUtils::LoadFileToMem(const char *filepath, uint8_t **inbuffer, uint32_
         return -2;
     }
 
-    uint32_t blocksize = 0x4000;
+    uint32_t blocksize = 0x20000;
     uint32_t done      = 0;
     int32_t readBytes  = 0;
 

source/network/CPTCPServer.cpp

@@ -29,6 +29,7 @@ CPTCPServer::CPTCPServer(int32_t port) : TCPServer(port, CPTCPServer::getPriorit
 }
 
 CPTCPServer::~CPTCPServer() {
+    DEBUG_FUNCTION_LINE("~CPTCPServer");
     CPTCPServer::AttachDetach(HID_DEVICE_DETACH);
 }
 

source/network/UDPClient.cpp

@@ -43,12 +43,12 @@ UDPClient::UDPClient(uint32_t ip, int32_t port) {
 }
 
 UDPClient::~UDPClient() {
+    DEBUG_FUNCTION_LINE("~UDPClient");
     if (this->sockfd != -1) {
         close(sockfd);
     }
-    if (HID_DEBUG) {
+
-        log_printf("UDPClient::~UDPClient(line %d): Thread has been closed", __LINE__);
+    DEBUG_FUNCTION_LINE("UDPClient::~UDPClient(line %d): Thread has been closed", __LINE__);
-    }
 }
 
 BOOL UDPClient::sendData(char *data, int32_t length) {

source/network/UDPServer.cpp

@@ -18,7 +18,7 @@
 #include <malloc.h>
 #include <stdio.h>
 #include <string.h>
-
+#include <coreinit/cache.h>
 #include <utils/logger.h>
 
 #define MAX_UDP_SIZE 0x578
@@ -45,9 +45,11 @@ UDPServer::UDPServer(int32_t port) {
 }
 
 UDPServer::~UDPServer() {
+
     CThread *pThreadPointer = UDPServer::pThread;
     if (pThreadPointer != NULL) {
         exitThread = 1;
+        OSMemoryBarrier();
         if (pThreadPointer != NULL) {
             delete pThreadPointer;
             UDPServer::pThread = NULL;
@@ -57,9 +59,9 @@ UDPServer::~UDPServer() {
             this->sockfd = -1;
         }
     }
-    if (HID_DEBUG) {
+
         DEBUG_FUNCTION_LINE("Thread has been closed");
-    }
+
 }
 
 void UDPServer::StartUDPThread(UDPServer *server) {

source/patcher/ControllerPatcherUtils.cpp

@@ -1021,7 +1021,7 @@ ControllerMappingPAD *ControllerPatcherUtils::getControllerMappingByType(UContro
 }
 
 CONTROLLER_PATCHER_RESULT_OR_ERROR ControllerPatcherUtils::doSampling(uint16_t deviceslot, uint8_t padslot = 0, BOOL ignorePadSlot = false) {
-    if (gSamplingCallback != NULL) {
+    if (gSamplingCallback != nullptr) {
         doSamplingSingle(WPAD_CHAN_0, deviceslot, padslot, ignorePadSlot);
         doSamplingSingle(WPAD_CHAN_1, deviceslot, padslot, ignorePadSlot);
         doSamplingSingle(WPAD_CHAN_2, deviceslot, padslot, ignorePadSlot);

source/utils/PadConst.cpp

@@ -27,14 +27,14 @@ const uint8_t DEF_STICK_OFFSET_MINMAX   = CONTRPS_VPAD_BUTTON_L_STICK_X_MINMAX -
 //!----------------------------------------------------------------------------------------------------------------------------------------------------------------------------
 //! Device names
 //!----------------------------------------------------------------------------------------------------------------------------------------------------------------------------
-const char *HID_GC_STRING         = "GameCube\nUSB-Adapter";
+const char *HID_GC_STRING         = "GameCube USB-Adapter";
 const char *HID_KEYBOARD_STRING   = "Keyboard";
 const char *HID_MOUSE_STRING      = "Mouse";
-const char *HID_DS3_STRING        = "DualShock 3\nController";
+const char *HID_DS3_STRING        = "DualShock 3 Controller";
-const char *HID_DS4_STRING        = "DualShock 4\nController";
+const char *HID_DS4_STRING        = "DualShock 4 Controller";
-const char *HID_NEW_DS4_STRING    = "DualShock 4\nController";
+const char *HID_NEW_DS4_STRING    = "DualShock 4 Controller";
-const char *HID_XINPUT_STRING     = "XInput\nController";
+const char *HID_XINPUT_STRING     = "XInput Controller";
-const char *HID_SWITCH_PRO_STRING = "Switch\nPro Controller";
+const char *HID_SWITCH_PRO_STRING = "Switch Pro Controller";
 
 //!----------------------------------------------------------------------------------------------------------------------------------------------------------------------------
 //! GC-Adapter

source/utils/TCPServer.cpp

@@ -20,17 +20,17 @@ TCPServer::TCPServer(int32_t port, int32_t priority) {
 
 TCPServer::~TCPServer() {
     CloseSockets();
-    //DEBUG_FUNCTION_LINE("Thread will be closed");
+    DEBUG_FUNCTION_LINE("Thread will be closed");
     exitThread = 1;
 
     ICInvalidateRange((void *) &exitThread, 4);
     DCFlushRange((void *) &exitThread, 4);
 
     if (pThread != NULL) {
-        //DEBUG_FUNCTION_LINE("Deleting it!");
+        DEBUG_FUNCTION_LINE("Deleting it!");
         delete pThread;
     }
-    //DEBUG_FUNCTION_LINE("Thread done");
+    DEBUG_FUNCTION_LINE("Thread done");
     pThread = NULL;
 }
 

source/utils/logger.h

@@ -1,39 +1,74 @@
 #pragma once
 
+#include <coreinit/debug.h>
+#include <cstring>
+#include <whb/log.h>
+
 #ifdef __cplusplus
 extern "C" {
 #endif
 
-#include <cstring>
+#define LOG_APP_TYPE "L"
-#include <whb/log.h>
+#define LOG_APP_NAME "controllerpatcher"
 
-#define __FILENAME_X__ (strrchr(__FILE__, '\\') ? strrchr(__FILE__, '\\') + 1 : __FILE__)
+#define __FILENAME__ ({                                \
-#define __FILENAME__   (strrchr(__FILE__, '/') ? strrchr(__FILE__, '/') + 1 : __FILENAME_X__)
+    const char *__filename = __FILE__;                 \
+    const char *__pos      = strrchr(__filename, '/'); \
+    if (!__pos) __pos = strrchr(__filename, '\\');     \
+    __pos ? __pos + 1 : __filename;                    \
+})
 
-#ifdef __LOGGING__
+#define LOG(LOG_FUNC, FMT, ARGS...)                                 LOG_EX_DEFAULT(LOG_FUNC, "", "", FMT, ##ARGS)
 
-#define log_print(str)           WHBLogPrint(str)
+#define LOG_EX_DEFAULT(LOG_FUNC, LOG_LEVEL, LINE_END, FMT, ARGS...) LOG_EX(__FILENAME__, __FUNCTION__, __LINE__, LOG_FUNC, LOG_LEVEL, LINE_END, FMT, ##ARGS)
-#define log_printf(FMT, ARGS...) WHBLogPrintf(FMT, ##ARGS);
 
-#define DEBUG_FUNCTION_LINE(FMT, ARGS...)                                                        \
+#define LOG_EX(FILENAME, FUNCTION, LINE, LOG_FUNC, LOG_LEVEL, LINE_END, FMT, ARGS...)                                                        \
-    do {                                                                                         \
+    do {                                                                                                                                     \
-        WHBLogPrintf("[%23s]%30s@L%04d: " FMT "", __FILENAME__, __FUNCTION__, __LINE__, ##ARGS); \
+        LOG_FUNC("[(%s)%18s][%23s]%30s@L%04d: " LOG_LEVEL "" FMT "" LINE_END, LOG_APP_TYPE, LOG_APP_NAME, FILENAME, FUNCTION, LINE, ##ARGS); \
-    } while (0);
+    } while (0)
 
-#define DEBUG_FUNCTION_LINE_WRITE(FMT, ARGS...)                                                  \
+#ifdef DEBUG
-    do {                                                                                         \
+
-        WHBLogWritef("[%23s]%30s@L%04d: " FMT "", __FILENAME__, __FUNCTION__, __LINE__, ##ARGS); \
+#ifdef VERBOSE_DEBUG
-    } while (0);
+#define DEBUG_FUNCTION_LINE_VERBOSE(FMT, ARGS...)                              LOG(WHBLogPrintf, FMT, ##ARGS)
+#define DEBUG_FUNCTION_LINE_VERBOSE_EX(FILENAME, FUNCTION, LINE, FMT, ARGS...) LOG_EX(FILENAME, FUNCTION, LINE, WHBLogPrintf, "", "", FMT, ##ARGS);
+#else
+#define DEBUG_FUNCTION_LINE_VERBOSE(FMT, ARGS...)    while (0)
+#define DEBUG_FUNCTION_LINE_VERBOSE_EX(FMT, ARGS...) while (0)
+#endif
+
+#define DEBUG_FUNCTION_LINE(FMT, ARGS...)                                      LOG(WHBLogPrintf, FMT, ##ARGS)
+
+#define DEBUG_FUNCTION_LINE_WRITE(FMT, ARGS...)                                LOG(WHBLogWritef, FMT, ##ARGS)
+
+#define DEBUG_FUNCTION_LINE_ERR(FMT, ARGS...)                                  LOG_EX_DEFAULT(WHBLogPrintf, "##ERROR## ", "", FMT, ##ARGS)
+#define DEBUG_FUNCTION_LINE_WARN(FMT, ARGS...)                                 LOG_EX_DEFAULT(WHBLogPrintf, "##WARN ## ", "", FMT, ##ARGS)
+#define DEBUG_FUNCTION_LINE_INFO(FMT, ARGS...)                                 LOG_EX_DEFAULT(WHBLogPrintf, "##INFO ## ", "", FMT, ##ARGS)
+
+#define DEBUG_FUNCTION_LINE_ERR_LAMBDA(FILENAME, FUNCTION, LINE, FMT, ARGS...) LOG_EX(FILENAME, FUNCTION, LINE, WHBLogPrintf, "##ERROR## ", "", FMT, ##ARGS);
 
 #else
 
-#define log_print(str)
+#define DEBUG_FUNCTION_LINE_VERBOSE_EX(FMT, ARGS...)                           while (0)
-#define log_printf(FMT, ARGS...)
+
-#define DEBUG_FUNCTION_LINE(FMT, ARGS...)
+#define DEBUG_FUNCTION_LINE_VERBOSE(FMT, ARGS...)                              while (0)
-#define DEBUG_FUNCTION_LINE_WRITE(FMT, ARGS...)
+
+#define DEBUG_FUNCTION_LINE(FMT, ARGS...)                                      LOG_EX_DEFAULT(OSReport, "", "\n", FMT, ##ARGS)
+
+#define DEBUG_FUNCTION_LINE_WRITE(FMT, ARGS...)                                while (0)
+
+#define DEBUG_FUNCTION_LINE_ERR(FMT, ARGS...)                                  LOG_EX_DEFAULT(OSReport, "##ERROR## ", "\n", FMT, ##ARGS)
+#define DEBUG_FUNCTION_LINE_WARN(FMT, ARGS...)                                 LOG_EX_DEFAULT(OSReport, "##WARN ## ", "\n", FMT, ##ARGS)
+#define DEBUG_FUNCTION_LINE_INFO(FMT, ARGS...)                                 LOG_EX_DEFAULT(OSReport, "##INFO ## ", "\n", FMT, ##ARGS)
+
+#define DEBUG_FUNCTION_LINE_ERR_LAMBDA(FILENAME, FUNCTION, LINE, FMT, ARGS...) LOG_EX(FILENAME, FUNCTION, LINE, OSReport, "##ERROR## ", "\n", FMT, ##ARGS);
 
 #endif
 
+void initLogging();
+
+void deinitLogging();
+
 #ifdef __cplusplus
 }
-#endif
+#endif