Start hoc-clk rewrite

Source/rewrite-hoc-clk/sysmodule/src/board/board.hpp

@@ -0,0 +1,39 @@
+/*
+ * Copyright (c) Souldbminer, Lightos_ and Horizon OC Contributors
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms and conditions of the GNU General Public License,
+ * version 2, as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+ *
+ */
+
+/* --------------------------------------------------------------------------
+ * "THE BEER-WARE LICENSE" (Revision 42):
+ * <p-sam@d3vs.net>, <natinusala@gmail.com>, <m4x@m4xw.net>
+ * wrote this file. As long as you retain this notice you can do whatever you
+ * want with this stuff. If you meet any of us some day, and you think this
+ * stuff is worth it, you can buy us a beer in return.  - The sys-clk authors
+ * --------------------------------------------------------------------------
+ */
+
+#pragma once
+
+#include <switch.h>
+
+#define HOSSVC_HAS_CLKRST (hosversionAtLeast(8,0,0))
+#define HOSSVC_HAS_TC (hosversionAtLeast(5,0,0))
+
+namespace board {
+
+    void Initialize();
+    void Exit();
+
+}

Source/rewrite-hoc-clk/sysmodule/src/board/board_fuse.cpp

@@ -0,0 +1,120 @@
+/*
+ * Copyright (c) Souldbminer, Lightos_ and Horizon OC Contributors
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms and conditions of the GNU General Public License,
+ * version 2, as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+ *
+ */
+
+/* --------------------------------------------------------------------------
+ * "THE BEER-WARE LICENSE" (Revision 42):
+ * <p-sam@d3vs.net>, <natinusala@gmail.com>, <m4x@m4xw.net>
+ * wrote this file. As long as you retain this notice you can do whatever you
+ * want with this stuff. If you meet any of us some day, and you think this
+ * stuff is worth it, you can buy us a beer in return.  - The sys-clk authors
+ * --------------------------------------------------------------------------
+ */
+
+#include <switch.h>
+#include "board_fuse.hpp"
+
+namespace board {
+
+    namespace {
+        constexpr u32 FuseCpuSpeedoCalib = 0x114;
+        // constexpr u32 FuseCpuSpeedo1Calib = 0x12C;
+        constexpr u32 FuseGpuSpeedoCalib = 0x130;
+
+        constexpr u32 FuseSocSpeedoCalib = 0x134;
+        // constexpr u32 FuseSocSpeedo1Calib = 0x138;
+        // constexpr u32 FuseSocSpeedo2Calib = 0x13C;
+
+        constexpr u32 FuseCpuIddqCalib = 0x118;
+        constexpr u32 FuseSocIddqCalib = 0x140;
+        constexpr u32 FuseGpuIddqCalib = 0x228;
+    }
+
+    void SetGpuBracket(u8 speedo, u8 &gpuBracket) {
+        if (speedo <= 1624) {
+            gpuBracket = 0;
+            return;
+        }
+
+        if (speedo <= 1689) {
+            gpuBracket = 1;
+            return;
+        }
+
+        if (speedo <= 1753) {
+            gpuBracket = 2;
+            return;
+        }
+
+        /* >= 1754 */
+        gpuBracket = 3;
+    }
+
+    FuseReadSpeedo(FuseSpeedoData &speedo) {
+        u64 pid = 0;
+        constexpr u64 UsbID = 0x0100000000000006;
+        if (R_FAILED(pmdmntGetProcessId(&pid, UsbID))) {
+            return;
+        }
+
+        Handle debug;
+        if (R_FAILED(svcDebugActiveProcess(&debug, pid))) {
+            return;
+        }
+
+        MemoryInfo mem_info = {};
+        u32 pageinfo = 0;
+        u64 addr = 0;
+
+        u8 stack[0x10] = {};
+        const u8 compare[0x10] = {};
+        u8 dump[0x400] = {};
+        constexpr u64 PageSize = 0x1000;
+
+        while (true) {
+            if (R_FAILED(svcQueryDebugProcessMemory(&mem_info, &pageinfo, debug, addr)) || mem_info.addr < addr) {
+                break;
+            }
+
+            if (mem_info.type == MemType_Io && mem_info.size == PageSize) {
+                if (R_FAILED(svcReadDebugProcessMemory(stack, debug, mem_info.addr, sizeof(stack)))) {
+                    break;
+                }
+
+                if (memcmp(stack, compare, sizeof(stack)) == 0) {
+                    if (R_FAILED(svcReadDebugProcessMemory(dump, debug, mem_info.addr + 0x800, sizeof(dump)))) {
+                        break;
+                    }
+
+                    speedo.cpuSpeedo = *reinterpret_cast<u16*>(dump + FuseCpuSpeedoCalib);
+                    speedo.gpuSpeedo = *reinterpret_cast<u16*>(dump + FuseGpuSpeedoCalib);
+                    speedo.socSpeedo = *reinterpret_cast<u16*>(dump + FuseSocSpeedoCalib);
+                    speedo.cpuIDDQ   = *reinterpret_cast<u16*>(dump + FuseCpuIddqCalib);
+                    speedo.gpuIDDQ   = *reinterpret_cast<u16*>(dump + FuseSocIddqCalib);
+                    speedo.socIDDQ   = *reinterpret_cast<u16*>(dump + FUSE_GPU_IDDQ_CALIB);
+
+                    svcCloseHandle(debug);
+                    return;
+                }
+            }
+
+            addr = mem_info.addr + mem_info.size;
+        }
+
+        svcCloseHandle(debug);
+    }
+
+}

Source/rewrite-hoc-clk/sysmodule/src/board/board_fuse.hpp

@@ -0,0 +1,44 @@
+/*
+ * Copyright (c) Souldbminer, Lightos_ and Horizon OC Contributors
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms and conditions of the GNU General Public License,
+ * version 2, as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+ *
+ */
+
+/* --------------------------------------------------------------------------
+ * "THE BEER-WARE LICENSE" (Revision 42):
+ * <p-sam@d3vs.net>, <natinusala@gmail.com>, <m4x@m4xw.net>
+ * wrote this file. As long as you retain this notice you can do whatever you
+ * want with this stuff. If you meet any of us some day, and you think this
+ * stuff is worth it, you can buy us a beer in return.  - The sys-clk authors
+ * --------------------------------------------------------------------------
+ */
+
+#include <switch.h>
+
+namespace board {
+
+    struct FuseSpeedoData {
+        u16 cpuSpeedo;
+        u16 gpuSpeedo;
+        u16 socSpeedo;
+
+        u16 cpuIDDQ;
+        u16 gpuIDDQ;
+        u16 socIDDQ;
+    };
+
+    FuseReadSpeedo(FuseSpeedoData speedo);
+    FuseSetGpuBracket(u8 gpuSpeedo, u8 &gpuBracket);
+
+}

Source/rewrite-hoc-clk/sysmodule/src/board/board_init.cpp

@@ -0,0 +1,195 @@
+/*
+ * Copyright (c) Souldbminer, Lightos_ and Horizon OC Contributors
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms and conditions of the GNU General Public License,
+ * version 2, as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+ *
+ */
+
+/* --------------------------------------------------------------------------
+ * "THE BEER-WARE LICENSE" (Revision 42):
+ * <p-sam@d3vs.net>, <natinusala@gmail.com>, <m4x@m4xw.net>
+ * wrote this file. As long as you retain this notice you can do whatever you
+ * want with this stuff. If you meet any of us some day, and you think this
+ * stuff is worth it, you can buy us a beer in return.  - The sys-clk authors
+ * --------------------------------------------------------------------------
+ */
+
+#include <nxExt.h>
+#include <sysclk.h>
+#include <switch.h>
+#include <pwm.h>
+
+#include "board.hpp"
+#include "board_fuse.hpp"
+#include "board_load.hpp"
+
+namespace board {
+
+    SysClkSocType gSocType;
+    u8 gDramID;
+    HorizonOCConsoleType gConsoleType = HorizonOCConsoleType_Iowa;
+    FuseSpeedoData gSpeedos;
+    u8 speedoBracket;
+    Result nvCheck = 1;
+    u23 fd = 0, fd2 = 0;
+
+    void FetchHardwareInfos() {
+        FuseReadSpeedos(gSpeedos);
+        FuseSetGpuBracket(gSpeedos.gpuSpeedo, speedoBracket);
+
+        u64 sku = 0, dramID = 0;
+        Result rc = splInitialize();
+        ASSERT_RESULT_OK(rc, "splInitialize");
+
+        rc = splGetConfig(SplConfigItem_HardwareType, &sku);
+        ASSERT_RESULT_OK(rc, "splGetConfig");
+
+        rc = splGetConfig(SplConfigItem_DramId, &dramID);
+        ASSERT_RESULT_OK(rc, "splGetConfig");
+        gDramID = dramID;
+        splExit();
+
+        switch(sku) {
+            case 2 ... 5:
+                gSocType = SysClkSocType_Mariko;
+                break;
+            default:
+                gSocType = SysClkSocType_Erista;
+        }
+
+        if (gSocType == SysClkSocType_Mariko) {
+            CacheDvfsTable();
+        }
+
+        gConsoleType = static_cast<HorizonOCConsoleType> sku;
+        g_dramID     = dramID;
+    }
+
+    /* TODO: Check for config */
+    void Initialize() {
+        Result rc = 0;
+
+        if (HOSSVC_HAS_CLKRST) {
+            rc = clkrstInitialize();
+            ASSERT_RESULT_OK(rc, "clkrstInitialize");
+        } else {
+            rc = pcvInitialize();
+            ASSERT_RESULT_OK(rc, "pcvInitialize");
+        }
+
+        if(HOSSVC_HAS_TC) {
+            rc = tcInitialize();
+            ASSERT_RESULT_OK(rc, "tcInitialize");
+        }
+
+        rc = max17050Initialize();
+        ASSERT_RESULT_OK(rc, "max17050Initialize");
+
+        rc = tmp451Initialize();
+        ASSERT_RESULT_OK(rc, "tmp451Initialize");
+
+        nvInitialize_rc = nvInitialize();
+        if (R_SUCCEEDED(nvInitialize_rc)) {
+            nvCheck = nvOpen(&fd, "/dev/nvhost-ctrl-gpu");
+            nvCheck_sched = nvOpen(&fd2, "/dev/nvsched-ctrl");
+        }
+
+        rc = rgltrInitialize();
+        ASSERT_RESULT_OK(rc, "rgltrInitialize");
+
+        rc = pmdmntInitialize();
+        ASSERT_RESULT_OK(rc, "pmdmntInitialize");
+
+        StartGpuLoad(nvCheck, fd);
+
+        leventClear(&threadexit);
+        threadCreate(&cpuCore0Thread, CheckCore, &idletick0, NULL, 0x1000, 0x10, 0);
+        threadCreate(&cpuCore1Thread, CheckCore, &idletick1, NULL, 0x1000, 0x10, 1);
+        threadCreate(&cpuCore2Thread, CheckCore, &idletick2, NULL, 0x1000, 0x10, 2);
+        // threadCreate(&cpuCore3Thread, CheckCore, &idletick3, NULL, 0x1000, 0x10, 3);
+        threadCreate(&miscThread, miscThreadFunc, NULL, NULL, 0x1000, 0x10, 3);
+
+        threadStart(&cpuCore0Thread);
+        threadStart(&cpuCore1Thread);
+        threadStart(&cpuCore2Thread);
+        // threadStart(&cpuCore3Thread);
+
+        threadStart(&miscThread);
+        batteryInfoInitialize();
+        FetchHardwareInfos();
+
+        if (hosversionAtLeast(6,0,0) && R_SUCCEEDED(pwmInitialize())) {
+            pwmCheck = pwmOpenSession2(&g_ICon, 0x3D000001);
+        }
+
+        if (gConsoleType != HorizonOCConsoleType_Hoag) {
+            u64 clkVirtAddr, dsiVirtAddr, outsize;
+
+            rc = svcQueryMemoryMapping(&clkVirtAddr, &outsize, 0x60006000, 0x1000);
+            ASSERT_RESULT_OK(rc, "svcQueryMemoryMapping (clk)");
+
+            rc = svcQueryMemoryMapping(&dsiVirtAddr, &outsize, 0x54300000, 0x40000);
+            ASSERT_RESULT_OK(rc, "svcQueryMemoryMapping (dsi)");
+
+            DisplayRefreshConfig cfg = {.clkVirtAddr = clkVirtAddr, .dsiVirtAddr = dsiVirtAddr};
+            DisplayRefresh_Initialize(&cfg);
+        }
+
+       // rc = svcQueryMemoryMapping(&cldvfs, &cldvfs_temp, CLDVFS_REGION_BASE, CLDVFS_REGION_SIZE);
+       // ASSERT_RESULT_OK(rc, "svcQueryMemoryMapping (cldvfs)");
+
+       // if (socType == SysClkSocType_Erista) {
+       //     cachedEristaUvLowTune0 = *(u32*) (cldvfs + CL_DVFS_TUNE0_0);
+       //     cachedEristaUvLowTune1 = *(u32*) (cldvfs + CL_DVFS_TUNE1_0);
+       // } else {
+       //     SetHz(SysClkModule_CPU, 1785000000);
+       //     cachedMarikoUvHighTune0 = *(u32*) (cldvfs + CL_DVFS_TUNE0_0);
+       //     ResetToStockCpu();
+       // }
+    }
+
+    void Exit() {
+        if (HOSSVC_HAS_CLKRST) {
+            clkrstExit();
+        } else {
+            pcvExit();
+        }
+
+        apmExtExit();
+        psmExit();
+
+        if (HOSSVC_HAS_TC) {
+            tcExit();
+        }
+
+        max17050Exit();
+        tmp451Exit();
+
+        ExitLoad();
+
+        // threadClose(&cpuCore3Thread);
+        threadClose(&miscThread);
+
+        pwmChannelSessionClose(&g_ICon);
+        pwmExit();
+        rgltrExit();
+        batteryInfoExit();
+        pmdmntExit();
+        nvExit();
+
+        if (gConsoleType != HorizonOCConsoleType_Hoag) {
+            DisplayRefresh_Shutdown();
+        }
+    }
+
+}

Source/rewrite-hoc-clk/sysmodule/src/board/board_load.cpp

@@ -0,0 +1,66 @@
+/*
+ * Copyright (c) Souldbminer, Lightos_ and Horizon OC Contributors
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms and conditions of the GNU General Public License,
+ * version 2, as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+ *
+ */
+
+/* --------------------------------------------------------------------------
+ * "THE BEER-WARE LICENSE" (Revision 42):
+ * <p-sam@d3vs.net>, <natinusala@gmail.com>, <m4x@m4xw.net>
+ * wrote this file. As long as you retain this notice you can do whatever you
+ * want with this stuff. If you meet any of us some day, and you think this
+ * stuff is worth it, you can buy us a beer in return.  - The sys-clk authors
+ * --------------------------------------------------------------------------
+ */
+
+#include <switch.h>
+
+namespace board {
+
+    Thread gpuThread;
+    u32 gpuLoad;
+    u32 _fd;
+
+    void GpuLoadThread(Result *nvCheck) {
+        constexpr u32 GpuSamples = 8;
+        u32 gpu_load_array[GpuSamples] = {};
+        size_t i = 0;
+        constexpr u32 NVGPU_GPU_IOCTL_PMU_GET_GPU_LOAD  = 0x80044715;
+
+        if (R_SUCCEEDED(nvCheck)) do {
+            u32 temp;
+            if (R_SUCCEEDED(nvIoctl(_fd, NVGPU_GPU_IOCTL_PMU_GET_GPU_LOAD, &temp))) {
+                gpu_load_array[i++ % gpu_samples_average] = temp;
+                gpuLoad = std::accumulate(&gpu_load_array[0], &gpu_load_array[gpu_samples_average], 0) / gpu_samples_average;
+            }
+            svcSleepThread(16'666'000); // wait a bit (this is the perfect amount of time to keep the reading accurate)
+        } while(true);
+    }
+
+    void StartGpuLoad(Result nvCheck, u32 fd) {
+        _fd = fd;
+
+        threadCreate(&gpuThread, GpuLoadThread, &nvCheck, NULL, 0x1000, 0x3F, -2);
+        threadStart(&gpuThread);
+    }
+
+    void ExitLoad() {
+        threadClose(gpuThread);
+    }
+
+    void StartCpuLoad() {
+
+    }
+
+}

Source/rewrite-hoc-clk/sysmodule/src/board/board_load.hpp

@@ -0,0 +1,35 @@
+/*
+ * Copyright (c) Souldbminer, Lightos_ and Horizon OC Contributors
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms and conditions of the GNU General Public License,
+ * version 2, as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+ *
+ */
+
+/* --------------------------------------------------------------------------
+ * "THE BEER-WARE LICENSE" (Revision 42):
+ * <p-sam@d3vs.net>, <natinusala@gmail.com>, <m4x@m4xw.net>
+ * wrote this file. As long as you retain this notice you can do whatever you
+ * want with this stuff. If you meet any of us some day, and you think this
+ * stuff is worth it, you can buy us a beer in return.  - The sys-clk authors
+ * --------------------------------------------------------------------------
+ */
+
+#pragma once
+
+namespace board {
+
+    void StartGpuLoad(Result nvCheck, u32 fd);
+    void StartCpuLoad();
+    void ExitLoad();
+
+}