ams: bump version to 0.8.10

simple sd_save flag

common/defaults/BCT.ini

@@ -8,6 +8,9 @@ stage2_entrypoint = 0xF0000000
 ; Note: Disabling debugmode will cause parts of ams.tma to not work, in the future.
 debugmode = 1 
 debugmode_user = 0
+; Note: Disabling usermode exception handlers will cause atmosphere to not fail gracefully under error conditions.
+; Support will not be provided to users who disable these. If you do not know what you are doing, leave them on.
+disable_user_exception_handlers = 0
 
 [stratosphere]
 ; To force-enable nogc, add nogc = 1

common/include/atmosphere/version.h

@@ -19,7 +19,7 @@
 
 #define ATMOSPHERE_RELEASE_VERSION_MAJOR    0
 #define ATMOSPHERE_RELEASE_VERSION_MINOR    8
-#define ATMOSPHERE_RELEASE_VERSION_MICRO    9
+#define ATMOSPHERE_RELEASE_VERSION_MICRO    10
 
 #define ATMOSPHERE_SUPPORTED_HOS_VERSION_MAJOR 8
 #define ATMOSPHERE_SUPPORTED_HOS_VERSION_MINOR 0

docs/changelog.md

@@ -1,4 +1,20 @@
 # Changelog
+## 0.8.10
++ A bug was fixed that could cause incorrect system memory allocation on 5.0.0.
+  + 5.0.0 should now correctly have an additional 12 MiB allocated for sysmodules.
++ Atmosphère features which check button presses now consider all controllers, isntead of just P1.
++ Support was added for configuring language/region on a per-game basis.
+  + This is managed by editing `atmosphere/titles/<title id>/config.ini` for the game.
+  + To edit title language, edit `override_config!override_language`.
+    + The languages supported are `ja`, `en-US`, `fr`, `de`, `it`, `es`, `zh-CN`, `ko`, `nl`, `pt`, `ru`, `zh-TW`, `en-GB`, `fr-CA`, `es-419`, `zh-Hans`, `zh-Hant`.
+  + To edit title region, edit `override_config!override_region`.
+    + The regions supported are `jpn`, `usa`, `eur`, `aus`, `chn`, `kor`, `twn`.
++ Atmosphère now provides a reimplementation of the `boot` system module.
+  + `boot` is responsible for performing hardware initialization, showing the Nintendo logo, and repairing NAND on system update failure.
+  + Atmosphère's `boot` implementation preserves AutoRCM during NAND repair.
+    + NAND repair occurs when an unexpected shutdown or error happens during a system update.
+    + This fixes a final edge case where AutoRCM might be removed by HOS, which could cause a user to burn fuses.
++ General system stability improvements to enhance the user's experience.
 ## 0.8.9
 + A number of bugs were fixed, including:
   + A data abort was fixed when mounting certain partitions on NAND.

exosphere/src/configitem.c

@@ -37,6 +37,7 @@
 
 static bool g_hiz_mode_enabled = false;
 static bool g_debugmode_override_user = false, g_debugmode_override_priv = false;
+static bool g_enable_usermode_exception_handlers = true;
 
 uint32_t configitem_set(bool privileged, ConfigItem item, uint64_t value) {
     switch (item) {
@@ -163,6 +164,10 @@ void configitem_set_debugmode_override(bool user, bool priv) {
     g_debugmode_override_priv = priv;
 }
 
+void configitem_disable_usermode_exception_handlers(void) {
+    g_enable_usermode_exception_handlers = false;
+}
+
 uint32_t configitem_get(bool privileged, ConfigItem item, uint64_t *p_outvalue) {
     uint32_t result = 0;
     switch (item) {
@@ -213,8 +218,10 @@ uint32_t configitem_get(bool privileged, ConfigItem item, uint64_t *p_outvalue)
         case CONFIGITEM_KERNELCONFIGURATION:
             {
                 uint64_t config = bootconfig_get_kernel_configuration();
-                /* Always enable usermode exception handlers. */
-                config |= KERNELCONFIGFLAG_ENABLE_USER_EXCEPTION_HANDLERS;
+                /* Enable usermode exception handlers by default. */
+                if (g_enable_usermode_exception_handlers) {
+                    config |= KERNELCONFIGFLAG_ENABLE_USER_EXCEPTION_HANDLERS;
+                }
                 *p_outvalue = config;
             }
             break;

exosphere/src/configitem.h

@@ -60,6 +60,7 @@ bool configitem_is_hiz_mode_enabled(void);
 bool configitem_is_debugmode_priv(void);
 
 void configitem_set_debugmode_override(bool user, bool priv);
+void configitem_disable_usermode_exception_handlers(void);
 void configitem_set_hiz_mode_enabled(bool enabled);
 
 uint64_t configitem_get_hardware_type(void);

exosphere/src/exocfg.c

@@ -75,3 +75,11 @@ unsigned int exosphere_should_override_debugmode_user(void) {
     
     return EXOSPHERE_CHECK_FLAG(EXOSPHERE_FLAG_IS_DEBUGMODE_USER);
 }
+
+unsigned int exosphere_should_disable_usermode_exception_handlers(void) {
+    if (!g_has_loaded_config) {
+        generic_panic();
+    }
+    
+    return EXOSPHERE_CHECK_FLAG(EXOSPHERE_FLAG_DISABLE_USERMODE_EXCEPTION_HANDLERS);
+}

exosphere/src/exocfg.h

@@ -35,10 +35,11 @@
 /* Exosphere config in DRAM shares physical/virtual mapping. */
 #define MAILBOX_EXOSPHERE_CONFIG_PHYS MAILBOX_EXOSPHERE_CONFIG
 
-#define EXOSPHERE_FLAGS_DEFAULT 0x00000000
-#define EXOSPHERE_FLAG_PERFORM_620_KEYGEN (1 << 0u)
-#define EXOSPHERE_FLAG_IS_DEBUGMODE_PRIV  (1 << 1u)
-#define EXOSPHERE_FLAG_IS_DEBUGMODE_USER  (1 << 2u)
+#define EXOSPHERE_FLAG_PERFORM_620_KEYGEN                   (1 << 0u)
+#define EXOSPHERE_FLAG_IS_DEBUGMODE_PRIV                    (1 << 1u)
+#define EXOSPHERE_FLAG_IS_DEBUGMODE_USER                    (1 << 2u)
+#define EXOSPHERE_FLAG_DISABLE_USERMODE_EXCEPTION_HANDLERS  (1 << 3u)
+#define EXOSPHERE_FLAGS_DEFAULT (EXOSPHERE_FLAG_IS_DEBUGMODE_PRIV)
 
 typedef struct {
     unsigned int magic;
@@ -52,6 +53,7 @@ unsigned int exosphere_get_target_firmware(void);
 unsigned int exosphere_should_perform_620_keygen(void);
 unsigned int exosphere_should_override_debugmode_priv(void);
 unsigned int exosphere_should_override_debugmode_user(void);
+unsigned int exosphere_should_disable_usermode_exception_handlers(void);
 
 static inline unsigned int exosphere_get_target_firmware_for_init(void) {
     const unsigned int magic = MAILBOX_EXOSPHERE_CONFIG_PHYS.magic;

exosphere/src/package2.c

@@ -538,6 +538,9 @@ void load_package2(coldboot_crt0_reloc_list_t *reloc_list) {
     /* Load Exosphere-specific config. */
     exosphere_load_config();
     configitem_set_debugmode_override(exosphere_should_override_debugmode_user() != 0, exosphere_should_override_debugmode_priv() != 0);
+    if (exosphere_should_disable_usermode_exception_handlers() != 0) {
+        configitem_disable_usermode_exception_handlers();
+    }
 
     /* Setup the Security Engine. */
     setup_se();

exosphere/src/smc_api.c

@@ -38,11 +38,6 @@
 #include "sc7.h"
 #include "exocfg.h"
 
-#define SMC_USER_HANDLERS 0x13
-#define SMC_PRIV_HANDLERS 0x9
-
-#define SMC_AMS_HANDLERS 0x2
-
 #define DEBUG_LOG_SMCS 0
 #define DEBUG_PANIC_ON_FAILURE 0
 
@@ -97,7 +92,7 @@ typedef struct {
     uint32_t num_handlers;
 } smc_table_t;
 
-static smc_table_entry_t g_smc_user_table[SMC_USER_HANDLERS] = {
+static smc_table_entry_t g_smc_user_table[] = {
     {0, 4, NULL},
     {0xC3000401, 4, smc_set_config_user},
     {0xC3000002, 1, smc_get_config_user},
@@ -118,8 +113,9 @@ static smc_table_entry_t g_smc_user_table[SMC_USER_HANDLERS] = {
     {0xC3000011, 4, smc_load_titlekey},
     {0xC3000012, 4, smc_unwrap_aes_wrapped_titlekey}
 };
+#define SMC_USER_HANDLERS (sizeof(g_smc_user_table) / sizeof(g_smc_user_table[0]))
 
-static smc_table_entry_t g_smc_priv_table[SMC_PRIV_HANDLERS] = {
+static smc_table_entry_t g_smc_priv_table[] = {
     {0, 4, NULL},
     {0xC4000001, 4, smc_cpu_suspend},
     {0x84000002, 4, smc_cpu_off},
@@ -130,12 +126,15 @@ static smc_table_entry_t g_smc_priv_table[SMC_PRIV_HANDLERS] = {
     {0xC3000007, 1, smc_configure_carveout},
     {0xC3000008, 1, smc_read_write_register}
 };
+#define SMC_PRIV_HANDLERS (sizeof(g_smc_priv_table) / sizeof(g_smc_priv_table[0]))
 
 /* This is a table used for atmosphere-specific SMCs. */
-static smc_table_entry_t g_smc_ams_table[SMC_AMS_HANDLERS] = {
+static smc_table_entry_t g_smc_ams_table[] = {
     {0, 4, NULL},
     {0xF0000201, 0, smc_ams_iram_copy},
+    {0xF0000002, 0, smc_read_write_register},
 };
+#define SMC_AMS_HANDLERS (sizeof(g_smc_ams_table) / sizeof(g_smc_ams_table[0]))
 
 static smc_table_t g_smc_tables[SMC_HANDLER_COUNT + 1] = {
     { /* SMC_HANDLER_USER */

fusee/fusee-primary/src/sdmmc/sdmmc_core.c

@@ -668,7 +668,7 @@ static int sdmmc_int_clk_enable(sdmmc_t *sdmmc)
 
     /* Clock failed to stabilize. */
     if (is_timeout) {
-        sdmmc_error(sdmmc, "clock never stabilized!");
+        sdmmc_error(sdmmc, "Clock never stabilized!");
         return 0;
     }
 
@@ -1353,8 +1353,11 @@ static int sdmmc_dma_init(sdmmc_t *sdmmc, sdmmc_request_t *req)
 {
     /* Invalid block count or size. */
     if (!req->blksz || !req->num_blocks)
+    {
+        sdmmc_error(sdmmc, "Empty DMA request!");
         return 0;
-
+    }
+    
     uint32_t blkcnt = req->num_blocks;
     
     /* Truncate block count. Length can't be over 65536 bytes. */
@@ -1366,8 +1369,11 @@ static int sdmmc_dma_init(sdmmc_t *sdmmc, sdmmc_request_t *req)
 
     /* DMA buffer address must be aligned to 4 bytes. */
     if ((4 - (dma_base_addr & 0x03)) & 0x03)
+    {
+        sdmmc_error(sdmmc, "Invalid DMA request data buffer: 0x%08X", dma_base_addr);
         return 0;
-
+    }
+    
     /* Write our address to the registers. */
     if (sdmmc->use_adma)
     {

fusee/fusee-secondary/Makefile

@@ -96,7 +96,7 @@ export DEPSDIR	:=	$(CURDIR)/$(BUILD)
 CFILES		:=	$(foreach dir,$(SOURCES),$(notdir $(wildcard $(dir)/*.c)))
 CPPFILES	:=	$(foreach dir,$(SOURCES),$(notdir $(wildcard $(dir)/*.cpp)))
 SFILES		:=	$(foreach dir,$(SOURCES),$(notdir $(wildcard $(dir)/*.s)))
-KIPFILES 	:=	loader.kip pm.kip sm.kip ams_mitm.kip spl.kip boot_100.kip boot_200.kip
+KIPFILES 	:=	loader.kip pm.kip sm.kip ams_mitm.kip spl.kip boot.kip
 BINFILES	:=	$(foreach dir,$(DATA),$(notdir $(wildcard $(dir)/*.*))) fusee-primary.bin \
 				exosphere.bin lp0fw.bin rebootstub.bin thermosphere.bin splash_screen.bmp \
 				sept-primary.bin sept-secondary.enc \

fusee/fusee-secondary/linker.ld

@@ -220,10 +220,8 @@ SECTIONS
        ======================= */
     PROVIDE(__ams_mitm_kip_start__ = ams_mitm_kip - __start__);
     PROVIDE(__ams_mitm_kip_size__ = ams_mitm_kip_end - ams_mitm_kip);
-    PROVIDE(__boot_100_kip_start__ = boot_100_kip - __start__);
-    PROVIDE(__boot_100_kip_size__ = boot_100_kip_end - boot_100_kip);
-    PROVIDE(__boot_200_kip_start__ = boot_200_kip - __start__);
-    PROVIDE(__boot_200_kip_size__ = boot_200_kip_end - boot_200_kip);
+    PROVIDE(__boot_kip_start__ = boot_kip - __start__);
+    PROVIDE(__boot_kip_size__ = boot_kip_end - boot_kip);
     PROVIDE(__exosphere_bin_start__ = exosphere_bin - __start__);
     PROVIDE(__exosphere_bin_size__ = exosphere_bin_end - exosphere_bin);
     PROVIDE(__fusee_primary_bin_start__ = fusee_primary_bin - __start__);

fusee/fusee-secondary/src/exocfg.h

@@ -24,10 +24,11 @@
 /* "EXO0" */
 #define MAGIC_EXOSPHERE_CONFIG (0x304F5845)
 
-#define EXOSPHERE_FLAGS_DEFAULT 0x00000000
-#define EXOSPHERE_FLAG_PERFORM_620_KEYGEN (1 << 0u)
-#define EXOSPHERE_FLAG_IS_DEBUGMODE_PRIV  (1 << 1u)
-#define EXOSPHERE_FLAG_IS_DEBUGMODE_USER  (1 << 2u)
+#define EXOSPHERE_FLAG_PERFORM_620_KEYGEN                   (1 << 0u)
+#define EXOSPHERE_FLAG_IS_DEBUGMODE_PRIV                    (1 << 1u)
+#define EXOSPHERE_FLAG_IS_DEBUGMODE_USER                    (1 << 2u)
+#define EXOSPHERE_FLAG_DISABLE_USERMODE_EXCEPTION_HANDLERS  (1 << 3u)
+#define EXOSPHERE_FLAGS_DEFAULT (EXOSPHERE_FLAG_IS_DEBUGMODE_PRIV)
 
 typedef struct {
     unsigned int magic;
@@ -41,5 +42,6 @@ typedef struct {
 #define EXOSPHERE_TARGETFW_KEY "target_firmware"
 #define EXOSPHERE_DEBUGMODE_PRIV_KEY "debugmode"
 #define EXOSPHERE_DEBUGMODE_USER_KEY "debugmode_user"
+#define EXOSPHERE_DISABLE_USERMODE_EXCEPTION_HANDLERS_KEY "disable_user_exception_handlers"
 
 #endif

fusee/fusee-secondary/src/main.c

@@ -39,6 +39,7 @@
 
 extern void (*__program_exit_callback)(int rc);
 
+static __attribute__((__aligned__(0x200))) stage2_args_t g_stage2_args_store;
 static stage2_args_t *g_stage2_args;
 static bool g_do_nxboot;
 
@@ -84,7 +85,8 @@ int main(int argc, void **argv) {
         generic_panic();
     }
     
-    g_stage2_args = (stage2_args_t *)argv[STAGE2_ARGV_ARGUMENT_STRUCT];
+    g_stage2_args = &g_stage2_args_store;
+    memcpy(g_stage2_args, (stage2_args_t *)argv[STAGE2_ARGV_ARGUMENT_STRUCT], sizeof(*g_stage2_args));
 
     if (g_stage2_args->version != 0) {
         generic_panic();
@@ -101,10 +103,11 @@ int main(int argc, void **argv) {
     
     /* Load BCT0 from SD if needed. */
     if (strcmp(g_stage2_args->bct0, "") == 0) {
-        read_from_file(g_stage2_args->bct0, sizeof(g_stage2_args->bct0) - 1, "atmosphere/BCT.ini");
-        if (!read_from_file(g_stage2_args->bct0, sizeof(g_stage2_args->bct0) - 1, "atmosphere/BCT.ini")) {
+        uint32_t bct_tmp_buf[sizeof(g_stage2_args->bct0) / sizeof(uint32_t)] = {0};
+        if (!read_from_file(bct_tmp_buf, sizeof(bct_tmp_buf) - 1, "atmosphere/BCT.ini")) {
             fatal_error("Failed to read BCT0 from SD!\n");
         }
+        memcpy(g_stage2_args->bct0, bct_tmp_buf, sizeof(bct_tmp_buf));
     }
 
     /* This will load all remaining binaries off of the SD. */

fusee/fusee-secondary/src/nxboot.c

@@ -106,22 +106,27 @@ static int exosphere_ini_handler(void *user, const char *section, const char *na
     if (strcmp(section, "exosphere") == 0) {
         if (strcmp(name, EXOSPHERE_TARGETFW_KEY) == 0) {
             sscanf(value, "%d", &exo_cfg->target_firmware);
-        } 
-        if (strcmp(name, EXOSPHERE_DEBUGMODE_PRIV_KEY) == 0) {
+        } else if (strcmp(name, EXOSPHERE_DEBUGMODE_PRIV_KEY) == 0) {
             sscanf(value, "%d", &tmp);
             if (tmp) {
                 exo_cfg->flags |= EXOSPHERE_FLAG_IS_DEBUGMODE_PRIV;
             } else {
                 exo_cfg->flags &= ~(EXOSPHERE_FLAG_IS_DEBUGMODE_PRIV);
             }
-        } 
-        if (strcmp(name, EXOSPHERE_DEBUGMODE_USER_KEY) == 0) {
+        } else if (strcmp(name, EXOSPHERE_DEBUGMODE_USER_KEY) == 0) {
             sscanf(value, "%d", &tmp);
             if (tmp) {
                 exo_cfg->flags |= EXOSPHERE_FLAG_IS_DEBUGMODE_USER;
             } else {
                 exo_cfg->flags &= ~(EXOSPHERE_FLAG_IS_DEBUGMODE_USER);
             }
+        } else if (strcmp(name, EXOSPHERE_DISABLE_USERMODE_EXCEPTION_HANDLERS_KEY) == 0) {
+            sscanf(value, "%d", &tmp);
+            if (tmp) {
+                exo_cfg->flags |= EXOSPHERE_FLAG_DISABLE_USERMODE_EXCEPTION_HANDLERS;
+            } else {
+                exo_cfg->flags &= ~(EXOSPHERE_FLAG_DISABLE_USERMODE_EXCEPTION_HANDLERS);
+            }
         } else {
             return 0;
         }

fusee/fusee-secondary/src/sdmmc/sdmmc_core.c

@@ -668,7 +668,7 @@ static int sdmmc_int_clk_enable(sdmmc_t *sdmmc)
 
     /* Clock failed to stabilize. */
     if (is_timeout) {
-        sdmmc_error(sdmmc, "clock never stabilized!");
+        sdmmc_error(sdmmc, "Clock never stabilized!");
         return 0;
     }
 
@@ -1353,8 +1353,11 @@ static int sdmmc_dma_init(sdmmc_t *sdmmc, sdmmc_request_t *req)
 {
     /* Invalid block count or size. */
     if (!req->blksz || !req->num_blocks)
+    {
+        sdmmc_error(sdmmc, "Empty DMA request!");
         return 0;
-
+    }
+    
     uint32_t blkcnt = req->num_blocks;
     
     /* Truncate block count. Length can't be over 65536 bytes. */
@@ -1366,8 +1369,11 @@ static int sdmmc_dma_init(sdmmc_t *sdmmc, sdmmc_request_t *req)
 
     /* DMA buffer address must be aligned to 4 bytes. */
     if ((4 - (dma_base_addr & 0x03)) & 0x03)
+    {
+        sdmmc_error(sdmmc, "Invalid DMA request data buffer: 0x%08X", dma_base_addr);
         return 0;
-
+    }
+    
     /* Write our address to the registers. */
     if (sdmmc->use_adma)
     {

fusee/fusee-secondary/src/start.s

@@ -103,20 +103,12 @@ _content_headers:
 .asciz "ams_mitm"
 .align 5
 
-/* boot_100 content header */
-.word __boot_100_kip_start__
-.word __boot_100_kip_size__
+/* boot content header */
+.word __boot_kip_start__
+.word __boot_kip_size__
 .word CONTENT_TYPE_KIP
 .word 0xCCCCCCCC
-.asciz "boot_100"
-.align 5
-
-/* boot_200 content header */
-.word __boot_200_kip_start__
-.word __boot_200_kip_size__
-.word CONTENT_TYPE_KIP
-.word 0xCCCCCCCC
-.asciz "boot_200"
+.asciz "boot"
 .align 5
 
 /* exosphere content header */

fusee/fusee-secondary/src/stratosphere.c

@@ -33,8 +33,7 @@
 #include "pm_kip.h"
 #include "sm_kip.h"
 #include "ams_mitm_kip.h"
-#include "boot_100_kip.h"
-#include "boot_200_kip.h"
+#include "boot_kip.h"
 #include "spl_kip.h"
 #undef u8
 #undef u32
@@ -47,18 +46,14 @@ static bool g_stratosphere_sm_enabled = true;
 static bool g_stratosphere_pm_enabled = true;
 static bool g_stratosphere_ams_mitm_enabled = true;
 static bool g_stratosphere_spl_enabled = true;
-static bool g_stratosphere_boot_enabled = false;
+static bool g_stratosphere_boot_enabled = true;
 
-extern const uint8_t boot_100_kip[], boot_200_kip[];
-extern const uint8_t loader_kip[], pm_kip[], sm_kip[], spl_kip[], ams_mitm_kip[];
-extern const uint32_t boot_100_kip_size, boot_200_kip_size;
-extern const uint32_t loader_kip_size, pm_kip_size, sm_kip_size, spl_kip_size, ams_mitm_kip_size;
+extern const uint8_t loader_kip[], pm_kip[], sm_kip[], spl_kip[], boot_kip[], ams_mitm_kip[];
+extern const uint32_t loader_kip_size, pm_kip_size, sm_kip_size, spl_kip_size, boot_kip_size, ams_mitm_kip_size;
 
 /* GCC doesn't consider the size as const... we have to write it ourselves. */
 
 ini1_header_t *stratosphere_get_ini1(uint32_t target_firmware) {
-    const uint8_t *boot_kip = NULL;
-    uint32_t boot_kip_size = 0;
     uint32_t num_processes = 0;
     uint8_t *data;
 
@@ -66,14 +61,6 @@ ini1_header_t *stratosphere_get_ini1(uint32_t target_firmware) {
         return g_stratosphere_ini1;
     }
 
-    if (target_firmware <= ATMOSPHERE_TARGET_FIRMWARE_100) {
-        boot_kip = boot_100_kip;
-        boot_kip_size = boot_100_kip_size;
-    } else {
-        boot_kip = boot_200_kip;
-        boot_kip_size = boot_200_kip_size;
-    }
-
     size_t size = sizeof(ini1_header_t);
     
     /* Calculate our processes' sizes. */

sept/sept-secondary/src/sdmmc/sdmmc_core.c

@@ -668,7 +668,7 @@ static int sdmmc_int_clk_enable(sdmmc_t *sdmmc)
 
     /* Clock failed to stabilize. */
     if (is_timeout) {
-        sdmmc_error(sdmmc, "clock never stabilized!");
+        sdmmc_error(sdmmc, "Clock never stabilized!");
         return 0;
     }
 
@@ -1353,8 +1353,11 @@ static int sdmmc_dma_init(sdmmc_t *sdmmc, sdmmc_request_t *req)
 {
     /* Invalid block count or size. */
     if (!req->blksz || !req->num_blocks)
+    {
+        sdmmc_error(sdmmc, "Empty DMA request!");
         return 0;
-
+    }
+    
     uint32_t blkcnt = req->num_blocks;
     
     /* Truncate block count. Length can't be over 65536 bytes. */
@@ -1366,8 +1369,11 @@ static int sdmmc_dma_init(sdmmc_t *sdmmc, sdmmc_request_t *req)
 
     /* DMA buffer address must be aligned to 4 bytes. */
     if ((4 - (dma_base_addr & 0x03)) & 0x03)
+    {
+        sdmmc_error(sdmmc, "Invalid DMA request data buffer: 0x%08X", dma_base_addr);
         return 0;
-
+    }
+    
     /* Write our address to the registers. */
     if (sdmmc->use_adma)
     {

stratosphere/ams_mitm/source/amsmitm_main.cpp

@@ -78,6 +78,16 @@ void __appInit(void) {
         if (R_FAILED(rc)) {
             std::abort();
         }
+
+        rc = pmdmntInitialize();
+        if (R_FAILED(rc)) {
+            std::abort();
+        }
+
+        rc = pminfoInitialize();
+        if (R_FAILED(rc)) {
+            std::abort();
+        }
     });
     
     CheckAtmosphereVersion(CURRENT_ATMOSPHERE_VERSION);

stratosphere/ams_mitm/source/fs_mitm/fs_file_storage.cpp

@@ -0,0 +1,112 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include <cstring>
+#include <switch.h>
+#include <stratosphere.hpp>
+
+#include "../utils.hpp"
+#include "fs_file_storage.hpp"
+
+Result FileStorage::UpdateSize() {
+    if (this->size == InvalidSize) {
+        return this->file->GetSize(&this->size);
+    }
+    return ResultSuccess;
+}
+
+Result FileStorage::Read(void *buffer, size_t size, u64 offset) {
+    Result rc;
+    u64 read_size;
+
+    if (size == 0) {
+        return ResultSuccess;
+    }
+    if (buffer == nullptr) {
+        return ResultFsNullptrArgument;
+    }
+    if (R_FAILED((rc = this->UpdateSize()))) {
+        return rc;
+    }
+    if (!IStorage::IsRangeValid(offset, size, this->size)) {
+        return ResultFsOutOfRange;
+    }
+
+    return this->file->Read(&read_size, offset, buffer, size);
+}
+
+Result FileStorage::Write(void *buffer, size_t size, u64 offset) {
+    Result rc;
+
+    if (size == 0) {
+        return ResultSuccess;
+    }
+    if (buffer == nullptr) {
+        return ResultFsNullptrArgument;
+    }
+    if (R_FAILED((rc = this->UpdateSize()))) {
+        return rc;
+    }
+    if (!IStorage::IsRangeValid(offset, size, this->size)) {
+        return ResultFsOutOfRange;
+    }
+
+    return this->file->Write(offset, buffer, size);
+}
+
+Result FileStorage::Flush() {
+    return this->file->Flush();
+}
+
+Result FileStorage::GetSize(u64 *out_size) {
+    Result rc = this->UpdateSize();
+    if (R_FAILED(rc)) {
+        return rc;
+    }
+    *out_size = this->size;
+    return ResultSuccess;
+}
+
+Result FileStorage::SetSize(u64 size) {
+    this->size = InvalidSize;
+    return this->file->SetSize(size);
+}
+
+Result FileStorage::OperateRange(u32 operation_type, u64 offset, u64 size, FsRangeInfo *out_range_info) {
+    Result rc;
+
+    switch (operation_type) {
+        case 2: /* TODO: OperationType_Invalidate */
+        case 3: /* TODO: OperationType_Query */
+            if (size == 0) {
+                if (operation_type == 3) {
+                    if (out_range_info == nullptr) {
+                        return ResultFsNullptrArgument;
+                    }
+                    /* N checks for size == sizeof(*out_range_info) here, but that's because their wrapper api is bad. */
+                    std::memset(out_range_info, 0, sizeof(*out_range_info));
+                }
+                return ResultSuccess;
+            }
+            if (R_FAILED((rc = this->UpdateSize()))) {
+                return rc;
+            }
+            /* N checks for positivity + signed overflow on offset/size here, but we're using unsigned types... */
+            return this->file->OperateRange(operation_type, offset, size, out_range_info);
+        default:
+            return ResultFsUnsupportedOperation;
+    }
+}

stratosphere/ams_mitm/source/fs_mitm/fs_file_storage.hpp

@@ -0,0 +1,54 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+ 
+#pragma once
+#include <switch.h>
+#include <stratosphere.hpp>
+#include "fs_shim.h"
+
+#include "../debug.hpp"
+#include "fs_istorage.hpp"
+#include "fs_ifile.hpp"
+
+class FileStorage : public IStorage {
+    public:
+        static constexpr u64 InvalidSize = UINT64_MAX;
+    private:
+        std::shared_ptr<IFile> base_file;
+        IFile *file;
+        u64 size;
+    public:
+        FileStorage(IFile *f) : base_file(f) {
+            this->file = this->base_file.get();
+            this->size = InvalidSize;
+        };
+        FileStorage(std::shared_ptr<IFile> f) : base_file(f) {
+            this->file = this->base_file.get();
+            this->size = InvalidSize;
+        };
+        virtual ~FileStorage() {
+            /* ... */
+        };
+    protected:
+        Result UpdateSize();
+    public:
+        virtual Result Read(void *buffer, size_t size, u64 offset) override;
+        virtual Result Write(void *buffer, size_t size, u64 offset) override;
+        virtual Result Flush() override;
+        virtual Result GetSize(u64 *out_size) override;
+        virtual Result SetSize(u64 size) override;
+        virtual Result OperateRange(u32 operation_type, u64 offset, u64 size, FsRangeInfo *out_range_info) override;
+};

stratosphere/ams_mitm/source/fs_mitm/fsmitm_service.cpp

@@ -163,12 +163,13 @@ Result FsMitmService::OpenFileSystemWithId(Out<std::shared_ptr<IFileSystemInterf
 
 Result FsMitmService::OpenSaveDataFileSystem(Out<std::shared_ptr<IFileSystemInterface>> out_fs, u8 space_id, FsSave save_struct) {
     bool should_redirect_saves = false;
+    const bool has_redirect_save_flags = Utils::HasFlag(this->title_id, "redirect_save");
     if (R_FAILED(Utils::GetSettingsItemBooleanValue("atmosphere", "fsmitm_redirect_saves_to_sd", &should_redirect_saves))) {
         return ResultAtmosphereMitmShouldForwardToSession;
     }
 
-    /* For now, until we're sure this is robust, only intercept normal savedata. */
-    if (!should_redirect_saves || save_struct.SaveDataType != FsSaveDataType_SaveData) {
+    /* For now, until we're sure this is robust, only intercept normal savedata , check if flag exist*/
+    if (!has_redirect_save_flags || !should_redirect_saves || save_struct.SaveDataType != FsSaveDataType_SaveData) {
         return ResultAtmosphereMitmShouldForwardToSession;
     }
 
@@ -430,4 +431,4 @@ Result FsMitmService::OpenDataStorageByDataId(Out<std::shared_ptr<IStorageInterf
     }
 
     return rc;
-}
+}

stratosphere/ams_mitm/source/set_mitm/set_mitm_service.cpp

@@ -0,0 +1,113 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include <mutex>
+#include <algorithm>
+#include <switch.h>
+#include "set_mitm_service.hpp"
+#include "set_shim.h"
+
+void SetMitmService::PostProcess(IMitmServiceObject *obj, IpcResponseContext *ctx) {
+    /* No commands need postprocessing. */
+}
+
+bool SetMitmService::IsValidLanguageCode(u64 lang_code) {
+    static constexpr u64 s_valid_language_codes[] = {
+        LanguageCode_Japanese,
+        LanguageCode_AmericanEnglish,
+        LanguageCode_French,
+        LanguageCode_German,
+        LanguageCode_Italian,
+        LanguageCode_Spanish,
+        LanguageCode_Chinese,
+        LanguageCode_Korean,
+        LanguageCode_Dutch,
+        LanguageCode_Portuguese,
+        LanguageCode_Russian,
+        LanguageCode_Taiwanese,
+        LanguageCode_BritishEnglish,
+        LanguageCode_CanadianFrench,
+        LanguageCode_LatinAmericanSpanish,
+        LanguageCode_SimplifiedChinese,
+        LanguageCode_TraditionalChinese,
+    };
+    size_t num_language_codes = sizeof(s_valid_language_codes) / sizeof(s_valid_language_codes[0]);
+    if (GetRuntimeFirmwareVersion() < FirmwareVersion_400) {
+        /* 4.0.0 added simplified and traditional chinese. */
+        num_language_codes -= 2;
+    }
+
+    for (size_t i = 0; i < num_language_codes; i++) {
+        if (lang_code == s_valid_language_codes[i]) {
+            return true;
+        }
+    }
+
+    return false;
+}
+
+bool SetMitmService::IsValidRegionCode(u32 region_code) {
+    return region_code < RegionCode_Max;
+}
+
+void SetMitmService::EnsureLocale() {
+    std::scoped_lock<HosMutex> lk(this->lock);
+
+    if (!this->got_locale) {
+        std::memset(&this->locale, 0xCC, sizeof(this->locale));
+        if (this->title_id == TitleId_Ns) {
+            u64 app_pid = 0;
+            u64 app_tid = 0;
+            Result rc;
+            if (R_FAILED((rc = pmdmntGetApplicationPid(&app_pid)))) {
+                return;
+            }
+            if (R_FAILED((rc = pminfoGetTitleId(&app_tid, app_pid)))) {
+                return;
+            }
+            this->locale = Utils::GetTitleOverrideLocale(app_tid);
+        } else {
+            this->locale = Utils::GetTitleOverrideLocale(this->title_id);
+            this->got_locale = true;
+        }
+    }
+}
+
+Result SetMitmService::GetLanguageCode(Out<u64> out_lang_code) {
+    this->EnsureLocale();
+
+    if (!IsValidLanguageCode(this->locale.language_code)) {
+        return ResultAtmosphereMitmShouldForwardToSession;
+    }
+
+    out_lang_code.SetValue(this->locale.language_code);
+    return ResultSuccess;
+}
+
+Result SetMitmService::GetRegionCode(Out<u32> out_region_code) {
+    this->EnsureLocale();
+
+    if (!IsValidRegionCode(this->locale.region_code)) {
+        return ResultAtmosphereMitmShouldForwardToSession;
+    }
+
+    out_region_code.SetValue(this->locale.region_code);
+    return ResultSuccess;
+}
+
+Result SetMitmService::GetAvailableLanguageCodes(OutPointerWithClientSize<u64> out_language_codes, Out<s32> out_count) {
+    return setGetAvailableLanguageCodesFwd(this->forward_service.get(), out_count.GetPointer(), out_language_codes.pointer, out_language_codes.num_elements);
+}

stratosphere/ams_mitm/source/set_mitm/set_mitm_service.hpp

@@ -0,0 +1,68 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+#include <stratosphere.hpp>
+
+#include "../utils.hpp"
+
+enum SetCmd : u32 {
+    SetCmd_GetLanguageCode = 0,
+    SetCmd_GetRegionCode = 4,
+
+    /* Commands for which set:sys *must* act as a passthrough. */
+    /* TODO: Solve the relevant IPC detection problem. */
+    SetCmd_GetAvailableLanguageCodes = 1,
+};
+
+class SetMitmService : public IMitmServiceObject {
+    private:
+        HosMutex lock;
+        OverrideLocale locale;
+        bool got_locale;
+    public:
+        SetMitmService(std::shared_ptr<Service> s, u64 pid) : IMitmServiceObject(s, pid) {
+            this->got_locale = false;
+        }
+
+        static bool ShouldMitm(u64 pid, u64 tid) {
+            /* Mitm all applications. */
+            return tid == TitleId_Ns || TitleIdIsApplication(tid);
+        }
+
+        static void PostProcess(IMitmServiceObject *obj, IpcResponseContext *ctx);
+
+    protected:
+        static bool IsValidLanguageCode(u64 lang_code);
+        static bool IsValidRegionCode(u32 region_code);
+
+        void EnsureLocale();
+    protected:
+        /* Overridden commands. */
+        Result GetLanguageCode(Out<u64> out_lang_code);
+        Result GetRegionCode(Out<u32> out_region_code);
+
+        /* Forced passthrough commands. */
+        Result GetAvailableLanguageCodes(OutPointerWithClientSize<u64> out_language_codes, Out<s32> out_count);
+    public:
+        DEFINE_SERVICE_DISPATCH_TABLE {
+            MakeServiceCommandMeta<SetCmd_GetLanguageCode, &SetMitmService::GetLanguageCode>(),
+            MakeServiceCommandMeta<SetCmd_GetRegionCode, &SetMitmService::GetRegionCode>(),
+
+            MakeServiceCommandMeta<SetCmd_GetAvailableLanguageCodes, &SetMitmService::GetAvailableLanguageCodes>(),
+        };
+};

stratosphere/ams_mitm/source/set_mitm/set_shim.c

@@ -0,0 +1,59 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include <string.h>
+#include <switch.h>
+#include "setsys_shim.h"
+
+/* Command forwarders. */
+Result setGetAvailableLanguageCodesFwd(Service* s, s32 *total_entries, u64 *language_codes, size_t max_entries) {
+    IpcCommand c;
+    ipcInitialize(&c);
+    ipcAddRecvStatic(&c, language_codes, max_entries * sizeof(*language_codes), 0);
+
+    struct {
+        u64 magic;
+        u64 cmd_id;
+    } *raw;
+
+    raw = serviceIpcPrepareHeader(s, &c, sizeof(*raw));
+
+    raw->magic = SFCI_MAGIC;
+    raw->cmd_id = 1;
+
+    Result rc = serviceIpcDispatch(s);
+
+    if (R_SUCCEEDED(rc)) {
+        IpcParsedCommand r;
+
+        struct {
+            u64 magic;
+            u64 result;
+            s32 total_entries;
+        } *resp;
+
+        serviceIpcParse(s, &r, sizeof(*resp));
+        resp = r.Raw;
+
+        rc = resp->result;
+
+        if (R_SUCCEEDED(rc)) {
+            *total_entries = resp->total_entries;
+        }
+    }
+
+    return rc;
+}

stratosphere/ams_mitm/source/set_mitm/set_shim.h

@@ -0,0 +1,19 @@
+/**
+ * @file set_shim.h
+ * @brief Settings Services (set) IPC wrapper. To be merged into libnx, eventually.
+ * @author SciresM
+ * @copyright libnx Authors
+ */
+#pragma once
+#include <switch.h>
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+/* Command forwarders. */
+Result setGetAvailableLanguageCodesFwd(Service* s, s32 *total_entries, u64 *language_codes, size_t max_entries);
+
+#ifdef __cplusplus
+}
+#endif

stratosphere/ams_mitm/source/set_mitm/setmitm_main.cpp

@@ -13,7 +13,7 @@
  * You should have received a copy of the GNU General Public License
  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  */
- 
+
 #include <cstdlib>
 #include <cstdint>
 #include <cstring>
@@ -28,6 +28,8 @@
 #include "setsys_settings_items.hpp"
 #include "setsys_firmware_version.hpp"
 
+#include "set_mitm_service.hpp"
+
 #include "../utils.hpp"
 
 struct SetSysManagerOptions {
@@ -44,17 +46,20 @@ void SetMitmMain(void *arg) {
 
     /* Initialize version manager. */
     VersionManager::Initialize();
-            
+
     /* Create server manager */
-    auto server_manager = new SetMitmManager(3);
-    
+    auto server_manager = new SetMitmManager(4);
+
     /* Create set:sys mitm. */
     AddMitmServerToManager<SetSysMitmService>(server_manager, "set:sys", 60);
-    
+
+    /* Create set mitm. */
+    AddMitmServerToManager<SetMitmService>(server_manager, "set", 60);
+
     /* Loop forever, servicing our services. */
     server_manager->Process();
-    
+
     delete server_manager;
-    
+
 }
 

stratosphere/ams_mitm/source/set_mitm/setsys_shim.c

@@ -55,7 +55,7 @@ Result setsysGetEdidFwd(Service* s, SetSysEdid* out) {
 Result setsysGetSettingsItemValueFwd(Service *s, const char *name, const char *item_key, void *value_out, size_t value_out_size, u64 *size_out) {
     char send_name[SET_MAX_NAME_SIZE];
     char send_item_key[SET_MAX_NAME_SIZE];
-    
+
     memset(send_name, 0, SET_MAX_NAME_SIZE);
     memset(send_item_key, 0, SET_MAX_NAME_SIZE);
     strncpy(send_name, name, SET_MAX_NAME_SIZE-1);

stratosphere/ams_mitm/source/utils.cpp

@@ -13,7 +13,7 @@
  * You should have received a copy of the GNU General Public License
  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  */
- 
+
 #include <switch.h>
 #include <stratosphere.hpp>
 #include <atomic>
@@ -83,18 +83,18 @@ void Utils::InitializeThreadFunc(void *args) {
         static const char * const required_active_services[] = {"pcv", "gpio", "pinmux", "psc:c"};
         for (unsigned int i = 0; i < sizeof(required_active_services) / sizeof(required_active_services[0]); i++) {
             if (R_FAILED(smGetServiceOriginal(&tmp_hnd, smEncodeName(required_active_services[i])))) {
-                /* TODO: Panic */
+                std::abort();
             } else {
-                svcCloseHandle(tmp_hnd);   
+                svcCloseHandle(tmp_hnd);
             }
         }
     });
-    
+
     /* Mount SD. */
     while (R_FAILED(fsMountSdcard(&g_sd_filesystem))) {
         svcSleepThread(1000000ULL);
     }
-    
+
     /* Back up CAL0, if it's not backed up already. */
     fsFsCreateDirectory(&g_sd_filesystem, "/atmosphere/automatic_backups");
     {
@@ -103,18 +103,18 @@ void Utils::InitializeThreadFunc(void *args) {
             std::abort();
         }
         fsStorageClose(&cal0_storage);
-        
+
         char serial_number[0x40] = {0};
         memcpy(serial_number, g_cal0_storage_backup + 0x250, 0x18);
-        
-        
+
+
         char prodinfo_backup_path[FS_MAX_PATH] = {0};
         if (strlen(serial_number) > 0) {
             snprintf(prodinfo_backup_path, sizeof(prodinfo_backup_path) - 1, "/atmosphere/automatic_backups/%s_PRODINFO.bin", serial_number);
         } else {
             snprintf(prodinfo_backup_path, sizeof(prodinfo_backup_path) - 1, "/atmosphere/automatic_backups/PRODINFO.bin");
         }
-        
+
         fsFsCreateFile(&g_sd_filesystem, prodinfo_backup_path, ProdinfoSize, 0);
         if (R_SUCCEEDED(fsFsOpenFile(&g_sd_filesystem, prodinfo_backup_path, FS_OPEN_READ | FS_OPEN_WRITE, &g_cal0_file))) {
             bool has_auto_backup = false;
@@ -132,19 +132,19 @@ void Utils::InitializeThreadFunc(void *args) {
                 }
                 has_auto_backup = is_cal0_valid;
             }
-            
+
             if (!has_auto_backup) {
                 fsFileSetSize(&g_cal0_file, ProdinfoSize);
                 fsFileWrite(&g_cal0_file, 0, g_cal0_storage_backup, ProdinfoSize);
                 fsFileFlush(&g_cal0_file);
             }
-            
+
             /* NOTE: g_cal0_file is intentionally not closed here. This prevents any other process from opening it. */
             memset(g_cal0_storage_backup, 0, sizeof(g_cal0_storage_backup));
             memset(g_cal0_backup, 0, sizeof(g_cal0_backup));
         }
     }
-    
+
     /* Check for MitM flags. */
     FsDir titles_dir;
     if (R_SUCCEEDED(fsFsOpenDirectory(&g_sd_filesystem, "/atmosphere/titles", FS_DIROPEN_DIRECTORY, &titles_dir))) {
@@ -172,7 +172,7 @@ void Utils::InitializeThreadFunc(void *args) {
                         fsFileClose(&f);
                     }
                 }
-                
+
                 memset(title_path, 0, sizeof(title_path));
                 strcpy(title_path, "/atmosphere/titles/");
                 strcat(title_path, dir_entry.name);
@@ -195,25 +195,25 @@ void Utils::InitializeThreadFunc(void *args) {
         }
         fsDirClose(&titles_dir);
     }
-    
+
     Utils::RefreshConfiguration();
-    
+
     /* Initialize set:sys. */
     DoWithSmSession([&]() {
         if (R_FAILED(setsysInitialize())) {
             std::abort();
         }
     });
-    
+
     /* Signal SD is initialized. */
     g_has_initialized = true;
-    
+
     /* Load custom settings configuration. */
     SettingsItemManager::LoadConfiguration();
-    
+
     /* Signal to waiters that we are ready. */
     g_sd_signal.Signal();
-    
+
     /* Initialize HID. */
     while (!g_has_hid_session) {
         DoWithSmSession([&]() {
@@ -243,7 +243,7 @@ Result Utils::OpenSdFile(const char *fn, int flags, FsFile *out) {
     if (!IsSdInitialized()) {
         return ResultFsSdCardNotPresent;
     }
-    
+
     return fsFsOpenFile(&g_sd_filesystem, fn, flags, out);
 }
 
@@ -251,7 +251,7 @@ Result Utils::OpenSdFileForAtmosphere(u64 title_id, const char *fn, int flags, F
     if (!IsSdInitialized()) {
         return ResultFsSdCardNotPresent;
     }
-    
+
     char path[FS_MAX_PATH];
     if (*fn == '/') {
         snprintf(path, sizeof(path), "/atmosphere/titles/%016lx%s", title_id, fn);
@@ -265,7 +265,7 @@ Result Utils::OpenRomFSSdFile(u64 title_id, const char *fn, int flags, FsFile *o
     if (!IsSdInitialized()) {
         return ResultFsSdCardNotPresent;
     }
-    
+
     return OpenRomFSFile(&g_sd_filesystem, title_id, fn, flags, out);
 }
 
@@ -273,7 +273,7 @@ Result Utils::OpenSdDir(const char *path, FsDir *out) {
     if (!IsSdInitialized()) {
         return ResultFsSdCardNotPresent;
     }
-    
+
     return fsFsOpenDirectory(&g_sd_filesystem, path, FS_DIROPEN_DIRECTORY | FS_DIROPEN_FILE, out);
 }
 
@@ -281,7 +281,7 @@ Result Utils::OpenSdDirForAtmosphere(u64 title_id, const char *path, FsDir *out)
     if (!IsSdInitialized()) {
         return ResultFsSdCardNotPresent;
     }
-    
+
     char safe_path[FS_MAX_PATH];
     if (*path == '/') {
         snprintf(safe_path, sizeof(safe_path), "/atmosphere/titles/%016lx%s", title_id, path);
@@ -295,7 +295,7 @@ Result Utils::OpenRomFSSdDir(u64 title_id, const char *path, FsDir *out) {
     if (!IsSdInitialized()) {
         return ResultFsSdCardNotPresent;
     }
-    
+
     return OpenRomFSDir(&g_sd_filesystem, title_id, path, out);
 }
 
@@ -327,7 +327,7 @@ bool Utils::HasSdRomfsContent(u64 title_id) {
         fsFileClose(&data_file);
         return true;
     }
-    
+
     /* Check for romfs folder with non-zero content. */
     FsDir dir;
     if (R_FAILED(Utils::OpenRomFSSdDir(title_id, "", &dir))) {
@@ -336,7 +336,7 @@ bool Utils::HasSdRomfsContent(u64 title_id) {
     ON_SCOPE_EXIT {
         fsDirClose(&dir);
     };
-    
+
     FsDirectoryEntry dir_entry;
     u64 read_entries;
     return R_SUCCEEDED(fsDirRead(&dir, 0, &read_entries, 1, &dir_entry)) && read_entries == 1;
@@ -346,40 +346,40 @@ Result Utils::SaveSdFileForAtmosphere(u64 title_id, const char *fn, void *data,
     if (!IsSdInitialized()) {
         return ResultFsSdCardNotPresent;
     }
-    
+
     Result rc = ResultSuccess;
-    
+
     char path[FS_MAX_PATH];
     if (*fn == '/') {
         snprintf(path, sizeof(path), "/atmosphere/titles/%016lx%s", title_id, fn);
     } else {
         snprintf(path, sizeof(path), "/atmosphere/titles/%016lx/%s", title_id, fn);
     }
-    
+
     /* Unconditionally create. */
     FsFile f;
     fsFsCreateFile(&g_sd_filesystem, path, size, 0);
-    
+
     /* Try to open. */
     rc = fsFsOpenFile(&g_sd_filesystem, path, FS_OPEN_READ | FS_OPEN_WRITE, &f);
     if (R_FAILED(rc)) {
         return rc;
     }
-    
+
     /* Always close, if we opened. */
     ON_SCOPE_EXIT {
         fsFileClose(&f);
     };
-    
+
     /* Try to make it big enough. */
     rc = fsFileSetSize(&f, size);
     if (R_FAILED(rc)) {
         return rc;
     }
-    
+
     /* Try to write the data. */
     rc = fsFileWrite(&f, 0, data, size);
-    
+
     return rc;
 }
 
@@ -395,14 +395,14 @@ bool Utils::HasTitleFlag(u64 tid, const char *flag) {
     if (IsSdInitialized()) {
         FsFile f;
         char flag_path[FS_MAX_PATH];
-        
+
         memset(flag_path, 0, sizeof(flag_path));
         snprintf(flag_path, sizeof(flag_path) - 1, "flags/%s.flag", flag);
         if (R_SUCCEEDED(OpenSdFileForAtmosphere(tid, flag_path, FS_OPEN_READ, &f))) {
             fsFileClose(&f);
             return true;
         }
-        
+
         /* TODO: Deprecate. */
         snprintf(flag_path, sizeof(flag_path) - 1, "%s.flag", flag);
         if (R_SUCCEEDED(OpenSdFileForAtmosphere(tid, flag_path, FS_OPEN_READ, &f))) {
@@ -440,7 +440,7 @@ bool Utils::HasSdMitMFlag(u64 tid) {
     if (IsHblTid(tid)) {
         return true;
     }
-    
+
     if (IsSdInitialized()) {
         return std::find(g_mitm_flagged_tids.begin(), g_mitm_flagged_tids.end(), tid) != g_mitm_flagged_tids.end();
     }
@@ -458,10 +458,14 @@ Result Utils::GetKeysHeld(u64 *keys) {
     if (!Utils::IsHidAvailable()) {
         return MAKERESULT(Module_Libnx, LibnxError_InitFail_HID);
     }
-    
+
     hidScanInput();
-    *keys = hidKeysHeld(CONTROLLER_P1_AUTO);
-    
+    *keys = 0;
+
+    for (int controller = 0; controller < 10; controller++) {
+        *keys |= hidKeysHeld((HidControllerID) controller);
+    }
+
     return ResultSuccess;
 }
 
@@ -477,21 +481,21 @@ bool Utils::HasOverrideButton(u64 tid) {
         /* Disable button override disable for non-applications. */
         return true;
     }
-    
+
     /* Unconditionally refresh loader.ini contents. */
     RefreshConfiguration();
-    
+
     if (IsHblTid(tid) && HasOverrideKey(&g_hbl_override_config.override_key)) {
         return true;
     }
-    
+
     OverrideKey title_cfg = GetTitleOverrideKey(tid);
     return HasOverrideKey(&title_cfg);
 }
 
 static OverrideKey ParseOverrideKey(const char *value) {
     OverrideKey cfg;
-    
+
     /* Parse on by default. */
     if (value[0] == '!') {
         cfg.override_by_default = true;
@@ -499,7 +503,7 @@ static OverrideKey ParseOverrideKey(const char *value) {
     } else {
         cfg.override_by_default = false;
     }
-    
+
     /* Parse key combination. */
     if (strcasecmp(value, "A") == 0) {
         cfg.key_combination = KEY_A;
@@ -540,7 +544,7 @@ static OverrideKey ParseOverrideKey(const char *value) {
     } else {
         cfg.key_combination = 0;
     }
-    
+
     return cfg;
 }
 
@@ -582,7 +586,7 @@ static int FsMitmIniHandler(void *user, const char *section, const char *name, c
 static int FsMitmTitleSpecificIniHandler(void *user, const char *section, const char *name, const char *value) {
     /* We'll output an override key when relevant. */
     OverrideKey *user_cfg = reinterpret_cast<OverrideKey *>(user);
-    
+
     if (strcasecmp(section, "override_config") == 0) {
         if (strcasecmp(name, "override_key") == 0) {
             *user_cfg = ParseOverrideKey(value);
@@ -596,49 +600,107 @@ static int FsMitmTitleSpecificIniHandler(void *user, const char *section, const
 OverrideKey Utils::GetTitleOverrideKey(u64 tid) {
     OverrideKey cfg = g_default_override_key;
     char path[FS_MAX_PATH+1] = {0};
-    snprintf(path, FS_MAX_PATH, "/atmosphere/titles/%016lx/config.ini", tid); 
+    snprintf(path, FS_MAX_PATH, "/atmosphere/titles/%016lx/config.ini", tid);
     FsFile cfg_file;
-    
+
     if (R_SUCCEEDED(fsFsOpenFile(&g_sd_filesystem, path, FS_OPEN_READ, &cfg_file))) {
         ON_SCOPE_EXIT { fsFileClose(&cfg_file); };
-        
+
         size_t config_file_size = 0x20000;
         fsFileGetSize(&cfg_file, &config_file_size);
-        
+
         char *config_buf = reinterpret_cast<char *>(calloc(1, config_file_size + 1));
         if (config_buf != NULL) {
             ON_SCOPE_EXIT { free(config_buf); };
-            
+
             /* Read title ini contents. */
             fsFileRead(&cfg_file, 0, config_buf, config_file_size, &config_file_size);
-            
+
             /* Parse title ini. */
             ini_parse_string(config_buf, FsMitmTitleSpecificIniHandler, &cfg);
         }
     }
-    
+
     return cfg;
 }
 
+static int FsMitmTitleSpecificLocaleIniHandler(void *user, const char *section, const char *name, const char *value) {
+    /* We'll output an override locale when relevant. */
+    OverrideLocale *user_locale = reinterpret_cast<OverrideLocale *>(user);
+
+    if (strcasecmp(section, "override_config") == 0) {
+        if (strcasecmp(name, "override_language") == 0) {
+            user_locale->language_code = EncodeLanguageCode(value);
+        } else if (strcasecmp(name, "override_region") == 0) {
+            if (strcasecmp(value, "jpn") == 0) {
+                user_locale->region_code = RegionCode_Japan;
+            } else if (strcasecmp(value, "usa") == 0) {
+                user_locale->region_code = RegionCode_America;
+            } else if (strcasecmp(value, "eur") == 0) {
+                user_locale->region_code = RegionCode_Europe;
+            } else if (strcasecmp(value, "aus") == 0) {
+                user_locale->region_code = RegionCode_Australia;
+            } else if (strcasecmp(value, "chn") == 0) {
+                user_locale->region_code = RegionCode_China;
+            } else if (strcasecmp(value, "kor") == 0) {
+                user_locale->region_code = RegionCode_Korea;
+            } else if (strcasecmp(value, "twn") == 0) {
+                user_locale->region_code = RegionCode_Taiwan;
+            }
+        }
+    } else {
+        return 0;
+    }
+    return 1;
+}
+
+OverrideLocale Utils::GetTitleOverrideLocale(u64 tid) {
+    OverrideLocale locale;
+    std::memset(&locale, 0xCC, sizeof(locale));
+    char path[FS_MAX_PATH+1] = {0};
+    snprintf(path, FS_MAX_PATH, "/atmosphere/titles/%016lx/config.ini", tid);
+    FsFile cfg_file;
+
+    if (R_SUCCEEDED(fsFsOpenFile(&g_sd_filesystem, path, FS_OPEN_READ, &cfg_file))) {
+        ON_SCOPE_EXIT { fsFileClose(&cfg_file); };
+
+        size_t config_file_size = 0x20000;
+        fsFileGetSize(&cfg_file, &config_file_size);
+
+        char *config_buf = reinterpret_cast<char *>(calloc(1, config_file_size + 1));
+        if (config_buf != NULL) {
+            ON_SCOPE_EXIT { free(config_buf); };
+
+            /* Read title ini contents. */
+            fsFileRead(&cfg_file, 0, config_buf, config_file_size, &config_file_size);
+
+            /* Parse title ini. */
+            ini_parse_string(config_buf, FsMitmTitleSpecificLocaleIniHandler, &locale);
+        }
+    }
+
+    return locale;
+}
+
 void Utils::RefreshConfiguration() {
     FsFile config_file;
     if (R_FAILED(fsFsOpenFile(&g_sd_filesystem, "/atmosphere/loader.ini", FS_OPEN_READ, &config_file))) {
         return;
     }
-    
+
     u64 size;
     if (R_FAILED(fsFileGetSize(&config_file, &size))) {
         return;
     }
-    
+
     size = std::min(size, (decltype(size))0x7FF);
-    
+
     /* Read in string. */
     std::fill(g_config_ini_data, g_config_ini_data + 0x800, 0);
     size_t r_s;
     fsFileRead(&config_file, 0, g_config_ini_data, size, &r_s);
     fsFileClose(&config_file);
-    
+
     ini_parse_string(g_config_ini_data, FsMitmIniHandler, NULL);
 }
 

stratosphere/ams_mitm/source/utils.hpp

@@ -42,6 +42,56 @@ struct OverrideKey {
     bool override_by_default;
 };
 
+struct OverrideLocale {
+    u64 language_code;
+    u32 region_code;
+};
+
+enum RegionCode : u32 {
+    RegionCode_Japan = 0,
+    RegionCode_America = 1,
+    RegionCode_Europe = 2,
+    RegionCode_Australia = 3,
+    RegionCode_China = 4,
+    RegionCode_Korea = 5,
+    RegionCode_Taiwan = 6,
+
+    RegionCode_Max,
+};
+
+static constexpr inline u64 EncodeLanguageCode(const char *code) {
+    u64 lang_code = 0;
+    for (size_t i = 0; i < sizeof(lang_code); i++) {
+        if (code[i] == '\x00') {
+            break;
+        }
+        lang_code |= static_cast<u64>(code[i]) << (8ul * i);
+    }
+    return lang_code;
+}
+
+enum LanguageCode : u64 {
+    LanguageCode_Japanese = EncodeLanguageCode("ja"),
+    LanguageCode_AmericanEnglish = EncodeLanguageCode("en-US"),
+    LanguageCode_French = EncodeLanguageCode("fr"),
+    LanguageCode_German = EncodeLanguageCode("de"),
+    LanguageCode_Italian = EncodeLanguageCode("it"),
+    LanguageCode_Spanish = EncodeLanguageCode("es"),
+    LanguageCode_Chinese = EncodeLanguageCode("zh-CN"),
+    LanguageCode_Korean = EncodeLanguageCode("ko"),
+    LanguageCode_Dutch = EncodeLanguageCode("nl"),
+    LanguageCode_Portuguese = EncodeLanguageCode("pt"),
+    LanguageCode_Russian = EncodeLanguageCode("ru"),
+    LanguageCode_Taiwanese = EncodeLanguageCode("zh-TW"),
+    LanguageCode_BritishEnglish = EncodeLanguageCode("en-GB"),
+    LanguageCode_CanadianFrench = EncodeLanguageCode("fr-CA"),
+    LanguageCode_LatinAmericanSpanish = EncodeLanguageCode("es-419"),
+    /* 4.0.0+ */
+    LanguageCode_SimplifiedChinese = EncodeLanguageCode("zh-Hans"),
+    LanguageCode_TraditionalChinese = EncodeLanguageCode("zh-Hant"),
+};
+
+
 class Utils {
     public:
         static bool IsSdInitialized();
@@ -82,12 +132,14 @@ class Utils {
         static OverrideKey GetTitleOverrideKey(u64 tid);
         static bool HasOverrideButton(u64 tid);
 
+        static OverrideLocale GetTitleOverrideLocale(u64 tid);
+
         /* Settings! */
         static Result GetSettingsItemValueSize(const char *name, const char *key, u64 *out_size);
         static Result GetSettingsItemValue(const char *name, const char *key, void *out, size_t max_size, u64 *out_size);
 
         static Result GetSettingsItemBooleanValue(const char *name, const char *key, bool *out);
-        
+
         /* Error occurred. */
         static void RebootToFatalError(AtmosphereFatalErrorContext *ctx);
     private:

stratosphere/boot/Makefile

@@ -16,6 +16,12 @@ ifneq (, $(strip $(shell git status --porcelain 2>/dev/null)))
     AMSREV := $(AMSREV)-dirty
 endif
 
+define _bin2o
+	bin2s $< | $(AS) -o $(@)
+	echo "extern const u8" `(echo $(<F) | sed -e 's/^\([0-9]\)/_\1/' | tr . _ | tr - _)`"_end[];" > `(echo $(<F) | tr . _ | tr - _)`.h
+	echo "extern const u8" `(echo $(<F) | sed -e 's/^\([0-9]\)/_\1/' | tr . _ | tr - _)`"[];" >> `(echo $(<F) | tr . _ | tr - _)`.h
+	echo "extern const u32" `(echo $(<F) | sed -e 's/^\([0-9]\)/_\1/' | tr . _ | tr - _)`_size";" >> `(echo $(<F) | tr . _ | tr - _)`.h
+endef
 
 #---------------------------------------------------------------------------------
 # TARGET is the name of the output
@@ -27,7 +33,7 @@ endif
 #---------------------------------------------------------------------------------
 TARGET		:=	$(notdir $(CURDIR))
 BUILD		:=	build
-SOURCES		:=	source
+SOURCES		:=	source source/i2c_driver source/updater
 DATA		:=	data
 INCLUDES	:=	include ../../common/include
 EXEFS_SRC	:=	exefs_src
@@ -69,14 +75,14 @@ export OUTPUT	:=	$(CURDIR)/$(TARGET)
 export TOPDIR	:=	$(CURDIR)
 
 export VPATH	:=	$(foreach dir,$(SOURCES),$(CURDIR)/$(dir)) \
-			$(foreach dir,$(DATA),$(CURDIR)/$(dir))
+			$(foreach dir,$(DATA),$(CURDIR)/$(dir)) $(TOPDIR)/../../fusee/fusee-primary
 
 export DEPSDIR	:=	$(CURDIR)/$(BUILD)
 
 CFILES		:=	$(foreach dir,$(SOURCES),$(notdir $(wildcard $(dir)/*.c)))
 CPPFILES	:=	$(foreach dir,$(SOURCES),$(notdir $(wildcard $(dir)/*.cpp)))
 SFILES		:=	$(foreach dir,$(SOURCES),$(notdir $(wildcard $(dir)/*.s)))
-BINFILES	:=	$(foreach dir,$(DATA),$(notdir $(wildcard $(dir)/*.*)))
+BINFILES	:=	$(foreach dir,$(DATA),$(notdir $(wildcard $(dir)/*.*))) fusee-primary.bin
 
 #---------------------------------------------------------------------------------
 # use CXX for linking C++ projects, CC for standard C
@@ -116,19 +122,23 @@ else
 	export APP_JSON := $(TOPDIR)/$(CONFIG_JSON)
 endif
 
-.PHONY: $(BUILD) clean all
+.PHONY: $(BUILD) check_fusee clean all
 
 #---------------------------------------------------------------------------------
 all: $(BUILD)
 
-$(BUILD):
+check_fusee:
+	@$(MAKE) -C $(TOPDIR)/../../fusee/fusee-primary all
+
+$(BUILD): check_fusee
 	@[ -d $@ ] || mkdir -p $@
 	@$(MAKE) --no-print-directory -C $(BUILD) -f $(CURDIR)/Makefile
 
 #---------------------------------------------------------------------------------
 clean:
 	@echo clean ...
-	@rm -fr $(BUILD) $(TARGET)_100.kip $(TARGET)_100.elf $(TARGET)_200.kip $(TARGET)_200.elf
+	@$(MAKE) -C $(TOPDIR)/../../fusee/fusee-primary clean
+	@rm -fr $(BUILD) $(TARGET).kip $(TARGET).elf
 
 
 #---------------------------------------------------------------------------------
@@ -140,20 +150,20 @@ DEPENDS	:=	$(OFILES:.o=.d)
 #---------------------------------------------------------------------------------
 # main targets
 #---------------------------------------------------------------------------------
-all	:	$(OUTPUT)_100.kip $(OUTPUT)_200.kip
+all	:	$(OUTPUT).kip
 
-$(OUTPUT)_100.kip	:	$(OUTPUT)_100.elf 
-$(OUTPUT)_200.kip	:	$(OUTPUT)_200.elf
+$(OUTPUT).kip	:	$(OUTPUT).elf
 
-$(OUTPUT)_100.kip	:	APP_JSON = $(TOPDIR)/boot_100.json
-$(OUTPUT)_200.kip	:	APP_JSON = $(TOPDIR)/boot_200.json
-
-$(OUTPUT)_100.elf	:	$(OFILES)
-$(OUTPUT)_200.elf	:	$(OFILES)
+$(OUTPUT).elf	:	$(OFILES)
 
 #---------------------------------------------------------------------------------
 # you need a rule like this for each extension you use as binary data
 #---------------------------------------------------------------------------------
+fusee_primary.bin.o	fusee_primary_bin.h:	fusee-primary.bin
+#---------------------------------------------------------------------------------
+	@echo $(notdir $<)
+	@$(_bin2o)
+
 %.bin.o	:	%.bin
 #---------------------------------------------------------------------------------
 	@echo $(notdir $<)

stratosphere/boot/boot.json

@@ -1,7 +1,7 @@
 {
     "name": "boot",
     "title_id": "0x0100000000000005",
-    "main_thread_stack_size": "0x1000",
+    "main_thread_stack_size": "0x8000",
     "main_thread_priority": 27,
     "default_cpu_id": 3,
     "process_category": 1,

stratosphere/boot/boot_100.json

@@ -1,171 +0,0 @@
-{
-    "name": "boot",
-    "title_id": "0x0100000000000005",
-    "main_thread_stack_size": "0x1000",
-    "main_thread_priority": 27,
-    "default_cpu_id": 3,
-    "process_category": 1,
-    "kernel_capabilities": [
-        {
-            "type": "handle_table_size",
-            "value": 128
-        },
-        {
-            "type": "syscalls",
-            "value": {
-                "svcSetHeapSize": "0x01",
-                "svcSetMemoryPermission": "0x02",
-                "svcSetMemoryAttribute": "0x03",
-                "svcMapMemory": "0x04",
-                "svcUnmapMemory": "0x05",
-                "svcQueryMemory": "0x06",
-                "svcExitProcess": "0x07",
-                "svcCreateThread": "0x08",
-                "svcStartThread": "0x09",
-                "svcExitThread": "0x0A",
-                "svcSleepThread": "0x0B",
-                "svcGetThreadPriority": "0x0C",
-                "svcSetThreadPriority": "0x0D",
-                "svcGetThreadCoreMask": "0x0E",
-                "svcSetThreadCoreMask": "0x0F",
-                "svcGetCurrentProcessorNumber": "0x10",
-                "svcSignalEvent": "0x11",
-                "svcClearEvent": "0x12",
-                "svcMapSharedMemory": "0x13",
-                "svcUnmapSharedMemory": "0x14",
-                "svcCreateTransferMemory": "0x15",
-                "svcCloseHandle": "0x16",
-                "svcResetSignal": "0x17",
-                "svcWaitSynchronization": "0x18",
-                "svcCancelSynchronization": "0x19",
-                "svcArbitrateLock": "0x1A",
-                "svcArbitrateUnlock": "0x1B",
-                "svcWaitProcessWideKeyAtomic": "0x1C",
-                "svcSignalProcessWideKey": "0x1D",
-                "svcGetSystemTick": "0x1E",
-                "svcConnectToNamedPort": "0x1F",
-                "svcSendSyncRequestLight": "0x20",
-                "svcSendSyncRequest": "0x21",
-                "svcSendSyncRequestWithUserBuffer": "0x22",
-                "svcSendAsyncRequestWithUserBuffer": "0x23",
-                "svcGetProcessId": "0x24",
-                "svcGetThreadId": "0x25",
-                "svcBreak": "0x26",
-                "svcOutputDebugString": "0x27",
-                "svcReturnFromException": "0x28",
-                "svcGetInfo": "0x29",
-                "svcCreateInterruptEvent": "0x53",
-                "svcQueryIoMapping": "0x55",
-                "svcCreateDeviceAddressSpace": "0x56",
-                "svcAttachDeviceAddressSpace": "0x57",
-                "svcDetachDeviceAddressSpace": "0x58",
-                "svcMapDeviceAddressSpaceAligned": "0x5A",
-                "svcUnmapDeviceAddressSpace": "0x5C",
-                "svcFlushProcessDataCache": "0x5F",
-                "svcCallSecureMonitor": "0x7F"
-            }
-        },
-        {
-            "type": "map",
-            "value": {
-                "address": "0x50003000",
-                "size": "0x1000",
-                "is_ro": false,
-                "is_io": true
-            }
-        },
-        {
-            "type": "map",
-            "value": {
-                "address": "0x54200000",
-                "size": "0x3000",
-                "is_ro": false,
-                "is_io": true
-            }
-        },
-        {
-            "type": "map",
-            "value": {
-                "address": "0x54300000",
-                "size": "0x1000",
-                "is_ro": false,
-                "is_io": true
-            }
-        },
-        {
-            "type": "map",
-            "value": {
-                "address": "0x60006000",
-                "size": "0x1000",
-                "is_ro": false,
-                "is_io": true
-            }
-        },
-        {
-            "type": "map",
-            "value": {
-                "address": "0x6000D000",
-                "size": "0x1000",
-                "is_ro": false,
-                "is_io": true
-            }
-        },
-        {
-            "type": "map",
-            "value": {
-                "address": "0x70000000",
-                "size": "0x4000",
-                "is_ro": false,
-                "is_io": true
-            }
-        },
-        {
-            "type": "map",
-            "value": {
-                "address": "0x7000C000",
-                "size": "0x2000",
-                "is_ro": false,
-                "is_io": true
-            }
-        },
-        {
-            "type": "map",
-            "value": {
-                "address": "0x7000E000",
-                "size": "0x4000",
-                "is_ro": false,
-                "is_io": true
-            }
-        },
-        {
-            "type": "map",
-            "value": {
-                "address": "0x700E3000",
-                "size": "0x1000",
-                "is_ro": false,
-                "is_io": true
-            }
-        },
-        {
-            "type": "irq_pair",
-            "value": [
-                70,
-                116
-            ]
-        },
-        {
-            "type": "irq_pair",
-            "value": [
-                124,
-                152
-            ]
-        },
-        {
-            "type": "irq_pair",
-            "value": [
-                85,
-                95
-            ]
-        }
-    ]
-}

stratosphere/boot/source/boot_battery_driver.cpp

@@ -0,0 +1,374 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include <switch.h>
+#include <stratosphere.hpp>
+#include "boot_functions.hpp"
+#include "boot_battery_driver.hpp"
+
+const Max17050Parameters *BatteryDriver::GetBatteryParameters() {
+    const u32 battery_version = Boot::GetBatteryVersion();
+    const u32 battery_vendor = Boot::GetBatteryVendor();
+
+    if (battery_version == 2) {
+        if (battery_vendor == 'M') {
+            return &Max17050Params2M;
+        } else {
+            return &Max17050Params2;
+        }
+    } else if (battery_version == 1) {
+        return &Max17050Params1;
+    } else {
+        switch (battery_vendor) {
+            case 'M':
+                return &Max17050ParamsM;
+            case 'R':
+                return &Max17050ParamsR;
+            case 'A':
+            default:
+                return &Max17050ParamsA;
+        }
+    }
+}
+
+Result BatteryDriver::Read(u8 addr, u16 *out) {
+    return Boot::ReadI2cRegister(this->i2c_session, reinterpret_cast<u8 *>(out), sizeof(*out), &addr, sizeof(addr));
+}
+
+Result BatteryDriver::Write(u8 addr, u16 val) {
+    return Boot::WriteI2cRegister(this->i2c_session, reinterpret_cast<u8 *>(&val), sizeof(val), &addr, sizeof(addr));
+}
+
+Result BatteryDriver::ReadWrite(u8 addr, u16 mask, u16 val) {
+    Result rc;
+    u16 cur_val;
+    if (R_FAILED((rc = this->Read(addr, &cur_val)))) {
+        return rc;
+    }
+
+    const u16 new_val = (cur_val & ~mask) | val;
+    if (R_FAILED((rc = this->Write(addr, new_val)))) {
+        return rc;
+    }
+    return ResultSuccess;
+}
+
+bool BatteryDriver::WriteValidate(u8 addr, u16 val) {
+    /* Nintendo doesn't seem to check errors when doing this? */
+    /* It's probably okay, since the value does get validated. */
+    /* That said, we will validate the read to avoid uninit data problems. */
+    this->Write(addr, val);
+    svcSleepThread(3'000'000ul);
+
+    u16 new_val;
+    return R_SUCCEEDED(this->Read(addr, &new_val)) && new_val == val;
+}
+
+bool BatteryDriver::IsPowerOnReset() {
+    /* N doesn't check result... */
+    u16 val = 0;
+    this->Read(Max17050Status, &val);
+    return (val & 0x0002) == 0x0002;
+}
+
+Result BatteryDriver::LockVfSoc() {
+    return this->Write(Max17050SocVfAccess, 0x0000);
+}
+
+Result BatteryDriver::UnlockVfSoc() {
+    return this->Write(Max17050SocVfAccess, 0x0080);
+}
+
+Result BatteryDriver::LockModelTable() {
+    Result rc;
+    if (R_FAILED((rc = this->Write(Max17050ModelAccess0, 0x0000)))) {
+        return rc;
+    }
+    if (R_FAILED((rc = this->Write(Max17050ModelAccess1, 0x0000)))) {
+        return rc;
+    }
+    return ResultSuccess;
+}
+
+Result BatteryDriver::UnlockModelTable() {
+    Result rc;
+    if (R_FAILED((rc = this->Write(Max17050ModelAccess0, 0x0059)))) {
+        return rc;
+    }
+    if (R_FAILED((rc = this->Write(Max17050ModelAccess1, 0x00C4)))) {
+        return rc;
+    }
+    return ResultSuccess;
+}
+
+Result BatteryDriver::SetModelTable(const u16 *model_table) {
+    Result rc;
+    for (size_t i = 0; i < Max17050ModelChrTblSize; i++) {
+        if (R_FAILED((rc = this->Write(Max17050ModelChrTblStart + i, model_table[i])))) {
+            return rc;
+        }
+    }
+
+    return ResultSuccess;
+}
+
+bool BatteryDriver::IsModelTableLocked() {
+    bool locked = true;
+
+    u16 cur_val = 0;
+    for (size_t i = 0; i < Max17050ModelChrTblSize; i++) {
+        this->Read(Max17050ModelChrTblStart + i, &cur_val);
+        locked &= (cur_val == 0);
+    }
+
+    return locked;
+}
+
+bool BatteryDriver::IsModelTableSet(const u16 *model_table) {
+    bool set = true;
+
+    u16 cur_val = 0;
+    for (size_t i = 0; i < Max17050ModelChrTblSize; i++) {
+        this->Read(Max17050ModelChrTblStart + i, &cur_val);
+        set &= (cur_val == model_table[i]);
+    }
+
+    return set;
+}
+
+Result BatteryDriver::InitializeBatteryParameters() {
+    const Max17050Parameters *params = GetBatteryParameters();
+    Result rc = ResultSuccess;
+
+    if (IsPowerOnReset()) {
+        /* Do initial config. */
+        if (R_FAILED((rc = this->ReadWrite(Max17050MiscCfg, 0x8000, 0x8000)))) {
+            return rc;
+        }
+
+        svcSleepThread(500'000'000ul);
+
+        if (R_FAILED((rc = this->Write(Max17050Config, 0x7210)))) {
+            return rc;
+        }
+        if (R_FAILED((rc = this->Write(Max17050FilterCfg, 0x8784)))) {
+            return rc;
+        }
+        if (R_FAILED((rc = this->Write(Max17050RelaxCfg, params->relaxcfg)))) {
+            return rc;
+        }
+        if (R_FAILED((rc = this->Write(Max17050LearnCfg, 0x2603)))) {
+            return rc;
+        }
+        if (R_FAILED((rc = this->Write(Max17050FullSocThr, params->fullsocthr)))) {
+            return rc;
+        }
+        if (R_FAILED((rc = this->Write(Max17050IAvgEmpty, params->iavgempty)))) {
+            return rc;
+        }
+
+        /* Unlock model table, write model table. */
+        do {
+            if (R_FAILED((rc = this->UnlockModelTable()))) {
+                return rc;
+            }
+            if (R_FAILED((rc = this->SetModelTable(params->modeltbl)))) {
+                return rc;
+            }
+        } while (!this->IsModelTableSet(params->modeltbl));
+
+        /* Lock model table. */
+        size_t lock_i = 0;
+        while (true) {
+            lock_i++;
+            if (R_FAILED((rc = this->LockModelTable()))) {
+                return rc;
+            }
+
+            if (this->IsModelTableLocked()) {
+                break;
+            }
+
+            if (lock_i >= 8) {
+                /* This is regarded as guaranteed success. */
+                return ResultSuccess;
+            }
+        }
+
+        /* Write custom parameters. */
+        while (!this->WriteValidate(Max17050RComp0, params->rcomp0)) { /* ... */ }
+        while (!this->WriteValidate(Max17050TempCo, params->tempco)) { /* ... */ }
+
+        if (R_FAILED((rc = this->Write(Max17050IChgTerm, params->ichgterm)))) {
+            return rc;
+        }
+        if (R_FAILED((rc = this->Write(Max17050TGain, params->tgain)))) {
+            return rc;
+        }
+        if (R_FAILED((rc = this->Write(Max17050TOff, params->toff)))) {
+            return rc;
+        }
+
+        while (!this->WriteValidate(Max17050VEmpty, params->vempty)) { /* ... */ }
+        while (!this->WriteValidate(Max17050QResidual00, params->qresidual00)) { /* ... */ }
+        while (!this->WriteValidate(Max17050QResidual10, params->qresidual10)) { /* ... */ }
+        while (!this->WriteValidate(Max17050QResidual20, params->qresidual20)) { /* ... */ }
+        while (!this->WriteValidate(Max17050QResidual30, params->qresidual30)) { /* ... */ }
+
+
+        /* Write full capacity parameters. */
+        while (!this->WriteValidate(Max17050FullCap, params->fullcap)) { /* ... */ }
+        if (R_FAILED((rc = this->Write(Max17050DesignCap, params->vffullcap)))) {
+            return rc;
+        }
+        while (!this->WriteValidate(Max17050FullCapNom, params->vffullcap)) { /* ... */ }
+
+        svcSleepThread(350'000'000ul);
+
+        /* Write VFSOC to VFSOC 0. */
+        u16 vfsoc, qh;
+        {
+            if (R_FAILED((rc = this->Read(Max17050SocVf, &vfsoc)))) {
+                return rc;
+            }
+            if (R_FAILED((rc = this->UnlockVfSoc()))) {
+                return rc;
+            }
+            if (R_FAILED((rc = this->Write(Max17050SocVf0, vfsoc)))) {
+                return rc;
+            }
+            if (R_FAILED((rc = this->Read(Max17050Qh, &qh)))) {
+                return rc;
+            }
+            if (R_FAILED((rc = this->Write(Max17050Qh0, qh)))) {
+                return rc;
+            }
+            if (R_FAILED((rc = this->LockVfSoc()))) {
+                return rc;
+            }
+        }
+
+        /* Write cycles. */
+        while (!this->WriteValidate(Max17050Cycles, 0x0060)) { /* ... */ }
+
+        /* Load new capacity parameters. */
+        const u16 remcap = static_cast<u16>((vfsoc * params->vffullcap) / 0x6400);
+        const u16 repcap = static_cast<u16>(remcap * (params->fullcap / params->vffullcap));
+        const u16 dqacc = params->vffullcap / 0x10;
+        while (!this->WriteValidate(Max17050RemCapMix, remcap)) { /* ... */ }
+        while (!this->WriteValidate(Max17050RemCapRep, repcap)) { /* ... */ }
+        while (!this->WriteValidate(Max17050DPAcc, 0x0C80)) { /* ... */ }
+        while (!this->WriteValidate(Max17050DQAcc, dqacc)) { /* ... */ }
+        while (!this->WriteValidate(Max17050FullCap, params->fullcap)) { /* ... */ }
+        if (R_FAILED((rc = this->Write(Max17050DesignCap, params->vffullcap)))) {
+            return rc;
+        }
+        while (!this->WriteValidate(Max17050FullCapNom, params->vffullcap)) { /* ... */ }
+        if (R_FAILED((rc = this->Write(Max17050SocRep, vfsoc)))) {
+            return rc;
+        }
+
+        /* Finish initialization. */
+        {
+            u16 status;
+            if (R_FAILED((rc = this->Read(Max17050Status, &status)))) {
+                return rc;
+            }
+            while (!this->WriteValidate(Max17050Status, status & 0xFFFD)) { /* ... */ }
+        }
+        if (R_FAILED((rc = this->Write(Max17050CGain, 0x7FFF)))) {
+            return rc;
+        }
+    }
+
+    return ResultSuccess;
+}
+
+Result BatteryDriver::IsBatteryRemoved(bool *out) {
+    /* N doesn't check result, but we will. */
+    u16 val = 0;
+    Result rc = this->Read(Max17050Status, &val);
+    if (R_FAILED(rc)) {
+        return rc;
+    }
+    *out = (val & 0x0008) == 0x0008;
+    return ResultSuccess;
+}
+
+Result BatteryDriver::GetTemperature(double *out) {
+    u16 val = 0;
+    Result rc = this->Read(Max17050Temperature, &val);
+    if (R_FAILED(rc)) {
+        return rc;
+    }
+    *out = static_cast<double>(val) * double(0.00390625);
+    return ResultSuccess;
+}
+
+Result BatteryDriver::GetAverageVCell(u32 *out) {
+    u16 val = 0;
+    Result rc = this->Read(Max17050AverageVCell, &val);
+    if (R_FAILED(rc)) {
+        return rc;
+    }
+    *out = (625 * u32(val >> 3)) / 1000;
+    return ResultSuccess;
+}
+
+Result BatteryDriver::GetSocRep(double *out) {
+    u16 val = 0;
+    Result rc = this->Read(Max17050SocRep, &val);
+    if (R_FAILED(rc)) {
+        return rc;
+    }
+    *out = static_cast<double>(val) * double(0.00390625);
+    return ResultSuccess;
+}
+
+Result BatteryDriver::GetBatteryPercentage(size_t *out) {
+    double raw_charge;
+    Result rc = this->GetSocRep(&raw_charge);
+    if (R_FAILED(rc)) {
+        return rc;
+    }
+    int converted_percentage = (((raw_charge - 3.93359375) * 98.0) / 94.2304688) + 2.0;
+    if (converted_percentage < 1) {
+        *out = 1;
+    } else if (converted_percentage > 100) {
+        *out = 100;
+    } else {
+        *out = static_cast<size_t>(converted_percentage);
+    }
+    return ResultSuccess;
+}
+
+Result BatteryDriver::SetShutdownTimer() {
+    return this->Write(Max17050ShdnTimer, 0xE000);
+}
+
+Result BatteryDriver::GetShutdownEnabled(bool *out) {
+    u16 val = 0;
+    Result rc = this->Read(Max17050Config, &val);
+    if (R_FAILED(rc)) {
+        return rc;
+    }
+    *out = (val & 0x0040) != 0;
+    return ResultSuccess;
+}
+
+Result BatteryDriver::SetShutdownEnabled(bool enabled) {
+    return this->ReadWrite(Max17050Config, 0x0040, enabled ? 0x0040 : 0x0000);
+}

stratosphere/boot/source/boot_battery_driver.hpp

@@ -0,0 +1,64 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+#include <stratosphere.hpp>
+
+#include "i2c_driver/i2c_api.hpp"
+#include "boot_battery_parameters.hpp"
+
+class BatteryDriver {
+    private:
+        I2cSessionImpl i2c_session;
+    public:
+        BatteryDriver() {
+            I2cDriver::Initialize();
+            I2cDriver::OpenSession(&this->i2c_session, I2cDevice_Max17050);
+        }
+
+        ~BatteryDriver() {
+            I2cDriver::CloseSession(this->i2c_session);
+            I2cDriver::Finalize();
+        }
+    private:
+        static const Max17050Parameters *GetBatteryParameters();
+
+        Result Read(u8 addr, u16 *out_data);
+        Result Write(u8 addr, u16 val);
+        Result ReadWrite(u8 addr, u16 mask, u16 val);
+        bool WriteValidate(u8 addr, u16 val);
+
+        bool IsPowerOnReset();
+        Result LockVfSoc();
+        Result UnlockVfSoc();
+        Result LockModelTable();
+        Result UnlockModelTable();
+        bool IsModelTableLocked();
+        Result SetModelTable(const u16 *model_table);
+        bool IsModelTableSet(const u16 *model_table);
+
+    public:
+        Result InitializeBatteryParameters();
+        Result IsBatteryRemoved(bool *out);
+        Result GetTemperature(double *out);
+        Result GetAverageVCell(u32 *out);
+        Result GetSocRep(double *out);
+        Result GetBatteryPercentage(size_t *out);
+        Result SetShutdownTimer();
+        Result GetShutdownEnabled(bool *out);
+        Result SetShutdownEnabled(bool enabled);
+};

stratosphere/boot/source/boot_battery_icons.cpp

@@ -0,0 +1,83 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+#include "boot_battery_icon_low.hpp"
+#include "boot_battery_icon_charging.hpp"
+#include "boot_battery_icon_charging_red.hpp"
+
+void Boot::ShowLowBatteryIcon() {
+    Boot::InitializeDisplay();
+    {
+        /* Low battery icon is shown for 5 seconds. */
+        Boot::ShowDisplay(LowBatteryX, LowBatteryY, LowBatteryW, LowBatteryH, LowBattery);
+        svcSleepThread(5'000'000'000ul);
+    }
+    Boot::FinalizeDisplay();
+}
+
+static void FillBatteryMeter(u32 *icon, const size_t icon_w, const size_t icon_h, const size_t meter_x, const size_t meter_y, const size_t meter_w, const size_t meter_h, const size_t fill_w) {
+    const size_t fill_x = meter_x + meter_w - fill_w;
+
+    if (fill_x + fill_w > icon_w || meter_y + meter_h > icon_h || fill_x == 0) {
+        return;
+    }
+
+    u32 *cur_row = icon + meter_y * icon_w + fill_x;
+    for (size_t y = 0; y < meter_h; y++) {
+        /* Make last column of meter identical to first column of meter. */
+        cur_row[-1] = icon[(meter_y + y) * icon_w + meter_x];
+
+        /* Black out further pixels. */
+        for (size_t x = 0; x < fill_w; x++) {
+            cur_row[x] = 0xFF000000;
+        }
+        cur_row += icon_w;
+    }
+}
+
+void Boot::StartShowChargingIcon(size_t battery_percentage, bool wait) {
+    const bool is_red = battery_percentage <= 15;
+
+    const size_t IconX = is_red ? ChargingRedBatteryX : ChargingBatteryX;
+    const size_t IconY = is_red ? ChargingRedBatteryY : ChargingBatteryY;
+    const size_t IconW = is_red ? ChargingRedBatteryW : ChargingBatteryW;
+    const size_t IconH = is_red ? ChargingRedBatteryH : ChargingBatteryH;
+    const size_t IconMeterX = is_red ? ChargingRedBatteryMeterX : ChargingBatteryMeterX;
+    const size_t IconMeterY = is_red ? ChargingRedBatteryMeterY : ChargingBatteryMeterY;
+    const size_t IconMeterW = is_red ? ChargingRedBatteryMeterW : ChargingBatteryMeterW;
+    const size_t IconMeterH = is_red ? ChargingRedBatteryMeterH : ChargingBatteryMeterH;
+    const size_t MeterFillW = static_cast<size_t>(IconMeterW * (1.0 - (0.0404 + 0.0096 * battery_percentage)) + 0.5);
+
+    /* Create stack buffer, copy icon into it, draw fill meter, draw. */
+    {
+        u32 Icon[IconW * IconH];
+        std::memcpy(Icon, is_red ? ChargingRedBattery : ChargingBattery, sizeof(Icon));
+        FillBatteryMeter(Icon, IconW, IconH, IconMeterX, IconMeterY, IconMeterW, IconMeterH, MeterFillW);
+
+        Boot::InitializeDisplay();
+        Boot::ShowDisplay(IconX, IconY, IconW, IconH, Icon);
+    }
+
+    /* Wait for 2 seconds if we're supposed to. */
+    if (wait) {
+        svcSleepThread(2'000'000'000ul);
+    }
+}
+
+void Boot::EndShowChargingIcon() {
+    Boot::FinalizeDisplay();
+}

stratosphere/boot/source/boot_battery_parameters.hpp

@@ -0,0 +1,286 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+static constexpr u8 Max17050Status           = 0x00;
+static constexpr u8 Max17050VAlrtThreshold   = 0x01;
+static constexpr u8 Max17050TAlrtThreshold   = 0x02;
+static constexpr u8 Max17050SocAlrtThreshold = 0x03;
+static constexpr u8 Max17050AtRate           = 0x04;
+static constexpr u8 Max17050RemCapRep        = 0x05;
+static constexpr u8 Max17050SocRep           = 0x06;
+static constexpr u8 Max17050Age              = 0x07;
+static constexpr u8 Max17050Temperature      = 0x08;
+static constexpr u8 Max17050VCell            = 0x09;
+static constexpr u8 Max17050Current          = 0x0A;
+static constexpr u8 Max17050AverageCurrent   = 0x0B;
+
+static constexpr u8 Max17050SocMix           = 0x0D;
+static constexpr u8 Max17050SocAv            = 0x0E;
+static constexpr u8 Max17050RemCapMix        = 0x0F;
+static constexpr u8 Max17050FullCap          = 0x10;
+static constexpr u8 Max17050Tte              = 0x11;
+static constexpr u8 Max17050QResidual00      = 0x12;
+static constexpr u8 Max17050FullSocThr       = 0x13;
+
+
+static constexpr u8 Max17050AverageTemp      = 0x16;
+static constexpr u8 Max17050Cycles           = 0x17;
+static constexpr u8 Max17050DesignCap        = 0x18;
+static constexpr u8 Max17050AverageVCell     = 0x19;
+static constexpr u8 Max17050MaxMinTemp       = 0x1A;
+static constexpr u8 Max17050MaxMinVoltage    = 0x1B;
+static constexpr u8 Max17050MaxMinCurrent    = 0x1C;
+static constexpr u8 Max17050Config           = 0x1D;
+static constexpr u8 Max17050IChgTerm         = 0x1E;
+static constexpr u8 Max17050RemCapAv         = 0x1F;
+
+static constexpr u8 Max17050Version          = 0x21;
+static constexpr u8 Max17050QResidual10      = 0x22;
+static constexpr u8 Max17050FullCapNom       = 0x23;
+static constexpr u8 Max17050TempNom          = 0x24;
+static constexpr u8 Max17050TempLim          = 0x25;
+
+static constexpr u8 Max17050Ain              = 0x27;
+static constexpr u8 Max17050LearnCfg         = 0x28;
+static constexpr u8 Max17050FilterCfg        = 0x29;
+static constexpr u8 Max17050RelaxCfg         = 0x2A;
+static constexpr u8 Max17050MiscCfg          = 0x2B;
+static constexpr u8 Max17050TGain            = 0x2C;
+static constexpr u8 Max17050TOff             = 0x2D;
+static constexpr u8 Max17050CGain            = 0x2E;
+static constexpr u8 Max17050COff             = 0x2F;
+
+
+static constexpr u8 Max17050QResidual20      = 0x32;
+
+
+
+static constexpr u8 Max17050IAvgEmpty        = 0x36;
+static constexpr u8 Max17050FCtc             = 0x37;
+static constexpr u8 Max17050RComp0           = 0x38;
+static constexpr u8 Max17050TempCo           = 0x39;
+static constexpr u8 Max17050VEmpty           = 0x3A;
+
+
+static constexpr u8 Max17050FStat            = 0x3D;
+static constexpr u8 Max17050Timer            = 0x3E;
+static constexpr u8 Max17050ShdnTimer        = 0x3F;
+
+
+static constexpr u8 Max17050QResidual30      = 0x42;
+
+
+static constexpr u8 Max17050DQAcc            = 0x45;
+static constexpr u8 Max17050DPAcc            = 0x46;
+
+static constexpr u8 Max17050SocVf0           = 0x48;
+
+static constexpr u8 Max17050Qh0              = 0x4C;
+static constexpr u8 Max17050Qh               = 0x4D;
+
+static constexpr u8 Max17050SocVfAccess      = 0x60;
+
+static constexpr u8 Max17050ModelAccess0     = 0x62;
+static constexpr u8 Max17050ModelAccess1     = 0x63;
+
+static constexpr u8 Max17050ModelChrTblStart = 0x80;
+static constexpr u8 Max17050ModelChrTblEnd   = 0xB0;
+
+
+static constexpr u8 Max17050VFocV            = 0xFB;
+static constexpr u8 Max17050SocVf            = 0xFF;
+
+static constexpr size_t Max17050ModelChrTblSize = Max17050ModelChrTblEnd - Max17050ModelChrTblStart;
+
+struct Max17050Parameters {
+    u16 relaxcfg;
+    u16 rcomp0;
+    u16 tempco;
+    u16 ichgterm;
+    u16 tgain;
+    u16 toff;
+    u16 vempty;
+    u16 qresidual00;
+    u16 qresidual10;
+    u16 qresidual20;
+    u16 qresidual30;
+    u16 fullcap;
+    u16 vffullcap;
+    u16 modeltbl[Max17050ModelChrTblSize];
+    u16 fullsocthr;
+    u16 iavgempty;
+};
+
+static_assert(sizeof(Max17050Parameters) == 0x7E, "Max17050Parameters definition!");
+
+static constexpr Max17050Parameters Max17050ParamsA = {
+    0x203B, /* relaxcfg */
+    0x0053, /* rcomp0 */
+    0x1C22, /* tempco */
+    0x0333, /* ichgterm */
+    0xE1F6, /* tgain */
+    0x2BF2, /* toff */
+    0xA05F, /* vempty */
+    0x5786, /* qresidual00 */
+    0x3184, /* qresidual10 */
+    0x1E00, /* qresidual20 */
+    0x1602, /* qresidual30 */
+    0x2476, /* fullcap */
+    0x2476, /* vffullcap */
+    { /* modeltbl */
+        0x9FF0, 0xAD30, 0xB5D0, 0xB9C0, 0xBAD0, 0xBBE0, 0xBC30, 0xBC90,
+        0xBCE0, 0xBD40, 0xBE70, 0xC0E0, 0xC4E0, 0xC890, 0xCC90, 0xD0F0,
+        0x0170, 0x0480, 0x0590, 0x0BE0, 0x0A00, 0x3C00, 0x3810, 0x3A00,
+        0x3A30, 0x19F0, 0x0EF0, 0x0AF0, 0x0BD0, 0x07F0, 0x06F0, 0x06F0,
+        0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200,
+        0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200,
+    },
+    0x5F00, /* fullsocthr */
+    0x1D2A  /* iavgempty */
+};
+
+static constexpr Max17050Parameters Max17050ParamsM = {
+    0x203B, /* relaxcfg */
+    0x0085, /* rcomp0 */
+    0x1625, /* tempco */
+    0x0333, /* ichgterm */
+    0xE1F6, /* tgain */
+    0x2BF2, /* toff */
+    0xA05F, /* vempty */
+    0x3100, /* qresidual00 */
+    0x1B00, /* qresidual10 */
+    0x1000, /* qresidual20 */
+    0x0C81, /* qresidual30 */
+    0x227A, /* fullcap */
+    0x227A, /* vffullcap */
+    { /* modeltbl */
+        0xA340, 0xB840, 0xB900, 0xBB70, 0xBC90, 0xBD20, 0xBDC0, 0xBEA0,
+        0xBF70, 0xC030, 0xC210, 0xC3F0, 0xC800, 0xC9E0, 0xCCA0, 0xD090,
+        0x0160, 0x3800, 0x0800, 0x1E00, 0x2550, 0x3060, 0x15D0, 0x1810,
+        0x1490, 0x0B80, 0x0BF0, 0x0AF0, 0x0CB0, 0x06F0, 0x09D0, 0x09D0,
+        0x0100, 0x0100, 0x0100, 0x0100, 0x0100, 0x0100, 0x0100, 0x0100,
+        0x0100, 0x0100, 0x0100, 0x0100, 0x0100, 0x0100, 0x0100, 0x0100,
+    },
+    0x5F00, /* fullsocthr */
+    0x1D2A  /* iavgempty */
+};
+
+static constexpr Max17050Parameters Max17050ParamsR = {
+    0x203B, /* relaxcfg */
+    0x0048, /* rcomp0 */
+    0x2034, /* tempco */
+    0x0333, /* ichgterm */
+    0xE1F6, /* tgain */
+    0x2BF2, /* toff */
+    0xA05F, /* vempty */
+    0x5A00, /* qresidual00 */
+    0x3B00, /* qresidual10 */
+    0x0F80, /* qresidual20 */
+    0x0B02, /* qresidual30 */
+    0x2466, /* fullcap */
+    0x2466, /* vffullcap */
+    { /* modeltbl */
+        0x9C50, 0xAD90, 0xB270, 0xB6A0, 0xB8F0, 0xBB10, 0xBC00, 0xBD00,
+        0xBD70, 0xBE70, 0xBF50, 0xC1F0, 0xC380, 0xC590, 0xC8E0, 0xD0B0,
+        0x00D0, 0x0150, 0x0300, 0x0D00, 0x0E00, 0x1900, 0x2AC0, 0x2830,
+        0x1760, 0x18F0, 0x0DF0, 0x0BC0, 0x0DF0, 0x0BF0, 0x06F0, 0x06F0,
+        0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200,
+        0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200,
+    },
+    0x5F00, /* fullsocthr */
+    0x1D2A  /* iavgempty */
+};
+
+static constexpr Max17050Parameters Max17050Params1 = {
+    0x203B, /* relaxcfg */
+    0x0040, /* rcomp0 */
+    0x1624, /* tempco */
+    0x0333, /* ichgterm */
+    0xE1F6, /* tgain */
+    0x2BF2, /* toff */
+    0xA05F, /* vempty */
+    0x4690, /* qresidual00 */
+    0x2605, /* qresidual10 */
+    0x1605, /* qresidual20 */
+    0x0F05, /* qresidual30 */
+    0x1AE4, /* fullcap */
+    0x1AE4, /* vffullcap */
+    { /* modeltbl */
+        0x8B50, 0x9C20, 0xACF0, 0xB160, 0xB3A0, 0xB5B0, 0xB950, 0xBBE0,
+        0xBDC0, 0xBEF0, 0xC140, 0xC250, 0xC600, 0xC960, 0xCCE0, 0xD060,
+        0x0070, 0x00F0, 0x0440, 0x0400, 0x0500, 0x0400, 0x0D00, 0x3270,
+        0x0FB0, 0x0AF0, 0x10F0, 0x0CE0, 0x09E0, 0x07F0, 0x06F0, 0x06F0,
+        0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200,
+        0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200,
+    },
+    0x5F00, /* fullsocthr */
+    0x1584  /* iavgempty */
+};
+
+static constexpr Max17050Parameters Max17050Params2 = {
+    0x203B, /* relaxcfg */
+    0x004A, /* rcomp0 */
+    0x1D23, /* tempco */
+    0x0333, /* ichgterm */
+    0xE1F6, /* tgain */
+    0x2BF2, /* toff */
+    0xA05F, /* vempty */
+    0x4000, /* qresidual00 */
+    0x1E80, /* qresidual10 */
+    0x0D83, /* qresidual20 */
+    0x0783, /* qresidual30 */
+    0x1C20, /* fullcap */
+    0x1C20, /* vffullcap */
+    { /* modeltbl */
+        0x8040, 0x9A30, 0xB430, 0xB770, 0xBAB0, 0xBBC0, 0xBD00, 0xBE50,
+        0xBF70, 0xC0D0, 0xC300, 0xC590, 0xC960, 0xCD40, 0xD1F0, 0xD5C0,
+        0x0040, 0x0060, 0x0510, 0x0D30, 0x16C0, 0x2160, 0x1380, 0x1A10,
+        0x0EC0, 0x0CE0, 0x08F0, 0x0940, 0x0920, 0x06F0, 0x06C0, 0x06C0,
+        0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200,
+        0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200,
+    },
+    0x5500, /* fullsocthr */
+    0x1680  /* iavgempty */
+};
+
+static constexpr Max17050Parameters Max17050Params2M = {
+    0x203B, /* relaxcfg */
+    0x0049, /* rcomp0 */
+    0x222A, /* tempco */
+    0x0333, /* ichgterm */
+    0xE1F6, /* tgain */
+    0x2BF2, /* toff */
+    0xA05F, /* vempty */
+    0x4F00, /* qresidual00 */
+    0x2680, /* qresidual10 */
+    0x1205, /* qresidual20 */
+    0x0C87, /* qresidual30 */
+    0x1C68, /* fullcap */
+    0x1C68, /* vffullcap */
+    { /* modeltbl */
+        0x8E40, 0xB570, 0xB8F0, 0xBB00, 0xBC20, 0xBCC0, 0xBE30, 0xBFE0,
+        0xC200, 0xC400, 0xC720, 0xCB50, 0xCF00, 0xD100, 0xD480, 0xD5C0,
+        0x00C0, 0x0C00, 0x0A10, 0x1800, 0x2C00, 0x1C10, 0x12D0, 0x09F0,
+        0x0AF0, 0x0850, 0x09F0, 0x06F0, 0x06B0, 0x07E0, 0x01D0, 0x01D0,
+        0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200,
+        0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200, 0x0200,
+    },
+    0x5500, /* fullsocthr */
+    0x16B9  /* iavgempty */
+};

stratosphere/boot/source/boot_boot_reason.cpp

@@ -0,0 +1,113 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+#include "boot_pmic_driver.hpp"
+#include "boot_rtc_driver.hpp"
+
+static u32 g_boot_reason = 0;
+static bool g_detected_boot_reason = false;
+
+struct BootReasonValue {
+    union {
+        struct {
+            u8 power_intr;
+            u8 rtc_intr;
+            u8 nv_erc;
+            u8 boot_reason;
+        };
+        u32 value;
+    };
+};
+
+static u32 MakeBootReason(u32 power_intr, u8 rtc_intr, u8 nv_erc, bool ac_ok) {
+    if (power_intr & 0x08) {
+        return 2;
+    }
+    if (rtc_intr & 0x02)  {
+        return 3;
+    }
+    if (power_intr & 0x80) {
+        return 1;
+    }
+    if (rtc_intr & 0x04) {
+        if (nv_erc != 0x80 && !Boot::IsRecoveryBoot()) {
+            return 4;
+        }
+    }
+    if ((nv_erc & 0x40) && ac_ok) {
+        return 1;
+    }
+    return 0;
+}
+
+void Boot::DetectBootReason() {
+    u8 power_intr;
+    u8 rtc_intr;
+    u8 rtc_intr_m;
+    u8 nv_erc;
+    bool ac_ok;
+
+    /* Get values from PMIC. */
+    {
+        PmicDriver pmic_driver;
+        if (R_FAILED(pmic_driver.GetPowerIntr(&power_intr))) {
+            std::abort();
+        }
+        if (R_FAILED(pmic_driver.GetNvErc(&nv_erc))) {
+            std::abort();
+        }
+        if (R_FAILED(pmic_driver.GetAcOk(&ac_ok))) {
+            std::abort();
+        }
+    }
+
+    /* Get values from RTC. */
+    {
+        RtcDriver rtc_driver;
+        if (R_FAILED(rtc_driver.GetRtcIntr(&rtc_intr))) {
+            std::abort();
+        }
+        if (R_FAILED(rtc_driver.GetRtcIntrM(&rtc_intr_m))) {
+            std::abort();
+        }
+    }
+
+    /* Set global derived boot reason. */
+    g_boot_reason = MakeBootReason(power_intr, rtc_intr & ~rtc_intr_m, nv_erc, ac_ok);
+
+    /* Set boot reason for SPL. */
+    if (GetRuntimeFirmwareVersion() >= FirmwareVersion_300) {
+        BootReasonValue boot_reason_value;
+        boot_reason_value.power_intr = power_intr;
+        boot_reason_value.rtc_intr = rtc_intr & ~rtc_intr_m;
+        boot_reason_value.nv_erc = nv_erc;
+        boot_reason_value.boot_reason = g_boot_reason;
+        if (R_FAILED(splSetBootReason(boot_reason_value.value))) {
+            std::abort();
+        }
+    }
+
+    g_detected_boot_reason = true;
+}
+
+u32 Boot::GetBootReason() {
+    if (!g_detected_boot_reason) {
+        std::abort();
+    }
+
+    return g_boot_reason;
+}

stratosphere/boot/source/boot_bq24193_charger.hpp

@@ -0,0 +1,139 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+static constexpr u8 Bq24193InputSourceControl                     = 0x00;
+static constexpr u8 Bq24193PowerOnConfiguration                   = 0x01;
+static constexpr u8 Bq24193ChargeCurrentControl                   = 0x02;
+static constexpr u8 Bq24193PreChargeTerminationCurrentControl     = 0x03;
+static constexpr u8 Bq24193ChargeVoltageControl                   = 0x04;
+static constexpr u8 Bq24193ChargeTerminationTimerControl          = 0x05;
+static constexpr u8 Bq24193IrCompensationThermalRegulationControl = 0x06;
+static constexpr u8 Bq24193MiscOperationControl                   = 0x07;
+static constexpr u8 Bq24193SystemStatus                           = 0x08;
+static constexpr u8 Bq24193Fault                                  = 0x09;
+static constexpr u8 Bq24193VendorPartRevisionStatus               = 0x0A;
+
+enum ChargerConfiguration : u8 {
+    ChargerConfiguration_ChargeDisable = (0 << 4),
+    ChargerConfiguration_ChargeBattery = (1 << 4),
+    ChargerConfiguration_Otg           = (2 << 4),
+};
+
+static constexpr u32 ChargeVoltageLimitMin = 3504;
+static constexpr u32 ChargeVoltageLimitMax = 4208;
+
+static inline u8 EncodeChargeVoltageLimit(u32 voltage) {
+    if (voltage < ChargeVoltageLimitMin || voltage > ChargeVoltageLimitMax) {
+        std::abort();
+    }
+    voltage -= ChargeVoltageLimitMin;
+    voltage >>= 4;
+    return static_cast<u8>(voltage << 2);
+}
+
+static inline u32 DecodeChargeVoltageLimit(u8 reg) {
+    return ChargeVoltageLimitMin + (static_cast<u32>(reg & 0xFC) << 2);
+}
+
+static constexpr u32 FastChargeCurrentLimitMin = 512;
+static constexpr u32 FastChargeCurrentLimitMax = 4544;
+
+static inline u8 EncodeFastChargeCurrentLimit(u32 current) {
+    if (current < FastChargeCurrentLimitMin || current > FastChargeCurrentLimitMax) {
+        std::abort();
+    }
+    current -= FastChargeCurrentLimitMin;
+    current >>= 6;
+    return static_cast<u8>(current << 2);
+}
+
+static inline u32 DecodeFastChargeCurrentLimit(u8 reg) {
+    return FastChargeCurrentLimitMin + (static_cast<u32>(reg & 0xFC) << 4);
+}
+
+enum InputCurrentLimit : u8 {
+    InputCurrentLimit_100mA  = 0,
+    InputCurrentLimit_150mA  = 1,
+    InputCurrentLimit_500mA  = 2,
+    InputCurrentLimit_900mA  = 3,
+    InputCurrentLimit_1200mA = 4,
+    InputCurrentLimit_1500mA = 5,
+    InputCurrentLimit_2000mA = 6,
+    InputCurrentLimit_3000mA = 7,
+};
+
+static constexpr u32 PreChargeCurrentLimitMin = 128;
+static constexpr u32 PreChargeCurrentLimitMax = 2048;
+
+static inline u8 EncodePreChargeCurrentLimit(u32 current) {
+    if (current < PreChargeCurrentLimitMin || current > PreChargeCurrentLimitMax) {
+        std::abort();
+    }
+    current -= PreChargeCurrentLimitMin;
+    current >>= 7;
+    return static_cast<u8>(current << 4);
+}
+
+static inline u32 DecodePreChargeCurrentLimit(u8 reg) {
+    return PreChargeCurrentLimitMin + (static_cast<u32>(reg & 0xF0) << 3);
+}
+
+static constexpr u32 TerminationCurrentLimitMin = 128;
+static constexpr u32 TerminationCurrentLimitMax = 2048;
+
+static inline u8 EncodeTerminationCurrentLimit(u32 current) {
+    if (current < TerminationCurrentLimitMin || current > TerminationCurrentLimitMax) {
+        std::abort();
+    }
+    current -= TerminationCurrentLimitMin;
+    current >>= 7;
+    return static_cast<u8>(current);
+}
+
+static inline u32 DecodeTerminationCurrentLimit(u8 reg) {
+    return TerminationCurrentLimitMin + (static_cast<u32>(reg & 0xF) << 7);
+}
+
+static constexpr u32 MinimumSystemVoltageLimitMin = 3000;
+static constexpr u32 MinimumSystemVoltageLimitMax = 3700;
+
+static inline u8 EncodeMinimumSystemVoltageLimit(u32 voltage) {
+    if (voltage < MinimumSystemVoltageLimitMin || voltage > MinimumSystemVoltageLimitMax) {
+        std::abort();
+    }
+    voltage -= MinimumSystemVoltageLimitMin;
+    voltage /= 100;
+    return static_cast<u8>(voltage << 1);
+}
+
+static inline u32 DecodeMinimumSystemVoltageLimit(u8 reg) {
+    return MinimumSystemVoltageLimitMin + (static_cast<u32>(reg & 0x0E) * 50);
+}
+
+enum WatchdogTimerSetting : u8 {
+    WatchdogTimerSetting_Disabled = (0 << 4),
+    WatchdogTimerSetting_40s      = (1 << 4),
+    WatchdogTimerSetting_80s      = (2 << 4),
+    WatchdogTimerSetting_160s     = (3 << 4),
+};
+
+enum BoostModeCurrentLimit : u8 {
+    BoostModeCurrentLimit_500mA  = 0,
+    BoostModeCurrentLimit_1300mA = 1,
+};

stratosphere/boot/source/boot_calibration.cpp

@@ -0,0 +1,114 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+
+static constexpr size_t BatteryLotOffset = 0x2CE0;
+static constexpr size_t BatteryLotSize = 0x20;
+static constexpr size_t BatteryVersionOffset = 0x4310;
+static constexpr size_t BatteryVersionSize = 0x10;
+
+static constexpr u32 BisStorageId_Prodinfo = 27;
+
+static constexpr u32 DefaultBatteryVendor = static_cast<u32>('A');
+static constexpr u32 DefaultBatteryVersion = 0;
+
+static constexpr Result ResultCalInvalidCrc = 0xCAC6; /* TODO: Verify this really is cal, move to libstrat results. */
+
+u16 Boot::GetCrc16(const void *data, size_t size) {
+    static constexpr u16 s_crc_table[0x10] = {
+        0x0000, 0xCC01, 0xD801, 0x1400, 0xF001, 0x3C00, 0x2800, 0xE401,
+        0xA001, 0x6C00, 0x7800, 0xB401, 0x5000, 0x9C01, 0x8801, 0x4400
+    };
+
+    if (data == nullptr) {
+        std::abort();
+    }
+
+    u16 crc16 = 0x55AA;
+    const u8 *data_u8 = reinterpret_cast<const u8 *>(data);
+    for (size_t i = 0; i < size; i++) {
+        crc16 = (crc16 >> 4) ^ (s_crc_table[crc16 & 0xF]) ^ (s_crc_table[data_u8[i] & 0xF]);
+        crc16 = (crc16 >> 4) ^ (s_crc_table[crc16 & 0xF]) ^ (s_crc_table[(data_u8[i] >> 4) & 0xF]);
+    }
+    return crc16;
+}
+
+static Result ValidateCalibrationCrc16(const void *data, size_t size) {
+    const u8 *data_u8 = reinterpret_cast<const u8 *>(data);
+    if (Boot::GetCrc16(data, size - sizeof(u16)) != *(reinterpret_cast<const u16 *>(&data_u8[size - sizeof(u16)]))) {
+        return ResultCalInvalidCrc;
+    }
+    return ResultSuccess;
+}
+
+static Result GetBatteryVendorImpl(u32 *vendor) {
+    FsStorage s;
+    Result rc = fsOpenBisStorage(&s, BisStorageId_Prodinfo);
+    if (R_FAILED(rc)) {
+        return rc;
+    }
+    ON_SCOPE_EXIT { fsStorageClose(&s); };
+
+    u8 battery_lot[BatteryLotSize];
+    if (R_FAILED((rc = fsStorageRead(&s, BatteryLotOffset, battery_lot, sizeof(battery_lot))))) {
+        return rc;
+    }
+
+    if (R_FAILED((rc = ValidateCalibrationCrc16(battery_lot, sizeof(battery_lot))))) {
+        return rc;
+    }
+
+    *vendor = battery_lot[7];
+    return ResultSuccess;
+}
+
+static Result GetBatteryVersionImpl(u32 *version) {
+    FsStorage s;
+    Result rc = fsOpenBisStorage(&s, BisStorageId_Prodinfo);
+    if (R_FAILED(rc)) {
+        return rc;
+    }
+    ON_SCOPE_EXIT { fsStorageClose(&s); };
+
+    u8 battery_version[BatteryVersionSize];
+    if (R_FAILED((rc = fsStorageRead(&s, BatteryVersionOffset, battery_version, sizeof(battery_version))))) {
+        return rc;
+    }
+
+    if (R_FAILED((rc = ValidateCalibrationCrc16(battery_version, sizeof(battery_version))))) {
+        return rc;
+    }
+
+    *version = battery_version[0];
+    return ResultSuccess;
+}
+
+u32 Boot::GetBatteryVendor() {
+    u32 vendor;
+    if (R_FAILED(GetBatteryVendorImpl(&vendor))) {
+        return DefaultBatteryVendor;
+    }
+    return vendor;
+}
+
+u32 Boot::GetBatteryVersion() {
+    u32 version;
+    if (R_FAILED(GetBatteryVersionImpl(&version))) {
+        return DefaultBatteryVersion;
+    }
+    return version;
+}

stratosphere/boot/source/boot_change_voltage.cpp

@@ -0,0 +1,36 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+
+static constexpr u32 Sdmmc3VoltageBit = (1 << 13); /* SDMMC3 */
+static constexpr u32 AudioVoltageBit  = (1 << 18); /* AUDIO_HV */
+static constexpr u32 GpioVoltageBit   = (1 << 21); /* GPIO */
+static constexpr u32 SpiVoltageBit    = (1 << 23); /* SPI_HV */
+
+static constexpr u32 VoltageChangeMask = SpiVoltageBit | GpioVoltageBit | AudioVoltageBit | Sdmmc3VoltageBit;
+
+static constexpr u32 PmcPwrDet    = 0x7000E448;
+static constexpr u32 PmcPwrDetVal = 0x7000E4E4;
+
+void Boot::ChangeGpioVoltageTo1_8v() {
+    /* Write mask to APBDEV_PMC_PWR_DET, then clear APBDEV_PMC_PWR_DET_VAL. */
+    WritePmcRegister(PmcPwrDet, VoltageChangeMask, VoltageChangeMask);
+    WritePmcRegister(PmcPwrDetVal, 0, VoltageChangeMask);
+
+    /* Sleep for 100 us. */
+    svcSleepThread(100'000ul);
+}

stratosphere/boot/source/boot_charger_driver.cpp

@@ -0,0 +1,177 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include <switch.h>
+#include <stratosphere.hpp>
+#include "boot_charger_driver.hpp"
+
+Result ChargerDriver::Read(u8 addr, u8 *out) {
+    return Boot::ReadI2cRegister(this->i2c_session, reinterpret_cast<u8 *>(out), sizeof(*out), &addr, sizeof(addr));
+}
+
+Result ChargerDriver::Write(u8 addr, u8 val) {
+    return Boot::WriteI2cRegister(this->i2c_session, reinterpret_cast<u8 *>(&val), sizeof(val), &addr, sizeof(addr));
+}
+
+Result ChargerDriver::ReadWrite(u8 addr, u8 mask, u8 val) {
+    Result rc;
+    u8 cur_val;
+    if (R_FAILED((rc = this->Read(addr, &cur_val)))) {
+        return rc;
+    }
+
+    const u8 new_val = (cur_val & ~mask) | val;
+    if (R_FAILED((rc = this->Write(addr, new_val)))) {
+        return rc;
+    }
+    return ResultSuccess;
+}
+
+Result ChargerDriver::Initialize() {
+    return this->Initialize(true);
+}
+
+Result ChargerDriver::Initialize(bool set_input_current_limit) {
+    Result rc;
+    if (set_input_current_limit) {
+        if (R_FAILED((rc = this->SetInputCurrentLimit(InputCurrentLimit_500mA)))) {
+            return rc;
+        }
+    }
+
+    if (R_FAILED((rc = this->SetChargeVoltageLimit(4208)))) {
+        return rc;
+    }
+
+    if (R_FAILED((rc = this->SetFastChargeCurrentLimit(512)))) {
+        return rc;
+    }
+
+    if (R_FAILED((rc = this->SetForce20PercentChargeCurrent(false)))) {
+        return rc;
+    }
+
+    if (R_FAILED((rc = this->SetPreChargeCurrentLimit(128)))) {
+        return rc;
+    }
+
+    if (R_FAILED((rc = this->SetTerminationCurrentLimit(128)))) {
+        return rc;
+    }
+
+    if (R_FAILED((rc = this->SetMinimumSystemVoltageLimit(3000)))) {
+        return rc;
+    }
+
+    if (R_FAILED((rc = this->SetWatchdogTimerSetting(WatchdogTimerSetting_Disabled)))) {
+        return rc;
+    }
+
+    if (R_FAILED((rc = this->SetChargingSafetyTimerEnabled(false)))) {
+        return rc;
+    }
+
+    if (R_FAILED((rc = this->ResetWatchdogTimer()))) {
+        return rc;
+    }
+
+    if (R_FAILED((rc = this->SetBoostModeCurrentLimit(BoostModeCurrentLimit_500mA)))) {
+        return rc;
+    }
+
+    if (R_FAILED((rc = this->SetHiZEnabled(false)))) {
+        return rc;
+    }
+
+    return ResultSuccess;
+}
+
+Result ChargerDriver::SetChargeEnabled(bool enabled) {
+    Boot::GpioSetValue(GpioPadName_Bq24193Charger, enabled ? GpioValue_Low : GpioValue_High);
+    return this->SetChargerConfiguration(ChargerConfiguration_ChargeBattery);
+}
+
+Result ChargerDriver::SetChargerConfiguration(ChargerConfiguration config) {
+    return this->ReadWrite(Bq24193PowerOnConfiguration, 0x30, config);
+}
+
+Result ChargerDriver::SetChargeVoltageLimit(u32 voltage) {
+    return this->ReadWrite(Bq24193ChargeVoltageControl, 0xFC, EncodeChargeVoltageLimit(voltage));
+}
+
+Result ChargerDriver::SetFastChargeCurrentLimit(u32 current) {
+    return this->ReadWrite(Bq24193ChargeCurrentControl, 0xFC, EncodeFastChargeCurrentLimit(current));
+}
+
+Result ChargerDriver::SetInputCurrentLimit(InputCurrentLimit current) {
+    return this->ReadWrite(Bq24193InputSourceControl, 0x07, current);
+}
+
+Result ChargerDriver::SetForce20PercentChargeCurrent(bool force) {
+    return this->ReadWrite(Bq24193ChargeCurrentControl, 0x01, force ? 1 : 0);
+}
+
+Result ChargerDriver::SetPreChargeCurrentLimit(u32 current) {
+    return this->ReadWrite(Bq24193PreChargeTerminationCurrentControl, 0xF0, EncodePreChargeCurrentLimit(current));
+}
+
+Result ChargerDriver::SetTerminationCurrentLimit(u32 current) {
+    return this->ReadWrite(Bq24193PreChargeTerminationCurrentControl, 0x0F, EncodeTerminationCurrentLimit(current));
+}
+
+Result ChargerDriver::SetMinimumSystemVoltageLimit(u32 voltage) {
+    return this->ReadWrite(Bq24193PowerOnConfiguration, 0x0E, EncodeMinimumSystemVoltageLimit(voltage));
+}
+
+Result ChargerDriver::SetWatchdogTimerSetting(WatchdogTimerSetting setting) {
+    return this->ReadWrite(Bq24193ChargeTerminationTimerControl, 0x30, setting);
+}
+
+Result ChargerDriver::SetChargingSafetyTimerEnabled(bool enabled) {
+    return this->ReadWrite(Bq24193ChargeTerminationTimerControl, 0x08, enabled ? 0x08 : 0);
+}
+
+Result ChargerDriver::ResetWatchdogTimer() {
+    return this->ReadWrite(Bq24193PowerOnConfiguration, 0x40, 0x40);
+}
+
+Result ChargerDriver::SetBoostModeCurrentLimit(BoostModeCurrentLimit current) {
+    return this->ReadWrite(Bq24193PowerOnConfiguration, 0x01, current);
+}
+
+Result ChargerDriver::SetHiZEnabled(bool enabled) {
+    return this->ReadWrite(Bq24193InputSourceControl, 0x80, enabled ? 0x80 : 0);
+}
+
+Result ChargerDriver::GetInputCurrentLimit(InputCurrentLimit *out) {
+    u8 limit;
+    Result rc = this->Read(Bq24193InputSourceControl, &limit);
+    if (R_FAILED(rc)) {
+        return rc;
+    }
+    *out = static_cast<InputCurrentLimit>(limit);
+    return ResultSuccess;
+}
+
+Result ChargerDriver::GetChargeVoltageLimit(u32 *out) {
+    u8 reg;
+    Result rc = this->Read(Bq24193ChargeVoltageControl, &reg);
+    if (R_FAILED(rc)) {
+        return rc;
+    }
+    *out = DecodeChargeVoltageLimit(reg);
+    return ResultSuccess;
+}

stratosphere/boot/source/boot_charger_driver.hpp

@@ -0,0 +1,68 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+#include <stratosphere.hpp>
+
+#include "i2c_driver/i2c_api.hpp"
+#include "boot_functions.hpp"
+#include "boot_bq24193_charger.hpp"
+
+class ChargerDriver {
+    private:
+        static constexpr u32 GpioPadName_Bq24193Charger = 0xA;
+    private:
+        I2cSessionImpl i2c_session;
+    public:
+        ChargerDriver() {
+            I2cDriver::Initialize();
+            I2cDriver::OpenSession(&this->i2c_session, I2cDevice_Bq24193);
+
+            Boot::GpioConfigure(GpioPadName_Bq24193Charger);
+            Boot::GpioSetDirection(GpioPadName_Bq24193Charger, GpioDirection_Output);
+        }
+
+        ~ChargerDriver() {
+            I2cDriver::CloseSession(this->i2c_session);
+            I2cDriver::Finalize();
+        }
+    private:
+        Result Read(u8 addr, u8 *out_data);
+        Result Write(u8 addr, u8 val);
+        Result ReadWrite(u8 addr, u8 mask, u8 val);
+
+        Result SetInputCurrentLimit(InputCurrentLimit current);
+        Result SetForce20PercentChargeCurrent(bool force);
+        Result SetPreChargeCurrentLimit(u32 current);
+        Result SetTerminationCurrentLimit(u32 current);
+        Result SetMinimumSystemVoltageLimit(u32 voltage);
+        Result SetWatchdogTimerSetting(WatchdogTimerSetting setting);
+        Result SetChargingSafetyTimerEnabled(bool enabled);
+        Result ResetWatchdogTimer();
+        Result SetBoostModeCurrentLimit(BoostModeCurrentLimit current);
+        Result SetHiZEnabled(bool enabled);
+
+    public:
+        Result Initialize();
+        Result Initialize(bool set_input_current_limit);
+        Result SetChargeVoltageLimit(u32 voltage);
+        Result SetFastChargeCurrentLimit(u32 current);
+        Result SetChargeEnabled(bool enabled);
+        Result SetChargerConfiguration(ChargerConfiguration config);
+        Result GetInputCurrentLimit(InputCurrentLimit *out);
+        Result GetChargeVoltageLimit(u32 *out);
+};

stratosphere/boot/source/boot_check_battery.cpp

@@ -0,0 +1,275 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+#include "boot_pmic_driver.hpp"
+#include "boot_battery_driver.hpp"
+#include "boot_charger_driver.hpp"
+
+enum CheckBatteryResult {
+    CheckBatteryResult_Success  = 0,
+    CheckBatteryResult_Shutdown = 1,
+    CheckBatteryResult_Reboot   = 2,
+};
+
+struct BatteryChargeParameters {
+    u32 temp_min;
+    u32 temp_low;
+    u32 temp_high;
+    u32 temp_max;
+    u32 allow_high_temp_charge_max_voltage;
+    u32 charge_voltage_limit_default;
+    u32 charge_voltage_limit_high_temp;
+    u32 allow_fast_charge_min_temp;
+    u32 allow_fast_charge_min_voltage;
+    u32 fast_charge_current_limit_default;
+    u32 fast_charge_current_limit_low_temp;
+    u32 fast_charge_current_limit_low_voltage;
+};
+
+static constexpr BatteryChargeParameters BatteryChargeParameters0 = {
+    .temp_min  = 4,
+    .temp_low  = 17,
+    .temp_high = 51,
+    .temp_max  = 60,
+    .allow_high_temp_charge_max_voltage = 4050,
+    .charge_voltage_limit_default       = 4208,
+    .charge_voltage_limit_high_temp     = 3952,
+    .allow_fast_charge_min_voltage          = 3320,
+    .fast_charge_current_limit_default      = 0x800,
+    .fast_charge_current_limit_low_temp     = 0x300,
+    .fast_charge_current_limit_low_voltage  = 0x200,
+};
+
+static constexpr BatteryChargeParameters BatteryChargeParameters1 = {
+    .temp_min  = 4,
+    .temp_low  = 17,
+    .temp_high = 51,
+    .temp_max  = 59,
+    .allow_high_temp_charge_max_voltage = 3984,
+    .charge_voltage_limit_default       = 4208,
+    .charge_voltage_limit_high_temp     = 3984,
+    .allow_fast_charge_min_voltage          = 0,
+    .fast_charge_current_limit_default      = 0x600,
+    .fast_charge_current_limit_low_temp     = 0x240,
+    .fast_charge_current_limit_low_voltage  = 0x600,
+};
+
+static constexpr BatteryChargeParameters BatteryChargeParameters2 = {
+    .temp_min  = 4,
+    .temp_low  = 17,
+    .temp_high = 51,
+    .temp_max  = 59,
+    .allow_high_temp_charge_max_voltage = 4080,
+    .charge_voltage_limit_default       = 4320,
+    .charge_voltage_limit_high_temp     = 4080,
+    .allow_fast_charge_min_voltage          = 0,
+    .fast_charge_current_limit_default      = 0x680,
+    .fast_charge_current_limit_low_temp     = 0x280,
+    .fast_charge_current_limit_low_voltage  = 0x680,
+};
+
+static const BatteryChargeParameters *GetBatteryChargeParameters(u32 battery_version) {
+    switch (battery_version) {
+        case 0:
+            return &BatteryChargeParameters0;
+        case 1:
+            return &BatteryChargeParameters1;
+        case 2:
+            return &BatteryChargeParameters2;
+        default:
+            std::abort();
+    }
+}
+
+static void UpdateCharger(PmicDriver *pmic_driver, ChargerDriver *charger_driver, BatteryDriver *battery_driver, const BatteryChargeParameters *params, u32 charge_voltage_limit) {
+    double temperature;
+    u32 battery_voltage;
+
+    if (R_FAILED(battery_driver->GetTemperature(&temperature)) || R_FAILED(battery_driver->GetAverageVCell(&battery_voltage))) {
+        pmic_driver->ShutdownSystem();
+    }
+
+    bool enable_charge = true;
+    if (temperature < double(params->temp_min)) {
+        enable_charge = false;
+    } else if (double(params->temp_high) <= temperature && temperature < double(params->temp_max)) {
+        if (battery_voltage < params->allow_high_temp_charge_max_voltage) {
+            charge_voltage_limit = std::min(charge_voltage_limit, params->charge_voltage_limit_high_temp);
+        } else {
+            enable_charge = false;
+        }
+    } else if (double(params->temp_max) <= temperature) {
+        enable_charge = false;
+        if (battery_voltage < params->allow_high_temp_charge_max_voltage) {
+            charge_voltage_limit = std::min(charge_voltage_limit, params->charge_voltage_limit_high_temp);
+        }
+    }
+
+    u32 fast_charge_current_limit = params->fast_charge_current_limit_default;
+    if (temperature < double(params->temp_low)) {
+        fast_charge_current_limit = std::min(fast_charge_current_limit, params->fast_charge_current_limit_low_temp);
+    }
+    if (battery_voltage < params->allow_fast_charge_min_voltage) {
+        fast_charge_current_limit = std::min(fast_charge_current_limit, params->fast_charge_current_limit_low_voltage);
+    }
+
+    if (R_FAILED(charger_driver->SetChargeEnabled(enable_charge))) {
+        pmic_driver->ShutdownSystem();
+    }
+    if (R_FAILED(charger_driver->SetChargeVoltageLimit(charge_voltage_limit))) {
+        pmic_driver->ShutdownSystem();
+    }
+    if (R_FAILED(charger_driver->SetFastChargeCurrentLimit(fast_charge_current_limit))) {
+        pmic_driver->ShutdownSystem();
+    }
+}
+
+static bool IsSufficientBattery(u32 battery_voltage, bool ac_ok) {
+    /* Nintendo has stuff for updating a static variable every 10 seconds here, but this seems, again, to be debug leftovers. */
+    const u32 required_voltage = ac_ok ? 4000 : 3650;
+    return battery_voltage >= required_voltage;
+}
+
+static CheckBatteryResult LoopCheckBattery(PmicDriver *pmic_driver, ChargerDriver *charger_driver, BatteryDriver *battery_driver, const BatteryChargeParameters *params, u32 charge_voltage_limit, bool reboot_on_power_button_pressed, bool succeed_on_sufficient_battery, bool shutdown_on_full_battery, bool can_show_battery_icon, bool can_show_charging_icon) {
+    bool is_showing_charging_icon = false;
+    ON_SCOPE_EXIT {
+        if (is_showing_charging_icon) {
+            Boot::EndShowChargingIcon();
+        }
+    };
+
+    if (can_show_charging_icon) {
+        size_t battery_percentage;
+        if (R_FAILED(battery_driver->GetBatteryPercentage(&battery_percentage))) {
+            return CheckBatteryResult_Shutdown;
+        }
+        Boot::StartShowChargingIcon(battery_percentage, true);
+        is_showing_charging_icon = true;
+    }
+
+    while (true) {
+        double battery_charge;
+        if (R_FAILED(battery_driver->GetSocRep(&battery_charge))) {
+            return CheckBatteryResult_Shutdown;
+        }
+        if (succeed_on_sufficient_battery && battery_charge >= 3.0) {
+            return CheckBatteryResult_Success;
+        } else if (shutdown_on_full_battery && battery_charge >= 99.0) {
+            return CheckBatteryResult_Shutdown;
+        } else {
+            /* Nintendo has logic for checking a value every 10 seconds. */
+            /* They never do anything with this value though, so it's probably just leftovers from debug? */
+        }
+
+        bool ac_ok;
+        if (R_FAILED(pmic_driver->GetAcOk(&ac_ok))) {
+            return CheckBatteryResult_Shutdown;
+        }
+
+        u32 battery_voltage;
+        if (R_FAILED(battery_driver->GetAverageVCell(&battery_voltage))) {
+            return CheckBatteryResult_Shutdown;
+        }
+
+        if (succeed_on_sufficient_battery && IsSufficientBattery(battery_voltage, ac_ok)) {
+            return CheckBatteryResult_Success;
+        }
+
+        if (!ac_ok) {
+            if (can_show_battery_icon && !is_showing_charging_icon) {
+                Boot::ShowLowBatteryIcon();
+            }
+            return CheckBatteryResult_Shutdown;
+        }
+
+        if (reboot_on_power_button_pressed) {
+            bool power_button_pressed;
+            if (R_FAILED(pmic_driver->GetPowerButtonPressed(&power_button_pressed))) {
+                return CheckBatteryResult_Shutdown;
+            }
+            if (power_button_pressed) {
+                return CheckBatteryResult_Reboot;
+            }
+        }
+
+        if (can_show_battery_icon && !is_showing_charging_icon) {
+            Boot::StartShowChargingIcon(1, false);
+            is_showing_charging_icon = true;
+        }
+
+        svcSleepThread(20'000'000ul);
+        UpdateCharger(pmic_driver, charger_driver, battery_driver, params, charge_voltage_limit);
+    }
+}
+
+void Boot::CheckBatteryCharge() {
+    PmicDriver pmic_driver;
+    BatteryDriver battery_driver;
+    ChargerDriver charger_driver;
+
+    if (R_FAILED(battery_driver.InitializeBatteryParameters())) {
+        pmic_driver.ShutdownSystem();
+    }
+    {
+        bool removed;
+        if (R_FAILED(battery_driver.IsBatteryRemoved(&removed)) || removed) {
+            pmic_driver.ShutdownSystem();
+        }
+    }
+
+    const u32 boot_reason = Boot::GetBootReason();
+    InputCurrentLimit input_current_limit;
+    if (R_FAILED(charger_driver.Initialize(boot_reason != 4)) || R_FAILED(charger_driver.GetInputCurrentLimit(&input_current_limit))) {
+        pmic_driver.ShutdownSystem();
+    }
+
+    if (input_current_limit <= InputCurrentLimit_150mA) {
+        charger_driver.SetChargerConfiguration(ChargerConfiguration_ChargeDisable);
+        pmic_driver.ShutdownSystem();
+    }
+
+    const BatteryChargeParameters *params = GetBatteryChargeParameters(Boot::GetBatteryVersion());
+    u32 charge_voltage_limit = params->charge_voltage_limit_default;
+    CheckBatteryResult check_result;
+    if (boot_reason == 4) {
+        if (R_FAILED(charger_driver.GetChargeVoltageLimit(&charge_voltage_limit))) {
+            pmic_driver.ShutdownSystem();
+        }
+        UpdateCharger(&pmic_driver, &charger_driver, &battery_driver, params, charge_voltage_limit);
+        check_result = LoopCheckBattery(&pmic_driver, &charger_driver, &battery_driver, params, charge_voltage_limit, true, false, true, false, false);
+    } else {
+        UpdateCharger(&pmic_driver, &charger_driver, &battery_driver, params, charge_voltage_limit);
+        if (boot_reason == 1) {
+            check_result = LoopCheckBattery(&pmic_driver, &charger_driver, &battery_driver, params, charge_voltage_limit, true, true, false, true, true);
+        } else {
+            check_result = LoopCheckBattery(&pmic_driver, &charger_driver, &battery_driver, params, charge_voltage_limit, false, true, false, true, false);
+        }
+    }
+
+    switch (check_result)   {
+        case CheckBatteryResult_Success:
+            break;
+        case CheckBatteryResult_Shutdown:
+            pmic_driver.ShutdownSystem();
+            break;
+        case CheckBatteryResult_Reboot:
+            Boot::RebootSystem();
+            break;
+        default:
+            std::abort();
+    }
+}

stratosphere/boot/source/boot_check_clock.cpp

@@ -0,0 +1,48 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+
+static constexpr u32 ExpectedPlluDivP = (1 << 16);
+static constexpr u32 ExpectedPlluDivN = (25 << 8);
+static constexpr u32 ExpectedPlluDivM = (2  << 0);
+static constexpr u32 ExpectedPlluVal  = (ExpectedPlluDivP | ExpectedPlluDivN | ExpectedPlluDivM);
+static constexpr u32 ExpectedPlluMask = 0x1FFFFF;
+
+static constexpr u32 ExpectedUtmipDivN = (25 << 16);
+static constexpr u32 ExpectedUtmipDivM = (1 << 8);
+static constexpr u32 ExpectedUtmipVal  = (ExpectedUtmipDivN | ExpectedUtmipDivM);
+static constexpr u32 ExpectedUtmipMask = 0xFFFF00;
+
+static bool IsUsbClockValid() {
+    u64 _vaddr;
+    if (R_FAILED(svcQueryIoMapping(&_vaddr, 0x60006000ul, 0x1000))) {
+        std::abort();
+    }
+    volatile u32 *car_regs = reinterpret_cast<volatile u32 *>(_vaddr);
+
+    const u32 pllu = car_regs[0xC0 >> 2];
+    const u32 utmip = car_regs[0x480 >> 2];
+    return ((pllu & ExpectedPlluMask) == ExpectedPlluVal) && ((utmip & ExpectedUtmipMask) == ExpectedUtmipVal);
+}
+
+void Boot::CheckClock() {
+    if (!IsUsbClockValid()) {
+        /* Sleep for 1s, then reboot. */
+        svcSleepThread(1'000'000'000ul);
+        Boot::RebootSystem();
+    }
+}

stratosphere/boot/source/boot_clock_initial_configuration.cpp

@@ -0,0 +1,28 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+#include "boot_registers_pmc.hpp"
+
+static constexpr u32 PmcClkOutCntrl = PmcBase + APBDEV_PMC_CLK_OUT_CNTRL;
+static constexpr u32 InitialClockOutMask1x = 0x00C4;
+static constexpr u32 InitialClockOutMask6x = 0xC4C4;
+
+void Boot::SetInitialClockConfiguration() {
+    /* Write mask to APBDEV_PMC_PWR_DET, then clear APBDEV_PMC_PWR_DET_VAL. */
+    const u32 mask = GetRuntimeFirmwareVersion() >= FirmwareVersion_600 ? InitialClockOutMask6x : InitialClockOutMask1x;
+    WritePmcRegister(PmcClkOutCntrl, mask, mask);
+}

stratosphere/boot/source/boot_display.cpp

@@ -0,0 +1,536 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+#include "boot_display_config.hpp"
+#include "i2c_driver/i2c_api.hpp"
+
+/* Helpful defines. */
+constexpr size_t DeviceAddressSpaceAlignSize = 0x400000;
+constexpr size_t DeviceAddressSpaceAlignMask = DeviceAddressSpaceAlignSize - 1;
+constexpr uintptr_t FrameBufferPaddr = DisplayConfigFrameBufferAddress;
+constexpr size_t FrameBufferWidth = 768;
+constexpr size_t FrameBufferHeight = 1280;
+constexpr size_t FrameBufferSize = FrameBufferHeight * FrameBufferWidth * sizeof(u32);
+
+constexpr uintptr_t Disp1Base = 0x54200000ul;
+constexpr uintptr_t DsiBase = 0x54300000ul;
+constexpr uintptr_t ClkRstBase = 0x60006000ul;
+constexpr uintptr_t GpioBase = 0x6000D000ul;
+constexpr uintptr_t ApbMiscBase = 0x70000000ul;
+constexpr uintptr_t MipiCalBase = 0x700E3000ul;
+constexpr size_t Disp1Size = 0x3000;
+constexpr size_t DsiSize = 0x1000;
+constexpr size_t ClkRstSize = 0x1000;
+constexpr size_t GpioSize = 0x1000;
+constexpr size_t ApbMiscSize = 0x1000;
+constexpr size_t MipiCalSize = 0x1000;
+
+/* Types. */
+
+/* Globals. */
+static bool g_is_display_intialized = false;
+static u32 *g_frame_buffer = nullptr;
+static bool g_is_mariko = false;
+static u32 g_lcd_vendor = 0;
+static Handle g_dc_das_hnd = INVALID_HANDLE;
+static u8 g_frame_buffer_storage[DeviceAddressSpaceAlignSize + FrameBufferSize];
+
+static uintptr_t g_disp1_regs = 0;
+static uintptr_t g_dsi_regs = 0;
+static uintptr_t g_clk_rst_regs = 0;
+static uintptr_t g_gpio_regs = 0;
+static uintptr_t g_apb_misc_regs = 0;
+static uintptr_t g_mipi_cal_regs = 0;
+
+static inline uintptr_t QueryVirtualAddress(uintptr_t phys, size_t size) {
+    uintptr_t aligned_phys = phys & ~0xFFFul;
+    size_t aligned_size = size + (phys - aligned_phys);
+    uintptr_t aligned_virt;
+    if (R_FAILED(svcQueryIoMapping(&aligned_virt, aligned_phys, aligned_size))) {
+        std::abort();
+    }
+    return aligned_virt + (phys - aligned_phys);
+}
+
+static inline void WriteRegister(volatile u32 *reg, u32 val) {
+    *reg = val;
+}
+
+static inline void WriteRegister(uintptr_t reg, u32 val) {
+    WriteRegister(reinterpret_cast<volatile u32 *>(reg), val);
+}
+
+static inline u32 ReadRegister(volatile u32 *reg) {
+    u32 val = *reg;
+    return val;
+}
+
+static inline u32 ReadRegister(uintptr_t reg) {
+    return ReadRegister(reinterpret_cast<volatile u32 *>(reg));
+}
+
+static inline void SetRegisterBits(volatile u32 *reg, u32 mask) {
+    *reg |= mask;
+}
+
+static inline void SetRegisterBits(uintptr_t reg, u32 mask) {
+    SetRegisterBits(reinterpret_cast<volatile u32 *>(reg), mask);
+}
+
+static inline void ClearRegisterBits(volatile u32 *reg, u32 mask) {
+    *reg &= mask;
+}
+
+static inline void ClearRegisterBits(uintptr_t reg, u32 mask) {
+    ClearRegisterBits(reinterpret_cast<volatile u32 *>(reg), mask);
+}
+
+static inline void ReadWriteRegisterBits(volatile u32 *reg, u32 val, u32 mask) {
+    *reg = (*reg & (~mask)) | (val & mask);
+}
+
+static inline void ReadWriteRegisterBits(uintptr_t reg, u32 val, u32 mask) {
+    ReadWriteRegisterBits(reinterpret_cast<volatile u32 *>(reg), val, mask);
+}
+
+static void InitializeRegisterBaseAddresses() {
+    g_disp1_regs    = QueryVirtualAddress(Disp1Base, Disp1Size);
+    g_dsi_regs      = QueryVirtualAddress(DsiBase, DsiSize);
+    g_clk_rst_regs  = QueryVirtualAddress(ClkRstBase, ClkRstSize);
+    g_gpio_regs     = QueryVirtualAddress(GpioBase, GpioSize);
+    g_apb_misc_regs = QueryVirtualAddress(ApbMiscBase, ApbMiscSize);
+    g_mipi_cal_regs = QueryVirtualAddress(MipiCalBase, MipiCalSize);
+}
+
+static inline void DoRegisterWrites(uintptr_t base_address, const RegisterWrite *reg_writes, size_t num_writes) {
+    for (size_t i = 0; i < num_writes; i++) {
+        *(reinterpret_cast<volatile u32 *>(base_address + reg_writes[i].offset)) = reg_writes[i].value;
+    }
+}
+
+static inline void DoSocDependentRegisterWrites(uintptr_t base_address, const RegisterWrite *reg_writes_erista, size_t num_writes_erista, const RegisterWrite *reg_writes_mariko, size_t num_writes_mariko) {
+    if (g_is_mariko) {
+        DoRegisterWrites(base_address, reg_writes_mariko, num_writes_mariko);
+    } else {
+        DoRegisterWrites(base_address, reg_writes_erista, num_writes_erista);
+    }
+}
+
+static inline void DoDsiSleepOrRegisterWrites(const DsiSleepOrRegisterWrite *reg_writes, size_t num_writes) {
+    for (size_t i = 0; i < num_writes; i++) {
+        if (reg_writes[i].kind == DsiSleepOrRegisterWriteKind_Write) {
+            *(reinterpret_cast<volatile u32 *>(g_dsi_regs + sizeof(u32) * reg_writes[i].offset)) = reg_writes[i].value;
+        } else if (reg_writes[i].kind == DsiSleepOrRegisterWriteKind_Sleep) {
+            svcSleepThread(1'000'000ul * u64(reg_writes[i].offset));
+        } else {
+            std::abort();
+        }
+    }
+}
+
+#define DO_REGISTER_WRITES(base_address, writes) DoRegisterWrites(base_address, writes, sizeof(writes) / sizeof(writes[0]))
+#define DO_SOC_DEPENDENT_REGISTER_WRITES(base_address, writes) DoSocDependentRegisterWrites(base_address, writes##Erista, sizeof(writes##Erista) / sizeof(writes##Erista[0]), writes##Mariko, sizeof(writes##Mariko) / sizeof(writes##Mariko[0]))
+#define DO_DSI_SLEEP_OR_REGISTER_WRITES(writes) DoDsiSleepOrRegisterWrites(writes, sizeof(writes) / sizeof(writes[0]))
+
+static void InitializeFrameBuffer() {
+    if (g_frame_buffer != nullptr) {
+        std::memset(g_frame_buffer, 0x00, FrameBufferSize);
+        armDCacheFlush(g_frame_buffer, FrameBufferSize);
+    } else {
+        const uintptr_t frame_buffer_aligned = ((reinterpret_cast<uintptr_t>(g_frame_buffer_storage) + DeviceAddressSpaceAlignMask) & ~uintptr_t(DeviceAddressSpaceAlignMask));
+        g_frame_buffer = reinterpret_cast<u32 *>(frame_buffer_aligned);
+        std::memset(g_frame_buffer, 0x00, FrameBufferSize);
+        armDCacheFlush(g_frame_buffer, FrameBufferSize);
+
+        constexpr u64 DeviceName_DC = 2;
+
+        /* Create Address Space. */
+        if (R_FAILED(svcCreateDeviceAddressSpace(&g_dc_das_hnd, 0, (1ul << 32)))) {
+            std::abort();
+        }
+        /* Attach it to the DC. */
+        if (R_FAILED(svcAttachDeviceAddressSpace(DeviceName_DC, g_dc_das_hnd))) {
+            std::abort();
+        }
+
+        /* Map the framebuffer for the DC as read-only. */
+        if (R_FAILED(svcMapDeviceAddressSpaceAligned(g_dc_das_hnd, CUR_PROCESS_HANDLE, frame_buffer_aligned, FrameBufferSize, FrameBufferPaddr, 1))) {
+            std::abort();
+        }
+    }
+}
+
+static void FinalizeFrameBuffer() {
+    if (g_frame_buffer != nullptr) {
+        const uintptr_t frame_buffer_aligned = reinterpret_cast<uintptr_t>(g_frame_buffer);
+        constexpr u64 DeviceName_DC = 2;
+
+        /* Unmap the framebuffer from the DC. */
+        if (R_FAILED(svcUnmapDeviceAddressSpace(g_dc_das_hnd, CUR_PROCESS_HANDLE, frame_buffer_aligned, FrameBufferSize, FrameBufferPaddr))) {
+            std::abort();
+        }
+        /* Detach address space from the DC. */
+        if (R_FAILED(svcDetachDeviceAddressSpace(DeviceName_DC, g_dc_das_hnd))) {
+            std::abort();
+        }
+        /* Close the address space. */
+        if (R_FAILED(svcCloseHandle(g_dc_das_hnd))) {
+            std::abort();
+        }
+        g_dc_das_hnd = INVALID_HANDLE;
+        g_frame_buffer = nullptr;
+    }
+}
+
+static void WaitDsiTrigger() {
+    TimeoutHelper timeout_helper(250'000'000ul);
+
+    while (true) {
+        if (timeout_helper.TimedOut()) {
+            break;
+        }
+        if (ReadRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER) == 0) {
+            break;
+        }
+    }
+
+    svcSleepThread(5'000'000ul);
+}
+
+static void WaitDsiHostControl() {
+    TimeoutHelper timeout_helper(150'000'000ul);
+
+    while (true) {
+        if (timeout_helper.TimedOut()) {
+            break;
+        }
+        if ((ReadRegister(g_dsi_regs + sizeof(u32) * DSI_HOST_CONTROL) & DSI_HOST_CONTROL_IMM_BTA) == 0) {
+            break;
+        }
+    }
+}
+
+void Boot::InitializeDisplay() {
+    /* Setup globals. */
+    InitializeRegisterBaseAddresses();
+    g_is_mariko = Boot::IsMariko();
+    InitializeFrameBuffer();
+
+    /* Turn on DSI/voltage rail. */
+    {
+        I2cSessionImpl i2c_session;
+        I2cDriver::Initialize();
+        I2cDriver::OpenSession(&i2c_session, I2cDevice_Max77620Pmic);
+
+        if (g_is_mariko) {
+            Boot::WriteI2cRegister(i2c_session, 0x18, 0x3A);
+            Boot::WriteI2cRegister(i2c_session, 0x1F, 0x71);
+        }
+        Boot::WriteI2cRegister(i2c_session, 0x23, 0xD0);
+
+        I2cDriver::Finalize();
+    }
+
+    /* Enable MIPI CAL, DSI, DISP1, HOST1X, UART_FST_MIPI_CAL, DSIA LP clocks. */
+    WriteRegister(g_clk_rst_regs + CLK_RST_CONTROLLER_RST_DEV_H_CLR, 0x1010000);
+    WriteRegister(g_clk_rst_regs + CLK_RST_CONTROLLER_CLK_ENB_H_SET, 0x1010000);
+    WriteRegister(g_clk_rst_regs + CLK_RST_CONTROLLER_RST_DEV_L_CLR, 0x18000000);
+    WriteRegister(g_clk_rst_regs + CLK_RST_CONTROLLER_CLK_ENB_L_SET, 0x18000000);
+    WriteRegister(g_clk_rst_regs + CLK_RST_CONTROLLER_CLK_ENB_X_SET, 0x20000);
+    WriteRegister(g_clk_rst_regs + CLK_RST_CONTROLLER_CLK_SOURCE_UART_FST_MIPI_CAL, 0xA);
+    WriteRegister(g_clk_rst_regs + CLK_RST_CONTROLLER_CLK_ENB_W_SET, 0x80000);
+    WriteRegister(g_clk_rst_regs + CLK_RST_CONTROLLER_CLK_SOURCE_DSIA_LP, 0xA);
+
+    /* DPD idle. */
+    WritePmcRegister(PmcBase + APBDEV_PMC_IO_DPD_REQ, 0x40000000);
+    WritePmcRegister(PmcBase + APBDEV_PMC_IO_DPD2_REQ, 0x40000000);
+
+    /* Configure LCD pinmux tristate + passthrough. */
+    ClearRegisterBits(g_apb_misc_regs + 0x3000 + PINMUX_AUX_NFC_EN, ~PINMUX_TRISTATE);
+    ClearRegisterBits(g_apb_misc_regs + 0x3000 + PINMUX_AUX_NFC_INT, ~PINMUX_TRISTATE);
+    ClearRegisterBits(g_apb_misc_regs + 0x3000 + PINMUX_AUX_LCD_BL_PWM, ~PINMUX_TRISTATE);
+    ClearRegisterBits(g_apb_misc_regs + 0x3000 + PINMUX_AUX_LCD_BL_EN, ~PINMUX_TRISTATE);
+    ClearRegisterBits(g_apb_misc_regs + 0x3000 + PINMUX_AUX_LCD_RST, ~PINMUX_TRISTATE);
+
+    /* Configure LCD power, VDD. */
+    SetRegisterBits(g_gpio_regs + GPIO_PORT3_CNF_0, 0x3);
+    SetRegisterBits(g_gpio_regs + GPIO_PORT3_OE_0,  0x3);
+    SetRegisterBits(g_gpio_regs + GPIO_PORT3_OUT_0, 0x1);
+    svcSleepThread(10'000'000ul);
+    SetRegisterBits(g_gpio_regs + GPIO_PORT3_OUT_0, 0x2);
+    svcSleepThread(10'000'000ul);
+
+    /* Configure LCD backlight. */
+    SetRegisterBits(g_gpio_regs + GPIO_PORT6_CNF_1, 0x7);
+    SetRegisterBits(g_gpio_regs + GPIO_PORT6_OE_1,  0x7);
+    SetRegisterBits(g_gpio_regs + GPIO_PORT6_OUT_1, 0x2);
+
+    /* Configure display interface and display. */
+    WriteRegister(g_mipi_cal_regs + 0x060, 0);
+    if (g_is_mariko) {
+        WriteRegister(g_mipi_cal_regs + 0x058, 0);
+        WriteRegister(g_apb_misc_regs + 0xAC0, 0);
+    }
+
+    /* Execute configs. */
+    DO_SOC_DEPENDENT_REGISTER_WRITES(g_clk_rst_regs, DisplayConfigPlld01);
+    DO_REGISTER_WRITES(g_disp1_regs, DisplayConfigDc01);
+    DO_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsi01Init01);
+    /* NOTE: Nintendo bug here. */
+    /* As of 8.0.0, Nintendo writes this list to CAR instead of DSI */
+    /* This results in them zeroing CLK_SOURCE_UARTA... */
+    DO_SOC_DEPENDENT_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsi01Init02);
+    DO_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsi01Init03);
+    DO_SOC_DEPENDENT_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsi01Init04);
+    DO_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsi01Init05);
+    DO_SOC_DEPENDENT_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsiPhyTiming);
+    DO_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsi01Init06);
+    DO_SOC_DEPENDENT_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsiPhyTiming);
+    DO_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsi01Init07);
+
+    svcSleepThread(10'000'000ul);
+
+    /* Enable backlight reset. */
+    SetRegisterBits(g_gpio_regs + GPIO_PORT6_OUT_1, 0x4);
+    svcSleepThread(60'000'000ul);
+
+    WriteRegister(g_dsi_regs + sizeof(u32) * DSI_BTA_TIMING, 0x50204);
+    WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x337);
+    WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+    WaitDsiTrigger();
+
+    WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x406);
+    WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+    WaitDsiTrigger();
+
+    WriteRegister(g_dsi_regs + sizeof(u32) * DSI_HOST_CONTROL, DSI_HOST_CONTROL_TX_TRIG_HOST | DSI_HOST_CONTROL_IMM_BTA | DSI_HOST_CONTROL_CS | DSI_HOST_CONTROL_ECC);
+    WaitDsiHostControl();
+    svcSleepThread(5'000'000ul);
+
+    /* Parse LCD vendor. */
+    {
+        u32 host_response[3];
+        for (size_t i = 0; i < sizeof(host_response) / sizeof(host_response[0]); i++) {
+            host_response[i] = ReadRegister(g_dsi_regs + sizeof(u32) * DSI_RD_DATA);
+        }
+
+        if ((host_response[2] & 0xFF) == 0x10) {
+            g_lcd_vendor = 0;
+        } else {
+            g_lcd_vendor = (host_response[2] >> 8) & 0xFF00;
+        }
+        g_lcd_vendor = (g_lcd_vendor & 0xFFFFFF00) | (host_response[2] & 0xFF);
+    }
+
+    /* LCD vendor specific configuration. */
+    switch (g_lcd_vendor) {
+        case 0xF30: /* TODO: What's this? */
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x1105);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+            svcSleepThread(180'000'000ul);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x439);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x9483FFB9);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+            svcSleepThread(5'000'000ul);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x739);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x711148B1);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x143209);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+            svcSleepThread(5'000'000ul);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x2905);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+            break;
+        case 0xF20: /* TODO: What's this? */
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x1105);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+            svcSleepThread(180'000'000ul);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x439);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x9483FFB9);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+            svcSleepThread(5'000'000ul);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x739);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x751548B1);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x143209);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+            svcSleepThread(5'000'000ul);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x2905);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+            break;
+        case 0x10: /* Japan Display Inc screens. */
+            DO_DSI_SLEEP_OR_REGISTER_WRITES(DisplayConfigJdiSpecificInit01);
+            break;
+        default:
+            if ((g_lcd_vendor | 0x10) == 0x1030) {
+                WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x1105);
+                WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+                svcSleepThread(120'000'000ul);
+                WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x2905);
+                WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+            }
+            break;
+    }
+    svcSleepThread(20'000'000ul);
+
+    DO_SOC_DEPENDENT_REGISTER_WRITES(g_clk_rst_regs, DisplayConfigPlld02);
+    DO_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsi01Init08);
+    DO_SOC_DEPENDENT_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsiPhyTiming);
+    DO_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsi01Init09);
+
+    WriteRegister(g_disp1_regs + sizeof(u32) * DC_DISP_DISP_CLOCK_CONTROL, SHIFT_CLK_DIVIDER(4));
+    DO_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsi01Init10);
+    svcSleepThread(10'000'000ul);
+
+    /* Configure MIPI CAL. */
+    DO_REGISTER_WRITES(g_mipi_cal_regs, DisplayConfigMipiCal01);
+    DO_SOC_DEPENDENT_REGISTER_WRITES(g_mipi_cal_regs, DisplayConfigMipiCal02);
+    DO_SOC_DEPENDENT_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsi01Init11);
+    DO_SOC_DEPENDENT_REGISTER_WRITES(g_mipi_cal_regs, DisplayConfigMipiCal03);
+    DO_REGISTER_WRITES(g_mipi_cal_regs, DisplayConfigMipiCal04);
+    if (g_is_mariko) {
+        /* On Mariko the above configurations are executed twice, for some reason. */
+        DO_SOC_DEPENDENT_REGISTER_WRITES(g_mipi_cal_regs, DisplayConfigMipiCal02);
+        DO_SOC_DEPENDENT_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsi01Init11);
+        DO_SOC_DEPENDENT_REGISTER_WRITES(g_mipi_cal_regs, DisplayConfigMipiCal03);
+        DO_REGISTER_WRITES(g_mipi_cal_regs, DisplayConfigMipiCal04);
+    }
+    svcSleepThread(10'000'000ul);
+
+    /* Write DISP1, FrameBuffer config. */
+    DO_REGISTER_WRITES(g_disp1_regs, DisplayConfigDc02);
+    DO_REGISTER_WRITES(g_disp1_regs, DisplayConfigFrameBuffer);
+    svcSleepThread(35'000'000ul);
+    g_is_display_intialized = true;
+}
+
+void Boot::ShowDisplay(size_t x, size_t y, size_t width, size_t height, const u32 *img) {
+    if (!g_is_display_intialized) {
+        return;
+    }
+
+    /* Draw the image to the screen. */
+    std::memset(g_frame_buffer, 0, FrameBufferSize);
+    {
+        for (size_t cur_y = 0; cur_y < height; cur_y++) {
+            for (size_t cur_x = 0; cur_x < width; cur_x++) {
+                g_frame_buffer[(FrameBufferHeight - (x + cur_x)) * FrameBufferWidth + y + cur_y] = img[cur_y * width + cur_x];
+            }
+        }
+    }
+    armDCacheFlush(g_frame_buffer, FrameBufferSize);
+
+    /* Enable backlight. */
+    SetRegisterBits(g_gpio_regs + GPIO_PORT6_OUT_1, 0x1);
+}
+
+void Boot::FinalizeDisplay() {
+    if (!g_is_display_intialized) {
+        return;
+    }
+
+    /* Disable backlight. */
+    ClearRegisterBits(g_gpio_regs + GPIO_PORT6_OUT_1, ~0x1);
+
+    WriteRegister(g_disp1_regs + sizeof(u32) * DSI_VIDEO_MODE_CONTROL, 1);
+    WriteRegister(g_disp1_regs + sizeof(u32) * DSI_WR_DATA, 0x2805);
+
+    /* Nintendo waits 5 frames before continuing. */
+    {
+        const uintptr_t host1x_vaddr = QueryVirtualAddress(0x500030a4, 4);
+        const u32 start_val = ReadRegister(host1x_vaddr);
+        while (ReadRegister(host1x_vaddr) < start_val + 5) {
+            /* spinlock here. */
+        }
+    }
+
+    WriteRegister(g_disp1_regs + sizeof(u32) * DC_CMD_STATE_ACCESS, (READ_MUX | WRITE_MUX));
+    WriteRegister(g_disp1_regs + sizeof(u32) * DSI_VIDEO_MODE_CONTROL, 0);
+
+
+    DO_SOC_DEPENDENT_REGISTER_WRITES(g_clk_rst_regs, DisplayConfigPlld01);
+    DO_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsi01Fini01);
+    DO_SOC_DEPENDENT_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsiPhyTiming);
+    DO_REGISTER_WRITES(g_dsi_regs, DisplayConfigDsi01Fini02);
+
+    svcSleepThread(10'000'000ul);
+
+    /* Vendor specific shutdown. */
+    switch (g_lcd_vendor) {
+        case 0x10:   /* Japan Display Inc screens. */
+            DO_REGISTER_WRITES(g_dsi_regs, DisplayConfigJdiSpecificFini01);
+            break;
+        case 0xF30:  /* TODO: What's this? */
+            DO_REGISTER_WRITES(g_dsi_regs, DisplayConfigF30SpecificFini01);
+            svcSleepThread(5'000'000ul);
+            break;
+        case 0x1020: /* TODO: What's this? */
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x439);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x9483FFB9);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+            svcSleepThread(5'000'000ul);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0xB39);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x751548B1);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x71143209);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x115631);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+            svcSleepThread(5'000'000ul);
+            break;
+        case 0x1030: /* TODO: What's this? */
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x439);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x9483FFB9);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+            svcSleepThread(5'000'000ul);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0xB39);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x711148B1);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x71143209);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x114D31);
+            WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+            svcSleepThread(5'000'000ul);
+            break;
+        default:
+            break;
+    }
+    svcSleepThread(5'000'000ul);
+
+    WriteRegister(g_dsi_regs + sizeof(u32) * DSI_WR_DATA, 0x1005);
+    WriteRegister(g_dsi_regs + sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST);
+    svcSleepThread(50'000'000ul);
+
+    /* Disable backlight RST/Voltage. */
+    ClearRegisterBits(g_gpio_regs + GPIO_PORT6_OUT_1, ~0x4);
+    svcSleepThread(10'000'000ul);
+    ClearRegisterBits(g_gpio_regs + GPIO_PORT3_OUT_0, ~0x2);
+    svcSleepThread(10'000'000ul);
+    ClearRegisterBits(g_gpio_regs + GPIO_PORT3_OUT_0, ~0x1);
+    svcSleepThread(10'000'000ul);
+
+    /* Cut clock to DSI. */
+    WriteRegister(g_clk_rst_regs + CLK_RST_CONTROLLER_RST_DEV_H_SET, 0x1010000);
+    WriteRegister(g_clk_rst_regs + CLK_RST_CONTROLLER_CLK_ENB_H_CLR, 0x1010000);
+    WriteRegister(g_clk_rst_regs + CLK_RST_CONTROLLER_RST_DEV_L_SET, 0x18000000);
+    WriteRegister(g_clk_rst_regs + CLK_RST_CONTROLLER_CLK_ENB_L_CLR, 0x18000000);
+    WriteRegister(g_dsi_regs + sizeof(u32) * DSI_PAD_CONTROL_0, (DSI_PAD_CONTROL_VS1_PULLDN_CLK | DSI_PAD_CONTROL_VS1_PULLDN(0xF) | DSI_PAD_CONTROL_VS1_PDIO_CLK | DSI_PAD_CONTROL_VS1_PDIO(0xF)));
+    WriteRegister(g_dsi_regs + sizeof(u32) * DSI_POWER_CONTROL, 0);
+
+    /* Final LCD config for PWM */
+    ClearRegisterBits(g_gpio_regs + GPIO_PORT6_CNF_1, ~0x1);
+    SetRegisterBits(g_apb_misc_regs + 0x3000 + PINMUX_AUX_LCD_BL_PWM, PINMUX_TRISTATE);
+    ReadWriteRegisterBits(g_apb_misc_regs + 0x3000 + PINMUX_AUX_LCD_BL_PWM, 1, 0x3);
+
+    /* Unmap framebuffer from DC virtual address space. */
+    FinalizeFrameBuffer();
+    g_is_display_intialized = false;
+}

stratosphere/boot/source/boot_display_config.hpp

@@ -0,0 +1,676 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+#include "boot_registers_clkrst.hpp"
+#include "boot_registers_di.hpp"
+#include "boot_registers_gpio.hpp"
+#include "boot_registers_pinmux.hpp"
+#include "boot_registers_pmc.hpp"
+
+struct RegisterWrite {
+    u32 offset;
+    u32 value;
+};
+
+enum DsiSleepOrRegisterWriteKind : u16 {
+    DsiSleepOrRegisterWriteKind_Write = 0,
+    DsiSleepOrRegisterWriteKind_Sleep = 1,
+};
+
+struct DsiSleepOrRegisterWrite {
+    DsiSleepOrRegisterWriteKind kind;
+    u16 offset;
+    u32 value;
+};
+
+static constexpr RegisterWrite DisplayConfigPlld01Erista[] = {
+    {CLK_RST_CONTROLLER_CLK_SOURCE_DISP1, 0x40000000},
+    {CLK_RST_CONTROLLER_PLLD_BASE,        0x4830A001},
+    {CLK_RST_CONTROLLER_PLLD_MISC1,       0x00000020},
+    {CLK_RST_CONTROLLER_PLLD_MISC,        0x002D0AAA},
+};
+
+static constexpr RegisterWrite DisplayConfigPlld01Mariko[] = {
+    {CLK_RST_CONTROLLER_CLK_SOURCE_DISP1, 0x40000000},
+    {CLK_RST_CONTROLLER_PLLD_BASE,        0x4830A001},
+    {CLK_RST_CONTROLLER_PLLD_MISC1,       0x00000000},
+    {CLK_RST_CONTROLLER_PLLD_MISC,        0x002DFC00},
+};
+
+static constexpr RegisterWrite DisplayConfigDc01[] = {
+    {sizeof(u32) * DC_CMD_STATE_ACCESS, 0},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_UPDATE},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_ACT_REQ},
+    {sizeof(u32) * DC_CMD_REG_ACT_CONTROL, 0x54},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_UPDATE},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_ACT_REQ},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT},
+    {sizeof(u32) * DC_DISP_DC_MCCIF_FIFOCTRL, 0},
+    {sizeof(u32) * DC_DISP_DISP_MEM_HIGH_PRIORITY, 0},
+    {sizeof(u32) * DC_DISP_DISP_MEM_HIGH_PRIORITY_TIMER, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_POWER_CONTROL, PW0_ENABLE | PW1_ENABLE | PW2_ENABLE | PW3_ENABLE | PW4_ENABLE | PM0_ENABLE | PM1_ENABLE},
+    {sizeof(u32) * DC_CMD_GENERAL_INCR_SYNCPT_CNTRL, SYNCPT_CNTRL_NO_STALL},
+    {sizeof(u32) * DC_CMD_CONT_SYNCPT_VSYNC, SYNCPT_VSYNC_ENABLE | 0x9}, // 9: SYNCPT
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_UPDATE | WIN_A_UPDATE | WIN_B_UPDATE | WIN_C_UPDATE},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_ACT_REQ | WIN_A_ACT_REQ | WIN_B_ACT_REQ | WIN_C_ACT_REQ},
+    {sizeof(u32) * DC_CMD_STATE_ACCESS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT},
+    {sizeof(u32) * DC_WIN_DV_CONTROL, 0},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT},
+    /* Setup default YUV colorspace conversion coefficients */
+    {sizeof(u32) * DC_WIN_CSC_YOF,   0xF0},
+    {sizeof(u32) * DC_WIN_CSC_KYRGB, 0x12A},
+    {sizeof(u32) * DC_WIN_CSC_KUR,   0},
+    {sizeof(u32) * DC_WIN_CSC_KVR,   0x198},
+    {sizeof(u32) * DC_WIN_CSC_KUG,   0x39B},
+    {sizeof(u32) * DC_WIN_CSC_KVG,   0x32F},
+    {sizeof(u32) * DC_WIN_CSC_KUB,   0x204},
+    {sizeof(u32) * DC_WIN_CSC_KVB,   0},
+    /* End of color coefficients */
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT},
+    {sizeof(u32) * DC_WIN_DV_CONTROL, 0},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT},
+    /* Setup default YUV colorspace conversion coefficients */
+    {sizeof(u32) * DC_WIN_CSC_YOF,   0xF0},
+    {sizeof(u32) * DC_WIN_CSC_KYRGB, 0x12A},
+    {sizeof(u32) * DC_WIN_CSC_KUR,   0},
+    {sizeof(u32) * DC_WIN_CSC_KVR,   0x198},
+    {sizeof(u32) * DC_WIN_CSC_KUG,   0x39B},
+    {sizeof(u32) * DC_WIN_CSC_KVG,   0x32F},
+    {sizeof(u32) * DC_WIN_CSC_KUB,   0x204},
+    {sizeof(u32) * DC_WIN_CSC_KVB,   0},
+    /* End of color coefficients */
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT},
+    {sizeof(u32) * DC_WIN_DV_CONTROL, 0},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT},
+    /* Setup default YUV colorspace conversion coefficients */
+    {sizeof(u32) * DC_WIN_CSC_YOF,   0xF0},
+    {sizeof(u32) * DC_WIN_CSC_KYRGB, 0x12A},
+    {sizeof(u32) * DC_WIN_CSC_KUR,   0},
+    {sizeof(u32) * DC_WIN_CSC_KVR,   0x198},
+    {sizeof(u32) * DC_WIN_CSC_KUG,   0x39B},
+    {sizeof(u32) * DC_WIN_CSC_KVG,   0x32F},
+    {sizeof(u32) * DC_WIN_CSC_KUB,   0x204},
+    {sizeof(u32) * DC_WIN_CSC_KVB,   0},
+    /* End of color coefficients */
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_DISP_DISP_COLOR_CONTROL, BASE_COLOR_SIZE_888},
+    {sizeof(u32) * DC_DISP_DISP_INTERFACE_CONTROL, DISP_DATA_FORMAT_DF1P1C},
+    {sizeof(u32) * DC_COM_PIN_OUTPUT_POLARITY(1), 0x1000000},
+    {sizeof(u32) * DC_COM_PIN_OUTPUT_POLARITY(3), 0},
+    {sizeof(u32) * 0x4E4, 0},
+    {sizeof(u32) * DC_COM_CRC_CONTROL, 0},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_UPDATE | WIN_A_UPDATE | WIN_B_UPDATE | WIN_C_UPDATE},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_ACT_REQ | WIN_A_ACT_REQ | WIN_B_ACT_REQ | WIN_C_ACT_REQ},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT},
+    {sizeof(u32) * 0x716, 0x10000FF},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT},
+    {sizeof(u32) * 0x716, 0x10000FF},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT},
+    {sizeof(u32) * 0x716, 0x10000FF},
+    {sizeof(u32) * DC_CMD_DISPLAY_COMMAND_OPTION0, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_DISP_DISP_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_COMMAND, 0},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_UPDATE | WIN_A_UPDATE | WIN_B_UPDATE | WIN_C_UPDATE},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_ACT_REQ | WIN_A_ACT_REQ | WIN_B_ACT_REQ | WIN_C_ACT_REQ}
+};
+
+static constexpr RegisterWrite DisplayConfigDsi01Init01[] = {
+    {sizeof(u32) * DSI_WR_DATA,         0x0},
+    {sizeof(u32) * DSI_INT_ENABLE,      0x0},
+    {sizeof(u32) * DSI_INT_STATUS,      0x0},
+    {sizeof(u32) * DSI_INT_MASK,        0x0},
+    {sizeof(u32) * DSI_INIT_SEQ_DATA_0, 0x0},
+    {sizeof(u32) * DSI_INIT_SEQ_DATA_1, 0x0},
+    {sizeof(u32) * DSI_INIT_SEQ_DATA_2, 0x0},
+    {sizeof(u32) * DSI_INIT_SEQ_DATA_3, 0x0},
+};
+
+static constexpr RegisterWrite DisplayConfigDsi01Init02Erista[] = {
+    {sizeof(u32) * DSI_INIT_SEQ_DATA_15, 0x0},
+};
+
+static constexpr RegisterWrite DisplayConfigDsi01Init02Mariko[] = {
+    {sizeof(u32) * DSI_INIT_SEQ_DATA_15_MARIKO, 0x0},
+};
+
+static constexpr RegisterWrite DisplayConfigDsi01Init03[] = {
+    {sizeof(u32) * DSI_DCS_CMDS,     0},
+    {sizeof(u32) * DSI_PKT_SEQ_0_LO, 0},
+    {sizeof(u32) * DSI_PKT_SEQ_1_LO, 0},
+    {sizeof(u32) * DSI_PKT_SEQ_2_LO, 0},
+    {sizeof(u32) * DSI_PKT_SEQ_3_LO, 0},
+    {sizeof(u32) * DSI_PKT_SEQ_4_LO, 0},
+    {sizeof(u32) * DSI_PKT_SEQ_5_LO, 0},
+    {sizeof(u32) * DSI_PKT_SEQ_0_HI, 0},
+    {sizeof(u32) * DSI_PKT_SEQ_1_HI, 0},
+    {sizeof(u32) * DSI_PKT_SEQ_2_HI, 0},
+    {sizeof(u32) * DSI_PKT_SEQ_3_HI, 0},
+    {sizeof(u32) * DSI_PKT_SEQ_4_HI, 0},
+    {sizeof(u32) * DSI_PKT_SEQ_5_HI, 0},
+};
+
+static constexpr RegisterWrite DisplayConfigDsi01Init04Erista[] = {
+    /* No register writes. */
+};
+
+static constexpr RegisterWrite DisplayConfigDsi01Init04Mariko[] = {
+    {sizeof(u32) * DSI_PAD_CONTROL_1,        0},
+    {sizeof(u32) * DSI_PAD_CONTROL_2,        0},
+    {sizeof(u32) * DSI_PAD_CONTROL_3,        0},
+    {sizeof(u32) * DSI_PAD_CONTROL_4,        0},
+    {sizeof(u32) * DSI_PAD_CONTROL_5_MARIKO, 0},
+    {sizeof(u32) * DSI_PAD_CONTROL_6_MARIKO, 0},
+    {sizeof(u32) * DSI_PAD_CONTROL_7_MARIKO, 0},
+};
+
+static constexpr RegisterWrite DisplayConfigDsi01Init05[] = {
+    {sizeof(u32) * DSI_PAD_CONTROL_CD,   0},
+    {sizeof(u32) * DSI_SOL_DELAY,        0x18},
+    {sizeof(u32) * DSI_MAX_THRESHOLD,    0x1E0},
+    {sizeof(u32) * DSI_TRIGGER,          0},
+    {sizeof(u32) * DSI_INIT_SEQ_CONTROL, 0},
+    {sizeof(u32) * DSI_PKT_LEN_0_1,      0},
+    {sizeof(u32) * DSI_PKT_LEN_2_3,      0},
+    {sizeof(u32) * DSI_PKT_LEN_4_5,      0},
+    {sizeof(u32) * DSI_PKT_LEN_6_7,      0},
+    {sizeof(u32) * DSI_PAD_CONTROL_1,    0},
+};
+
+static constexpr RegisterWrite DisplayConfigDsi01Init06[] = {
+    {sizeof(u32) * DSI_PHY_TIMING_1,  0x40A0E05},
+    {sizeof(u32) * DSI_PHY_TIMING_2,  0x30109},
+    {sizeof(u32) * DSI_BTA_TIMING,    0x190A14},
+    {sizeof(u32) * DSI_TIMEOUT_0,     DSI_TIMEOUT_LRX(0x2000) | DSI_TIMEOUT_HTX(0xFFFF)},
+    {sizeof(u32) * DSI_TIMEOUT_1,     DSI_TIMEOUT_PR(0x765) | DSI_TIMEOUT_TA(0x2000)},
+    {sizeof(u32) * DSI_TO_TALLY,      0},
+    {sizeof(u32) * DSI_PAD_CONTROL_0, DSI_PAD_CONTROL_VS1_PULLDN(0) | DSI_PAD_CONTROL_VS1_PDIO(0)}, // Enable
+    {sizeof(u32) * DSI_POWER_CONTROL, DSI_POWER_CONTROL_ENABLE},
+    {sizeof(u32) * DSI_POWER_CONTROL, DSI_POWER_CONTROL_ENABLE},
+    {sizeof(u32) * DSI_POWER_CONTROL, 0},
+    {sizeof(u32) * DSI_POWER_CONTROL, 0},
+    {sizeof(u32) * DSI_PAD_CONTROL_1, 0},
+
+};
+
+static constexpr RegisterWrite DisplayConfigDsi01Init07[] = {
+    {sizeof(u32) * DSI_PHY_TIMING_1,        0x40A0E05},
+    {sizeof(u32) * DSI_PHY_TIMING_2,        0x30118},
+    {sizeof(u32) * DSI_BTA_TIMING,          0x190A14},
+    {sizeof(u32) * DSI_TIMEOUT_0,           DSI_TIMEOUT_LRX(0x2000) | DSI_TIMEOUT_HTX(0xFFFF)},
+    {sizeof(u32) * DSI_TIMEOUT_1,           DSI_TIMEOUT_PR(0x1343) | DSI_TIMEOUT_TA(0x2000)},
+    {sizeof(u32) * DSI_TO_TALLY,            0},
+    {sizeof(u32) * DSI_HOST_CONTROL,        DSI_HOST_CONTROL_CRC_RESET | DSI_HOST_CONTROL_TX_TRIG_HOST | DSI_HOST_CONTROL_CS | DSI_HOST_CONTROL_ECC},
+    {sizeof(u32) * DSI_CONTROL,             DSI_CONTROL_LANES(3) | DSI_CONTROL_HOST_ENABLE},
+    {sizeof(u32) * DSI_POWER_CONTROL,       DSI_POWER_CONTROL_ENABLE},
+    {sizeof(u32) * DSI_POWER_CONTROL,       DSI_POWER_CONTROL_ENABLE},
+    {sizeof(u32) * DSI_MAX_THRESHOLD,       0x40},
+    {sizeof(u32) * DSI_TRIGGER,             0},
+    {sizeof(u32) * DSI_TX_CRC,              0},
+    {sizeof(u32) * DSI_INIT_SEQ_CONTROL,    0}
+};
+
+static constexpr RegisterWrite DisplayConfigDsiPhyTimingErista[] = {
+    {sizeof(u32) * DSI_PHY_TIMING_0, 0x6070601},
+};
+
+static constexpr RegisterWrite DisplayConfigDsiPhyTimingMariko[] = {
+    {sizeof(u32) * DSI_PHY_TIMING_0, 0x6070603},
+};
+
+static constexpr DsiSleepOrRegisterWrite DisplayConfigJdiSpecificInit01[] = {
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0x439},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0x9483FFB9},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xBD15},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0x1939},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xAAAAAAD8},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xAAAAAAEB},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xAAEBAAAA},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xAAAAAAAA},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xAAAAAAEB},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xAAEBAAAA},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xAA},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0x1BD15},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0x2739},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xFFFFFFD8},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xFFFFFFFF},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xFFFFFFFF},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xFFFFFFFF},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xFFFFFFFF},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xFFFFFFFF},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xFFFFFFFF},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xFFFFFFFF},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xFFFFFFFF},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xFFFFFF},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0x2BD15},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xF39},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xFFFFFFD8},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xFFFFFFFF},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xFFFFFFFF},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xFFFFFF},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xBD15},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0x6D915},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0x439},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0xB9},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0x1105},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {DsiSleepOrRegisterWriteKind_Sleep, 0xB4, 0},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_WR_DATA, 0x2905},
+    {DsiSleepOrRegisterWriteKind_Write, DSI_TRIGGER, DSI_TRIGGER_HOST},
+};
+
+static constexpr RegisterWrite DisplayConfigPlld02Erista[] = {
+    {CLK_RST_CONTROLLER_PLLD_BASE,        0x4810c001},
+    {CLK_RST_CONTROLLER_PLLD_MISC1,       0x00000020},
+    {CLK_RST_CONTROLLER_PLLD_MISC,        0x002D0AAA},
+};
+
+static constexpr RegisterWrite DisplayConfigPlld02Mariko[] = {
+    {CLK_RST_CONTROLLER_PLLD_BASE,        0x4810c001},
+    {CLK_RST_CONTROLLER_PLLD_MISC1,       0x00000000},
+    {CLK_RST_CONTROLLER_PLLD_MISC,        0x002DFC00},
+};
+
+static constexpr RegisterWrite DisplayConfigDsi01Init08[] = {
+    {sizeof(u32) * DSI_PAD_CONTROL_1, 0},
+};
+
+static constexpr RegisterWrite DisplayConfigDsi01Init09[] = {
+    {sizeof(u32) * DSI_PHY_TIMING_1,    0x40A0E05},
+    {sizeof(u32) * DSI_PHY_TIMING_2,    0x30172},
+    {sizeof(u32) * DSI_BTA_TIMING,      0x190A14},
+    {sizeof(u32) * DSI_TIMEOUT_0,       DSI_TIMEOUT_LRX(0x2000) | DSI_TIMEOUT_HTX(0xA40)},
+    {sizeof(u32) * DSI_TIMEOUT_1,       DSI_TIMEOUT_PR(0x5A2F) | DSI_TIMEOUT_TA(0x2000)},
+    {sizeof(u32) * DSI_TO_TALLY,        0},
+    {sizeof(u32) * DSI_PKT_SEQ_0_LO,    0x40000208},
+    {sizeof(u32) * DSI_PKT_SEQ_2_LO,    0x40000308},
+    {sizeof(u32) * DSI_PKT_SEQ_4_LO,    0x40000308},
+    {sizeof(u32) * DSI_PKT_SEQ_1_LO,    0x40000308},
+    {sizeof(u32) * DSI_PKT_SEQ_3_LO,    0x3F3B2B08},
+    {sizeof(u32) * DSI_PKT_SEQ_3_HI,    0x2CC},
+    {sizeof(u32) * DSI_PKT_SEQ_5_LO,    0x3F3B2B08},
+    {sizeof(u32) * DSI_PKT_SEQ_5_HI,    0x2CC},
+    {sizeof(u32) * DSI_PKT_LEN_0_1,     0xCE0000},
+    {sizeof(u32) * DSI_PKT_LEN_2_3,     0x87001A2},
+    {sizeof(u32) * DSI_PKT_LEN_4_5,     0x190},
+    {sizeof(u32) * DSI_PKT_LEN_6_7,     0x190},
+    {sizeof(u32) * DSI_HOST_CONTROL,    0},
+};
+
+static constexpr RegisterWrite DisplayConfigDsi01Init10[] = {
+    {sizeof(u32) * DSI_TRIGGER,         0},
+    {sizeof(u32) * DSI_CONTROL,         0},
+    {sizeof(u32) * DSI_SOL_DELAY,       6},
+    {sizeof(u32) * DSI_MAX_THRESHOLD,   0x1E0},
+    {sizeof(u32) * DSI_POWER_CONTROL,   DSI_POWER_CONTROL_ENABLE},
+    {sizeof(u32) * DSI_CONTROL,         DSI_CONTROL_HS_CLK_CTRL | DSI_CONTROL_FORMAT(3) | DSI_CONTROL_LANES(3) | DSI_CONTROL_VIDEO_ENABLE},
+    {sizeof(u32) * DSI_HOST_CONTROL,    DSI_HOST_CONTROL_HS | DSI_HOST_CONTROL_FIFO_SEL| DSI_HOST_CONTROL_CS | DSI_HOST_CONTROL_ECC},
+    {sizeof(u32) * DSI_CONTROL,         DSI_CONTROL_HS_CLK_CTRL | DSI_CONTROL_FORMAT(3) | DSI_CONTROL_LANES(3) | DSI_CONTROL_VIDEO_ENABLE},
+    {sizeof(u32) * DSI_HOST_CONTROL,    DSI_HOST_CONTROL_CS | DSI_HOST_CONTROL_ECC},
+    {sizeof(u32) * DSI_HOST_CONTROL,    DSI_HOST_CONTROL_HS | DSI_HOST_CONTROL_CS | DSI_HOST_CONTROL_ECC}
+};
+
+static constexpr RegisterWrite DisplayConfigDsi01Init11Erista[] = {
+    {sizeof(u32) * DSI_PAD_CONTROL_1, 0},
+    {sizeof(u32) * DSI_PAD_CONTROL_2, 0},
+    {sizeof(u32) * DSI_PAD_CONTROL_3, DSI_PAD_PREEMP_PD_CLK(0x3) | DSI_PAD_PREEMP_PU_CLK(0x3) | DSI_PAD_PREEMP_PD(0x03) | DSI_PAD_PREEMP_PU(0x3)},
+    {sizeof(u32) * DSI_PAD_CONTROL_4, 0}
+};
+
+static constexpr RegisterWrite DisplayConfigDsi01Init11Mariko[] = {
+    {sizeof(u32) * DSI_PAD_CONTROL_1,        0},
+    {sizeof(u32) * DSI_PAD_CONTROL_2,        0},
+    {sizeof(u32) * DSI_PAD_CONTROL_3,        0},
+    {sizeof(u32) * DSI_PAD_CONTROL_4,        0x77777},
+    {sizeof(u32) * DSI_PAD_CONTROL_5_MARIKO, 0x77777},
+    {sizeof(u32) * DSI_PAD_CONTROL_6_MARIKO, DSI_PAD_PREEMP_PD_CLK(0x1) | DSI_PAD_PREEMP_PU_CLK(0x1) | DSI_PAD_PREEMP_PD(0x01) | DSI_PAD_PREEMP_PU(0x1)},
+    {sizeof(u32) * DSI_PAD_CONTROL_7_MARIKO, 0},
+};
+
+static constexpr RegisterWrite DisplayConfigMipiCal01[] = {
+    {0x60, 0},
+    {0x08, 0xF3F10000},
+    {0x58, 1},
+    {0x60, 0},
+};
+
+static constexpr RegisterWrite DisplayConfigMipiCal02Erista[] = {
+    {0x60, 0x10010},
+    {0x5C, 0x300},
+};
+
+static constexpr RegisterWrite DisplayConfigMipiCal02Mariko[] = {
+    {0x60, 0x10010},
+    {0x5C, 0},
+};
+
+static constexpr RegisterWrite DisplayConfigMipiCal03Erista[] = {
+    {0x38, 0x200200},
+    {0x3C, 0x200200},
+    {0x64, 0x200002},
+    {0x68, 0x200002},
+    {0x14, 0},
+    {0x18, 0},
+};
+
+static constexpr RegisterWrite DisplayConfigMipiCal03Mariko[] = {
+    {0x38, 0x200006},
+    {0x3C, 0x200006},
+    {0x64, 0x260000},
+    {0x68, 0x260000},
+    {0x14, 0},
+    {0x18, 0},
+};
+
+static constexpr RegisterWrite DisplayConfigMipiCal04[] = {
+    {0x1C, 0},
+    {0x20, 0},
+    {0x24, 0},
+    {0x28, 0},
+    {0x40, 0},
+    {0x44, 0},
+    {0x68, 0},
+    {0x70, 0},
+    {0x74, 0},
+    {0x00, 0x2A000001},
+};
+
+static constexpr RegisterWrite DisplayConfigDc02[] = {
+    {sizeof(u32) * DC_CMD_STATE_ACCESS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT},
+    {sizeof(u32) * DC_WIN_DV_CONTROL, 0},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT},
+    /* Setup default YUV colorspace conversion coefficients */
+    {sizeof(u32) * DC_WIN_CSC_YOF,   0xF0},
+    {sizeof(u32) * DC_WIN_CSC_KYRGB, 0x12A},
+    {sizeof(u32) * DC_WIN_CSC_KUR,   0},
+    {sizeof(u32) * DC_WIN_CSC_KVR,   0x198},
+    {sizeof(u32) * DC_WIN_CSC_KUG,   0x39B},
+    {sizeof(u32) * DC_WIN_CSC_KVG,   0x32F},
+    {sizeof(u32) * DC_WIN_CSC_KUB,   0x204},
+    {sizeof(u32) * DC_WIN_CSC_KVB,   0},
+    /* End of color coefficients */
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT},
+    {sizeof(u32) * DC_WIN_DV_CONTROL, 0},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT},
+    /* Setup default YUV colorspace conversion coefficients */
+    {sizeof(u32) * DC_WIN_CSC_YOF,   0xF0},
+    {sizeof(u32) * DC_WIN_CSC_KYRGB, 0x12A},
+    {sizeof(u32) * DC_WIN_CSC_KUR,   0},
+    {sizeof(u32) * DC_WIN_CSC_KVR,   0x198},
+    {sizeof(u32) * DC_WIN_CSC_KUG,   0x39B},
+    {sizeof(u32) * DC_WIN_CSC_KVG,   0x32F},
+    {sizeof(u32) * DC_WIN_CSC_KUB,   0x204},
+    {sizeof(u32) * DC_WIN_CSC_KVB,   0},
+    /* End of color coefficients */
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT},
+    {sizeof(u32) * DC_WIN_DV_CONTROL, 0},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT},
+    /* Setup default YUV colorspace conversion coefficients */
+    {sizeof(u32) * DC_WIN_CSC_YOF,   0xF0},
+    {sizeof(u32) * DC_WIN_CSC_KYRGB, 0x12A},
+    {sizeof(u32) * DC_WIN_CSC_KUR,   0},
+    {sizeof(u32) * DC_WIN_CSC_KVR,   0x198},
+    {sizeof(u32) * DC_WIN_CSC_KUG,   0x39B},
+    {sizeof(u32) * DC_WIN_CSC_KVG,   0x32F},
+    {sizeof(u32) * DC_WIN_CSC_KUB,   0x204},
+    {sizeof(u32) * DC_WIN_CSC_KVB,   0},
+    /* End of color coefficients */
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_DISP_DISP_COLOR_CONTROL, BASE_COLOR_SIZE_888},
+    {sizeof(u32) * DC_DISP_DISP_INTERFACE_CONTROL, DISP_DATA_FORMAT_DF1P1C},
+    {sizeof(u32) * DC_COM_PIN_OUTPUT_POLARITY(1), 0x1000000},
+    {sizeof(u32) * DC_COM_PIN_OUTPUT_POLARITY(3), 0},
+    {sizeof(u32) * 0x4E4, 0},
+    {sizeof(u32) * DC_COM_CRC_CONTROL, 0},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_UPDATE | WIN_A_UPDATE | WIN_B_UPDATE | WIN_C_UPDATE},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_ACT_REQ | WIN_A_ACT_REQ | WIN_B_ACT_REQ | WIN_C_ACT_REQ},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT},
+    {sizeof(u32) * 0x716, 0x10000FF},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT},
+    {sizeof(u32) * 0x716, 0x10000FF},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT},
+    {sizeof(u32) * 0x716, 0x10000FF},
+    {sizeof(u32) * DC_CMD_DISPLAY_COMMAND_OPTION0, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_DISP_DISP_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_COMMAND, 0},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_UPDATE | WIN_A_UPDATE | WIN_B_UPDATE | WIN_C_UPDATE},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_ACT_REQ | WIN_A_ACT_REQ | WIN_B_ACT_REQ | WIN_C_ACT_REQ},
+    {sizeof(u32) * DC_CMD_STATE_ACCESS, 0},
+    /* Set Display timings */
+    {sizeof(u32) * DC_DISP_DISP_TIMING_OPTIONS, 0},
+    {sizeof(u32) * DC_DISP_REF_TO_SYNC, (1 << 16)}, // h_ref_to_sync = 0, v_ref_to_sync = 1.
+    {sizeof(u32) * DC_DISP_SYNC_WIDTH,  0x10048},
+    {sizeof(u32) * DC_DISP_BACK_PORCH,  0x90048},
+    {sizeof(u32) * DC_DISP_ACTIVE,      0x50002D0},
+    {sizeof(u32) * DC_DISP_FRONT_PORCH, 0xA0088}, // Sources say that this should be above the DC_DISP_ACTIVE cmd.
+    /* End of Display timings */
+    {sizeof(u32) * DC_DISP_SHIFT_CLOCK_OPTIONS, SC1_H_QUALIFIER_NONE | SC0_H_QUALIFIER_NONE},
+    {sizeof(u32) * DC_COM_PIN_OUTPUT_ENABLE(1), 0},
+    {sizeof(u32) * DC_DISP_DATA_ENABLE_OPTIONS, DE_SELECT_ACTIVE | DE_CONTROL_NORMAL},
+    {sizeof(u32) * DC_DISP_DISP_INTERFACE_CONTROL, DISP_DATA_FORMAT_DF1P1C},
+    {sizeof(u32) * DC_DISP_DISP_CLOCK_CONTROL, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_COMMAND_OPTION0, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_DISP_DISP_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_COMMAND, DISP_CTRL_MODE_C_DISPLAY},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_UPDATE},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_ACT_REQ},
+    {sizeof(u32) * DC_CMD_STATE_ACCESS, READ_MUX | WRITE_MUX},
+    {sizeof(u32) * DC_DISP_FRONT_PORCH, 0xA0088},
+    {sizeof(u32) * DC_CMD_STATE_ACCESS, 0},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_UPDATE},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_ACT_REQ},
+    {sizeof(u32) * DC_CMD_GENERAL_INCR_SYNCPT, 0x301},
+    {sizeof(u32) * DC_CMD_GENERAL_INCR_SYNCPT, 0x301},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_UPDATE},
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_ACT_REQ},
+    {sizeof(u32) * DC_CMD_STATE_ACCESS, 0},
+    {sizeof(u32) * DC_DISP_DISP_CLOCK_CONTROL, PIXEL_CLK_DIVIDER_PCD1 | SHIFT_CLK_DIVIDER(4)},
+    {sizeof(u32) * DC_DISP_DISP_COLOR_CONTROL, BASE_COLOR_SIZE_888},
+    {sizeof(u32) * DC_CMD_DISPLAY_COMMAND_OPTION0, 0}
+};
+
+static constexpr u32 DisplayConfigFrameBufferAddress = 0xC0000000;
+
+static constexpr RegisterWrite DisplayConfigFrameBuffer[] = {
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_C_SELECT}, //Enable window C.
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_B_SELECT}, //Enable window B.
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_CMD_DISPLAY_WINDOW_HEADER, WINDOW_A_SELECT}, //Enable window A.
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_DISP_DISP_WIN_OPTIONS, DSI_ENABLE}, //DSI_ENABLE
+    {sizeof(u32) * DC_WIN_COLOR_DEPTH, WIN_COLOR_DEPTH_B8G8R8A8}, //T_A8R8G8B8 //NX Default: T_A8B8G8R8, WIN_COLOR_DEPTH_R8G8B8A8
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_WIN_POSITION, 0}, //(0,0)
+    {sizeof(u32) * DC_WIN_H_INITIAL_DDA, 0},
+    {sizeof(u32) * DC_WIN_V_INITIAL_DDA, 0},
+    {sizeof(u32) * DC_WIN_PRESCALED_SIZE, V_PRESCALED_SIZE(1280) | H_PRESCALED_SIZE(2880)}, //Pre-scaled size: 1280x2880 bytes.
+    {sizeof(u32) * DC_WIN_DDA_INC, V_DDA_INC(0x1000) | H_DDA_INC(0x1000)},
+    {sizeof(u32) * DC_WIN_SIZE, V_SIZE(1280) | H_SIZE(720)}, //Window size: 1280 vertical lines x 720 horizontal pixels.
+    {sizeof(u32) * DC_WIN_LINE_STRIDE, 0x6000C00}, //768*2x768*4 (= 0x600 x 0xC00) bytes, see TRM for alignment requirements.
+    {sizeof(u32) * DC_WIN_BUFFER_CONTROL, 0},
+    {sizeof(u32) * DC_WINBUF_SURFACE_KIND, 0}, //Regular surface.
+    {sizeof(u32) * DC_WINBUF_START_ADDR, DisplayConfigFrameBufferAddress}, //Framebuffer address.
+    {sizeof(u32) * DC_WINBUF_ADDR_H_OFFSET, 0},
+    {sizeof(u32) * DC_WINBUF_ADDR_V_OFFSET, 0},
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_DISP_DISP_WIN_OPTIONS, DSI_ENABLE}, //DSI_ENABLE
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_DISP_DISP_WIN_OPTIONS, DSI_ENABLE}, //DSI_ENABLE
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, 0},
+    {sizeof(u32) * DC_DISP_DISP_WIN_OPTIONS, DSI_ENABLE}, //DSI_ENABLE
+    {sizeof(u32) * DC_WIN_WIN_OPTIONS, WIN_ENABLE}, //Enable window AD.
+    {sizeof(u32) * DC_CMD_DISPLAY_COMMAND, DISP_CTRL_MODE_C_DISPLAY}, //DISPLAY_CTRL_MODE: continuous display.
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_UPDATE | WIN_A_UPDATE}, //General update; window A update.
+    {sizeof(u32) * DC_CMD_STATE_CONTROL, GENERAL_ACT_REQ | WIN_A_ACT_REQ} //General activation request; window A activation request.
+};
+
+static constexpr RegisterWrite DisplayConfigDsi01Fini01[] = {
+    {sizeof(u32) * DSI_POWER_CONTROL, 0},
+    {sizeof(u32) * DSI_PAD_CONTROL_1, 0},
+};
+
+static constexpr RegisterWrite DisplayConfigDsi01Fini02[] = {
+    {sizeof(u32) * DSI_PHY_TIMING_1,      0x40A0E05},
+    {sizeof(u32) * DSI_PHY_TIMING_2,      0x30109},
+    {sizeof(u32) * DSI_BTA_TIMING,        0x190A14},
+    {sizeof(u32) * DSI_TIMEOUT_0,         DSI_TIMEOUT_LRX(0x2000) | DSI_TIMEOUT_HTX(0xFFFF) },
+    {sizeof(u32) * DSI_TIMEOUT_1,         DSI_TIMEOUT_PR(0x765) | DSI_TIMEOUT_TA(0x2000)},
+    {sizeof(u32) * DSI_TO_TALLY,          0},
+    {sizeof(u32) * DSI_HOST_CONTROL,      DSI_HOST_CONTROL_CRC_RESET | DSI_HOST_CONTROL_TX_TRIG_HOST | DSI_HOST_CONTROL_CS | DSI_HOST_CONTROL_ECC},
+    {sizeof(u32) * DSI_CONTROL,           DSI_CONTROL_LANES(3) | DSI_CONTROL_HOST_ENABLE},
+    {sizeof(u32) * DSI_POWER_CONTROL,     DSI_POWER_CONTROL_ENABLE},
+    {sizeof(u32) * DSI_MAX_THRESHOLD,     0x40},
+    {sizeof(u32) * DSI_TRIGGER,           0},
+    {sizeof(u32) * DSI_TX_CRC,            0},
+    {sizeof(u32) * DSI_INIT_SEQ_CONTROL,  0}
+};
+
+static constexpr RegisterWrite DisplayConfigJdiSpecificFini01[] = {
+    {sizeof(u32) * DSI_WR_DATA, 0x439},
+    {sizeof(u32) * DSI_WR_DATA, 0x9483FFB9},
+    {sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {sizeof(u32) * DSI_WR_DATA, 0x2139},
+    {sizeof(u32) * DSI_WR_DATA, 0x191919D5},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19},
+    {sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {sizeof(u32) * DSI_WR_DATA, 0xB39},
+    {sizeof(u32) * DSI_WR_DATA, 0x4F0F41B1},
+    {sizeof(u32) * DSI_WR_DATA, 0xF179A433},
+    {sizeof(u32) * DSI_WR_DATA, 0x2D81},
+    {sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {sizeof(u32) * DSI_WR_DATA, 0x439},
+    {sizeof(u32) * DSI_WR_DATA, 0xB9},
+    {sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST},
+};
+
+static constexpr RegisterWrite DisplayConfigF30SpecificFini01[] = {
+    {sizeof(u32) * DSI_WR_DATA, 0x439},
+    {sizeof(u32) * DSI_WR_DATA, 0x9483FFB9},
+    {sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {sizeof(u32) * DSI_WR_DATA, 0x2C39},
+    {sizeof(u32) * DSI_WR_DATA, 0x191919D5},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {sizeof(u32) * DSI_WR_DATA, 0x2C39},
+    {sizeof(u32) * DSI_WR_DATA, 0x191919D6},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_WR_DATA, 0x19191919},
+    {sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {sizeof(u32) * DSI_WR_DATA, 0xB39},
+    {sizeof(u32) * DSI_WR_DATA, 0x711148B1},
+    {sizeof(u32) * DSI_WR_DATA, 0x71143209},
+    {sizeof(u32) * DSI_WR_DATA, 0x114D31},
+    {sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST},
+    {sizeof(u32) * DSI_WR_DATA, 0x439},
+    {sizeof(u32) * DSI_WR_DATA, 0xB9},
+    {sizeof(u32) * DSI_TRIGGER, DSI_TRIGGER_HOST},
+};

stratosphere/boot/source/boot_fan_enable.cpp

@@ -0,0 +1,27 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+
+static constexpr u32 GpioPadName_FanEnable = 0x4B;
+
+void Boot::SetFanEnabled() {
+    if (Boot::GetHardwareType() == HardwareType_Copper) {
+        Boot::GpioConfigure(GpioPadName_FanEnable);
+        Boot::GpioSetDirection(GpioPadName_FanEnable, GpioDirection_Output);
+        Boot::GpioSetValue(GpioPadName_FanEnable, GpioValue_High);
+    }
+}

stratosphere/boot/source/boot_functions.hpp

@@ -0,0 +1,92 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+#include <stratosphere.hpp>
+
+#include "boot_types.hpp"
+#include "i2c_driver/i2c_types.hpp"
+
+class Boot {
+    public:
+        static constexpr u32 GpioPhysicalBase = 0x6000D000;
+        static constexpr u32 ApbMiscPhysicalBase = 0x70000000;
+    public:
+        /* Functions for actually booting. */
+        static void ChangeGpioVoltageTo1_8v();
+        static void SetInitialGpioConfiguration();
+        static void CheckClock();
+        static void DetectBootReason();
+        static void ShowSplashScreen();
+        static void CheckBatteryCharge();
+        static void SetInitialClockConfiguration();
+        static void ConfigurePinmux();
+        static void SetInitialWakePinConfiguration();
+        static void SetFanEnabled();
+        static void CheckAndRepairBootImages();
+
+        /* Power utilities. */
+        static void RebootSystem();
+        static void ShutdownSystem();
+
+        /* Register Utilities. */
+        static u32 ReadPmcRegister(u32 phys_addr);
+        static void WritePmcRegister(u32 phys_addr, u32 value, u32 mask = UINT32_MAX);
+
+        /* GPIO Utilities. */
+        static u32 GpioConfigure(u32 gpio_pad_name);
+        static u32 GpioSetDirection(u32 gpio_pad_name, GpioDirection dir);
+        static u32 GpioSetValue(u32 gpio_pad_name, GpioValue val);
+
+        /* Pinmux Utilities. */
+        static u32 PinmuxUpdatePark(u32 pinmux_name);
+        static u32 PinmuxUpdatePad(u32 pinmux_name, u32 config_val, u32 config_mask);
+        static u32 PinmuxUpdateDrivePad(u32 pinmux_drivepad_name, u32 config_val, u32 config_mask);
+        static u32 PinmuxDummyReadDrivePad(u32 pinmux_drivepad_name);
+        static void ConfigurePinmuxInitialPads();
+        static void ConfigurePinmuxInitialDrivePads();
+
+        /* SPL Utilities. */
+        static HardwareType GetHardwareType();
+        static u32 GetBootReason();
+        static bool IsRecoveryBoot();
+        static bool IsMariko();
+
+        /* I2C Utilities. */
+        static Result ReadI2cRegister(I2cSessionImpl &session, u8 *dst, size_t dst_size, const u8 *cmd, size_t cmd_size);
+        static Result WriteI2cRegister(I2cSessionImpl &session, const u8 *src, size_t src_size, const u8 *cmd, size_t cmd_size);
+        static Result WriteI2cRegister(I2cSessionImpl &session, const u8 address, const u8 value);
+
+        /* Splash Screen/Display utilities. */
+        static void InitializeDisplay();
+        static void ShowDisplay(size_t x, size_t y, size_t width, size_t height, const u32 *img);
+        static void FinalizeDisplay();
+
+        /* Battery Display utilities. */
+        static void ShowLowBatteryIcon();
+        static void StartShowChargingIcon(size_t battery_percentage, bool wait);
+        static void EndShowChargingIcon();
+
+        /* Calibration utilities. */
+        static u16 GetCrc16(const void *data, size_t size);
+        static u32 GetBatteryVersion();
+        static u32 GetBatteryVendor();
+
+        /* Wake pin utiliies. */
+        static void SetWakeEventLevel(u32 index, u32 level);
+        static void SetWakeEventEnabled(u32 index, bool enabled);
+};

stratosphere/boot/source/boot_gpio_initial_configuration.cpp

@@ -0,0 +1,82 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+#include "boot_gpio_initial_configuration_icosa.hpp"
+#include "boot_gpio_initial_configuration_copper.hpp"
+#include "boot_gpio_initial_configuration_hoag.hpp"
+#include "boot_gpio_initial_configuration_iowa.hpp"
+
+void Boot::SetInitialGpioConfiguration() {
+    const GpioInitialConfig *configs = nullptr;
+    size_t num_configs = 0;
+    const HardwareType hw_type = Boot::GetHardwareType();
+    const FirmwareVersion fw_ver = GetRuntimeFirmwareVersion();
+
+    /* Choose GPIO map. */
+    if (fw_ver >= FirmwareVersion_200) {
+        switch (hw_type) {
+            case HardwareType_Icosa:
+                {
+                    if (fw_ver >= FirmwareVersion_400) {
+                        configs = GpioInitialConfigsIcosa4x;
+                        num_configs = GpioNumInitialConfigsIcosa4x;
+                    } else {
+                        configs = GpioInitialConfigsIcosa;
+                        num_configs = GpioNumInitialConfigsIcosa;
+                    }
+                }
+                break;
+            case HardwareType_Copper:
+                configs = GpioInitialConfigsCopper;
+                num_configs = GpioNumInitialConfigsCopper;
+                break;
+            case HardwareType_Hoag:
+                configs = GpioInitialConfigsHoag;
+                num_configs = GpioNumInitialConfigsHoag;
+                break;
+            case HardwareType_Iowa:
+                configs = GpioInitialConfigsIowa;
+                num_configs = GpioNumInitialConfigsIowa;
+                break;
+            default:
+                /* Unknown hardware type, we can't proceed. */
+                std::abort();
+        }
+    } else {
+        /* Until 2.0.0, the GPIO map for Icosa was used for all hardware types. */
+        configs = GpioInitialConfigsIcosa;
+        num_configs = GpioNumInitialConfigsIcosa;
+    }
+
+    /* Ensure we found an appropriate config. */
+    if (configs == nullptr) {
+        std::abort();
+    }
+
+    for (size_t i = 0; i < num_configs; i++) {
+        /* Configure the GPIO. */
+        Boot::GpioConfigure(configs[i].pad_name);
+
+        /* Set the GPIO's direction. */
+        Boot::GpioSetDirection(configs[i].pad_name, configs[i].direction);
+
+        if (configs[i].direction == GpioDirection_Output) {
+            /* Set the GPIO's value. */
+            Boot::GpioSetValue(configs[i].pad_name, configs[i].value);
+        }
+    }
+}

stratosphere/boot/source/boot_gpio_initial_configuration_copper.hpp

@@ -0,0 +1,69 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+static constexpr GpioInitialConfig GpioInitialConfigsCopper[] = {
+    {0x40, GpioDirection_Output, GpioValue_Low},
+    {0x05, GpioDirection_Output, GpioValue_Low},
+    {0x41, GpioDirection_Input, GpioValue_High},
+    {0x42, GpioDirection_Input, GpioValue_Low},
+    {0x43, GpioDirection_Output, GpioValue_Low},
+    {0x02, GpioDirection_Output, GpioValue_Low},
+    {0x07, GpioDirection_Output, GpioValue_Low},
+    {0x44, GpioDirection_Input, GpioValue_High},
+    {0x45, GpioDirection_Input, GpioValue_High},
+    {0x0F, GpioDirection_Input, GpioValue_High},
+    {0x46, GpioDirection_Output, GpioValue_Low},
+    {0x47, GpioDirection_Output, GpioValue_Low},
+    {0x10, GpioDirection_Input, GpioValue_Low},
+    {0x11, GpioDirection_Input, GpioValue_Low},
+    {0x12, GpioDirection_Input, GpioValue_Low},
+    {0x13, GpioDirection_Input, GpioValue_Low},
+    {0x14, GpioDirection_Input, GpioValue_High},
+    {0x18, GpioDirection_Input, GpioValue_Low},
+    {0x19, GpioDirection_Input, GpioValue_High},
+    {0x1A, GpioDirection_Input, GpioValue_High},
+    {0x1C, GpioDirection_Input, GpioValue_High},
+    {0x4D, GpioDirection_Output, GpioValue_Low},
+    {0x20, GpioDirection_Output, GpioValue_Low},
+    {0x38, GpioDirection_Input, GpioValue_High},
+    {0x23, GpioDirection_Input, GpioValue_High},
+    {0x25, GpioDirection_Input, GpioValue_Low},
+    {0x26, GpioDirection_Input, GpioValue_Low},
+    {0x27, GpioDirection_Input, GpioValue_Low},
+    {0x28, GpioDirection_Input, GpioValue_High},
+    {0x29, GpioDirection_Input, GpioValue_High},
+    {0x2A, GpioDirection_Input, GpioValue_High},
+    {0x48, GpioDirection_Output, GpioValue_Low},
+    {0x49, GpioDirection_Output, GpioValue_Low},
+    {0x4A, GpioDirection_Output, GpioValue_Low},
+    {0x2D, GpioDirection_Output, GpioValue_Low},
+    {0x2E, GpioDirection_Output, GpioValue_Low},
+    {0x37, GpioDirection_Input, GpioValue_Low},
+    {0x2F, GpioDirection_Output, GpioValue_Low},
+    {0x03, GpioDirection_Output, GpioValue_Low},
+    {0x30, GpioDirection_Input, GpioValue_Low},
+    {0x31, GpioDirection_Output, GpioValue_Low},
+    {0x4B, GpioDirection_Output, GpioValue_Low},
+    {0x4C, GpioDirection_Input, GpioValue_High},
+    {0x4E, GpioDirection_Input, GpioValue_Low},
+};
+
+static constexpr u32 GpioNumInitialConfigsCopper = (sizeof(GpioInitialConfigsCopper) / sizeof(GpioInitialConfigsCopper[0]));

stratosphere/boot/source/boot_gpio_initial_configuration_hoag.hpp

@@ -0,0 +1,84 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+static constexpr GpioInitialConfig GpioInitialConfigsHoag[] = {
+    {0x04, GpioDirection_Input, GpioValue_High},
+    {0x05, GpioDirection_Output, GpioValue_Low},
+    {0x06, GpioDirection_Input, GpioValue_Low},
+    {0x02, GpioDirection_Output, GpioValue_Low},
+    {0x3C, GpioDirection_Input, GpioValue_Low},
+    {0x0F, GpioDirection_Input, GpioValue_High},
+    {0x08, GpioDirection_Input, GpioValue_Low},
+    {0x09, GpioDirection_Input, GpioValue_Low},
+    {0x0A, GpioDirection_Output, GpioValue_Low},
+    {0x0B, GpioDirection_Input, GpioValue_Low},
+    {0x0D, GpioDirection_Output, GpioValue_Low},
+    {0x0E, GpioDirection_Input, GpioValue_Low},
+    {0x10, GpioDirection_Input, GpioValue_Low},
+    {0x11, GpioDirection_Input, GpioValue_Low},
+    {0x12, GpioDirection_Input, GpioValue_Low},
+    {0x13, GpioDirection_Input, GpioValue_Low},
+    {0x14, GpioDirection_Input, GpioValue_High},
+    {0x16, GpioDirection_Input, GpioValue_Low},
+    {0x15, GpioDirection_Input, GpioValue_Low},
+    {0x17, GpioDirection_Input, GpioValue_High},
+    {0x18, GpioDirection_Input, GpioValue_Low},
+    {0x19, GpioDirection_Input, GpioValue_High},
+    {0x1A, GpioDirection_Input, GpioValue_High},
+    {0x1B, GpioDirection_Input, GpioValue_Low},
+    {0x1C, GpioDirection_Input, GpioValue_Low},
+    {0x1D, GpioDirection_Output, GpioValue_Low},
+    {0x1E, GpioDirection_Output, GpioValue_Low},
+    {0x20, GpioDirection_Output, GpioValue_Low},
+    {0x21, GpioDirection_Input, GpioValue_Low},
+    {0x38, GpioDirection_Input, GpioValue_High},
+    {0x22, GpioDirection_Input, GpioValue_Low},
+    {0x23, GpioDirection_Input, GpioValue_High},
+    {0x01, GpioDirection_Output, GpioValue_Low},
+    {0x39, GpioDirection_Output, GpioValue_Low},
+    {0x24, GpioDirection_Output, GpioValue_Low},
+    {0x34, GpioDirection_Input, GpioValue_Low},
+    {0x25, GpioDirection_Input, GpioValue_Low},
+    {0x26, GpioDirection_Input, GpioValue_Low},
+    {0x27, GpioDirection_Input, GpioValue_Low},
+    {0x2B, GpioDirection_Output, GpioValue_Low},
+    {0x28, GpioDirection_Input, GpioValue_High},
+    {0x1F, GpioDirection_Output, GpioValue_Low},
+    {0x29, GpioDirection_Input, GpioValue_High},
+    {0x3A, GpioDirection_Output, GpioValue_Low},
+    {0x0C, GpioDirection_Input, GpioValue_Low},
+    {0x2D, GpioDirection_Output, GpioValue_Low},
+    {0x2E, GpioDirection_Output, GpioValue_Low},
+    {0x37, GpioDirection_Input, GpioValue_Low},
+    {0x2F, GpioDirection_Output, GpioValue_Low},
+    {0x03, GpioDirection_Output, GpioValue_Low},
+    {0x30, GpioDirection_Input, GpioValue_Low},
+    {0x3B, GpioDirection_Input, GpioValue_Low},
+    {0x31, GpioDirection_Output, GpioValue_Low},
+    {0x32, GpioDirection_Output, GpioValue_Low},
+    {0x33, GpioDirection_Output, GpioValue_Low},
+    {0x35, GpioDirection_Input, GpioValue_High},
+    {0x2C, GpioDirection_Output, GpioValue_Low},
+    {0x36, GpioDirection_Output, GpioValue_Low},
+
+};
+
+static constexpr u32 GpioNumInitialConfigsHoag = (sizeof(GpioInitialConfigsHoag) / sizeof(GpioInitialConfigsHoag[0]));

stratosphere/boot/source/boot_gpio_initial_configuration_icosa.hpp

@@ -0,0 +1,150 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+static constexpr GpioInitialConfig GpioInitialConfigsIcosa[] = {
+    {0x04, GpioDirection_Input, GpioValue_High},
+    {0x05, GpioDirection_Output, GpioValue_Low},
+    {0x06, GpioDirection_Input, GpioValue_Low},
+    {0x02, GpioDirection_Output, GpioValue_Low},
+    {0x07, GpioDirection_Output, GpioValue_Low},
+    {0x3C, GpioDirection_Input, GpioValue_Low},
+    {0x0F, GpioDirection_Input, GpioValue_High},
+    {0x08, GpioDirection_Input, GpioValue_Low},
+    {0x09, GpioDirection_Input, GpioValue_Low},
+    {0x0A, GpioDirection_Output, GpioValue_Low},
+    {0x0B, GpioDirection_Input, GpioValue_High},
+    {0x0D, GpioDirection_Output, GpioValue_Low},
+    {0x0E, GpioDirection_Input, GpioValue_Low},
+    {0x10, GpioDirection_Input, GpioValue_Low},
+    {0x11, GpioDirection_Input, GpioValue_Low},
+    {0x12, GpioDirection_Input, GpioValue_Low},
+    {0x13, GpioDirection_Input, GpioValue_Low},
+    {0x14, GpioDirection_Input, GpioValue_High},
+    {0x16, GpioDirection_Input, GpioValue_Low},
+    {0x15, GpioDirection_Input, GpioValue_Low},
+    {0x17, GpioDirection_Input, GpioValue_High},
+    {0x18, GpioDirection_Input, GpioValue_Low},
+    {0x19, GpioDirection_Input, GpioValue_High},
+    {0x1A, GpioDirection_Input, GpioValue_High},
+    {0x1B, GpioDirection_Input, GpioValue_High},
+    {0x1C, GpioDirection_Input, GpioValue_Low},
+    {0x1D, GpioDirection_Output, GpioValue_Low},
+    {0x1E, GpioDirection_Output, GpioValue_Low},
+    {0x20, GpioDirection_Output, GpioValue_Low},
+    {0x21, GpioDirection_Input, GpioValue_High},
+    {0x38, GpioDirection_Input, GpioValue_High},
+    {0x22, GpioDirection_Input, GpioValue_Low},
+    {0x23, GpioDirection_Input, GpioValue_High},
+    {0x01, GpioDirection_Output, GpioValue_Low},
+    {0x39, GpioDirection_Output, GpioValue_Low},
+    {0x24, GpioDirection_Output, GpioValue_Low},
+    {0x34, GpioDirection_Input, GpioValue_Low},
+    {0x25, GpioDirection_Input, GpioValue_Low},
+    {0x26, GpioDirection_Input, GpioValue_Low},
+    {0x27, GpioDirection_Input, GpioValue_Low},
+    {0x2B, GpioDirection_Output, GpioValue_Low},
+    {0x28, GpioDirection_Input, GpioValue_High},
+    {0x1F, GpioDirection_Output, GpioValue_Low},
+    {0x29, GpioDirection_Input, GpioValue_High},
+    {0x2A, GpioDirection_Input, GpioValue_High},
+    {0x3A, GpioDirection_Output, GpioValue_Low},
+    {0x0C, GpioDirection_Input, GpioValue_Low},
+    {0x2D, GpioDirection_Output, GpioValue_Low},
+    {0x2E, GpioDirection_Output, GpioValue_Low},
+    {0x37, GpioDirection_Input, GpioValue_Low},
+    {0x2F, GpioDirection_Output, GpioValue_Low},
+    {0x03, GpioDirection_Output, GpioValue_Low},
+    {0x30, GpioDirection_Input, GpioValue_Low},
+    {0x3B, GpioDirection_Input, GpioValue_Low},
+    {0x31, GpioDirection_Output, GpioValue_Low},
+    {0x32, GpioDirection_Output, GpioValue_Low},
+    {0x33, GpioDirection_Output, GpioValue_Low},
+    {0x35, GpioDirection_Input, GpioValue_High},
+    {0x2C, GpioDirection_Output, GpioValue_Low},
+    {0x36, GpioDirection_Output, GpioValue_Low},
+};
+
+static constexpr u32 GpioNumInitialConfigsIcosa = (sizeof(GpioInitialConfigsIcosa) / sizeof(GpioInitialConfigsIcosa[0]));
+
+static constexpr GpioInitialConfig GpioInitialConfigsIcosa4x[] = {
+    {0x04, GpioDirection_Input, GpioValue_High},
+    {0x05, GpioDirection_Output, GpioValue_Low},
+    {0x06, GpioDirection_Input, GpioValue_Low},
+    {0x02, GpioDirection_Output, GpioValue_Low},
+    {0x07, GpioDirection_Output, GpioValue_Low},
+    {0x3C, GpioDirection_Input, GpioValue_Low},
+    {0x0F, GpioDirection_Input, GpioValue_High},
+    {0x08, GpioDirection_Input, GpioValue_Low},
+    {0x09, GpioDirection_Input, GpioValue_Low},
+    {0x0A, GpioDirection_Output, GpioValue_Low},
+    {0x0B, GpioDirection_Input, GpioValue_High},
+    {0x0D, GpioDirection_Output, GpioValue_Low},
+    {0x0E, GpioDirection_Input, GpioValue_Low},
+    {0x10, GpioDirection_Input, GpioValue_Low},
+    {0x11, GpioDirection_Input, GpioValue_Low},
+    {0x12, GpioDirection_Input, GpioValue_Low},
+    {0x13, GpioDirection_Input, GpioValue_Low},
+    {0x14, GpioDirection_Input, GpioValue_High},
+    {0x16, GpioDirection_Input, GpioValue_Low},
+    {0x15, GpioDirection_Input, GpioValue_Low},
+    {0x17, GpioDirection_Input, GpioValue_High},
+    {0x18, GpioDirection_Input, GpioValue_High},
+    {0x19, GpioDirection_Input, GpioValue_High},
+    {0x1A, GpioDirection_Input, GpioValue_High},
+    {0x1B, GpioDirection_Input, GpioValue_High},
+    {0x1C, GpioDirection_Input, GpioValue_Low},
+    {0x1D, GpioDirection_Output, GpioValue_Low},
+    {0x1E, GpioDirection_Output, GpioValue_Low},
+    {0x20, GpioDirection_Output, GpioValue_Low},
+    {0x21, GpioDirection_Input, GpioValue_High},
+    {0x38, GpioDirection_Input, GpioValue_High},
+    {0x22, GpioDirection_Input, GpioValue_Low},
+    {0x23, GpioDirection_Input, GpioValue_High},
+    {0x01, GpioDirection_Output, GpioValue_Low},
+    {0x39, GpioDirection_Output, GpioValue_Low},
+    {0x24, GpioDirection_Output, GpioValue_Low},
+    {0x34, GpioDirection_Input, GpioValue_Low},
+    {0x25, GpioDirection_Input, GpioValue_Low},
+    {0x26, GpioDirection_Input, GpioValue_Low},
+    {0x27, GpioDirection_Input, GpioValue_Low},
+    {0x2B, GpioDirection_Output, GpioValue_Low},
+    {0x28, GpioDirection_Input, GpioValue_High},
+    {0x1F, GpioDirection_Output, GpioValue_Low},
+    {0x29, GpioDirection_Input, GpioValue_High},
+    {0x2A, GpioDirection_Input, GpioValue_High},
+    {0x3A, GpioDirection_Output, GpioValue_Low},
+    {0x0C, GpioDirection_Input, GpioValue_Low},
+    {0x2D, GpioDirection_Output, GpioValue_Low},
+    {0x2E, GpioDirection_Output, GpioValue_Low},
+    {0x37, GpioDirection_Input, GpioValue_Low},
+    {0x2F, GpioDirection_Output, GpioValue_Low},
+    {0x03, GpioDirection_Output, GpioValue_Low},
+    {0x30, GpioDirection_Input, GpioValue_Low},
+    {0x3B, GpioDirection_Input, GpioValue_Low},
+    {0x31, GpioDirection_Output, GpioValue_Low},
+    {0x32, GpioDirection_Output, GpioValue_Low},
+    {0x33, GpioDirection_Output, GpioValue_Low},
+    {0x35, GpioDirection_Input, GpioValue_High},
+    {0x2C, GpioDirection_Output, GpioValue_Low},
+    {0x36, GpioDirection_Output, GpioValue_Low},
+};
+
+static constexpr u32 GpioNumInitialConfigsIcosa4x = (sizeof(GpioInitialConfigsIcosa4x) / sizeof(GpioInitialConfigsIcosa4x[0]));

stratosphere/boot/source/boot_gpio_initial_configuration_iowa.hpp

@@ -0,0 +1,84 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+static constexpr GpioInitialConfig GpioInitialConfigsIowa[] = {
+    {0x04, GpioDirection_Input, GpioValue_High},
+    {0x05, GpioDirection_Output, GpioValue_Low},
+    {0x06, GpioDirection_Input, GpioValue_Low},
+    {0x02, GpioDirection_Output, GpioValue_Low},
+    {0x3C, GpioDirection_Input, GpioValue_Low},
+    {0x0F, GpioDirection_Input, GpioValue_High},
+    {0x08, GpioDirection_Input, GpioValue_Low},
+    {0x09, GpioDirection_Input, GpioValue_Low},
+    {0x0A, GpioDirection_Output, GpioValue_Low},
+    {0x0B, GpioDirection_Input, GpioValue_Low},
+    {0x0D, GpioDirection_Output, GpioValue_Low},
+    {0x0E, GpioDirection_Input, GpioValue_Low},
+    {0x10, GpioDirection_Input, GpioValue_Low},
+    {0x11, GpioDirection_Input, GpioValue_Low},
+    {0x12, GpioDirection_Input, GpioValue_Low},
+    {0x13, GpioDirection_Input, GpioValue_Low},
+    {0x14, GpioDirection_Input, GpioValue_High},
+    {0x16, GpioDirection_Input, GpioValue_Low},
+    {0x15, GpioDirection_Input, GpioValue_Low},
+    {0x17, GpioDirection_Input, GpioValue_High},
+    {0x18, GpioDirection_Input, GpioValue_Low},
+    {0x19, GpioDirection_Input, GpioValue_High},
+    {0x1A, GpioDirection_Input, GpioValue_High},
+    {0x1B, GpioDirection_Input, GpioValue_Low},
+    {0x1C, GpioDirection_Input, GpioValue_Low},
+    {0x1D, GpioDirection_Output, GpioValue_Low},
+    {0x1E, GpioDirection_Output, GpioValue_Low},
+    {0x20, GpioDirection_Output, GpioValue_Low},
+    {0x21, GpioDirection_Input, GpioValue_Low},
+    {0x38, GpioDirection_Input, GpioValue_High},
+    {0x22, GpioDirection_Input, GpioValue_Low},
+    {0x23, GpioDirection_Input, GpioValue_High},
+    {0x01, GpioDirection_Output, GpioValue_Low},
+    {0x39, GpioDirection_Output, GpioValue_Low},
+    {0x24, GpioDirection_Output, GpioValue_Low},
+    {0x34, GpioDirection_Input, GpioValue_Low},
+    {0x25, GpioDirection_Input, GpioValue_Low},
+    {0x26, GpioDirection_Input, GpioValue_Low},
+    {0x27, GpioDirection_Input, GpioValue_Low},
+    {0x2B, GpioDirection_Output, GpioValue_Low},
+    {0x28, GpioDirection_Input, GpioValue_High},
+    {0x1F, GpioDirection_Output, GpioValue_Low},
+    {0x29, GpioDirection_Input, GpioValue_High},
+    {0x3A, GpioDirection_Output, GpioValue_Low},
+    {0x0C, GpioDirection_Input, GpioValue_Low},
+    {0x2D, GpioDirection_Output, GpioValue_Low},
+    {0x2E, GpioDirection_Output, GpioValue_Low},
+    {0x37, GpioDirection_Input, GpioValue_Low},
+    {0x2F, GpioDirection_Output, GpioValue_Low},
+    {0x03, GpioDirection_Output, GpioValue_Low},
+    {0x30, GpioDirection_Input, GpioValue_Low},
+    {0x3B, GpioDirection_Input, GpioValue_Low},
+    {0x31, GpioDirection_Output, GpioValue_Low},
+    {0x32, GpioDirection_Output, GpioValue_Low},
+    {0x33, GpioDirection_Output, GpioValue_Low},
+    {0x35, GpioDirection_Input, GpioValue_High},
+    {0x2C, GpioDirection_Output, GpioValue_Low},
+    {0x36, GpioDirection_Output, GpioValue_Low},
+
+};
+
+static constexpr u32 GpioNumInitialConfigsIowa = (sizeof(GpioInitialConfigsIowa) / sizeof(GpioInitialConfigsIowa[0]));

stratosphere/boot/source/boot_gpio_map.hpp

@@ -0,0 +1,111 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+static constexpr u32 GpioInvalid = UINT32_MAX;
+
+static constexpr u32 GpioMap[] = {
+    GpioInvalid,  /* Invalid */
+    0x000000CC,   /* Port Z, Pin 4 */
+    0x00000024,   /* Port E, Pin 4 */
+    0x0000003C,   /* Port H, Pin 4 */
+    0x000000DA,   /* Port BB, Pin 2 */
+    0x000000DB,   /* Port BB, Pin 3 */
+    0x000000DC,   /* Port BB, Pin 4 */
+    0x00000025,   /* Port E, Pin 5 */
+    0x00000090,   /* Port S, Pin 0 */
+    0x00000091,   /* Port S, Pin 1 */
+    0x00000096,   /* Port S, Pin 6 */
+    0x00000097,   /* Port S, Pin 7 */
+    0x00000026,   /* Port E, Pin 6 */
+    0x00000005,   /* Port A, Pin 5 */
+    0x00000078,   /* Port P, Pin 0 */
+    0x00000093,   /* Port S, Pin 3 */
+    0x0000007D,   /* Port P, Pin 5 */
+    0x0000007C,   /* Port P, Pin 4 */
+    0x0000007B,   /* Port P, Pin 3 */
+    0x0000007A,   /* Port P, Pin 2 */
+    0x000000BC,   /* Port X, Pin 4 */
+    0x000000AE,   /* Port V, Pin 6 */
+    0x000000BA,   /* Port X, Pin 2 */
+    0x000000B9,   /* Port X, Pin 1 */
+    0x000000BD,   /* Port X, Pin 5 */
+    0x000000BE,   /* Port X, Pin 6 */
+    0x000000BF,   /* Port X, Pin 7 */
+    0x000000C0,   /* Port Y, Pin 0 */
+    0x000000C1,   /* Port Y, Pin 1 */
+    0x000000A9,   /* Port V, Pin 1 */
+    0x000000AA,   /* Port V, Pin 2 */
+    0x00000055,   /* Port K, Pin 5 */
+    0x000000AD,   /* Port V, Pin 5 */
+    0x000000C8,   /* Port Z, Pin 0 */
+    0x000000CA,   /* Port Z, Pin 2 */
+    0x000000CB,   /* Port Z, Pin 3 */
+    0x0000004F,   /* Port J, Pin 7 */
+    0x00000050,   /* Port K, Pin 0 */
+    0x00000051,   /* Port K, Pin 1 */
+    0x00000052,   /* Port K, Pin 2 */
+    0x00000054,   /* Port K, Pin 4 */
+    0x00000056,   /* Port K, Pin 6 */
+    0x00000057,   /* Port K, Pin 7 */
+    0x00000053,   /* Port K, Pin 3 */
+    0x000000E3,   /* Port CC, Pin 3 */
+    0x00000038,   /* Port H, Pin 0 */
+    0x00000039,   /* Port H, Pin 1 */
+    0x0000003B,   /* Port H, Pin 3 */
+    0x0000003D,   /* Port H, Pin 5 */
+    0x0000003F,   /* Port H, Pin 7 */
+    0x00000040,   /* Port I, Pin 0 */
+    0x00000041,   /* Port I, Pin 1 */
+    0x0000003E,   /* Port H, Pin 6 */
+    0x000000E2,   /* Port CC, Pin 2 */
+    0x000000E4,   /* Port CC, Pin 4 */
+    0x0000003A,   /* Port H, Pin 2 */
+    0x000000C9,   /* Port Z, Pin 1 */
+    0x0000004D,   /* Port J, Pin 5 */
+    0x00000058,   /* Port L, Pin 0 */
+    0x0000003E,   /* Port H, Pin 6 */
+    0x00000026,   /* Port E, Pin 6 */
+
+    /* Copper only */
+    GpioInvalid,  /* Invalid */
+    0x00000033,   /* Port G, Pin 3 */
+    0x0000001C,   /* Port D, Pin 4 */
+    0x000000D9,   /* Port BB, Pin 1 */
+    0x0000000C,   /* Port B, Pin 4 */
+    0x0000000D,   /* Port B, Pin 5 */
+    0x00000021,   /* Port E, Pin 1 */
+    0x00000027,   /* Port E, Pin 7 */
+    0x00000092,   /* Port S, Pin 2 */
+    0x00000095,   /* Port S, Pin 5 */
+    0x00000098,   /* Port T, Pin 0 */
+    0x00000010,   /* Port C, Pin 0 */
+    0x00000011,   /* Port C, Pin 1 */
+    0x00000012,   /* Port C, Pin 2 */
+    0x00000042,   /* Port I, Pin 2 */
+    0x000000E6,   /* Port CC, Pin 6 */
+
+    /* 2.0.0+ Copper only */
+    0x000000AC,   /* Port V, Pin 4 */
+    0x000000E1,   /* Port CC, Pin 1 */
+
+    /* 5.0.0+ Copper only (unused) */
+    0x00000056,   /* Port K, Pin 6 */
+};
+
+static constexpr u32 GpioPadNameMax = (sizeof(GpioMap) / sizeof(GpioMap[0]));

stratosphere/boot/source/boot_gpio_utils.cpp

@@ -0,0 +1,119 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+#include "boot_gpio_map.hpp"
+
+static bool g_initialized_gpio_vaddr = false;
+static uintptr_t g_gpio_vaddr = 0;
+
+static inline u32 GetGpioPadDescriptor(u32 gpio_pad_name) {
+    if (gpio_pad_name >= GpioPadNameMax) {
+        std::abort();
+    }
+
+    return GpioMap[gpio_pad_name];
+}
+
+static uintptr_t GetGpioBaseAddress() {
+    if (!g_initialized_gpio_vaddr) {
+        u64 vaddr;
+        if (R_FAILED(svcQueryIoMapping(&vaddr, Boot::GpioPhysicalBase, 0x1000))) {
+            std::abort();
+        }
+        g_gpio_vaddr = vaddr;
+        g_initialized_gpio_vaddr = true;
+    }
+    return g_gpio_vaddr;
+}
+
+u32 Boot::GpioConfigure(u32 gpio_pad_name) {
+    uintptr_t gpio_base_vaddr = GetGpioBaseAddress();
+
+    /* Fetch this GPIO's pad descriptor */
+    const u32 gpio_pad_desc = GetGpioPadDescriptor(gpio_pad_name);
+
+    /* Discard invalid GPIOs */
+    if (gpio_pad_desc == GpioInvalid) {
+        return GpioInvalid;
+    }
+
+    /* Convert the GPIO pad descriptor into its register offset */
+    u32 gpio_reg_offset = (((gpio_pad_desc << 0x03) & 0xFFFFFF00) | ((gpio_pad_desc >> 0x01) & 0x0C));
+
+    /* Extract the bit and lock values from the GPIO pad descriptor */
+    u32 gpio_cnf_val = ((0x01 << ((gpio_pad_desc & 0x07) | 0x08)) | (0x01 << (gpio_pad_desc & 0x07)));
+
+    /* Write to the appropriate GPIO_CNF_x register (upper offset) */
+    *(reinterpret_cast<volatile u32 *>(gpio_base_vaddr + gpio_reg_offset + 0x80)) = gpio_cnf_val;
+
+    /* Do a dummy read from GPIO_CNF_x register (lower offset) */
+    gpio_cnf_val = *(reinterpret_cast<volatile u32 *>(gpio_base_vaddr + gpio_reg_offset));
+
+    return gpio_cnf_val;
+}
+
+u32 Boot::GpioSetDirection(u32 gpio_pad_name, GpioDirection dir) {
+    uintptr_t gpio_base_vaddr = GetGpioBaseAddress();
+
+    /* Fetch this GPIO's pad descriptor */
+    const u32 gpio_pad_desc = GetGpioPadDescriptor(gpio_pad_name);
+
+    /* Discard invalid GPIOs */
+    if (gpio_pad_desc == GpioInvalid) {
+        return GpioInvalid;
+    }
+
+    /* Convert the GPIO pad descriptor into its register offset */
+    u32 gpio_reg_offset = (((gpio_pad_desc << 0x03) & 0xFFFFFF00) | ((gpio_pad_desc >> 0x01) & 0x0C));
+
+    /* Set the direction bit and lock values */
+    u32 gpio_oe_val = ((0x01 << ((gpio_pad_desc & 0x07) | 0x08)) | (static_cast<u32>(dir) << (gpio_pad_desc & 0x07)));
+
+    /* Write to the appropriate GPIO_OE_x register (upper offset) */
+    *(reinterpret_cast<volatile u32 *>(gpio_base_vaddr + gpio_reg_offset + 0x90)) = gpio_oe_val;
+
+    /* Do a dummy read from GPIO_OE_x register (lower offset) */
+    gpio_oe_val = *(reinterpret_cast<volatile u32 *>(gpio_base_vaddr + gpio_reg_offset + 0x10));
+
+    return gpio_oe_val;
+}
+
+u32 Boot::GpioSetValue(u32 gpio_pad_name, GpioValue val) {
+    uintptr_t gpio_base_vaddr = GetGpioBaseAddress();
+
+    /* Fetch this GPIO's pad descriptor */
+    const u32 gpio_pad_desc = GetGpioPadDescriptor(gpio_pad_name);
+
+    /* Discard invalid GPIOs */
+    if (gpio_pad_desc == GpioInvalid) {
+        return GpioInvalid;
+    }
+
+    /* Convert the GPIO pad descriptor into its register offset */
+    u32 gpio_reg_offset = (((gpio_pad_desc << 0x03) & 0xFFFFFF00) | ((gpio_pad_desc >> 0x01) & 0x0C));
+
+    /* Set the output bit and lock values */
+    u32 gpio_out_val = ((0x01 << ((gpio_pad_desc & 0x07) | 0x08)) | (static_cast<u32>(val) << (gpio_pad_desc & 0x07)));
+
+    /* Write to the appropriate GPIO_OUT_x register (upper offset) */
+    *(reinterpret_cast<volatile u32 *>(gpio_base_vaddr + gpio_reg_offset + 0xA0)) = gpio_out_val;
+
+    /* Do a dummy read from GPIO_OUT_x register (lower offset) */
+    gpio_out_val = *(reinterpret_cast<volatile u32 *>(gpio_base_vaddr + gpio_reg_offset + 0x20));
+
+    return gpio_out_val;
+}

stratosphere/boot/source/boot_i2c_utils.cpp

@@ -0,0 +1,75 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+#include "i2c_driver/i2c_api.hpp"
+
+template<typename F>
+static Result RetryUntilSuccess(F f) {
+    constexpr u64 timeout = 10'000'000'000ul;
+    constexpr u64 retry_interval = 20'000'000ul;
+
+    u64 cur_time = 0;
+    while (true) {
+        Result rc = f();
+        if (R_SUCCEEDED(rc)) {
+            return rc;
+        } else {
+            cur_time += retry_interval;
+            if (cur_time >= timeout) {
+                return rc;
+            }
+        }
+        svcSleepThread(retry_interval);
+    }
+}
+
+Result Boot::ReadI2cRegister(I2cSessionImpl &session, u8 *dst, size_t dst_size, const u8 *cmd, size_t cmd_size) {
+    Result rc;
+    if (dst == nullptr || dst_size == 0 || cmd == nullptr || cmd_size == 0) {
+        std::abort();
+    }
+
+    u8 cmd_list[I2cCommandListFormatter::MaxCommandListSize];
+
+    I2cCommandListFormatter formatter(cmd_list, sizeof(cmd_list));
+    if (R_FAILED((rc = formatter.EnqueueSendCommand(I2cTransactionOption_Start, cmd, cmd_size)))) {
+        std::abort();
+    }
+    if (R_FAILED((rc = formatter.EnqueueReceiveCommand(static_cast<I2cTransactionOption>(I2cTransactionOption_Start | I2cTransactionOption_Stop), dst_size)))) {
+        std::abort();
+    }
+
+    return RetryUntilSuccess([&]() { return I2cDriver::ExecuteCommandList(session, dst, dst_size, cmd_list, formatter.GetCurrentSize()); });
+}
+
+Result Boot::WriteI2cRegister(I2cSessionImpl &session, const u8 *src, size_t src_size, const u8 *cmd, size_t cmd_size) {
+    if (src == nullptr || src_size == 0 || cmd == nullptr || cmd_size == 0) {
+        std::abort();
+    }
+
+    u8 cmd_list[0x20];
+
+    /* N doesn't use a CommandListFormatter here... */
+    std::memcpy(&cmd_list[0], cmd, cmd_size);
+    std::memcpy(&cmd_list[cmd_size], src, src_size);
+
+    return RetryUntilSuccess([&]() { return I2cDriver::Send(session, cmd_list, src_size + cmd_size, static_cast<I2cTransactionOption>(I2cTransactionOption_Start | I2cTransactionOption_Stop)); });
+}
+
+Result Boot::WriteI2cRegister(I2cSessionImpl &session, const u8 address, const u8 value) {
+    return Boot::WriteI2cRegister(session, &value, sizeof(value), &address, sizeof(address));
+}

stratosphere/boot/source/boot_pinmux_configuration.cpp

@@ -0,0 +1,95 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+#include "boot_pinmux_map.hpp"
+#include "boot_pinmux_initial_configuration_icosa.hpp"
+#include "boot_pinmux_initial_configuration_copper.hpp"
+#include "boot_pinmux_initial_configuration_hoag.hpp"
+#include "boot_pinmux_initial_configuration_iowa.hpp"
+#include "boot_pinmux_initial_drive_pad_configuration.hpp"
+
+void Boot::ConfigurePinmux() {
+    /* Update parks. */
+    for (size_t i = 0; i < PinmuxPadNameMax; i++) {
+        Boot::PinmuxUpdatePark(static_cast<u32>(i));
+    }
+
+    /* Dummy read all drive pads. */
+    for (size_t i = 0; i < PinmuxDrivePadNameMax; i++) {
+        Boot::PinmuxDummyReadDrivePad(static_cast<u32>(i));
+    }
+
+    /* Set initial pad configs. */
+    Boot::ConfigurePinmuxInitialPads();
+
+    /* Set initial drive pad configs. */
+    Boot::ConfigurePinmuxInitialDrivePads();
+}
+
+void Boot::ConfigurePinmuxInitialPads() {
+    const PinmuxInitialConfig *configs = nullptr;
+    size_t num_configs = 0;
+    const HardwareType hw_type = Boot::GetHardwareType();
+
+    switch (hw_type) {
+        case HardwareType_Icosa:
+            configs = PinmuxInitialConfigsIcosa;
+            num_configs = PinmuxNumInitialConfigsIcosa;
+            break;
+        case HardwareType_Copper:
+            configs = PinmuxInitialConfigsCopper;
+            num_configs = PinmuxNumInitialConfigsCopper;
+            break;
+        case HardwareType_Hoag:
+            configs = PinmuxInitialConfigsHoag;
+            num_configs = PinmuxNumInitialConfigsHoag;
+            break;
+        case HardwareType_Iowa:
+            configs = PinmuxInitialConfigsIowa;
+            num_configs = PinmuxNumInitialConfigsIowa;
+            break;
+        default:
+            /* Unknown hardware type, we can't proceed. */
+            std::abort();
+    }
+
+    /* Ensure we found an appropriate config. */
+    if (configs == nullptr) {
+        std::abort();
+    }
+
+    for (size_t i = 0; i < num_configs - 1; i++) {
+        Boot::PinmuxUpdatePad(configs[i].name, configs[i].val, configs[i].mask);
+    }
+
+    /* Extra configs for iowa only. */
+    if (hw_type == HardwareType_Iowa) {
+        static constexpr u32 ExtraIowaPinmuxPadNames[] = {
+            0xAA, 0xAC, 0xA2, 0xA3, 0xA4, 0xA5, 0xA6, 0xA7, 0xA8, 0xA9
+        };
+        for (size_t i = 0; i < sizeof(ExtraIowaPinmuxPadNames) / sizeof(ExtraIowaPinmuxPadNames[0]); i++) {
+            Boot::PinmuxUpdatePad(ExtraIowaPinmuxPadNames[i], 0x2000, 0x2000);
+        }
+    }
+}
+
+void Boot::ConfigurePinmuxInitialDrivePads() {
+    const PinmuxInitialConfig *configs = PinmuxInitialDrivePadConfigs;
+    for (size_t i = 0; i < PinmuxNumInitialDrivePadConfigs; i++) {
+        Boot::PinmuxUpdateDrivePad(configs[i].name, configs[i].val, configs[i].mask);
+    }
+}

stratosphere/boot/source/boot_pinmux_initial_configuration_copper.hpp

@@ -0,0 +1,186 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+static constexpr PinmuxInitialConfig PinmuxInitialConfigsCopper[] = {
+    {0x10, 0x20, 0x27F},
+    {0x0F, 0x00, 0x267},
+    {0x0E, 0x20, 0x27F},
+    {0x5B, 0x00, 0x00},
+    {0x80, 0x01, 0x7F},
+    {0x34, 0x40, 0x267},
+    {0x35, 0x40, 0x267},
+    {0x55, 0x00, 0x18},
+    {0x56, 0x01, 0x67},
+    {0x5C, 0x00, 0x00},
+    {0x59, 0x00, 0x00},
+    {0x5A, 0x10, 0x18},
+    {0x2C, 0x40, 0x267},
+    {0x2D, 0x40, 0x267},
+    {0x2E, 0x40, 0x267},
+    {0x2F, 0x40, 0x267},
+    {0x36, 0x00, 0x67},
+    {0x37, 0x30, 0x7F},
+    {0x38, 0x00, 0x67},
+    {0x39, 0x28, 0x7F},
+    {0x54, 0x00, 0x67},
+    {0x9B, 0x30, 0x7F},
+    {0x42, 0x00, 0x67},
+    {0x43, 0x28, 0x7F},
+    {0x44, 0x00, 0x67},
+    {0x45, 0x28, 0x7F},
+    {0x4B, 0x28, 0x7F},
+    {0x4C, 0x00, 0x67},
+    {0x4A, 0x00, 0x67},
+    {0x4D, 0x00, 0x67},
+    {0x64, 0x20, 0x27F},
+    {0x63, 0x40, 0x267},
+    {0x5E, 0x04, 0x67},
+    {0x60, 0x04, 0x67},
+    {0x17, 0x24, 0x7F},
+    {0x18, 0x24, 0x7F},
+    {0x27, 0x04, 0x67},
+    {0x2A, 0x04, 0x67},
+    {0x2B, 0x04, 0x67},
+    {0x90, 0x24, 0x7F},
+    {0x32, 0x24, 0x27F},
+    {0x33, 0x34, 0x27F},
+    {0x76, 0x04, 0x67},
+    {0x79, 0x04, 0x67},
+    {0x08, 0x24, 0x7F},
+    {0x09, 0x24, 0x7F},
+    {0x0A, 0x24, 0x7F},
+    {0x0B, 0x24, 0x7F},
+    {0x88, 0x34, 0x7F},
+    {0x89, 0x24, 0x7F},
+    {0x8A, 0x34, 0x7F},
+    {0x8B, 0x34, 0x7F},
+    {0x8D, 0x34, 0x7F},
+    {0x81, 0x04, 0x67},
+    {0x9D, 0x34, 0x7F},
+    {0x9F, 0x34, 0x7F},
+    {0xA1, 0x34, 0x7F},
+    {0x92, 0x4C, 0x7F},
+    {0x93, 0x4C, 0x7F},
+    {0x94, 0x44, 0x7F},
+    {0x96, 0x34, 0x7F},
+    {0x98, 0x34, 0x7F},
+    {0x99, 0x34, 0x7F},
+    {0x12, 0x04, 0x7F},
+    {0x13, 0x04, 0x67},
+    {0x14, 0x04, 0x7F},
+    {0x6A, 0x04, 0x67},
+    {0x6B, 0x04, 0x67},
+    {0x6C, 0x2C, 0x7F},
+    {0x6D, 0x04, 0x67},
+    {0x6E, 0x04, 0x67},
+    {0x6F, 0x24, 0x7F},
+    {0x70, 0x04, 0x7F},
+    {0x73, 0x04, 0x67},
+    {0x69, 0x24, 0x7F},
+    {0x5D, 0x05, 0x07},
+    {0x5F, 0x05, 0x07},
+    {0x61, 0x05, 0x07},
+    {0x47, 0x05, 0x07},
+    {0x48, 0x05, 0x07},
+    {0x46, 0x05, 0x07},
+    {0x49, 0x05, 0x07},
+    {0x19, 0x05, 0x07},
+    {0x1A, 0x05, 0x07},
+    {0x1B, 0x05, 0x07},
+    {0x26, 0x05, 0x07},
+    {0x28, 0x05, 0x07},
+    {0x29, 0x05, 0x07},
+    {0x8F, 0x05, 0x07},
+    {0x30, 0x05, 0x07},
+    {0x31, 0x05, 0x07},
+    {0x52, 0x05, 0x07},
+    {0x53, 0x05, 0x07},
+    {0x75, 0x05, 0x07},
+    {0x77, 0x05, 0x07},
+    {0x78, 0x05, 0x07},
+    {0x7A, 0x05, 0x07},
+    {0x0D, 0x05, 0x07},
+    {0x0C, 0x05, 0x07},
+    {0x11, 0x05, 0x07},
+    {0x8E, 0x05, 0x07},
+    {0x00, 0x05, 0x07},
+    {0x01, 0x05, 0x07},
+    {0x05, 0x05, 0x07},
+    {0x04, 0x05, 0x07},
+    {0x03, 0x05, 0x07},
+    {0x02, 0x05, 0x07},
+    {0x06, 0x05, 0x07},
+    {0x07, 0x05, 0x07},
+    {0x87, 0x05, 0x07},
+    {0x86, 0x05, 0x07},
+    {0x82, 0x05, 0x07},
+    {0x83, 0x05, 0x07},
+    {0x85, 0x05, 0x07},
+    {0x84, 0x05, 0x07},
+    {0x8C, 0x05, 0x07},
+    {0x7B, 0x05, 0x07},
+    {0x7C, 0x05, 0x07},
+    {0x7D, 0x05, 0x07},
+    {0x7E, 0x05, 0x07},
+    {0x7F, 0x05, 0x07},
+    {0x9C, 0x05, 0x07},
+    {0x9E, 0x05, 0x07},
+    {0xA0, 0x05, 0x07},
+    {0x58, 0x00, 0x00},
+    {0x4F, 0x05, 0x07},
+    {0x50, 0x05, 0x07},
+    {0x4E, 0x05, 0x07},
+    {0x51, 0x05, 0x07},
+    {0x3A, 0x05, 0x07},
+    {0x3B, 0x05, 0x07},
+    {0x3C, 0x05, 0x07},
+    {0x3D, 0x05, 0x07},
+    {0x95, 0x05, 0x07},
+    {0x97, 0x05, 0x07},
+    {0x9A, 0x05, 0x07},
+    {0x15, 0x05, 0x07},
+    {0x16, 0x05, 0x07},
+    {0x1C, 0x05, 0x07},
+    {0x1D, 0x05, 0x07},
+    {0x1E, 0x05, 0x07},
+    {0x1F, 0x05, 0x07},
+    {0x3E, 0x05, 0x07},
+    {0x3F, 0x05, 0x07},
+    {0x40, 0x05, 0x07},
+    {0x41, 0x05, 0x07},
+    {0x91, 0x05, 0x07},
+    {0x71, 0x05, 0x07},
+    {0x72, 0x05, 0x07},
+    {0x74, 0x05, 0x07},
+    {0x22, 0x05, 0x07},
+    {0x23, 0x05, 0x07},
+    {0x20, 0x05, 0x07},
+    {0x21, 0x05, 0x07},
+    {0x24, 0x05, 0x07},
+    {0x25, 0x05, 0x07},
+    {0x62, 0x05, 0x07},
+    {0x65, 0x05, 0x07},
+    {0x66, 0x05, 0x07},
+    {0x67, 0x05, 0x07},
+    {0x68, 0x05, 0x07},
+};
+
+static constexpr u32 PinmuxNumInitialConfigsCopper = (sizeof(PinmuxInitialConfigsCopper) / sizeof(PinmuxInitialConfigsCopper[0]));

stratosphere/boot/source/boot_pinmux_initial_configuration_hoag.hpp

@@ -0,0 +1,186 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+static constexpr PinmuxInitialConfig PinmuxInitialConfigsHoag[] = {
+    {0x5D, 0x00, 0x67},
+    {0x47, 0x28, 0x7F},
+    {0x48, 0x00, 0x67},
+    {0x46, 0x00, 0x67},
+    {0x49, 0x00, 0x67},
+    {0x30, 0x40, 0x27F},
+    {0x31, 0x40, 0x27F},
+    {0x0D, 0x20, 0x27F},
+    {0x0C, 0x00, 0x267},
+    {0x10, 0x20, 0x27F},
+    {0x0F, 0x00, 0x267},
+    {0x0E, 0x20, 0x27F},
+    {0x00, 0x48, 0x7F},
+    {0x01, 0x50, 0x7F},
+    {0x05, 0x50, 0x7F},
+    {0x04, 0x50, 0x7F},
+    {0x03, 0x50, 0x7F},
+    {0x02, 0x50, 0x7F},
+    {0x5B, 0x00, 0x78},
+    {0x7C, 0x01, 0x67},
+    {0x80, 0x01, 0x7F},
+    {0x34, 0x40, 0x27F},
+    {0x35, 0x40, 0x27F},
+    {0x55, 0x20, 0x78},
+    {0x56, 0x20, 0x7F},
+    {0xA1, 0x30, 0x7F},
+    {0x5C, 0x00, 0x78},
+    {0x59, 0x00, 0x60},
+    {0x5A, 0x30, 0x78},
+    {0x2C, 0x40, 0x27F},
+    {0x2D, 0x40, 0x27F},
+    {0x2E, 0x40, 0x27F},
+    {0x2F, 0x40, 0x27F},
+    {0x3B, 0x20, 0x7F},
+    {0x3C, 0x00, 0x67},
+    {0x3D, 0x20, 0x7F},
+    {0x36, 0x00, 0x67},
+    {0x37, 0x30, 0x7F},
+    {0x38, 0x00, 0x67},
+    {0x39, 0x28, 0x7F},
+    {0x54, 0x00, 0x67},
+    {0x9B, 0x30, 0x7F},
+    {0x1C, 0x00, 0x67},
+    {0x1D, 0x30, 0x7F},
+    {0x1E, 0x00, 0x67},
+    {0x1F, 0x00, 0x67},
+    {0x3F, 0x20, 0x7F},
+    {0x40, 0x00, 0x67},
+    {0x41, 0x20, 0x7F},
+    {0x42, 0x00, 0x67},
+    {0x43, 0x28, 0x7F},
+    {0x44, 0x00, 0x67},
+    {0x45, 0x28, 0x7F},
+    {0x22, 0x00, 0x67},
+    {0x23, 0x28, 0x7F},
+    {0x20, 0x00, 0x67},
+    {0x21, 0x00, 0x67},
+    {0x4B, 0x28, 0x7F},
+    {0x4C, 0x00, 0x67},
+    {0x4A, 0x00, 0x67},
+    {0x4D, 0x00, 0x67},
+    {0x64, 0x20, 0x27F},
+    {0x5F, 0x34, 0x7F},
+    {0x60, 0x04, 0x67},
+    {0x61, 0x2C, 0x7F},
+    {0x2A, 0x04, 0x67},
+    {0x2B, 0x04, 0x67},
+    {0x8F, 0x24, 0x7F},
+    {0x33, 0x34, 0x27F},
+    {0x52, 0x2C, 0x7F},
+    {0x53, 0x24, 0x7F},
+    {0x77, 0x04, 0x67},
+    {0x78, 0x34, 0x7F},
+    {0x11, 0x04, 0x67},
+    {0x06, 0x2C, 0x7F},
+    {0x08, 0x24, 0x7F},
+    {0x09, 0x24, 0x7F},
+    {0x0A, 0x24, 0x7F},
+    {0x0B, 0x24, 0x7F},
+    {0x88, 0x34, 0x7F},
+    {0x86, 0x2C, 0x7F},
+    {0x82, 0x24, 0x7F},
+    {0x85, 0x34, 0x7F},
+    {0x89, 0x24, 0x7F},
+    {0x8A, 0x34, 0x7F},
+    {0x8B, 0x34, 0x7F},
+    {0x8C, 0x34, 0x7F},
+    {0x8D, 0x24, 0x7F},
+    {0x7D, 0x04, 0x67},
+    {0x7E, 0x04, 0x67},
+    {0x81, 0x04, 0x67},
+    {0x9C, 0x34, 0x7F},
+    {0x9D, 0x34, 0x7F},
+    {0x9E, 0x2C, 0x7F},
+    {0x9F, 0x34, 0x7F},
+    {0xA0, 0x04, 0x67},
+    {0x4F, 0x04, 0x67},
+    {0x51, 0x04, 0x67},
+    {0x3A, 0x24, 0x7F},
+    {0x92, 0x4C, 0x7F},
+    {0x93, 0x4C, 0x7F},
+    {0x94, 0x44, 0x7F},
+    {0x95, 0x04, 0x67},
+    {0x96, 0x34, 0x7F},
+    {0x97, 0x04, 0x67},
+    {0x98, 0x34, 0x7F},
+    {0x99, 0x34, 0x7F},
+    {0x9A, 0x04, 0x67},
+    {0x3E, 0x24, 0x7F},
+    {0x6A, 0x04, 0x67},
+    {0x6B, 0x04, 0x67},
+    {0x6C, 0x2C, 0x7F},
+    {0x6D, 0x04, 0x67},
+    {0x6E, 0x04, 0x67},
+    {0x6F, 0x24, 0x7F},
+    {0x91, 0x24, 0x7F},
+    {0x70, 0x04, 0x7F},
+    {0x71, 0x04, 0x67},
+    {0x72, 0x04, 0x67},
+    {0x65, 0x34, 0x7F},
+    {0x66, 0x04, 0x67},
+    {0x67, 0x04, 0x267},
+    {0x5E, 0x05, 0x07},
+    {0x17, 0x05, 0x07},
+    {0x18, 0x05, 0x07},
+    {0x19, 0x05, 0x07},
+    {0x1A, 0x05, 0x07},
+    {0x1B, 0x05, 0x07},
+    {0x26, 0x05, 0x07},
+    {0x27, 0x05, 0x07},
+    {0x28, 0x05, 0x07},
+    {0x29, 0x05, 0x07},
+    {0x90, 0x05, 0x07},
+    {0x32, 0x05, 0x07},
+    {0x75, 0x05, 0x07},
+    {0x76, 0x05, 0x07},
+    {0x79, 0x05, 0x07},
+    {0x7A, 0x05, 0x07},
+    {0x8E, 0x05, 0x07},
+    {0x07, 0x05, 0x07},
+    {0x87, 0x05, 0x07},
+    {0x83, 0x05, 0x07},
+    {0x84, 0x05, 0x07},
+    {0x7B, 0x05, 0x07},
+    {0x7F, 0x05, 0x07},
+    {0x58, 0x00, 0x00},
+    {0x50, 0x05, 0x07},
+    {0x4E, 0x05, 0x07},
+    {0x12, 0x05, 0x07},
+    {0x13, 0x05, 0x07},
+    {0x14, 0x05, 0x07},
+    {0x15, 0x05, 0x07},
+    {0x16, 0x05, 0x07},
+    {0x73, 0x05, 0x07},
+    {0x74, 0x05, 0x07},
+    {0x24, 0x05, 0x07},
+    {0x25, 0x05, 0x07},
+    {0x62, 0x05, 0x07},
+    {0x68, 0x05, 0x07},
+    {0x69, 0x05, 0x07},
+    {0x63, 0x05, 0x07},
+};
+
+static constexpr u32 PinmuxNumInitialConfigsHoag = (sizeof(PinmuxInitialConfigsHoag) / sizeof(PinmuxInitialConfigsHoag[0]));

stratosphere/boot/source/boot_pinmux_initial_configuration_icosa.hpp

@@ -0,0 +1,186 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+static constexpr PinmuxInitialConfig PinmuxInitialConfigsIcosa[] = {
+    {0x5D, 0x00, 0x67},
+    {0x47, 0x28, 0x7F},
+    {0x48, 0x00, 0x67},
+    {0x46, 0x00, 0x67},
+    {0x49, 0x00, 0x67},
+    {0x30, 0x40, 0x27F},
+    {0x31, 0x40, 0x27F},
+    {0x0D, 0x20, 0x27F},
+    {0x0C, 0x00, 0x267},
+    {0x10, 0x20, 0x27F},
+    {0x0F, 0x00, 0x267},
+    {0x0E, 0x20, 0x27F},
+    {0x00, 0x48, 0x7F},
+    {0x01, 0x50, 0x7F},
+    {0x05, 0x50, 0x7F},
+    {0x04, 0x50, 0x7F},
+    {0x03, 0x50, 0x7F},
+    {0x02, 0x50, 0x7F},
+    {0x5B, 0x00, 0x78},
+    {0x7C, 0x01, 0x67},
+    {0x80, 0x01, 0x7F},
+    {0x34, 0x40, 0x27F},
+    {0x35, 0x40, 0x27F},
+    {0x55, 0x20, 0x78},
+    {0x56, 0x20, 0x7F},
+    {0xA1, 0x30, 0x7F},
+    {0x5C, 0x00, 0x78},
+    {0x59, 0x00, 0x60},
+    {0x5A, 0x30, 0x78},
+    {0x2C, 0x40, 0x27F},
+    {0x2D, 0x40, 0x27F},
+    {0x2E, 0x40, 0x27F},
+    {0x2F, 0x40, 0x27F},
+    {0x3B, 0x20, 0x7F},
+    {0x3C, 0x00, 0x67},
+    {0x3D, 0x20, 0x7F},
+    {0x36, 0x00, 0x67},
+    {0x37, 0x30, 0x7F},
+    {0x38, 0x00, 0x67},
+    {0x39, 0x28, 0x7F},
+    {0x54, 0x00, 0x67},
+    {0x9B, 0x30, 0x7F},
+    {0x1C, 0x00, 0x67},
+    {0x1D, 0x30, 0x7F},
+    {0x1E, 0x00, 0x67},
+    {0x1F, 0x00, 0x67},
+    {0x3F, 0x20, 0x7F},
+    {0x40, 0x00, 0x67},
+    {0x41, 0x20, 0x7F},
+    {0x42, 0x00, 0x67},
+    {0x43, 0x28, 0x7F},
+    {0x44, 0x00, 0x67},
+    {0x45, 0x28, 0x7F},
+    {0x22, 0x00, 0x67},
+    {0x23, 0x28, 0x7F},
+    {0x20, 0x00, 0x67},
+    {0x21, 0x00, 0x67},
+    {0x4B, 0x28, 0x7F},
+    {0x4C, 0x00, 0x67},
+    {0x4A, 0x00, 0x67},
+    {0x4D, 0x00, 0x67},
+    {0x64, 0x20, 0x27F},
+    {0x5F, 0x34, 0x7F},
+    {0x60, 0x04, 0x67},
+    {0x61, 0x2C, 0x7F},
+    {0x2A, 0x04, 0x67},
+    {0x2B, 0x04, 0x67},
+    {0x8F, 0x24, 0x7F},
+    {0x33, 0x34, 0x27F},
+    {0x52, 0x2C, 0x7F},
+    {0x53, 0x24, 0x7F},
+    {0x77, 0x04, 0x67},
+    {0x78, 0x34, 0x7F},
+    {0x11, 0x04, 0x67},
+    {0x06, 0x2C, 0x7F},
+    {0x08, 0x24, 0x7F},
+    {0x09, 0x24, 0x7F},
+    {0x0A, 0x24, 0x7F},
+    {0x0B, 0x24, 0x7F},
+    {0x88, 0x34, 0x7F},
+    {0x86, 0x2C, 0x7F},
+    {0x82, 0x24, 0x7F},
+    {0x85, 0x34, 0x7F},
+    {0x89, 0x24, 0x7F},
+    {0x8A, 0x34, 0x7F},
+    {0x8B, 0x34, 0x7F},
+    {0x8C, 0x34, 0x7F},
+    {0x8D, 0x24, 0x7F},
+    {0x7D, 0x04, 0x67},
+    {0x7E, 0x04, 0x67},
+    {0x81, 0x04, 0x67},
+    {0x9C, 0x34, 0x7F},
+    {0x9D, 0x34, 0x7F},
+    {0x9E, 0x2C, 0x7F},
+    {0x9F, 0x34, 0x7F},
+    {0xA0, 0x04, 0x67},
+    {0x4F, 0x04, 0x67},
+    {0x51, 0x04, 0x67},
+    {0x3A, 0x24, 0x7F},
+    {0x92, 0x4C, 0x7F},
+    {0x93, 0x4C, 0x7F},
+    {0x94, 0x44, 0x7F},
+    {0x95, 0x04, 0x67},
+    {0x96, 0x34, 0x7F},
+    {0x97, 0x04, 0x67},
+    {0x98, 0x34, 0x7F},
+    {0x99, 0x34, 0x7F},
+    {0x9A, 0x04, 0x67},
+    {0x3E, 0x24, 0x7F},
+    {0x6A, 0x04, 0x67},
+    {0x6B, 0x04, 0x67},
+    {0x6C, 0x2C, 0x7F},
+    {0x6D, 0x04, 0x67},
+    {0x6E, 0x04, 0x67},
+    {0x6F, 0x24, 0x7F},
+    {0x91, 0x24, 0x7F},
+    {0x70, 0x04, 0x7F},
+    {0x71, 0x04, 0x67},
+    {0x72, 0x04, 0x67},
+    {0x65, 0x34, 0x7F},
+    {0x66, 0x04, 0x67},
+    {0x67, 0x04, 0x267},
+    {0x5E, 0x05, 0x07},
+    {0x17, 0x05, 0x07},
+    {0x18, 0x05, 0x07},
+    {0x19, 0x05, 0x07},
+    {0x1A, 0x05, 0x07},
+    {0x1B, 0x05, 0x07},
+    {0x26, 0x05, 0x07},
+    {0x27, 0x05, 0x07},
+    {0x28, 0x05, 0x07},
+    {0x29, 0x05, 0x07},
+    {0x90, 0x05, 0x07},
+    {0x32, 0x05, 0x07},
+    {0x75, 0x05, 0x07},
+    {0x76, 0x05, 0x07},
+    {0x79, 0x05, 0x07},
+    {0x7A, 0x05, 0x07},
+    {0x8E, 0x05, 0x07},
+    {0x07, 0x05, 0x07},
+    {0x87, 0x05, 0x07},
+    {0x83, 0x05, 0x07},
+    {0x84, 0x05, 0x07},
+    {0x7B, 0x05, 0x07},
+    {0x7F, 0x05, 0x07},
+    {0x58, 0x00, 0x00},
+    {0x50, 0x05, 0x07},
+    {0x4E, 0x05, 0x07},
+    {0x12, 0x05, 0x07},
+    {0x13, 0x05, 0x07},
+    {0x14, 0x05, 0x07},
+    {0x15, 0x05, 0x07},
+    {0x16, 0x05, 0x07},
+    {0x73, 0x05, 0x07},
+    {0x74, 0x05, 0x07},
+    {0x24, 0x05, 0x07},
+    {0x25, 0x05, 0x07},
+    {0x62, 0x05, 0x07},
+    {0x68, 0x05, 0x07},
+    {0x69, 0x05, 0x07},
+    {0x63, 0x05, 0x07},
+};
+
+static constexpr u32 PinmuxNumInitialConfigsIcosa = (sizeof(PinmuxInitialConfigsIcosa) / sizeof(PinmuxInitialConfigsIcosa[0]));

stratosphere/boot/source/boot_pinmux_initial_configuration_iowa.hpp

@@ -0,0 +1,199 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+static constexpr PinmuxInitialConfig PinmuxInitialConfigsIowa[] = {
+    {0x5D, 0x00, 0x7F},
+    {0x47, 0x28, 0x7F},
+    {0x48, 0x00, 0x7F},
+    {0x46, 0x00, 0x7F},
+    {0x49, 0x00, 0x7F},
+    {0x30, 0x40, 0x27F},
+    {0x31, 0x40, 0x27F},
+    {0x0D, 0x20, 0x27F},
+    {0x0C, 0x00, 0x27F},
+    {0x10, 0x40, 0x27F},
+    {0x0F, 0x00, 0x27F},
+    {0x0E, 0x20, 0x27F},
+    {0x00, 0x40, 0x7F},
+    {0x01, 0x50, 0x7F},
+    {0x05, 0x50, 0x7F},
+    {0x04, 0x50, 0x7F},
+    {0x03, 0x50, 0x7F},
+    {0x02, 0x50, 0x7F},
+    {0xAA, 0x40, 0x7F},
+    {0xAC, 0x40, 0x7F},
+    {0xA2, 0x50, 0x7F},
+    {0xA3, 0x50, 0x7F},
+    {0xA4, 0x50, 0x7F},
+    {0xA5, 0x50, 0x7F},
+    {0xA6, 0x50, 0x7F},
+    {0xA7, 0x50, 0x7F},
+    {0xA8, 0x50, 0x7F},
+    {0xA9, 0x50, 0x7F},
+    {0x5B, 0x00, 0x78},
+    {0x7C, 0x01, 0x67},
+    {0x80, 0x01, 0x7F},
+    {0x34, 0x40, 0x27F},
+    {0x35, 0x40, 0x27F},
+    {0x55, 0x20, 0x78},
+    {0x56, 0x20, 0x7F},
+    {0xA1, 0x30, 0x7F},
+    {0x5C, 0x00, 0x78},
+    {0x5A, 0x20, 0x78},
+    {0x2C, 0x40, 0x27F},
+    {0x2D, 0x40, 0x27F},
+    {0x2E, 0x40, 0x27F},
+    {0x2F, 0x40, 0x27F},
+    {0x3B, 0x20, 0x7F},
+    {0x3C, 0x00, 0x7F},
+    {0x3D, 0x20, 0x7F},
+    {0x36, 0x00, 0x7F},
+    {0x37, 0x30, 0x7F},
+    {0x38, 0x00, 0x7F},
+    {0x39, 0x28, 0x7F},
+    {0x54, 0x00, 0x67},
+    {0x9B, 0x30, 0x7F},
+    {0x1C, 0x00, 0x7F},
+    {0x1D, 0x30, 0x7F},
+    {0x1E, 0x00, 0x7F},
+    {0x1F, 0x00, 0x7F},
+    {0x3F, 0x20, 0x7F},
+    {0x40, 0x00, 0x7F},
+    {0x41, 0x20, 0x7F},
+    {0x42, 0x00, 0x7F},
+    {0x43, 0x28, 0x7F},
+    {0x44, 0x00, 0x7F},
+    {0x45, 0x28, 0x7F},
+    {0x4B, 0x28, 0x7F},
+    {0x4C, 0x00, 0x7F},
+    {0x4A, 0x00, 0x7F},
+    {0x4D, 0x00, 0x7F},
+    {0x64, 0x20, 0x27F},
+    {0x5F, 0x34, 0x7F},
+    {0x60, 0x04, 0x67},
+    {0x61, 0x2C, 0x7F},
+    {0x2A, 0x04, 0x67},
+    {0x8F, 0x24, 0x7F},
+    {0x33, 0x34, 0x27F},
+    {0x52, 0x2C, 0x7F},
+    {0x53, 0x24, 0x7F},
+    {0x77, 0x04, 0x67},
+    {0x78, 0x24, 0x7F},
+    {0x11, 0x04, 0x67},
+    {0x06, 0x2C, 0x7F},
+    {0x08, 0x24, 0x7F},
+    {0x09, 0x24, 0x7F},
+    {0x0A, 0x24, 0x7F},
+    {0x0B, 0x24, 0x7F},
+    {0x88, 0x34, 0x7F},
+    {0x86, 0x2C, 0x7F},
+    {0x82, 0x24, 0x7F},
+    {0x85, 0x34, 0x7F},
+    {0x89, 0x24, 0x7F},
+    {0x8A, 0x34, 0x7F},
+    {0x8B, 0x34, 0x7F},
+    {0x8C, 0x24, 0x7F},
+    {0x8D, 0x24, 0x7F},
+    {0x7D, 0x04, 0x67},
+    {0x7E, 0x04, 0x67},
+    {0x81, 0x04, 0x67},
+    {0x9C, 0x24, 0x7F},
+    {0x9D, 0x34, 0x7F},
+    {0x9E, 0x2C, 0x7F},
+    {0x9F, 0x34, 0x7F},
+    {0xA0, 0x04, 0x67},
+    {0x4F, 0x04, 0x67},
+    {0x51, 0x04, 0x67},
+    {0x3A, 0x24, 0x7F},
+    {0x92, 0x4C, 0x7F},
+    {0x93, 0x4C, 0x7F},
+    {0x94, 0x44, 0x7F},
+    {0x95, 0x04, 0x67},
+    {0x96, 0x34, 0x7F},
+    {0x97, 0x04, 0x67},
+    {0x98, 0x34, 0x7F},
+    {0x9A, 0x04, 0x67},
+    {0x3E, 0x24, 0x7F},
+    {0x6A, 0x04, 0x67},
+    {0x6B, 0x04, 0x67},
+    {0x6C, 0x2C, 0x7F},
+    {0x6D, 0x04, 0x67},
+    {0x6E, 0x04, 0x67},
+    {0x6F, 0x24, 0x7F},
+    {0x91, 0x24, 0x7F},
+    {0x70, 0x04, 0x7F},
+    {0x71, 0x04, 0x67},
+    {0x72, 0x04, 0x67},
+    {0x65, 0x34, 0x7F},
+    {0x66, 0x04, 0x67},
+    {0x67, 0x04, 0x267},
+    {0x5E, 0x05, 0x07},
+    {0x17, 0x05, 0x07},
+    {0x18, 0x05, 0x07},
+    {0x19, 0x05, 0x07},
+    {0x1A, 0x05, 0x07},
+    {0x1B, 0x05, 0x07},
+    {0x26, 0x05, 0x07},
+    {0x27, 0x05, 0x07},
+    {0x28, 0x05, 0x07},
+    {0x29, 0x05, 0x07},
+    {0x2B, 0x05, 0x07},
+    {0x90, 0x05, 0x07},
+    {0x32, 0x05, 0x07},
+    {0x75, 0x05, 0x07},
+    {0x76, 0x05, 0x07},
+    {0x79, 0x05, 0x07},
+    {0x7A, 0x05, 0x07},
+    {0x8E, 0x05, 0x07},
+    {0xAB, 0x05, 0x07},
+    {0xAD, 0x05, 0x07},
+    {0xAE, 0x05, 0x07},
+    {0x07, 0x05, 0x07},
+    {0x87, 0x05, 0x07},
+    {0x83, 0x05, 0x07},
+    {0x84, 0x05, 0x07},
+    {0x7B, 0x05, 0x07},
+    {0x7F, 0x05, 0x07},
+    {0x58, 0x00, 0x00},
+    {0x59, 0x00, 0x00},
+    {0x50, 0x05, 0x07},
+    {0x4E, 0x05, 0x07},
+    {0x99, 0x05, 0x07},
+    {0x12, 0x05, 0x07},
+    {0x13, 0x05, 0x07},
+    {0x14, 0x05, 0x07},
+    {0x15, 0x05, 0x07},
+    {0x16, 0x05, 0x07},
+    {0x73, 0x05, 0x07},
+    {0x74, 0x05, 0x07},
+    {0x22, 0x05, 0x07},
+    {0x23, 0x05, 0x07},
+    {0x20, 0x05, 0x07},
+    {0x21, 0x05, 0x07},
+    {0x24, 0x05, 0x07},
+    {0x25, 0x05, 0x07},
+    {0x62, 0x05, 0x07},
+    {0x68, 0x05, 0x07},
+    {0x69, 0x05, 0x07},
+    {0x63, 0x05, 0x07},
+};
+
+static constexpr u32 PinmuxNumInitialConfigsIowa = (sizeof(PinmuxInitialConfigsIowa) / sizeof(PinmuxInitialConfigsIowa[0]));

stratosphere/boot/source/boot_pinmux_initial_drive_pad_configuration.hpp

@@ -0,0 +1,72 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+static constexpr PinmuxInitialConfig PinmuxInitialDrivePadConfigs[] = {
+    {0x04, 0x01010000, 0x01F1F000},
+    {0x0D, 0x01010000, 0x01F1F000},
+    {0x10, 0x01010000, 0x01F1F000},
+    {0x12, 0x01010000, 0x01F1F000},
+    {0x13, 0x01010000, 0x01F1F000},
+    {0x14, 0x0001F000, 0x01F1F000},
+    {0x15, 0x0001F000, 0x01F1F000},
+    {0x24, 0x01010000, 0x01F1F000},
+    {0x25, 0x01010000, 0x01F1F000},
+    {0x26, 0x01010000, 0x01F1F000},
+    {0x27, 0x01010000, 0x01F1F000},
+    {0x28, 0x01010000, 0x01F1F000},
+    {0x29, 0x01010000, 0x01F1F000},
+    {0x2A, 0x01010000, 0x01F1F000},
+    {0x2B, 0x01010000, 0x01F1F000},
+    {0x2C, 0x01F1F000, 0x01F1F000},
+    {0x2D, 0x01F1F000, 0x01F1F000},
+    {0x2F, 0x01F1F000, 0x01F1F000},
+    {0x30, 0x01404000, 0x01F1F000},
+    {0x31, 0x0001F000, 0x01F1F000},
+    {0x32, 0x0001F000, 0x01F1F000},
+    {0x33, 0x0001F000, 0x01F1F000},
+    {0x34, 0x0001F000, 0x01F1F000},
+    {0x35, 0x00007000, 0x01F1F000},
+    {0x36, 0x00007000, 0x01F1F000},
+    {0x46, 0x01010000, 0x01F1F000},
+    {0x47, 0x01010000, 0x01F1F000},
+    {0x4C, 0x01404000, 0x01F1F000},
+    {0x4D, 0x01404000, 0x01F1F000},
+    {0x62, 0x0001F000, 0x01F1F000},
+    {0x63, 0x0001F000, 0x01F1F000},
+    {0x7C, 0x01414000, 0x01F1F000},
+    {0x87, 0x01404000, 0x01F1F000},
+    {0x88, 0x01404000, 0x01F1F000},
+    {0x89, 0x01404000, 0x01F1F000},
+    {0x8A, 0x01404000, 0x01F1F000},
+    {0x6D, 0x00000000, 0xF0000000},
+    {0x6E, 0x00000000, 0xF0000000},
+    {0x6F, 0x00000000, 0xF0000000},
+    {0x70, 0x00000000, 0xF0000000},
+    {0x71, 0x00000000, 0xF0000000},
+    {0x72, 0x00000000, 0xF0000000},
+    {0x73, 0x00000000, 0xF0000000},
+    {0x74, 0x00000000, 0xF0000000},
+    {0x75, 0x00000000, 0xF0000000},
+    {0x76, 0x00000000, 0xF0000000},
+    {0x69, 0x51212000, 0xF1F1F000},
+};
+
+static constexpr u32 PinmuxNumInitialDrivePadConfigs = (sizeof(PinmuxInitialDrivePadConfigs) / sizeof(PinmuxInitialDrivePadConfigs[0]));

stratosphere/boot/source/boot_pinmux_map.hpp

@@ -0,0 +1,364 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+struct PinmuxDefinition {
+    u32 reg_offset;
+    u32 mask_val;
+    u32 pm_val;
+};
+
+struct PinmuxDrivePadDefinition {
+    u32 reg_offset;
+    u32 mask_val;
+};
+
+static constexpr PinmuxDefinition PinmuxMap[] = {
+    {0x00003000, 0x72FF, 0x01},   /* Sdmmc1Clk */
+    {0x00003004, 0x72FF, 0x02},   /* Sdmmc1Cmd */
+    {0x00003008, 0x72FF, 0x02},   /* Sdmmc1Dat3 */
+    {0x0000300C, 0x72FF, 0x02},   /* Sdmmc1Dat2 */
+    {0x00003010, 0x72FF, 0x02},   /* Sdmmc1Dat1 */
+    {0x00003014, 0x72FF, 0x01},   /* Sdmmc1Dat0 */
+    {0x0000301C, 0x72FF, 0x01},   /* Sdmmc3Clk */
+    {0x00003020, 0x72FF, 0x01},   /* Sdmmc3Cmd */
+    {0x00003024, 0x72FF, 0x01},   /* Sdmmc3Dat0 */
+    {0x00003028, 0x72FF, 0x01},   /* Sdmmc3Dat1 */
+    {0x0000302C, 0x72FF, 0x01},   /* Sdmmc3Dat2 */
+    {0x00003030, 0x72FF, 0x01},   /* Sdmmc3Dat3 */
+    {0x00003038, 0x1DFF, 0x01},   /* PexL0RstN */
+    {0x0000303C, 0x1DFF, 0x01},   /* PexL0ClkreqN */
+    {0x00003040, 0x1DFF, 0x01},   /* PexWakeN */
+    {0x00003044, 0x1DFF, 0x01},   /* PexL1RstN */
+    {0x00003048, 0x1DFF, 0x01},   /* PexL1ClkreqN */
+    {0x0000304C, 0x19FF, 0x01},   /* SataLedActive */
+    {0x00003050, 0x1F2FF, 0x01},  /* Spi1Mosi */
+    {0x00003054, 0x1F2FF, 0x01},  /* Spi1Miso */
+    {0x00003058, 0x1F2FF, 0x01},  /* Spi1Sck */
+    {0x0000305C, 0x1F2FF, 0x01},  /* Spi1Cs0 */
+    {0x00003060, 0x1F2FF, 0x01},  /* Spi1Cs1 */
+    {0x00003064, 0x72FF, 0x02},   /* Spi2Mosi */
+    {0x00003068, 0x72FF, 0x02},   /* Spi2Miso */
+    {0x0000306C, 0x72FF, 0x02},   /* Spi2Sck */
+    {0x00003070, 0x72FF, 0x02},   /* Spi2Cs0 */
+    {0x00003074, 0x72FF, 0x01},   /* Spi2Cs1 */
+    {0x00003078, 0x1F2FF, 0x01},  /* Spi4Mosi */
+    {0x0000307C, 0x1F2FF, 0x01},  /* Spi4Miso */
+    {0x00003080, 0x1F2FF, 0x01},  /* Spi4Sck */
+    {0x00003084, 0x1F2FF, 0x01},  /* Spi4Cs0 */
+    {0x00003088, 0x72FF, 0x01},   /* QspiSck */
+    {0x0000308C, 0x72FF, 0x01},   /* QspiCsN */
+    {0x00003090, 0x72FF, 0x01},   /* QspiIo0 */
+    {0x00003094, 0x72FF, 0x01},   /* QspiIo1 */
+    {0x00003098, 0x72FF, 0x01},   /* QspiIo2 */
+    {0x0000309C, 0x72FF, 0x01},   /* QspiIo3 */
+    {0x000030A4, 0x19FF, 0x02},   /* Dmic1Clk */
+    {0x000030A8, 0x19FF, 0x02},   /* Dmic1Dat */
+    {0x000030AC, 0x19FF, 0x02},   /* Dmic2Clk */
+    {0x000030B0, 0x19FF, 0x02},   /* Dmic2Dat */
+    {0x000030B4, 0x19FF, 0x02},   /* Dmic3Clk */
+    {0x000030B8, 0x19FF, 0x02},   /* Dmic3Dat */
+    {0x000030BC, 0x1DFF, 0x01},   /* Gen1I2cScl */
+    {0x000030C0, 0x1DFF, 0x01},   /* Gen1I2cSda */
+    {0x000030C4, 0x1DFF, 0x01},   /* Gen2I2cScl */
+    {0x000030C8, 0x1DFF, 0x01},   /* Gen2I2cSda */
+    {0x000030CC, 0x1DFF, 0x01},   /* Gen3I2cScl */
+    {0x000030D0, 0x1DFF, 0x01},   /* Gen3I2cSda */
+    {0x000030D4, 0x1DFF, 0x02},   /* CamI2cScl */
+    {0x000030D8, 0x1DFF, 0x02},   /* CamI2cSda */
+    {0x000030DC, 0x1DFF, 0x01},   /* PwrI2cScl */
+    {0x000030E0, 0x1DFF, 0x01},   /* PwrI2cSda */
+    {0x000030E4, 0x19FF, 0x01},   /* Uart1Tx */
+    {0x000030E8, 0x19FF, 0x01},   /* Uart1Rx */
+    {0x000030EC, 0x19FF, 0x01},   /* Uart1Rts */
+    {0x000030F0, 0x19FF, 0x01},   /* Uart1Cts */
+    {0x000030F4, 0x19FF, 0x00},   /* Uart2Tx */
+    {0x000030F8, 0x19FF, 0x00},   /* Uart2Rx */
+    {0x000030FC, 0x19FF, 0x02},   /* Uart2Rts */
+    {0x00003100, 0x19FF, 0x02},   /* Uart2Cts */
+    {0x00003104, 0x19FF, 0x02},   /* Uart3Tx */
+    {0x00003108, 0x19FF, 0x02},   /* Uart3Rx */
+    {0x0000310C, 0x19FF, 0x02},   /* Uart3Rts */
+    {0x00003110, 0x19FF, 0x02},   /* Uart3Cts */
+    {0x00003114, 0x19FF, 0x02},   /* Uart4Tx */
+    {0x00003118, 0x19FF, 0x02},   /* Uart4Rx */
+    {0x0000311C, 0x19FF, 0x02},   /* Uart4Rts */
+    {0x00003120, 0x19FF, 0x02},   /* Uart4Cts */
+    {0x00003124, 0x72FF, 0x01},   /* Dap1Fs */
+    {0x00003128, 0x72FF, 0x01},   /* Dap1Din */
+    {0x0000312C, 0x72FF, 0x01},   /* Dap1Dout */
+    {0x00003130, 0x72FF, 0x01},   /* Dap1Sclk */
+    {0x00003134, 0x72FF, 0x01},   /* Dap2Fs */
+    {0x00003138, 0x72FF, 0x01},   /* Dap2Din */
+    {0x0000313C, 0x72FF, 0x01},   /* Dap2Dout */
+    {0x00003140, 0x72FF, 0x01},   /* Dap2Sclk */
+    {0x00003144, 0x72FF, 0x01},   /* Dap4Fs */
+    {0x00003148, 0x72FF, 0x01},   /* Dap4Din */
+    {0x0000314C, 0x72FF, 0x01},   /* Dap4Dout */
+    {0x00003150, 0x72FF, 0x01},   /* Dap4Sclk */
+    {0x00003154, 0x72FF, 0x01},   /* Cam1Mclk */
+    {0x00003158, 0x72FF, 0x01},   /* Cam2Mclk */
+    {0x0000315C, 0x72FF, 0x01},   /* JtagRtck */
+    {0x00003160, 0x118C, 0xFF},   /* Clk32kIn */
+    {0x00003164, 0x72FF, 0x02},   /* Clk32kOut */
+    {0x00003168, 0x1DFF, 0x01},   /* BattBcl */
+    {0x0000316C, 0x11CC, 0xFF},   /* ClkReq */
+    {0x00003170, 0x11CC, 0xFF},   /* CpuPwrReq */
+    {0x00003174, 0x11CC, 0xFF},   /* PwrIntN */
+    {0x00003178, 0x11CC, 0xFF},   /* Shutdown */
+    {0x0000317C, 0x11CC, 0xFF},   /* CorePwrReq */
+    {0x00003180, 0x19FF, 0x01},   /* AudMclk */
+    {0x00003184, 0x19FF, 0x00},   /* DvfsPwm */
+    {0x00003188, 0x19FF, 0x00},   /* DvfsClk */
+    {0x0000318C, 0x19FF, 0x00},   /* GpioX1Aud */
+    {0x00003190, 0x19FF, 0x00},   /* GpioX3Aud */
+    {0x00003194, 0x1DFF, 0x00},   /* GpioPcc7 */
+    {0x00003198, 0x1DFF, 0x01},   /* HdmiCec */
+    {0x0000319C, 0x1DFF, 0x01},   /* HdmiIntDpHpd */
+    {0x000031A0, 0x19FF, 0x01},   /* SpdifOut */
+    {0x000031A4, 0x19FF, 0x01},   /* SpdifIn */
+    {0x000031A8, 0x1DFF, 0x01},   /* UsbVbusEn0 */
+    {0x000031AC, 0x1DFF, 0x01},   /* UsbVbusEn1 */
+    {0x000031B0, 0x19FF, 0x01},   /* DpHpd0 */
+    {0x000031B4, 0x19FF, 0x00},   /* WifiEn */
+    {0x000031B8, 0x19FF, 0x00},   /* WifiRst */
+    {0x000031BC, 0x19FF, 0x00},   /* WifiWakeAp */
+    {0x000031C0, 0x19FF, 0x00},   /* ApWakeBt */
+    {0x000031C4, 0x19FF, 0x00},   /* BtRst */
+    {0x000031C8, 0x19FF, 0x00},   /* BtWakeAp */
+    {0x000031CC, 0x19FF, 0x00},   /* ApWakeNfc */
+    {0x000031D0, 0x19FF, 0x00},   /* NfcEn */
+    {0x000031D4, 0x19FF, 0x00},   /* NfcInt */
+    {0x000031D8, 0x19FF, 0x00},   /* GpsEn */
+    {0x000031DC, 0x19FF, 0x00},   /* GpsRst */
+    {0x000031E0, 0x19FF, 0x01},   /* CamRst */
+    {0x000031E4, 0x19FF, 0x02},   /* CamAfEn */
+    {0x000031E8, 0x19FF, 0x02},   /* CamFlashEn */
+    {0x000031EC, 0x19FF, 0x01},   /* Cam1Pwdn */
+    {0x000031F0, 0x19FF, 0x01},   /* Cam2Pwdn */
+    {0x000031F4, 0x19FF, 0x01},   /* Cam1Strobe */
+    {0x000031F8, 0x19FF, 0x01},   /* LcdTe */
+    {0x000031FC, 0x19FF, 0x03},   /* LcdBlPwm */
+    {0x00003200, 0x19FF, 0x00},   /* LcdBlEn */
+    {0x00003204, 0x19FF, 0x00},   /* LcdRst */
+    {0x00003208, 0x19FF, 0x01},   /* LcdGpio1 */
+    {0x0000320C, 0x19FF, 0x02},   /* LcdGpio2 */
+    {0x00003210, 0x19FF, 0x00},   /* ApReady */
+    {0x00003214, 0x19FF, 0x00},   /* TouchRst */
+    {0x00003218, 0x19FF, 0x01},   /* TouchClk */
+    {0x0000321C, 0x19FF, 0x00},   /* ModemWakeAp */
+    {0x00003220, 0x19FF, 0x00},   /* TouchInt */
+    {0x00003224, 0x19FF, 0x00},   /* MotionInt */
+    {0x00003228, 0x19FF, 0x00},   /* AlsProxInt */
+    {0x0000322C, 0x19FF, 0x00},   /* TempAlert */
+    {0x00003230, 0x19FF, 0x00},   /* ButtonPowerOn */
+    {0x00003234, 0x19FF, 0x00},   /* ButtonVolUp */
+    {0x00003238, 0x19FF, 0x00},   /* ButtonVolDown */
+    {0x0000323C, 0x19FF, 0x00},   /* ButtonSlideSw */
+    {0x00003240, 0x19FF, 0x00},   /* ButtonHome */
+    {0x00003244, 0x19FF, 0x01},   /* GpioPa6 */
+    {0x00003248, 0x19FF, 0x00},   /* GpioPe6 */
+    {0x0000324C, 0x19FF, 0x00},   /* GpioPe7 */
+    {0x00003250, 0x19FF, 0x00},   /* GpioPh6 */
+    {0x00003254, 0x72FF, 0x02},   /* GpioPk0 */
+    {0x00003258, 0x72FF, 0x02},   /* GpioPk1 */
+    {0x0000325C, 0x72FF, 0x02},   /* GpioPk2 */
+    {0x00003260, 0x72FF, 0x02},   /* GpioPk3 */
+    {0x00003264, 0x72FF, 0x01},   /* GpioPk4 */
+    {0x00003268, 0x72FF, 0x01},   /* GpioPk5 */
+    {0x0000326C, 0x72FF, 0x01},   /* GpioPk6 */
+    {0x00003270, 0x72FF, 0x01},   /* GpioPk7 */
+    {0x00003274, 0x72FF, 0x00},   /* GpioPl0 */
+    {0x00003278, 0x72FF, 0x01},   /* GpioPl1 */
+    {0x0000327C, 0x72FF, 0x01},   /* GpioPz0 */
+    {0x00003280, 0x72FF, 0x02},   /* GpioPz1 */
+    {0x00003284, 0x72FF, 0x02},   /* GpioPz2 */
+    {0x00003288, 0x72FF, 0x01},   /* GpioPz3 */
+    {0x0000328C, 0x72FF, 0x01},   /* GpioPz4 */
+    {0x00003290, 0x72FF, 0x01},   /* GpioPz5 */
+
+    /* 5.0.0+ only */
+    {0x00003294, 0x1F2FF, 0x02},   /* Sdmmc2Dat0 */
+    {0x00003298, 0x1F2FF, 0x02},   /* Sdmmc2Dat1 */
+    {0x0000329C, 0x1F2FF, 0x02},   /* Sdmmc2Dat2 */
+    {0x000032A0, 0x1F2FF, 0x02},   /* Sdmmc2Dat3 */
+    {0x000032A4, 0x1F2FF, 0x02},   /* Sdmmc2Dat4 */
+    {0x000032A8, 0x1F2FF, 0x02},   /* Sdmmc2Dat5 */
+    {0x000032AC, 0x1F2FF, 0x02},   /* Sdmmc2Dat6 */
+    {0x000032B0, 0x1F2FF, 0x02},   /* Sdmmc2Dat7 */
+    {0x000032B4, 0x1F2FF, 0x02},   /* Sdmmc2Clk */
+    {0x000032B8, 0x1F2FF, 0x00},   /* Sdmmc2Clkb */
+    {0x000032BC, 0x1F2FF, 0x02},   /* Sdmmc2Cmd */
+    {0x000032C0, 0x1F2FF, 0x00},   /* Sdmmc2Dqs */
+    {0x000032C4, 0x1F2FF, 0x00},   /* Sdmmc2Dqsb */
+};
+
+static constexpr u32 PinmuxPadNameMax = (sizeof(PinmuxMap) / sizeof(PinmuxMap[0]));
+
+static constexpr PinmuxDrivePadDefinition PinmuxDrivePadMap[] = {
+    {0x000008E4, 0x01F1F000},   /* AlsProxInt */
+    {0x000008E8, 0x01F1F000},   /* ApReady */
+    {0x000008EC, 0x01F1F000},   /* ApWakeBt */
+    {0x000008F0, 0x01F1F000},   /* ApWakeNfc */
+    {0x000008F4, 0x01F1F000},   /* AudMclk */
+    {0x000008F8, 0x01F1F000},   /* BattBcl */
+    {0x000008FC, 0x01F1F000},   /* BtRst */
+    {0x00000900, 0x01F1F000},   /* BtWakeAp */
+    {0x00000904, 0x01F1F000},   /* ButtonHome */
+    {0x00000908, 0x01F1F000},   /* ButtonPowerOn */
+    {0x0000090C, 0x01F1F000},   /* ButtonSlideSw */
+    {0x00000910, 0x01F1F000},   /* ButtonVolDown */
+    {0x00000914, 0x01F1F000},   /* ButtonVolUp */
+    {0x00000918, 0x01F1F000},   /* Cam1Mclk */
+    {0x0000091C, 0x01F1F000},   /* Cam1Pwdn */
+    {0x00000920, 0x01F1F000},   /* Cam1Strobe */
+    {0x00000924, 0x01F1F000},   /* Cam2Mclk */
+    {0x00000928, 0x01F1F000},   /* Cam2Pwdn */
+    {0x0000092C, 0x01F1F000},   /* CamAfEn */
+    {0x00000930, 0x01F1F000},   /* CamFlashEn */
+    {0x00000934, 0x01F1F000},   /* CamI2cScl */
+    {0x00000938, 0x01F1F000},   /* CamI2cSda */
+    {0x0000093C, 0x01F1F000},   /* CamRst */
+    {0x00000940, 0x01F1F000},   /* Clk32kIn */
+    {0x00000944, 0x01F1F000},   /* Clk32kOut */
+    {0x00000948, 0x01F1F000},   /* ClkReq */
+    {0x0000094C, 0x01F1F000},   /* CorePwrReq */
+    {0x00000950, 0x01F1F000},   /* CpuPwrReq */
+    {0x00000954, 0xF0000000},   /* Dap1Din */
+    {0x00000958, 0xF0000000},   /* Dap1Dout */
+    {0x0000095C, 0xF0000000},   /* Dap1Fs */
+    {0x00000960, 0xF0000000},   /* Dap1Sclk */
+    {0x00000964, 0xF0000000},   /* Dap2Din */
+    {0x00000968, 0xF0000000},   /* Dap2Dout */
+    {0x0000096C, 0xF0000000},   /* Dap2Fs */
+    {0x00000970, 0xF0000000},   /* Dap2Sclk */
+    {0x00000974, 0x01F1F000},   /* Dap4Din */
+    {0x00000978, 0x01F1F000},   /* Dap4Dout */
+    {0x0000097C, 0x01F1F000},   /* Dap4Fs */
+    {0x00000980, 0x01F1F000},   /* Dap4Sclk */
+    {0x00000984, 0x01F1F000},   /* Dmic1Clk */
+    {0x00000988, 0x01F1F000},   /* Dmic1Dat */
+    {0x0000098C, 0x01F1F000},   /* Dmic2Clk */
+    {0x00000990, 0x01F1F000},   /* Dmic2Dat */
+    {0x00000994, 0x01F1F000},   /* Dmic3Clk */
+    {0x00000998, 0x01F1F000},   /* Dmic3Dat */
+    {0x0000099C, 0x01F1F000},   /* DpHpd */
+    {0x000009A0, 0x01F1F000},   /* DvfsClk */
+    {0x000009A4, 0x01F1F000},   /* DvfsPwm */
+    {0x000009A8, 0x01F1F000},   /* Gen1I2cScl */
+    {0x000009AC, 0x01F1F000},   /* Gen1I2cSda */
+    {0x000009B0, 0x01F1F000},   /* Gen2I2cScl */
+    {0x000009B4, 0x01F1F000},   /* Gen2I2cSda */
+    {0x000009B8, 0x01F1F000},   /* Gen3I2cScl */
+    {0x000009BC, 0x01F1F000},   /* Gen3I2cSda */
+    {0x000009C0, 0x01F1F000},   /* GpioPa6 */
+    {0x000009C4, 0x01F1F000},   /* GpioPcc7 */
+    {0x000009C8, 0x01F1F000},   /* GpioPe6 */
+    {0x000009CC, 0x01F1F000},   /* GpioPe7 */
+    {0x000009D0, 0x01F1F000},   /* GpioPh6 */
+    {0x000009D4, 0xF0000000},   /* GpioPk0 */
+    {0x000009D8, 0xF0000000},   /* GpioPk1 */
+    {0x000009DC, 0xF0000000},   /* GpioPk2 */
+    {0x000009E0, 0xF0000000},   /* GpioPk3 */
+    {0x000009E4, 0xF0000000},   /* GpioPk4 */
+    {0x000009E8, 0xF0000000},   /* GpioPk5 */
+    {0x000009EC, 0xF0000000},   /* GpioPk6 */
+    {0x000009F0, 0xF0000000},   /* GpioPk7 */
+    {0x000009F4, 0xF0000000},   /* GpioPl0 */
+    {0x000009F8, 0xF0000000},   /* GpioPl1 */
+    {0x000009FC, 0x07F7F000},   /* GpioPz0 */
+    {0x00000A00, 0x07F7F000},   /* GpioPz1 */
+    {0x00000A04, 0x07F7F000},   /* GpioPz2 */
+    {0x00000A08, 0x07F7F000},   /* GpioPz3 */
+    {0x00000A0C, 0x07F7F000},   /* GpioPz4 */
+    {0x00000A10, 0x07F7F000},   /* GpioPz5 */
+    {0x00000A14, 0x01F1F000},   /* GpioX1Aud */
+    {0x00000A18, 0x01F1F000},   /* GpioX3Aud */
+    {0x00000A1C, 0x01F1F000},   /* GpsEn */
+    {0x00000A20, 0x01F1F000},   /* GpsRst */
+    {0x00000A24, 0x01F1F000},   /* HdmiCec */
+    {0x00000A28, 0x01F1F000},   /* HdmiIntDpHpd */
+    {0x00000A2C, 0x01F1F000},   /* JtagRtck */
+    {0x00000A30, 0x01F1F000},   /* LcdBlEn */
+    {0x00000A34, 0x01F1F000},   /* LcdBlPwm */
+    {0x00000A38, 0x01F1F000},   /* LcdGpio1 */
+    {0x00000A3C, 0x01F1F000},   /* LcdGpio2 */
+    {0x00000A40, 0x01F1F000},   /* LcdRst */
+    {0x00000A44, 0x01F1F000},   /* LcdTe */
+    {0x00000A48, 0x01F1F000},   /* ModemWakeAp */
+    {0x00000A4C, 0x01F1F000},   /* MotionInt */
+    {0x00000A50, 0x01F1F000},   /* NfcEn */
+    {0x00000A54, 0x01F1F000},   /* NfcInt */
+    {0x00000A58, 0x01F1F000},   /* PexL0ClkReqN */
+    {0x00000A5C, 0x01F1F000},   /* PexL0RstN */
+    {0x00000A60, 0x01F1F000},   /* PexL1ClkreqN */
+    {0x00000A64, 0x01F1F000},   /* PexL1RstN */
+    {0x00000A68, 0x01F1F000},   /* PexWakeN */
+    {0x00000A6C, 0x01F1F000},   /* PwrI2cScl */
+    {0x00000A70, 0x01F1F000},   /* PwrI2cSda */
+    {0x00000A74, 0x01F1F000},   /* PwrIntN */
+    {0x00000A78, 0x07F7F000},   /* QspiComp */
+    {0x00000A90, 0xF0000000},   /* QspiSck */
+    {0x00000A94, 0x01F1F000},   /* SataLedActive */
+    {0x00000A98, 0xF7F7F000},   /* Sdmmc1Pad */
+    {0x00000AB0, 0xF7F7F000},   /* Sdmmc3Pad */
+    {0x00000AC8, 0x01F1F000},   /* Shutdown */
+    {0x00000ACC, 0x01F1F000},   /* SpdifIn */
+    {0x00000AD0, 0x01F1F000},   /* SpdifOut */
+    {0x00000AD4, 0xF0000000},   /* Spi1Cs0 */
+    {0x00000AD8, 0xF0000000},   /* Spi1Cs1 */
+    {0x00000ADC, 0xF0000000},   /* Spi1Miso */
+    {0x00000AE0, 0xF0000000},   /* Spi1Mosi */
+    {0x00000AE4, 0xF0000000},   /* Spi1Sck */
+    {0x00000AE8, 0xF0000000},   /* Spi2Cs0 */
+    {0x00000AEC, 0xF0000000},   /* Spi2Cs1 */
+    {0x00000AF0, 0xF0000000},   /* Spi2Miso */
+    {0x00000AF4, 0xF0000000},   /* Spi2Mosi */
+    {0x00000AF8, 0xF0000000},   /* Spi2Sck */
+    {0x00000AFC, 0xF0000000},   /* Spi4Cs0 */
+    {0x00000B00, 0xF0000000},   /* Spi4Miso */
+    {0x00000B04, 0xF0000000},   /* Spi4Mosi */
+    {0x00000B08, 0xF0000000},   /* Spi4Sck */
+    {0x00000B0C, 0x01F1F000},   /* TempAlert */
+    {0x00000B10, 0x01F1F000},   /* TouchClk */
+    {0x00000B14, 0x01F1F000},   /* TouchInt */
+    {0x00000B18, 0x01F1F000},   /* TouchRst */
+    {0x00000B1C, 0x01F1F000},   /* Uart1Cts */
+    {0x00000B20, 0x01F1F000},   /* Uart1Rts */
+    {0x00000B24, 0x01F1F000},   /* Uart1Rx */
+    {0x00000B28, 0x01F1F000},   /* Uart1Tx */
+    {0x00000B2C, 0x01F1F000},   /* Uart2Cts */
+    {0x00000B30, 0x01F1F000},   /* Uart2Rts */
+    {0x00000B34, 0x01F1F000},   /* Uart2Rx */
+    {0x00000B38, 0x01F1F000},   /* Uart2Tx */
+    {0x00000B3C, 0x01F1F000},   /* Uart3Cts */
+    {0x00000B40, 0x01F1F000},   /* Uart3Rts */
+    {0x00000B44, 0x01F1F000},   /* Uart3Rx */
+    {0x00000B48, 0x01F1F000},   /* Uart3Tx */
+    {0x00000B4C, 0x01F1F000},   /* Uart4Cts */
+    {0x00000B50, 0x01F1F000},   /* Uart4Rts */
+    {0x00000B54, 0x01F1F000},   /* Uart4Rx */
+    {0x00000B58, 0x01F1F000},   /* Uart4Tx */
+    {0x00000B5C, 0x01F1F000},   /* UsbVbusEn0 */
+    {0x00000B60, 0x01F1F000},   /* UsbVbusEn1 */
+    {0x00000B64, 0x01F1F000},   /* WifiEn */
+    {0x00000B68, 0x01F1F000},   /* WifiRst */
+    {0x00000B6C, 0x01F1F000},   /* WifiWakeAp */
+};
+
+static constexpr u32 PinmuxDrivePadNameMax = (sizeof(PinmuxDrivePadMap) / sizeof(PinmuxDrivePadMap[0]));

stratosphere/boot/source/boot_pinmux_utils.cpp

@@ -0,0 +1,505 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+#include "boot_pinmux_map.hpp"
+
+static bool g_initialized_pinmux_vaddr = false;
+static uintptr_t g_pinmux_vaddr = 0;
+
+static inline const PinmuxDefinition *GetPinmuxDefinition(u32 pinmux_name) {
+    if (pinmux_name >= PinmuxPadNameMax) {
+        std::abort();
+    }
+
+    return &PinmuxMap[pinmux_name];
+}
+
+static inline const PinmuxDrivePadDefinition *GetPinmuxDrivePadDefinition(u32 pinmux_name) {
+    if (pinmux_name >= PinmuxDrivePadNameMax) {
+        std::abort();
+    }
+
+    return &PinmuxDrivePadMap[pinmux_name];
+}
+
+static uintptr_t GetPinmuxBaseAddress() {
+    if (!g_initialized_pinmux_vaddr) {
+        u64 vaddr;
+        if (R_FAILED(svcQueryIoMapping(&vaddr, Boot::ApbMiscPhysicalBase, 0x4000))) {
+            std::abort();
+        }
+        g_pinmux_vaddr = vaddr;
+        g_initialized_pinmux_vaddr = true;
+    }
+    return g_pinmux_vaddr;
+}
+
+u32 Boot::PinmuxUpdatePark(u32 pinmux_name) {
+    const uintptr_t pinmux_base_vaddr = GetPinmuxBaseAddress();
+    const PinmuxDefinition *pinmux_def = GetPinmuxDefinition(pinmux_name);
+
+    /* Fetch this PINMUX's register offset */
+    u32 pinmux_reg_offset = pinmux_def->reg_offset;
+
+    /* Fetch this PINMUX's mask value */
+    u32 pinmux_mask_val = pinmux_def->mask_val;
+
+    /* Get current register ptr. */
+    volatile u32 *pinmux_reg = reinterpret_cast<volatile u32 *>(pinmux_base_vaddr + pinmux_reg_offset);
+
+    /* Read from the PINMUX register */
+    u32 pinmux_val = *pinmux_reg;
+
+    /* This PINMUX supports park change */
+    if (pinmux_mask_val & 0x20) {
+        /* Clear park status if set */
+        if (pinmux_val & 0x20) {
+            pinmux_val &= ~(0x20);
+        }
+    }
+
+    /* Write to the appropriate PINMUX register */
+    *pinmux_reg = pinmux_val;
+
+    /* Do a dummy read from the PINMUX register */
+    pinmux_val = *pinmux_reg;
+
+    return pinmux_val;
+}
+
+u32 Boot::PinmuxUpdatePad(u32 pinmux_name, u32 pinmux_config_val, u32 pinmux_config_mask_val) {
+    const uintptr_t pinmux_base_vaddr = GetPinmuxBaseAddress();
+    const PinmuxDefinition *pinmux_def = GetPinmuxDefinition(pinmux_name);
+
+    /* Fetch this PINMUX's register offset */
+    u32 pinmux_reg_offset = pinmux_def->reg_offset;
+
+    /* Fetch this PINMUX's mask value */
+    u32 pinmux_mask_val = pinmux_def->mask_val;
+
+    /* Get current register ptr. */
+    volatile u32 *pinmux_reg = reinterpret_cast<volatile u32 *>(pinmux_base_vaddr + pinmux_reg_offset);
+
+    /* Read from the PINMUX register */
+    u32 pinmux_val = *pinmux_reg;
+
+    /* This PINMUX register is locked */
+    if (pinmux_val & 0x80) {
+        std::abort();
+    }
+
+    u32 pm_val = (pinmux_config_val & 0x07);
+
+    /* Adjust PM */
+    if (pinmux_config_mask_val & 0x07) {
+        /* Apply additional changes first */
+        if (pm_val == 0x05) {
+            /* This pin supports PUPD change */
+            if (pinmux_mask_val & 0x0C) {
+                /* Change PUPD */
+                if ((pinmux_val & 0x0C) != 0x04) {
+                    pinmux_val &= 0xFFFFFFF3;
+                    pinmux_val |= 0x04;
+                }
+            }
+
+            /* This pin supports Tristate change */
+            if (pinmux_mask_val & 0x10) {
+                /* Change Tristate */
+                if (!(pinmux_val & 0x10)) {
+                    pinmux_val |= 0x10;
+                }
+            }
+
+            /* This pin supports EInput change */
+            if (pinmux_mask_val & 0x40) {
+                /* Change EInput */
+                if (pinmux_val & 0x40) {
+                    pinmux_val &= 0xFFFFFFBF;
+                }
+            }
+        } else if (pm_val >= 0x06) {
+            /* Default to safe value */
+            pm_val = 0x04;
+        }
+
+        /* Translate PM value if necessary */
+        if (pm_val == 0x04 || pm_val == 0x05) {
+            pm_val = pinmux_def->pm_val;
+        }
+
+        /* This pin supports PM change */
+        if (pinmux_mask_val & 0x03) {
+            /* Change PM */
+            if ((pinmux_val & 0x03) != (pm_val & 0x03)) {
+                pinmux_val &= 0xFFFFFFFC;
+                pinmux_val |= (pm_val & 0x03);
+            }
+        }
+    }
+
+    u32 pupd_config_val = (pinmux_config_val & 0x18);
+
+    /* Adjust PUPD */
+    if (pinmux_config_mask_val & 0x18) {
+        if (pupd_config_val < 0x11) {
+            /* This pin supports PUPD change */
+            if (pinmux_mask_val & 0x0C) {
+                /* Change PUPD */
+                if (((pinmux_val >> 0x02) & 0x03) != (pupd_config_val >> 0x03)) {
+                    pinmux_val &= 0xFFFFFFF3;
+                    pinmux_val |= (pupd_config_val >> 0x01);
+                }
+            }
+        }
+    }
+
+    u32 eod_config_val = (pinmux_config_val & 0x60);
+
+    /* Adjust EOd field */
+    if (pinmux_config_mask_val & 0x60) {
+        if (eod_config_val == 0x20) {
+            /* This pin supports Tristate change */
+            if (pinmux_mask_val & 0x10) {
+                /* Change Tristate */
+                if (!(pinmux_val & 0x10)) {
+                    pinmux_val |= 0x10;
+                }
+            }
+
+            /* This pin supports EInput change */
+            if (pinmux_mask_val & 0x40) {
+                /* Change EInput */
+                if (!(pinmux_val & 0x40)) {
+                    pinmux_val |= 0x40;
+                }
+            }
+
+            /* This pin supports EOd change */
+            if (pinmux_mask_val & 0x800) {
+                /* Change EOd */
+                if (pinmux_val & 0x800) {
+                    pinmux_val &= 0xFFFFF7FF;
+                }
+            }
+        } else if (eod_config_val == 0x40) {
+            /* This pin supports Tristate change */
+            if (pinmux_mask_val & 0x10) {
+                /* Change Tristate */
+                if (pinmux_val & 0x10) {
+                    pinmux_val &= 0xFFFFFFEF;
+                }
+            }
+
+            /* This pin supports EInput change */
+            if (pinmux_mask_val & 0x40) {
+                /* Change EInput */
+                if (!(pinmux_val & 0x40)) {
+                    pinmux_val |= 0x40;
+                }
+            }
+
+            /* This pin supports EOd change */
+            if (pinmux_mask_val & 0x800) {
+                /* Change EOd */
+                if (pinmux_val & 0x800) {
+                    pinmux_val &= 0xFFFFF7FF;
+                }
+            }
+        } else if (eod_config_val == 0x60) {
+            /* This pin supports Tristate change */
+            if (pinmux_mask_val & 0x10) {
+                /* Change Tristate */
+                if (pinmux_val & 0x10) {
+                    pinmux_val &= 0xFFFFFFEF;
+                }
+            }
+
+            /* This pin supports EInput change */
+            if (pinmux_mask_val & 0x40) {
+                /* Change EInput */
+                if (!(pinmux_val & 0x40)) {
+                    pinmux_val |= 0x40;
+                }
+            }
+
+            /* This pin supports EOd change */
+            if (pinmux_mask_val & 0x800) {
+                /* Change EOd */
+                if (!(pinmux_val & 0x800)) {
+                    pinmux_val |= 0x800;
+                }
+            }
+        } else {
+            /* This pin supports Tristate change */
+            if (pinmux_mask_val & 0x10) {
+                /* Change Tristate */
+                if (pinmux_val & 0x10) {
+                    pinmux_val &= 0xFFFFFFEF;
+                }
+            }
+
+            /* This pin supports EInput change */
+            if (pinmux_mask_val & 0x40) {
+                /* Change EInput */
+                if (pinmux_val & 0x40) {
+                    pinmux_val &= 0xFFFFFFBF;
+                }
+            }
+
+            /* This pin supports EOd change */
+            if (pinmux_mask_val & 0x800) {
+                /* Change EOd */
+                if (pinmux_val & 0x800) {
+                    pinmux_val &= 0xFFFFF7FF;
+                }
+            }
+        }
+    }
+
+    u32 lock_config_val = (pinmux_config_val & 0x80);
+
+    /* Adjust Lock */
+    if (pinmux_config_mask_val & 0x80) {
+        /* This pin supports Lock change */
+        if (pinmux_mask_val & 0x80) {
+            /* Change Lock */
+            if ((pinmux_val ^ pinmux_config_val) & 0x80) {
+                pinmux_val &= 0xFFFFFF7F;
+                pinmux_val |= lock_config_val;
+            }
+        }
+    }
+
+    u32 ioreset_config_val = (((pinmux_config_val >> 0x08) & 0x1) << 0x10);
+
+    /* Adjust IoReset */
+    if (pinmux_config_mask_val & 0x100) {
+        /* This pin supports IoReset change */
+        if (pinmux_mask_val & 0x10000) {
+            /* Change IoReset */
+            if (((pinmux_val >> 0x10) ^ (pinmux_config_val >> 0x08)) & 0x01) {
+                pinmux_val &= 0xFFFEFFFF;
+                pinmux_val |= ioreset_config_val;
+            }
+        }
+    }
+
+    u32 park_config_val = (((pinmux_config_val >> 0x0A) & 0x1) << 0x5);
+
+    /* Adjust Park */
+    if (pinmux_config_mask_val & 0x400) {
+        /* This pin supports Park change */
+        if (pinmux_mask_val & 0x20) {
+            /* Change Park */
+            if (((pinmux_val >> 0x05) ^ (pinmux_config_val >> 0x0A)) & 0x01) {
+                pinmux_val &= 0xFFFFFFDF;
+                pinmux_val |= park_config_val;
+            }
+        }
+    }
+
+    u32 elpdr_config_val = (((pinmux_config_val >> 0x0B) & 0x1) << 0x08);
+
+    /* Adjust ELpdr */
+    if (pinmux_config_mask_val & 0x800) {
+        /* This pin supports ELpdr change */
+        if (pinmux_mask_val & 0x100) {
+            /* Change ELpdr */
+            if (((pinmux_val >> 0x08) ^ (pinmux_config_val >> 0x0B)) & 0x01) {
+                pinmux_val &= 0xFFFFFEFF;
+                pinmux_val |= elpdr_config_val;
+            }
+        }
+    }
+
+    u32 ehsm_config_val = (((pinmux_config_val >> 0x0C) & 0x1) << 0x09);
+
+    /* Adjust EHsm */
+    if (pinmux_config_mask_val & 0x1000) {
+        /* This pin supports EHsm change */
+        if (pinmux_mask_val & 0x200) {
+            /* Change EHsm */
+            if (((pinmux_val >> 0x09) ^ (pinmux_config_val >> 0x0C)) & 0x01) {
+                pinmux_val &= 0xFFFFFDFF;
+                pinmux_val |= ehsm_config_val;
+            }
+        }
+    }
+
+    u32 eiohv_config_val = (((pinmux_config_val >> 0x09) & 0x1) << 0x0A);
+
+    /* Adjust EIoHv */
+    if (pinmux_config_mask_val & 0x200) {
+        /* This pin supports EIoHv change */
+        if (pinmux_mask_val & 0x400) {
+            /* Change EIoHv */
+            if (((pinmux_val >> 0x0A) ^ (pinmux_config_val >> 0x09)) & 0x01) {
+                pinmux_val &= 0xFFFFFBFF;
+                pinmux_val |= eiohv_config_val;
+            }
+        }
+    }
+
+    u32 eschmt_config_val = (((pinmux_config_val >> 0x0D) & 0x1) << 0x0C);
+
+    /* Adjust ESchmt */
+    if (pinmux_config_mask_val & 0x2000) {
+        /* This pin supports ESchmt change */
+        if (pinmux_mask_val & 0x1000) {
+            /* Change ESchmt */
+            if (((pinmux_val >> 0x0C) ^ (pinmux_config_val >> 0x0D)) & 0x01) {
+                pinmux_val &= 0xFFFFEFFF;
+                pinmux_val |= eschmt_config_val;
+            }
+        }
+    }
+
+    u32 preemp_config_val = (((pinmux_config_val >> 0x10) & 0x1) << 0xF);
+
+    /* Adjust Preemp */
+    if (pinmux_config_mask_val & 0x10000) {
+        /* This pin supports Preemp change */
+        if (pinmux_mask_val & 0x8000) {
+            /* Change Preemp */
+            if (((pinmux_val >> 0x0F) ^ (pinmux_config_val >> 0x10)) & 0x01) {
+                pinmux_val &= 0xFFFF7FFF;
+                pinmux_val |= preemp_config_val;
+            }
+        }
+    }
+
+    u32 drvtype_config_val = (((pinmux_config_val >> 0x0E) & 0x3) << 0xD);
+
+    /* Adjust DrvType */
+    if (pinmux_config_mask_val & 0xC000) {
+        /* This pin supports DrvType change */
+        if (pinmux_mask_val & 0x6000) {
+            /* Change DrvType */
+            if (((pinmux_val >> 0x0D) ^ (pinmux_config_val >> 0x0E)) & 0x03) {
+                pinmux_val &= 0xFFFF9FFF;
+                pinmux_val |= drvtype_config_val;
+            }
+        }
+    }
+
+    /* Write to the appropriate PINMUX register */
+    *pinmux_reg = pinmux_val;
+
+    /* Do a dummy read from the PINMUX register */
+    pinmux_val = *pinmux_reg;
+
+    return pinmux_val;
+}
+
+u32 Boot::PinmuxUpdateDrivePad(u32 pinmux_drivepad_name, u32 pinmux_drivepad_config_val, u32 pinmux_drivepad_config_mask_val) {
+    const uintptr_t pinmux_base_vaddr = GetPinmuxBaseAddress();
+    const PinmuxDrivePadDefinition *pinmux_drivepad_def = GetPinmuxDrivePadDefinition(pinmux_drivepad_name);
+
+    /* Fetch this PINMUX drive group's register offset */
+    u32 pinmux_drivepad_reg_offset = pinmux_drivepad_def->reg_offset;
+
+    /* Fetch this PINMUX drive group's mask value */
+    u32 pinmux_drivepad_mask_val = pinmux_drivepad_def->mask_val;
+
+    /* Get current register ptr. */
+    volatile u32 *pinmux_drivepad_reg = reinterpret_cast<volatile u32 *>(pinmux_base_vaddr + pinmux_drivepad_reg_offset);
+
+    /* Read from the PINMUX drive group register */
+    u32 pinmux_drivepad_val = *pinmux_drivepad_reg;
+
+    /* Adjust DriveDownStrength */
+    if (pinmux_drivepad_config_mask_val & 0x1F000) {
+        u32 mask_val = 0x7F000;
+
+        /* Adjust mask value */
+        if ((pinmux_drivepad_mask_val & 0x7F000) != 0x7F000)
+            mask_val = 0x1F000;
+
+        /* This drive group supports DriveDownStrength change */
+        if (pinmux_drivepad_mask_val & mask_val) {
+            /* Change DriveDownStrength */
+            if (((pinmux_drivepad_config_val & 0x7F000) & mask_val) != (pinmux_drivepad_val & mask_val)) {
+                pinmux_drivepad_val &= ~(mask_val);
+                pinmux_drivepad_val |= ((pinmux_drivepad_config_val & 0x7F000) & mask_val);
+            }
+        }
+    }
+
+    /* Adjust DriveUpStrength */
+    if (pinmux_drivepad_config_mask_val & 0x1F00000) {
+        u32 mask_val = 0x7F00000;
+
+        /* Adjust mask value */
+        if ((pinmux_drivepad_mask_val & 0x7F00000) != 0x7F00000)
+            mask_val = 0x1F00000;
+
+        /* This drive group supports DriveUpStrength change */
+        if (pinmux_drivepad_mask_val & mask_val) {
+            /* Change DriveUpStrength */
+            if (((pinmux_drivepad_config_val & 0x7F00000) & mask_val) != (pinmux_drivepad_val & mask_val)) {
+                pinmux_drivepad_val &= ~(mask_val);
+                pinmux_drivepad_val |= ((pinmux_drivepad_config_val & 0x7F00000) & mask_val);
+            }
+        }
+    }
+
+    /* Adjust DriveDownSlew */
+    if (pinmux_drivepad_config_mask_val & 0x30000000) {
+        /* This drive group supports DriveDownSlew change */
+        if (pinmux_drivepad_mask_val & 0x30000000) {
+            /* Change DriveDownSlew */
+            if ((pinmux_drivepad_val ^ pinmux_drivepad_config_val) & 0x30000000) {
+                pinmux_drivepad_val &= 0xCFFFFFFF;
+                pinmux_drivepad_val |= (pinmux_drivepad_config_val & 0x30000000);
+            }
+        }
+    }
+
+    /* Adjust DriveUpSlew */
+    if (pinmux_drivepad_config_mask_val & 0xC0000000) {
+        /* This drive group supports DriveUpSlew change */
+        if (pinmux_drivepad_mask_val & 0xC0000000) {
+            /* Change DriveUpSlew */
+            if ((pinmux_drivepad_val ^ pinmux_drivepad_config_val) & 0xC0000000) {
+                pinmux_drivepad_val &= 0x3FFFFFFF;
+                pinmux_drivepad_val |= (pinmux_drivepad_config_val & 0xC0000000);
+            }
+        }
+    }
+
+    /* Write to the appropriate PINMUX drive group register */
+    *pinmux_drivepad_reg = pinmux_drivepad_val;
+
+    /* Do a dummy read from the PINMUX drive group register */
+    pinmux_drivepad_val = *pinmux_drivepad_reg;
+
+    return pinmux_drivepad_val;
+}
+
+u32 Boot::PinmuxDummyReadDrivePad(u32 pinmux_drivepad_name) {
+    const uintptr_t pinmux_base_vaddr = GetPinmuxBaseAddress();
+    const PinmuxDrivePadDefinition *pinmux_drivepad_def = GetPinmuxDrivePadDefinition(pinmux_drivepad_name);
+
+    /* Fetch this PINMUX drive group's register offset */
+    u32 pinmux_drivepad_reg_offset = pinmux_drivepad_def->reg_offset;
+
+    /* Get current register ptr. */
+    volatile u32 *pinmux_drivepad_reg = reinterpret_cast<volatile u32 *>(pinmux_base_vaddr + pinmux_drivepad_reg_offset);
+
+    return *pinmux_drivepad_reg;
+}

stratosphere/boot/source/boot_pmc_wrapper.cpp

@@ -0,0 +1,57 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+
+static constexpr u32 SmcFunctionId_AtmosphereReadWriteRegister = 0xF0000002;
+
+static constexpr u32 PmcPhysStart = 0x7000E400;
+static constexpr u32 PmcPhysEnd = 0x7000EFFF;
+
+static inline bool IsValidPmcAddress(u32 phys_addr) {
+    return (phys_addr & 3) == 0 && PmcPhysStart <= phys_addr && phys_addr <= PmcPhysEnd;
+}
+
+static inline u32 SmcAtmosphereReadWriteRegister(u32 phys_addr, u32 value, u32 mask) {
+    SecmonArgs args;
+
+    args.X[0] = SmcFunctionId_AtmosphereReadWriteRegister;
+    args.X[1] = phys_addr;
+    args.X[2] = mask;
+    args.X[3] = value;
+    svcCallSecureMonitor(&args);
+    if (args.X[0] != 0) {
+        std::abort();
+    }
+
+    return static_cast<u32>(args.X[1]);
+}
+
+u32 Boot::ReadPmcRegister(u32 phys_addr) {
+    if (!IsValidPmcAddress(phys_addr)) {
+        std::abort();
+    }
+
+    return SmcAtmosphereReadWriteRegister(phys_addr, 0, 0);
+}
+
+void Boot::WritePmcRegister(u32 phys_addr, u32 value, u32 mask) {
+    if (!IsValidPmcAddress(phys_addr)) {
+        std::abort();
+    }
+
+    SmcAtmosphereReadWriteRegister(phys_addr, value, mask);
+}

stratosphere/boot/source/boot_pmic_driver.cpp

@@ -0,0 +1,132 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include <switch.h>
+#include <stratosphere.hpp>
+#include "boot_functions.hpp"
+#include "boot_pmic_driver.hpp"
+
+void PmicDriver::ShutdownSystem() {
+    if (R_FAILED(this->ShutdownSystem(false))) {
+        std::abort();
+    }
+}
+
+void PmicDriver::RebootSystem() {
+    if (R_FAILED(this->ShutdownSystem(true))) {
+        std::abort();
+    }
+}
+
+Result PmicDriver::GetAcOk(bool *out) {
+    u8 power_status;
+    Result rc = this->GetPowerStatus(&power_status);
+    if (R_FAILED(rc)) {
+        return rc;
+    }
+
+    *out = (power_status & 0x02) != 0;
+    return ResultSuccess;
+}
+
+Result PmicDriver::GetPowerIntr(u8 *out) {
+    const u8 addr = 0x0B;
+    return Boot::ReadI2cRegister(this->i2c_session, out, sizeof(*out), &addr, sizeof(addr));
+}
+
+Result PmicDriver::GetPowerStatus(u8 *out) {
+    const u8 addr = 0x15;
+    return Boot::ReadI2cRegister(this->i2c_session, out, sizeof(*out), &addr, sizeof(addr));
+}
+
+Result PmicDriver::GetNvErc(u8 *out) {
+    const u8 addr = 0x0C;
+    return Boot::ReadI2cRegister(this->i2c_session, out, sizeof(*out), &addr, sizeof(addr));
+}
+
+Result PmicDriver::GetPowerButtonPressed(bool *out) {
+    u8 power_intr;
+    Result rc = this->GetPowerIntr(&power_intr);
+    if (R_FAILED(rc)) {
+        return rc;
+    }
+    *out = (power_intr & 0x08) != 0;
+    return ResultSuccess;
+}
+
+Result PmicDriver::ShutdownSystem(bool reboot) {
+    const u8 on_off_1_addr = 0x41;
+    const u8 on_off_2_addr = 0x42;
+
+    /* Get value, set or clear software reset mask. */
+    u8 on_off_2_val = 0;
+    if (R_FAILED(Boot::ReadI2cRegister(this->i2c_session, &on_off_2_val, sizeof(on_off_2_val), &on_off_2_addr, sizeof(on_off_2_addr)))) {
+        std::abort();
+    }
+    if (reboot) {
+        on_off_2_val |= 0x80;
+    } else {
+        on_off_2_val &= ~0x80;
+    }
+    if (R_FAILED(Boot::WriteI2cRegister(this->i2c_session, &on_off_2_val, sizeof(on_off_2_val), &on_off_2_addr, sizeof(on_off_2_addr)))) {
+        std::abort();
+    }
+
+    /* Get value, set software reset mask. */
+    u8 on_off_1_val = 0;
+    if (R_FAILED(Boot::ReadI2cRegister(this->i2c_session, &on_off_1_val, sizeof(on_off_1_val), &on_off_1_addr, sizeof(on_off_1_addr)))) {
+        std::abort();
+    }
+    on_off_1_val |= 0x80;
+
+    /* Finalize the battery. */
+    {
+        BatteryDriver battery_driver;
+        this->FinalizeBattery(&battery_driver);
+    }
+
+    /* Actually write the value to trigger shutdown/reset. */
+    if (R_FAILED(Boot::WriteI2cRegister(this->i2c_session, &on_off_1_val, sizeof(on_off_1_val), &on_off_1_addr, sizeof(on_off_1_addr)))) {
+        std::abort();
+    }
+
+    /* Allow up to 5 seconds for shutdown/reboot to take place. */
+    svcSleepThread(5'000'000'000ul);
+    std::abort();
+}
+
+void PmicDriver::FinalizeBattery(BatteryDriver *battery_driver) {
+    /* Set shutdown timer. */
+    battery_driver->SetShutdownTimer();
+
+    /* Get whether shutdown is enabled. */
+    bool shutdown_enabled;
+    if (R_FAILED(battery_driver->GetShutdownEnabled(&shutdown_enabled))) {
+        return;
+    }
+
+    bool ac_ok;
+    bool desired_shutdown_enabled;
+    if (R_FAILED(this->GetAcOk(&ac_ok)) || ac_ok) {
+        desired_shutdown_enabled = false;
+    } else {
+        desired_shutdown_enabled = true;
+    }
+
+    if (shutdown_enabled != desired_shutdown_enabled) {
+        battery_driver->SetShutdownEnabled(desired_shutdown_enabled);
+    }
+}

stratosphere/boot/source/boot_pmic_driver.hpp

@@ -0,0 +1,48 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+#include <stratosphere.hpp>
+
+#include "i2c_driver/i2c_api.hpp"
+#include "boot_battery_driver.hpp"
+
+class PmicDriver {
+    private:
+        I2cSessionImpl i2c_session;
+    public:
+        PmicDriver() {
+            I2cDriver::Initialize();
+            I2cDriver::OpenSession(&this->i2c_session, I2cDevice_Max77620Pmic);
+        }
+
+        ~PmicDriver() {
+            I2cDriver::CloseSession(this->i2c_session);
+            I2cDriver::Finalize();
+        }
+    private:
+        Result GetPowerStatus(u8 *out);
+        Result ShutdownSystem(bool reboot);
+        void FinalizeBattery(BatteryDriver *battery_driver);
+    public:
+        void ShutdownSystem();
+        void RebootSystem();
+        Result GetAcOk(bool *out);
+        Result GetPowerIntr(u8 *out);
+        Result GetNvErc(u8 *out);
+        Result GetPowerButtonPressed(bool *out);
+};

stratosphere/boot/source/boot_reboot_manager.cpp

@@ -0,0 +1,75 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include <switch.h>
+#include <stratosphere.hpp>
+#include <strings.h>
+#include "boot_functions.hpp"
+#include "boot_reboot_manager.hpp"
+#include "fusee-primary_bin.h"
+
+static u8 g_work_page[0x1000] __attribute__ ((aligned (0x1000)));
+
+static void ClearIram() {
+    /* Make page FFs. */
+    memset(g_work_page, 0xFF, sizeof(g_work_page));
+
+    /* Overwrite all of IRAM with FFs. */
+    for (size_t ofs = 0; ofs < IRAM_SIZE; ofs += sizeof(g_work_page)) {
+        CopyToIram(IRAM_BASE + ofs, g_work_page, sizeof(g_work_page));
+    }
+}
+
+static void DoRebootToPayload() {
+    /* Ensure clean IRAM state. */
+    ClearIram();
+
+    /* Copy in payload. */
+    for (size_t ofs = 0; ofs < fusee_primary_bin_size; ofs += 0x1000) {
+        std::memcpy(g_work_page, &fusee_primary_bin[ofs], std::min(static_cast<size_t>(fusee_primary_bin_size - ofs), size_t(0x1000)));
+        CopyToIram(IRAM_PAYLOAD_BASE + ofs, g_work_page, 0x1000);
+    }
+
+    RebootToIramPayload();
+}
+
+Result BootRebootManager::PerformReboot() {
+    DoRebootToPayload();
+    return ResultSuccess;
+}
+
+void BootRebootManager::RebootForFatalError(AtmosphereFatalErrorContext *ctx) {
+    /* Ensure clean IRAM state. */
+    ClearIram();
+
+    /* Copy in payload. */
+    for (size_t ofs = 0; ofs < fusee_primary_bin_size; ofs += 0x1000) {
+        std::memcpy(g_work_page, &fusee_primary_bin[ofs], std::min(static_cast<size_t>(fusee_primary_bin_size - ofs), size_t(0x1000)));
+        CopyToIram(IRAM_PAYLOAD_BASE + ofs, g_work_page, 0x1000);
+    }
+
+    std::memset(g_work_page, 0xCC, sizeof(g_work_page));
+    std::memcpy(g_work_page, ctx, sizeof(*ctx));
+    CopyToIram(IRAM_PAYLOAD_BASE + IRAM_PAYLOAD_MAX_SIZE, g_work_page, sizeof(g_work_page));
+
+    RebootToIramPayload();
+}
+
+void Boot::RebootSystem() {
+    if (R_FAILED(BootRebootManager::PerformReboot())) {
+        std::abort();
+    }
+}

stratosphere/boot/source/boot_reboot_manager.hpp

@@ -0,0 +1,30 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+#include <stratosphere.hpp>
+
+#define IRAM_BASE             0x40000000ull
+#define IRAM_SIZE             0x40000
+#define IRAM_PAYLOAD_MAX_SIZE 0x2E000
+#define IRAM_PAYLOAD_BASE 0x40010000ull
+
+class BootRebootManager {
+    public:
+        static Result PerformReboot();
+        static void RebootForFatalError(AtmosphereFatalErrorContext *ctx);
+};

stratosphere/boot/source/boot_registers_clkrst.hpp

@@ -0,0 +1,119 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+static constexpr size_t CLK_RST_CONTROLLER_RST_SOURCE = 0x0;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEVICES_L = 0x4;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEVICES_H = 0x8;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEVICES_U = 0xC;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_OUT_ENB_L = 0x10;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_OUT_ENB_H = 0x14;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_OUT_ENB_U = 0x18;
+static constexpr size_t CLK_RST_CONTROLLER_CCLK_BURST_POLICY = 0x20;
+static constexpr size_t CLK_RST_CONTROLLER_SUPER_CCLK_DIVIDER = 0x24;
+static constexpr size_t CLK_RST_CONTROLLER_SCLK_BURST_POLICY = 0x28;
+static constexpr size_t CLK_RST_CONTROLLER_SUPER_SCLK_DIVIDER = 0x2C;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SYSTEM_RATE = 0x30;
+static constexpr size_t CLK_RST_CONTROLLER_MISC_CLK_ENB = 0x48;
+static constexpr size_t CLK_RST_CONTROLLER_OSC_CTRL = 0x50;
+static constexpr size_t CLK_RST_CONTROLLER_PLLC_BASE = 0x80;
+static constexpr size_t CLK_RST_CONTROLLER_PLLC_MISC = 0x88;
+static constexpr size_t CLK_RST_CONTROLLER_PLLM_BASE = 0x90;
+static constexpr size_t CLK_RST_CONTROLLER_PLLM_MISC1 = 0x98;
+static constexpr size_t CLK_RST_CONTROLLER_PLLM_MISC2 = 0x9C;
+static constexpr size_t CLK_RST_CONTROLLER_PLLP_BASE = 0xA0;
+static constexpr size_t CLK_RST_CONTROLLER_PLLD_BASE = 0xD0;
+static constexpr size_t CLK_RST_CONTROLLER_PLLD_MISC1 = 0xD8;
+static constexpr size_t CLK_RST_CONTROLLER_PLLD_MISC = 0xDC;
+static constexpr size_t CLK_RST_CONTROLLER_PLLX_BASE = 0xE0;
+static constexpr size_t CLK_RST_CONTROLLER_PLLX_MISC = 0xE4;
+static constexpr size_t CLK_RST_CONTROLLER_PLLE_BASE = 0xE8;
+static constexpr size_t CLK_RST_CONTROLLER_PLLE_MISC = 0xEC;
+static constexpr size_t CLK_RST_CONTROLLER_LVL2_CLK_GATE_OVRA = 0xF8;
+static constexpr size_t CLK_RST_CONTROLLER_LVL2_CLK_GATE_OVRB = 0xFC;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_PWM = 0x110;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_I2C1 = 0x124;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_I2C5 = 0x128;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_DISP1 = 0x138;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_VI = 0x148;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_SDMMC1 = 0x150;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_SDMMC2 = 0x154;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_SDMMC4 = 0x164;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_UARTA = 0x178;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_UARTB = 0x17C;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_HOST1X = 0x180;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_UARTC = 0x1A0;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_I2C3 = 0x1B8;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_SDMMC3 = 0x1BC;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_CSITE = 0x1D4;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_EMC = 0x19C;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_TSEC = 0x1F4;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_OUT_ENB_X = 0x280;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_ENB_X_SET = 0x284;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_ENB_X_CLR = 0x288;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEVICES_X = 0x28C;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEV_X_SET = 0x290;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEV_X_CLR = 0x294;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_OUT_ENB_Y = 0x298;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_ENB_Y_SET = 0x29C;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_ENB_Y_CLR = 0x2A0;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEVICES_Y = 0x2A4;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEV_Y_SET = 0x2A8;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEV_Y_CLR = 0x2AC;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEV_L_SET = 0x300;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEV_L_CLR = 0x304;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEV_H_SET = 0x308;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEV_H_CLR = 0x30C;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEV_U_SET = 0x310;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEV_U_CLR = 0x314;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_ENB_L_SET = 0x320;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_ENB_L_CLR = 0x324;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_ENB_H_SET = 0x328;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_ENB_H_CLR = 0x32C;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_ENB_U_SET = 0x330;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_ENB_U_CLR = 0x334;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEVICES_V = 0x358;
+static constexpr size_t CLK_RST_CONTROLLER_RST_DEVICES_W = 0x35C;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_OUT_ENB_V = 0x360;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_OUT_ENB_W = 0x364;
+static constexpr size_t CLK_RST_CONTROLLER_CPU_SOFTRST_CTRL2 = 0x388;
+static constexpr size_t CLK_RST_CONTROLLER_LVL2_CLK_GATE_OVRC = 0x3A0;
+static constexpr size_t CLK_RST_CONTROLLER_LVL2_CLK_GATE_OVRD = 0x3A4;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_MSELECT = 0x3B4;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_SOR1 = 0x410;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_SE = 0x42C;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_ENB_V_SET = 0x440;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_ENB_W_SET = 0x448;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_ENB_W_CLR = 0x44C;
+static constexpr size_t CLK_RST_CONTROLLER_RST_CPUG_CMPLX_SET = 0x450;
+static constexpr size_t CLK_RST_CONTROLLER_RST_CPUG_CMPLX_CLR = 0x454;
+static constexpr size_t CLK_RST_CONTROLLER_UTMIP_PLL_CFG2 = 0x488;
+static constexpr size_t CLK_RST_CONTROLLER_PLLE_AUX = 0x48C;
+static constexpr size_t CLK_RST_CONTROLLER_AUDIO_SYNC_CLK_I2S0 = 0x4A0;
+static constexpr size_t CLK_RST_CONTROLLER_PLLX_MISC_3 = 0x518;
+static constexpr size_t CLK_RST_CONTROLLER_LVL2_CLK_GATE_OVRE = 0x554;
+static constexpr size_t CLK_RST_CONTROLLER_SPARE_REG0 = 0x55C;
+static constexpr size_t CLK_RST_CONTROLLER_PLLMB_BASE = 0x5E8;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_DSIA_LP = 0x620;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_EMC_DLL = 0x664;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_UART_FST_MIPI_CAL = 0x66C;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_SDMMC_LEGACY_TM = 0x694;
+static constexpr size_t CLK_RST_CONTROLLER_CLK_SOURCE_NVENC = 0x6A0;
+static constexpr size_t CLK_RST_CONTROLLER_SE_SUPER_CLK_DIVIDER = 0x704;

stratosphere/boot/source/boot_registers_di.hpp

@@ -0,0 +1,353 @@
+/*
+ * Copyright (c) 2018 naehrwert
+ * Copyright (C) 2018 CTCaer
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+#define DC_CMD_GENERAL_INCR_SYNCPT 0x00
+
+#define DC_CMD_GENERAL_INCR_SYNCPT_CNTRL 0x01
+#define  SYNCPT_CNTRL_NO_STALL   (1 << 8)
+#define  SYNCPT_CNTRL_SOFT_RESET (1 << 0)
+
+#define DC_CMD_CONT_SYNCPT_VSYNC 0x28
+#define  SYNCPT_VSYNC_ENABLE (1 << 8)
+
+#define DC_CMD_DISPLAY_COMMAND_OPTION0 0x031
+
+#define DC_CMD_DISPLAY_COMMAND 0x32
+#define  DISP_CTRL_MODE_STOP       (0 << 5)
+#define  DISP_CTRL_MODE_C_DISPLAY  (1 << 5)
+#define  DISP_CTRL_MODE_NC_DISPLAY (2 << 5)
+#define  DISP_CTRL_MODE_MASK       (3 << 5)
+
+#define DC_CMD_DISPLAY_POWER_CONTROL 0x36
+#define  PW0_ENABLE (1 <<  0)
+#define  PW1_ENABLE (1 <<  2)
+#define  PW2_ENABLE (1 <<  4)
+#define  PW3_ENABLE (1 <<  6)
+#define  PW4_ENABLE (1 <<  8)
+#define  PM0_ENABLE (1 << 16)
+#define  PM1_ENABLE (1 << 18)
+
+#define DC_CMD_INT_MASK 0x38
+#define DC_CMD_INT_ENABLE 0x39
+
+#define DC_CMD_STATE_ACCESS 0x40
+#define  READ_MUX  (1 << 0)
+#define  WRITE_MUX (1 << 2)
+
+#define DC_CMD_STATE_CONTROL 0x41
+#define  GENERAL_ACT_REQ (1 <<  0)
+#define  WIN_A_ACT_REQ   (1 <<  1)
+#define  WIN_B_ACT_REQ   (1 <<  2)
+#define  WIN_C_ACT_REQ   (1 <<  3)
+#define  CURSOR_ACT_REQ  (1 <<  7)
+#define  GENERAL_UPDATE  (1 <<  8)
+#define  WIN_A_UPDATE    (1 <<  9)
+#define  WIN_B_UPDATE    (1 << 10)
+#define  WIN_C_UPDATE    (1 << 11)
+#define  CURSOR_UPDATE   (1 << 15)
+#define  NC_HOST_TRIG    (1 << 24)
+
+#define DC_CMD_DISPLAY_WINDOW_HEADER 0x42
+#define  WINDOW_A_SELECT (1 << 4)
+#define  WINDOW_B_SELECT (1 << 5)
+#define  WINDOW_C_SELECT (1 << 6)
+
+#define DC_CMD_REG_ACT_CONTROL 0x043
+
+#define DC_COM_CRC_CONTROL 0x300
+#define DC_COM_PIN_OUTPUT_ENABLE(x) (0x302 + (x))
+#define DC_COM_PIN_OUTPUT_POLARITY(x) (0x306 + (x))
+
+#define DC_COM_DSC_TOP_CTL 0x33E
+
+#define DC_DISP_DISP_WIN_OPTIONS 0x402
+#define  HDMI_ENABLE     (1 << 30)
+#define  DSI_ENABLE      (1 << 29)
+#define  SOR1_TIMING_CYA (1 << 27)
+#define  SOR1_ENABLE     (1 << 26)
+#define  SOR_ENABLE      (1 << 25)
+#define  CURSOR_ENABLE   (1 << 16)
+
+#define DC_DISP_DISP_MEM_HIGH_PRIORITY 0x403
+#define DC_DISP_DISP_MEM_HIGH_PRIORITY_TIMER 0x404
+#define DC_DISP_DISP_TIMING_OPTIONS 0x405
+#define DC_DISP_REF_TO_SYNC 0x406
+#define DC_DISP_SYNC_WIDTH 0x407
+#define DC_DISP_BACK_PORCH 0x408
+#define DC_DISP_ACTIVE 0x409
+#define DC_DISP_FRONT_PORCH 0x40A
+
+#define DC_DISP_DISP_CLOCK_CONTROL 0x42E
+#define  PIXEL_CLK_DIVIDER_PCD1  (0 << 8)
+#define  PIXEL_CLK_DIVIDER_PCD1H (1 << 8)
+#define  PIXEL_CLK_DIVIDER_PCD2  (2 << 8)
+#define  PIXEL_CLK_DIVIDER_PCD3  (3 << 8)
+#define  PIXEL_CLK_DIVIDER_PCD4  (4 << 8)
+#define  PIXEL_CLK_DIVIDER_PCD6  (5 << 8)
+#define  PIXEL_CLK_DIVIDER_PCD8  (6 << 8)
+#define  PIXEL_CLK_DIVIDER_PCD9  (7 << 8)
+#define  PIXEL_CLK_DIVIDER_PCD12 (8 << 8)
+#define  PIXEL_CLK_DIVIDER_PCD16 (9 << 8)
+#define  PIXEL_CLK_DIVIDER_PCD18 (10 << 8)
+#define  PIXEL_CLK_DIVIDER_PCD24 (11 << 8)
+#define  PIXEL_CLK_DIVIDER_PCD13 (12 << 8)
+#define  SHIFT_CLK_DIVIDER(x)    ((x) & 0xff)
+
+#define DC_DISP_DISP_INTERFACE_CONTROL 0x42F
+#define  DISP_DATA_FORMAT_DF1P1C    (0 << 0)
+#define  DISP_DATA_FORMAT_DF1P2C24B (1 << 0)
+#define  DISP_DATA_FORMAT_DF1P2C18B (2 << 0)
+#define  DISP_DATA_FORMAT_DF1P2C16B (3 << 0)
+#define  DISP_DATA_FORMAT_DF2S      (4 << 0)
+#define  DISP_DATA_FORMAT_DF3S      (5 << 0)
+#define  DISP_DATA_FORMAT_DFSPI     (6 << 0)
+#define  DISP_DATA_FORMAT_DF1P3C24B (7 << 0)
+#define  DISP_DATA_FORMAT_DF1P3C18B (8 << 0)
+#define  DISP_ALIGNMENT_MSB         (0 << 8)
+#define  DISP_ALIGNMENT_LSB         (1 << 8)
+#define  DISP_ORDER_RED_BLUE        (0 << 9)
+#define  DISP_ORDER_BLUE_RED        (1 << 9)
+
+#define DC_DISP_DISP_COLOR_CONTROL 0x430
+#define  DITHER_CONTROL_MASK    (3 << 8)
+#define  DITHER_CONTROL_DISABLE (0 << 8)
+#define  DITHER_CONTROL_ORDERED (2 << 8)
+#define  DITHER_CONTROL_ERRDIFF (3 << 8)
+#define  BASE_COLOR_SIZE_MASK   (0xf << 0)
+#define  BASE_COLOR_SIZE_666    (0 << 0)
+#define  BASE_COLOR_SIZE_111    (1 << 0)
+#define  BASE_COLOR_SIZE_222    (2 << 0)
+#define  BASE_COLOR_SIZE_333    (3 << 0)
+#define  BASE_COLOR_SIZE_444    (4 << 0)
+#define  BASE_COLOR_SIZE_555    (5 << 0)
+#define  BASE_COLOR_SIZE_565    (6 << 0)
+#define  BASE_COLOR_SIZE_332    (7 << 0)
+#define  BASE_COLOR_SIZE_888    (8 << 0)
+
+#define DC_DISP_SHIFT_CLOCK_OPTIONS 0x431
+#define  SC1_H_QUALIFIER_NONE	(1 << 16)
+#define  SC0_H_QUALIFIER_NONE	(1 <<  0)
+
+#define DC_DISP_DATA_ENABLE_OPTIONS 0x432
+#define  DE_SELECT_ACTIVE_BLANK  (0 << 0)
+#define  DE_SELECT_ACTIVE        (1 << 0)
+#define  DE_SELECT_ACTIVE_IS     (2 << 0)
+#define  DE_CONTROL_ONECLK       (0 << 2)
+#define  DE_CONTROL_NORMAL       (1 << 2)
+#define  DE_CONTROL_EARLY_EXT    (2 << 2)
+#define  DE_CONTROL_EARLY        (3 << 2)
+#define  DE_CONTROL_ACTIVE_BLANK (4 << 2)
+
+#define DC_DISP_DC_MCCIF_FIFOCTRL 0x480
+#define DC_DISP_SD_BL_PARAMETERS 0x4D7
+#define DC_DISP_SD_BL_CONTROL 0x4DC
+#define DC_DISP_BLEND_BACKGROUND_COLOR 0x4E4
+
+#define DC_WIN_CSC_YOF 0x611
+#define DC_WIN_CSC_KYRGB 0x612
+#define DC_WIN_CSC_KUR 0x613
+#define DC_WIN_CSC_KVR 0x614
+#define DC_WIN_CSC_KUG 0x615
+#define DC_WIN_CSC_KVG 0x616
+#define DC_WIN_CSC_KUB 0x617
+#define DC_WIN_CSC_KVB 0x618
+#define DC_WIN_AD_WIN_OPTIONS 0xB80
+#define DC_WIN_BD_WIN_OPTIONS 0xD80
+#define DC_WIN_CD_WIN_OPTIONS 0xF80
+
+// The following registers are A/B/C shadows of the 0xB80/0xD80/0xF80 registers (see DISPLAY_WINDOW_HEADER).
+#define DC_WIN_WIN_OPTIONS 0x700
+#define  H_DIRECTION  (1 <<  0)
+#define  V_DIRECTION  (1 <<  2)
+#define  SCAN_COLUMN  (1 <<  4)
+#define  COLOR_EXPAND (1 <<  6)
+#define  CSC_ENABLE   (1 << 18)
+#define  WIN_ENABLE   (1 << 30)
+
+#define DC_WIN_COLOR_DEPTH 0x703
+#define  WIN_COLOR_DEPTH_P1             0x0
+#define  WIN_COLOR_DEPTH_P2             0x1
+#define  WIN_COLOR_DEPTH_P4             0x2
+#define  WIN_COLOR_DEPTH_P8             0x3
+#define  WIN_COLOR_DEPTH_B4G4R4A4       0x4
+#define  WIN_COLOR_DEPTH_B5G5R5A        0x5
+#define  WIN_COLOR_DEPTH_B5G6R5         0x6
+#define  WIN_COLOR_DEPTH_AB5G5R5        0x7
+#define  WIN_COLOR_DEPTH_B8G8R8A8       0xC
+#define  WIN_COLOR_DEPTH_R8G8B8A8       0xD
+#define  WIN_COLOR_DEPTH_B6x2G6x2R6x2A8 0xE
+#define  WIN_COLOR_DEPTH_R6x2G6x2B6x2A8 0xF
+#define  WIN_COLOR_DEPTH_YCbCr422       0x10
+#define  WIN_COLOR_DEPTH_YUV422         0x11
+#define  WIN_COLOR_DEPTH_YCbCr420P      0x12
+#define  WIN_COLOR_DEPTH_YUV420P        0x13
+#define  WIN_COLOR_DEPTH_YCbCr422P      0x14
+#define  WIN_COLOR_DEPTH_YUV422P        0x15
+#define  WIN_COLOR_DEPTH_YCbCr422R      0x16
+#define  WIN_COLOR_DEPTH_YUV422R        0x17
+#define  WIN_COLOR_DEPTH_YCbCr422RA     0x18
+#define  WIN_COLOR_DEPTH_YUV422RA       0x19
+
+#define DC_WIN_BUFFER_CONTROL 0x702
+#define DC_WIN_POSITION 0x704
+
+#define DC_WIN_SIZE 0x705
+#define  H_SIZE(x) (((x) & 0x1fff) <<  0)
+#define  V_SIZE(x) (((x) & 0x1fff) << 16)
+
+#define DC_WIN_PRESCALED_SIZE 0x706
+#define  H_PRESCALED_SIZE(x) (((x) & 0x7fff) <<  0)
+#define  V_PRESCALED_SIZE(x) (((x) & 0x1fff) << 16)
+
+#define DC_WIN_H_INITIAL_DDA 0x707
+#define DC_WIN_V_INITIAL_DDA 0x708
+
+#define DC_WIN_DDA_INC 0x709
+#define  H_DDA_INC(x) (((x) & 0xffff) <<  0)
+#define  V_DDA_INC(x) (((x) & 0xffff) << 16)
+
+#define DC_WIN_LINE_STRIDE 0x70A
+#define  LINE_STRIDE(x)	   (x)
+#define  UV_LINE_STRIDE(x) (((x) & 0xffff) << 16)
+#define DC_WIN_DV_CONTROL 0x70E
+
+// The following registers are A/B/C shadows of the 0xBC0/0xDC0/0xFC0 registers (see DISPLAY_WINDOW_HEADER).
+#define DC_WINBUF_START_ADDR 0x800
+#define DC_WINBUF_ADDR_H_OFFSET 0x806
+#define DC_WINBUF_ADDR_V_OFFSET 0x808
+#define DC_WINBUF_SURFACE_KIND 0x80B
+#define  PITCH	(0 << 0)
+#define  TILED	(1 << 0)
+#define  BLOCK	(2 << 0)
+#define  BLOCK_HEIGHT(x) (((x) & 0x7) << 4)
+
+/*! Display serial interface registers. */
+#define _DSIREG(reg) ((reg) * 4)
+
+#define DSI_RD_DATA 0x9
+#define DSI_WR_DATA 0xA
+
+#define DSI_POWER_CONTROL 0xB
+#define  DSI_POWER_CONTROL_ENABLE 1
+
+#define DSI_INT_ENABLE 0xC
+#define DSI_INT_STATUS 0xD
+#define DSI_INT_MASK 0xE
+
+#define DSI_HOST_CONTROL 0xF
+#define  DSI_HOST_CONTROL_FIFO_RESET   (1 << 21)
+#define  DSI_HOST_CONTROL_CRC_RESET    (1 << 20)
+#define  DSI_HOST_CONTROL_TX_TRIG_SOL  (0 << 12)
+#define  DSI_HOST_CONTROL_TX_TRIG_FIFO (1 << 12)
+#define  DSI_HOST_CONTROL_TX_TRIG_HOST (2 << 12)
+#define  DSI_HOST_CONTROL_RAW          (1 << 6)
+#define  DSI_HOST_CONTROL_HS           (1 << 5)
+#define  DSI_HOST_CONTROL_FIFO_SEL     (1 << 4)
+#define  DSI_HOST_CONTROL_IMM_BTA      (1 << 3)
+#define  DSI_HOST_CONTROL_PKT_BTA      (1 << 2)
+#define  DSI_HOST_CONTROL_CS           (1 << 1)
+#define  DSI_HOST_CONTROL_ECC          (1 << 0)
+
+#define DSI_CONTROL 0x10
+#define  DSI_CONTROL_HS_CLK_CTRL  (1 << 20)
+#define  DSI_CONTROL_CHANNEL(c)   (((c) & 0x3) << 16)
+#define  DSI_CONTROL_FORMAT(f)    (((f) & 0x3) << 12)
+#define  DSI_CONTROL_TX_TRIG(x)   (((x) & 0x3) <<  8)
+#define  DSI_CONTROL_LANES(n)     (((n) & 0x3) <<  4)
+#define  DSI_CONTROL_DCS_ENABLE   (1 << 3)
+#define  DSI_CONTROL_SOURCE(s)    (((s) & 0x1) <<  2)
+#define  DSI_CONTROL_VIDEO_ENABLE (1 << 1)
+#define  DSI_CONTROL_HOST_ENABLE  (1 << 0)
+
+#define DSI_SOL_DELAY 0x11
+#define DSI_MAX_THRESHOLD 0x12
+
+#define DSI_TRIGGER 0x13
+#define  DSI_TRIGGER_HOST  (1 << 1)
+#define  DSI_TRIGGER_VIDEO (1 << 0)
+
+#define DSI_TX_CRC 0x14
+#define DSI_STATUS 0x15
+#define DSI_INIT_SEQ_CONTROL 0x1A
+#define DSI_INIT_SEQ_DATA_0 0x1B
+#define DSI_INIT_SEQ_DATA_1 0x1C
+#define DSI_INIT_SEQ_DATA_2 0x1D
+#define DSI_INIT_SEQ_DATA_3 0x1E
+#define DSI_PKT_SEQ_0_LO 0x23
+#define DSI_PKT_SEQ_0_HI 0x24
+#define DSI_PKT_SEQ_1_LO 0x25
+#define DSI_PKT_SEQ_1_HI 0x26
+#define DSI_PKT_SEQ_2_LO 0x27
+#define DSI_PKT_SEQ_2_HI 0x28
+#define DSI_PKT_SEQ_3_LO 0x29
+#define DSI_PKT_SEQ_3_HI 0x2A
+#define DSI_PKT_SEQ_4_LO 0x2B
+#define DSI_PKT_SEQ_4_HI 0x2C
+#define DSI_PKT_SEQ_5_LO 0x2D
+#define DSI_PKT_SEQ_5_HI 0x2E
+#define DSI_DCS_CMDS 0x33
+#define DSI_PKT_LEN_0_1 0x34
+#define DSI_PKT_LEN_2_3 0x35
+#define DSI_PKT_LEN_4_5 0x36
+#define DSI_PKT_LEN_6_7 0x37
+#define DSI_PHY_TIMING_0 0x3C
+#define DSI_PHY_TIMING_1 0x3D
+#define DSI_PHY_TIMING_2 0x3E
+#define DSI_BTA_TIMING 0x3F
+
+#define DSI_TIMEOUT_0 0x44
+#define  DSI_TIMEOUT_LRX(x) (((x) & 0xffff) << 16)
+#define  DSI_TIMEOUT_HTX(x) (((x) & 0xffff) <<  0)
+
+#define DSI_TIMEOUT_1 0x45
+#define  DSI_TIMEOUT_PR(x) (((x) & 0xffff) << 16)
+#define  DSI_TIMEOUT_TA(x) (((x) & 0xffff) <<  0)
+
+#define DSI_TO_TALLY 0x46
+
+#define DSI_PAD_CONTROL_0 0x4B
+#define  DSI_PAD_CONTROL_VS1_PULLDN_CLK (1 << 24)
+#define  DSI_PAD_CONTROL_VS1_PULLDN(x)  (((x) & 0xf) << 16)
+#define  DSI_PAD_CONTROL_VS1_PDIO_CLK   (1 <<  8)
+#define  DSI_PAD_CONTROL_VS1_PDIO(x)    (((x) & 0xf) <<  0)
+
+#define DSI_PAD_CONTROL_CD 0x4c
+#define DSI_VIDEO_MODE_CONTROL 0x4E
+
+#define DSI_PAD_CONTROL_1 0x4F
+#define DSI_PAD_CONTROL_2 0x50
+
+#define DSI_PAD_CONTROL_3 0x51
+#define  DSI_PAD_PREEMP_PD_CLK(x) (((x) & 0x3) << 12)
+#define  DSI_PAD_PREEMP_PU_CLK(x) (((x) & 0x3) << 8)
+#define  DSI_PAD_PREEMP_PD(x)     (((x) & 0x3) << 4)
+#define  DSI_PAD_PREEMP_PU(x)     (((x) & 0x3) << 0)
+
+#define DSI_PAD_CONTROL_4 0x52
+#define DSI_PAD_CONTROL_5_MARIKO 0x53
+#define DSI_PAD_CONTROL_6_MARIKO 0x54
+#define DSI_PAD_CONTROL_7_MARIKO 0x55
+#define DSI_INIT_SEQ_DATA_15 0x5F
+
+#define MIPI_CAL_MIPI_BIAS_PAD_CFG2 0x60
+#define DSI_INIT_SEQ_DATA_15_MARIKO 0x62

stratosphere/boot/source/boot_registers_gpio.hpp

@@ -0,0 +1,28 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+static constexpr size_t GPIO_PORT3_CNF_0 = 0x200;
+static constexpr size_t GPIO_PORT3_OE_0  = 0x210;
+static constexpr size_t GPIO_PORT3_OUT_0 = 0x220;
+
+static constexpr size_t GPIO_PORT6_CNF_1 = 0x504;
+static constexpr size_t GPIO_PORT6_OE_1  = 0x514;
+static constexpr size_t GPIO_PORT6_OUT_1 = 0x524;

stratosphere/boot/source/boot_registers_pinmux.hpp

@@ -0,0 +1,75 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+static constexpr size_t APB_MISC_GP_SDMMC1_CLK_LPBK_CONTROL = 0x8D4;
+static constexpr size_t APB_MISC_GP_SDMMC3_CLK_LPBK_CONTROL = 0x8D8;
+static constexpr size_t APB_MISC_GP_SDMMC1_PAD_CFGPADCTRL   = 0xA98;
+static constexpr size_t APB_MISC_GP_VGPIO_GPIO_MUX_SEL      = 0xB74;
+
+static constexpr size_t PINMUX_AUX_SDMMC1_CLK  = 0x00;
+static constexpr size_t PINMUX_AUX_SDMMC1_CMD  = 0x04;
+static constexpr size_t PINMUX_AUX_SDMMC1_DAT3 = 0x08;
+static constexpr size_t PINMUX_AUX_SDMMC1_DAT2 = 0x0C;
+static constexpr size_t PINMUX_AUX_SDMMC1_DAT1 = 0x10;
+static constexpr size_t PINMUX_AUX_SDMMC1_DAT0 = 0x14;
+static constexpr size_t PINMUX_AUX_SDMMC3_CLK  = 0x1C;
+static constexpr size_t PINMUX_AUX_SDMMC3_CMD  = 0x20;
+static constexpr size_t PINMUX_AUX_SDMMC3_DAT0 = 0x24;
+static constexpr size_t PINMUX_AUX_SDMMC3_DAT1 = 0x28;
+static constexpr size_t PINMUX_AUX_SDMMC3_DAT2 = 0x2C;
+static constexpr size_t PINMUX_AUX_SDMMC3_DAT3 = 0x30;
+static constexpr size_t PINMUX_AUX_DMIC3_CLK   = 0xB4;
+static constexpr size_t PINMUX_AUX_UART2_TX    = 0xF4;
+static constexpr size_t PINMUX_AUX_UART3_TX    = 0x104;
+static constexpr size_t PINMUX_AUX_WIFI_EN     = 0x1B4;
+static constexpr size_t PINMUX_AUX_WIFI_RST    = 0x1B8;
+static constexpr size_t PINMUX_AUX_NFC_EN      = 0x1D0;
+static constexpr size_t PINMUX_AUX_NFC_INT     = 0x1D4;
+static constexpr size_t PINMUX_AUX_LCD_BL_PWM  = 0x1FC;
+static constexpr size_t PINMUX_AUX_LCD_BL_EN   = 0x200;
+static constexpr size_t PINMUX_AUX_LCD_RST     = 0x204;
+static constexpr size_t PINMUX_AUX_GPIO_PE6    = 0x248;
+static constexpr size_t PINMUX_AUX_GPIO_PH6    = 0x250;
+static constexpr size_t PINMUX_AUX_GPIO_PZ1    = 0x280;
+
+static constexpr u32 PINMUX_FUNC_MASK    = (3 << 0);
+
+static constexpr u32 PINMUX_PULL_MASK    = (3 << 2);
+static constexpr u32 PINMUX_PULL_NONE    = (0 << 2);
+static constexpr u32 PINMUX_PULL_DOWN    = (1 << 2);
+static constexpr u32 PINMUX_PULL_UP      = (2 << 2);
+
+static constexpr u32 PINMUX_TRISTATE     = (1 << 4);
+static constexpr u32 PINMUX_PARKED       = (1 << 5);
+static constexpr u32 PINMUX_INPUT_ENABLE = (1 << 6);
+static constexpr u32 PINMUX_LOCK         = (1 << 7);
+static constexpr u32 PINMUX_LPDR         = (1 << 8);
+static constexpr u32 PINMUX_HSM          = (1 << 9);
+
+static constexpr u32 PINMUX_IO_HV        = (1 << 10);
+static constexpr u32 PINMUX_OPEN_DRAIN   = (1 << 11);
+static constexpr u32 PINMUX_SCHMT        = (1 << 12);
+
+static constexpr u32 PINMUX_DRIVE_1X     = (0 << 13) ;
+static constexpr u32 PINMUX_DRIVE_2X     = (1 << 13);
+static constexpr u32 PINMUX_DRIVE_3X     = (2 << 13);
+static constexpr u32 PINMUX_DRIVE_4X     = (3 << 13);
+

stratosphere/boot/source/boot_registers_pmc.hpp

@@ -0,0 +1,81 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+static constexpr uintptr_t PmcBase = 0x7000E400ul;
+
+static constexpr size_t APBDEV_PMC_CNTRL = 0x0;
+static constexpr u32 PMC_CNTRL_MAIN_RST = (1 << 4);
+static constexpr size_t APBDEV_PMC_SEC_DISABLE = 0x4;
+static constexpr size_t APBDEV_PMC_WAKE_MASK = 0xC;
+static constexpr size_t APBDEV_PMC_WAKE_LVL = 0x10;
+static constexpr size_t APBDEV_PMC_DPD_PADS_ORIDE = 0x1C;
+static constexpr size_t APBDEV_PMC_PWRGATE_TOGGLE = 0x30;
+static constexpr size_t APBDEV_PMC_PWRGATE_STATUS = 0x38;
+static constexpr size_t APBDEV_PMC_BLINK_TIMER = 0x40;
+static constexpr size_t APBDEV_PMC_NO_IOPOWER = 0x44;
+static constexpr size_t APBDEV_PMC_SCRATCH0 = 0x50;
+static constexpr size_t APBDEV_PMC_SCRATCH1 = 0x54;
+static constexpr size_t APBDEV_PMC_SCRATCH20 = 0xA0;
+static constexpr size_t APBDEV_PMC_AUTO_WAKE_LVL_MASK = 0xDC;
+static constexpr size_t APBDEV_PMC_PWR_DET_VAL = 0xE4;
+static constexpr u32 PMC_PWR_DET_SDMMC1_IO_EN = (1 << 12);
+static constexpr size_t APBDEV_PMC_DDR_PWR = 0xE8;
+static constexpr size_t APBDEV_PMC_CRYPTO_OP = 0xF4;
+static constexpr u32 PMC_CRYPTO_OP_SE_ENABLE  = 0;
+static constexpr u32 PMC_CRYPTO_OP_SE_DISABLE = 1;
+static constexpr size_t APBDEV_PMC_SCRATCH33 = 0x120;
+static constexpr size_t APBDEV_PMC_SCRATCH40 = 0x13C;
+static constexpr size_t APBDEV_PMC_WAKE2_MASK = 0x160;
+static constexpr size_t APBDEV_PMC_WAKE2_LVL = 0x164;
+static constexpr size_t APBDEV_PMC_AUTO_WAKE2_LVL_MASK = 0x170;
+static constexpr size_t APBDEV_PMC_OSC_EDPD_OVER = 0x1A4;
+static constexpr size_t APBDEV_PMC_CLK_OUT_CNTRL = 0x1A8;
+static constexpr size_t APBDEV_PMC_RST_STATUS = 0x1B4;
+static constexpr size_t APBDEV_PMC_IO_DPD_REQ = 0x1B8;
+static constexpr size_t APBDEV_PMC_IO_DPD2_REQ = 0x1C0;
+static constexpr size_t APBDEV_PMC_VDDP_SEL = 0x1CC;
+static constexpr size_t APBDEV_PMC_DDR_CFG = 0x1D0;
+static constexpr size_t APBDEV_PMC_SCRATCH45 = 0x234;
+static constexpr size_t APBDEV_PMC_SCRATCH46 = 0x238;
+static constexpr size_t APBDEV_PMC_SCRATCH49 = 0x244;
+static constexpr size_t APBDEV_PMC_TSC_MULT = 0x2B4;
+static constexpr size_t APBDEV_PMC_SEC_DISABLE2 = 0x2C4;
+static constexpr size_t APBDEV_PMC_WEAK_BIAS = 0x2C8;
+static constexpr size_t APBDEV_PMC_REG_SHORT = 0x2CC;
+static constexpr size_t APBDEV_PMC_SEC_DISABLE3 = 0x2D8;
+static constexpr size_t APBDEV_PMC_SECURE_SCRATCH21 = 0x334;
+static constexpr size_t APBDEV_PMC_SECURE_SCRATCH32 = 0x360;
+static constexpr size_t APBDEV_PMC_SECURE_SCRATCH49 = 0x3A4;
+static constexpr size_t APBDEV_PMC_CNTRL2 = 0x440;
+static constexpr size_t APBDEV_PMC_IO_DPD3_REQ = 0x45C;
+static constexpr size_t APBDEV_PMC_IO_DPD4_REQ = 0x464;
+static constexpr size_t APBDEV_PMC_UTMIP_PAD_CFG1 = 0x4C4;
+static constexpr size_t APBDEV_PMC_UTMIP_PAD_CFG3 = 0x4CC;
+static constexpr size_t APBDEV_PMC_WAKE_DEBOUNCE_EN = 0x4D8;
+static constexpr size_t APBDEV_PMC_DDR_CNTRL = 0x4E4;
+static constexpr size_t APBDEV_PMC_SEC_DISABLE4 = 0x5B0;
+static constexpr size_t APBDEV_PMC_SEC_DISABLE5 = 0x5B4;
+static constexpr size_t APBDEV_PMC_SEC_DISABLE6 = 0x5B8;
+static constexpr size_t APBDEV_PMC_SEC_DISABLE7 = 0x5BC;
+static constexpr size_t APBDEV_PMC_SEC_DISABLE8 = 0x5C0;
+static constexpr size_t APBDEV_PMC_SCRATCH188 = 0x810;
+static constexpr size_t APBDEV_PMC_SCRATCH190 = 0x818;
+static constexpr size_t APBDEV_PMC_SCRATCH200 = 0x840;

stratosphere/boot/source/boot_repair_boot_images.cpp

@@ -0,0 +1,31 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+#include "updater/updater_api.hpp"
+
+static u8 __attribute__((__aligned__(0x1000))) g_boot_image_work_buffer[0x10000];
+
+void Boot::CheckAndRepairBootImages() {
+    const BootImageUpdateType boot_image_update_type = Updater::GetBootImageUpdateType(Boot::GetHardwareType());
+
+    bool repaired_normal, repaired_safe;
+    Result rc = Updater::VerifyBootImagesAndRepairIfNeeded(&repaired_normal, &repaired_safe, g_boot_image_work_buffer, sizeof(g_boot_image_work_buffer), boot_image_update_type);
+    if (R_SUCCEEDED(rc) && repaired_normal) {
+        /* Nintendo only performs a reboot on successful normal repair. */
+        Boot::RebootSystem();
+    }
+}

stratosphere/boot/source/boot_rtc_driver.cpp

@@ -0,0 +1,41 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include <switch.h>
+#include <stratosphere.hpp>
+#include "boot_functions.hpp"
+#include "boot_rtc_driver.hpp"
+
+Result RtcDriver::ReadRtcRegister(u8 *out, u8 address) {
+    const u8 update_addr = 0x04;
+    const u8 update_val = 0x10;
+    Result rc = Boot::WriteI2cRegister(this->i2c_session, &update_val, sizeof(update_val), &update_addr, sizeof(update_addr));
+    if (R_FAILED(rc)) {
+        return rc;
+    }
+    svcSleepThread(16'000'000ul);
+    return Boot::ReadI2cRegister(this->i2c_session, out, sizeof(*out), &address, sizeof(address));
+}
+
+Result RtcDriver::GetRtcIntr(u8 *out) {
+    const u8 addr = 0x00;
+    return Boot::ReadI2cRegister(this->i2c_session, out, sizeof(*out), &addr, sizeof(addr));
+}
+
+Result RtcDriver::GetRtcIntrM(u8 *out) {
+    const u8 addr = 0x01;
+    return this->ReadRtcRegister(out, addr);
+}

stratosphere/boot/source/boot_rtc_driver.hpp

@@ -0,0 +1,41 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+#include <stratosphere.hpp>
+
+#include "i2c_driver/i2c_api.hpp"
+
+class RtcDriver {
+    private:
+        I2cSessionImpl i2c_session;
+    public:
+        RtcDriver() {
+            I2cDriver::Initialize();
+            I2cDriver::OpenSession(&this->i2c_session, I2cDevice_Max77620Rtc);
+        }
+
+        ~RtcDriver() {
+            I2cDriver::CloseSession(this->i2c_session);
+            I2cDriver::Finalize();
+        }
+    private:
+        Result ReadRtcRegister(u8 *out, u8 address);
+    public:
+        Result GetRtcIntr(u8 *out);
+        Result GetRtcIntrM(u8 *out);
+};

stratosphere/boot/source/boot_spl_utils.cpp

@@ -0,0 +1,47 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+
+HardwareType Boot::GetHardwareType() {
+    u64 out_val = 0;
+    if (R_FAILED(splGetConfig(SplConfigItem_HardwareType, &out_val))) {
+        std::abort();
+    }
+    return static_cast<HardwareType>(out_val);
+}
+
+bool Boot::IsRecoveryBoot() {
+    u64 val = 0;
+    if (R_FAILED(splGetConfig(SplConfigItem_IsRecoveryBoot, &val))) {
+        std::abort();
+    }
+    return val != 0;
+}
+
+bool Boot::IsMariko() {
+    HardwareType hw_type = GetHardwareType();
+    switch (hw_type) {
+        case HardwareType_Icosa:
+        case HardwareType_Copper:
+            return false;
+        case HardwareType_Hoag:
+        case HardwareType_Iowa:
+            return true;
+        default:
+            std::abort();
+    }
+}

stratosphere/boot/source/boot_splash_screen.cpp

@@ -0,0 +1,34 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+#include "boot_splash_screen_notext.hpp"
+/* TODO: Compile-time switch for splash_screen_text.hpp? */
+
+void Boot::ShowSplashScreen() {
+    const u32 boot_reason = Boot::GetBootReason();
+    if (boot_reason == 1 || boot_reason == 4) {
+        return;
+    }
+
+    Boot::InitializeDisplay();
+    {
+        /* Splash screen is shown for 2 seconds. */
+        Boot::ShowDisplay(SplashScreenX, SplashScreenY, SplashScreenW, SplashScreenH, SplashScreen);
+        svcSleepThread(2'000'000'000ul);
+    }
+    Boot::FinalizeDisplay();
+}

stratosphere/boot/source/boot_types.hpp

@@ -0,0 +1,44 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+#include <stratosphere.hpp>
+
+enum HardwareType {
+    HardwareType_Icosa = 0,
+    HardwareType_Copper = 1,
+    HardwareType_Hoag = 2,
+    HardwareType_Iowa = 3,
+};
+
+struct GpioInitialConfig {
+    u32 pad_name;
+    GpioDirection direction;
+    GpioValue value;
+};
+
+struct PinmuxInitialConfig {
+    u32 name;
+    u32 val;
+    u32 mask;
+};
+
+struct WakePinConfig {
+    u32 index;
+    bool enabled;
+    u32 level;
+};

stratosphere/boot/source/boot_wake_control_configs.hpp

@@ -0,0 +1,41 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+#include "boot_registers_pmc.hpp"
+
+struct WakeControlConfig {
+    u32 reg_offset;
+    u32 mask_val;
+    bool flag_val;
+};
+
+static constexpr WakeControlConfig WakeControlConfigs[] = {
+    {APBDEV_PMC_CNTRL, 0x0800, true},
+    {APBDEV_PMC_CNTRL, 0x0400, false},
+    {APBDEV_PMC_CNTRL, 0x0200, true},
+    {APBDEV_PMC_CNTRL, 0x0100, false},
+    {APBDEV_PMC_CNTRL, 0x0040, false},
+    {APBDEV_PMC_CNTRL, 0x0020, false},
+    {APBDEV_PMC_CNTRL2, 0x4000, true},
+    {APBDEV_PMC_CNTRL2, 0x0200, false},
+    {APBDEV_PMC_CNTRL2, 0x0001, true},
+};
+
+static constexpr size_t NumWakeControlConfigs = sizeof(WakeControlConfigs) / sizeof(WakeControlConfigs[0]);

stratosphere/boot/source/boot_wake_pin_configuration.hpp

@@ -0,0 +1,74 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+static constexpr WakePinConfig WakePinConfigs[] = {
+    {0x00, false, 0x02},
+    {0x01, false, 0x02},
+    {0x02, false, 0x02},
+    {0x03, false, 0x02},
+    {0x04, true,  0x02},
+    {0x05, false, 0x02},
+    {0x06, true,  0x02},
+    {0x07, true,  0x02},
+    {0x08, false, 0x01},
+    {0x0A, true,  0x02},
+    {0x0B, false, 0x02},
+    {0x0C, false, 0x02},
+    {0x0D, false, 0x02},
+    {0x0E, true,  0x00},
+    {0x0F, false, 0x02},
+    {0x11, false, 0x02},
+    {0x12, false, 0x02},
+    {0x13, false, 0x02},
+    {0x14, false, 0x02},
+    {0x15, false, 0x02},
+    {0x16, false, 0x02},
+    {0x17, false, 0x02},
+    {0x18, false, 0x02},
+    {0x19, false, 0x02},
+    {0x1A, false, 0x02},
+    {0x1B, true,  0x00},
+    {0x1C, false, 0x02},
+    {0x21, false, 0x02},
+    {0x22, true,  0x00},
+    {0x23, true,  0x02},
+    {0x24, false, 0x02},
+    {0x2D, false, 0x02},
+    {0x2E, false, 0x02},
+    {0x2F, false, 0x02},
+    {0x30, true,  0x02},
+    {0x31, false, 0x02},
+    {0x32, false, 0x02},
+    {0x33, true,  0x00},
+    {0x34, true,  0x00},
+    {0x35, false, 0x02},
+    {0x36, false, 0x02},
+    {0x37, false, 0x02},
+    {0x38, false, 0x02},
+    {0x39, false, 0x02},
+    {0x3A, false, 0x02},
+    {0x3B, false, 0x02},
+    {0x3D, false, 0x02},
+    {0x3E, false, 0x02},
+    {0x3F, false, 0x02},
+};
+
+static constexpr size_t NumWakePinConfigs = sizeof(WakePinConfigs) / sizeof(WakePinConfigs[0]);

stratosphere/boot/source/boot_wake_pin_configuration_copper.hpp

@@ -0,0 +1,74 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+
+#include "boot_types.hpp"
+
+static constexpr WakePinConfig WakePinConfigsCopper[] = {
+    {0x00, true,  0x02},
+    {0x01, false, 0x02},
+    {0x02, false, 0x02},
+    {0x03, true,  0x02},
+    {0x04, false, 0x02},
+    {0x05, true,  0x02},
+    {0x06, false, 0x02},
+    {0x07, false, 0x02},
+    {0x08, true,  0x02},
+    {0x0A, false, 0x02},
+    {0x0B, false, 0x02},
+    {0x0C, false, 0x02},
+    {0x0D, false, 0x02},
+    {0x0E, true,  0x00},
+    {0x0F, false, 0x02},
+    {0x11, false, 0x02},
+    {0x12, false, 0x02},
+    {0x13, false, 0x02},
+    {0x14, false, 0x02},
+    {0x15, false, 0x02},
+    {0x16, false, 0x02},
+    {0x17, false, 0x02},
+    {0x18, true,  0x02},
+    {0x19, false, 0x02},
+    {0x1A, false, 0x02},
+    {0x1B, false, 0x00},
+    {0x1C, false, 0x02},
+    {0x21, false, 0x02},
+    {0x22, false, 0x00},
+    {0x23, false, 0x02},
+    {0x24, false, 0x02},
+    {0x2D, false, 0x02},
+    {0x2E, false, 0x02},
+    {0x2F, true,  0x02},
+    {0x30, true,  0x02},
+    {0x31, false, 0x02},
+    {0x32, true,  0x02},
+    {0x33, true,  0x00},
+    {0x34, true,  0x00},
+    {0x35, false, 0x02},
+    {0x36, false, 0x02},
+    {0x37, false, 0x02},
+    {0x38, false, 0x02},
+    {0x39, false, 0x02},
+    {0x3A, false, 0x02},
+    {0x3B, false, 0x02},
+    {0x3D, false, 0x02},
+    {0x3E, false, 0x02},
+    {0x3F, false, 0x02},
+};
+
+static constexpr size_t NumWakePinConfigsCopper = sizeof(WakePinConfigsCopper) / sizeof(WakePinConfigsCopper[0]);

stratosphere/boot/source/boot_wake_pins.cpp

@@ -0,0 +1,88 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include "boot_functions.hpp"
+#include "boot_registers_pmc.hpp"
+#include "boot_wake_control_configs.hpp"
+#include "boot_wake_pin_configuration.hpp"
+#include "boot_wake_pin_configuration_copper.hpp"
+
+static void UpdatePmcControlBit(const u32 reg_offset, const u32 mask_val, const bool flag) {
+    Boot::WritePmcRegister(PmcBase + reg_offset, flag ? UINT32_MAX : 0, mask_val);
+    Boot::ReadPmcRegister(PmcBase + reg_offset);
+}
+
+static void InitializePmcWakeConfiguration(const bool is_blink) {
+    /* Initialize APBDEV_PMC_WAKE_DEBOUNCE_EN, do a dummy read. */
+    Boot::WritePmcRegister(PmcBase + APBDEV_PMC_WAKE_DEBOUNCE_EN, 0);
+    Boot::ReadPmcRegister(PmcBase + APBDEV_PMC_WAKE_DEBOUNCE_EN);
+
+    /* Initialize APBDEV_PMC_BLINK_TIMER, do a dummy read. */
+    Boot::WritePmcRegister(PmcBase + APBDEV_PMC_BLINK_TIMER, 0x8008800);
+    Boot::ReadPmcRegister(PmcBase + APBDEV_PMC_BLINK_TIMER);
+
+    /* Set control bits, do dummy reads. */
+    for (size_t i = 0; i < NumWakeControlConfigs; i++) {
+        UpdatePmcControlBit(WakeControlConfigs[i].reg_offset, WakeControlConfigs[i].mask_val, WakeControlConfigs[i].flag_val);
+    }
+
+    /* Set bit 0x80 in APBDEV_PMC_CNTRL based on is_blink, do dummy read. */
+    UpdatePmcControlBit(APBDEV_PMC_CNTRL, 0x80, is_blink);
+
+    /* Set bit 0x100000 in APBDEV_PMC_DPD_PADS_ORIDE based on is_blink, do dummy read. */
+    UpdatePmcControlBit(APBDEV_PMC_DPD_PADS_ORIDE, 0x100000, is_blink);
+}
+
+void Boot::SetWakeEventLevel(u32 index, u32 level) {
+    u32 pmc_wake_level_reg_offset = index <= 0x1F ? APBDEV_PMC_WAKE_LVL : APBDEV_PMC_WAKE2_LVL;
+    u32 pmc_wake_level_mask_reg_offset = index <= 0x1F ? APBDEV_PMC_AUTO_WAKE_LVL_MASK : APBDEV_PMC_AUTO_WAKE2_LVL_MASK;
+    if (level != 2) {
+        std::swap(pmc_wake_level_reg_offset, pmc_wake_level_mask_reg_offset);
+    }
+
+    const u32 mask_val = (1 << (index & 0x1F));
+
+    /* Clear level reg bit. */
+    UpdatePmcControlBit(pmc_wake_level_reg_offset, mask_val, false);
+
+    /* Set or clear mask reg bit. */
+    UpdatePmcControlBit(pmc_wake_level_mask_reg_offset, mask_val, level > 0);
+}
+
+void Boot::SetWakeEventEnabled(u32 index, bool enabled) {
+    /* Set or clear enabled bit. */
+    UpdatePmcControlBit(index <= 0x1F ? APBDEV_PMC_WAKE_MASK : APBDEV_PMC_WAKE2_MASK, (1 << (index & 0x1F)), enabled);
+}
+
+void Boot::SetInitialWakePinConfiguration() {
+    InitializePmcWakeConfiguration(false);
+
+    /* Set wake event levels, wake event enables. */
+    const WakePinConfig *configs;
+    size_t num_configs;
+    if (Boot::GetHardwareType() == HardwareType_Copper) {
+        configs = WakePinConfigsCopper;
+        num_configs = NumWakePinConfigsCopper;
+    } else {
+        configs = WakePinConfigs;
+        num_configs = NumWakePinConfigs;
+    }
+
+    for (size_t i = 0; i < num_configs; i++) {
+        Boot::SetWakeEventLevel(configs[i].index, configs[i].level);
+        Boot::SetWakeEventEnabled(configs[i].index, configs[i].enabled);
+    }
+}

stratosphere/boot/source/i2c_driver/boot_pcv.cpp

@@ -0,0 +1,90 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include <switch.h>
+#include <stratosphere.hpp>
+
+#include "i2c_types.hpp"
+#include "i2c_registers.hpp"
+#include "boot_pcv.hpp"
+
+static I2cBus GetI2cBus(PcvModule module) {
+    switch (module) {
+        case PcvModule_I2C1:
+            return I2cBus_I2c1;
+        case PcvModule_I2C2:
+            return I2cBus_I2c2;
+        case PcvModule_I2C3:
+            return I2cBus_I2c3;
+        case PcvModule_I2C4:
+            return I2cBus_I2c4;
+        case PcvModule_I2C5:
+            return I2cBus_I2c5;
+        case PcvModule_I2C6:
+            return I2cBus_I2c6;
+        default:
+            std::abort();
+    }
+}
+
+void Pcv::Initialize() {
+    /* Don't do anything. */
+}
+
+void Pcv::Finalize() {
+    /* Don't do anything. */
+}
+
+Result Pcv::SetClockRate(PcvModule module, u32 hz) {
+    /* Get clock/reset registers. */
+    ClkRstRegisters regs;
+    regs.SetBus(GetI2cBus(module));
+    /* Set clock enabled/source. */
+    SetRegisterBits(regs.clk_en_reg, regs.mask);
+    ReadWriteRegisterBits(regs.clk_src_reg, 0x4, 0xFF);
+    svcSleepThread(1000ul);
+    ReadWriteRegisterBits(regs.clk_src_reg, 0, 0xE0000000);
+    svcSleepThread(2000ul);
+
+    return ResultSuccess;
+}
+
+Result Pcv::SetClockEnabled(PcvModule module, bool enabled) {
+    return ResultSuccess;
+}
+
+Result Pcv::SetVoltageEnabled(u32 domain, bool enabled) {
+    return ResultSuccess;
+}
+
+Result Pcv::SetVoltageValue(u32 domain, u32 voltage) {
+    return ResultSuccess;
+}
+
+Result Pcv::SetReset(PcvModule module, bool reset) {
+    /* Get clock/reset registers. */
+    ClkRstRegisters regs;
+    regs.SetBus(GetI2cBus(module));
+
+    /* Set/clear reset. */
+    if (reset) {
+        SetRegisterBits(regs.rst_reg, regs.mask);
+    } else {
+        ClearRegisterBits(regs.rst_reg, ~regs.mask);
+    }
+
+    return ResultSuccess;
+}

stratosphere/boot/source/i2c_driver/boot_pcv.hpp

@@ -0,0 +1,33 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+#include <stratosphere.hpp>
+
+/* pcv isn't alive at the time boot runs, but nn::i2c::driver needs nn::pcv. */
+/* These are the overrides N puts in boot. */
+
+class Pcv {
+    public:
+        static void Initialize();
+        static void Finalize();
+        static Result SetClockRate(PcvModule module, u32 hz);
+        static Result SetClockEnabled(PcvModule module, bool enabled);
+        static Result SetVoltageEnabled(u32 domain, bool enabled);
+        static Result SetVoltageValue(u32 domain, u32 voltage);
+        static Result SetReset(PcvModule module, bool reset);
+};

stratosphere/boot/source/i2c_driver/i2c_api.cpp

@@ -0,0 +1,182 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include <switch.h>
+#include <stratosphere.hpp>
+
+#include "i2c_api.hpp"
+#include "i2c_resource_manager.hpp"
+
+typedef Result (*CommandHandler)(const u8 **cur_cmd, u8 **cur_dst, I2cSessionImpl& session);
+
+static Result I2cSendHandler(const u8 **cur_cmd, u8 **cur_dst, I2cSessionImpl& session) {
+    I2cTransactionOption option = static_cast<I2cTransactionOption>(
+        (((**cur_cmd) & (1 << 6)) ? I2cTransactionOption_Start : 0) | (((**cur_cmd) & (1 << 7)) ? I2cTransactionOption_Stop : 0)
+    );
+    (*cur_cmd)++;
+
+    size_t num_bytes = (**cur_cmd);
+    (*cur_cmd)++;
+
+    Result rc = I2cDriver::Send(session, *cur_cmd, num_bytes, option);
+    if (R_FAILED(rc)) {
+        return rc;
+    }
+    (*cur_cmd) += num_bytes;
+
+    return ResultSuccess;
+}
+
+static Result I2cReceiveHandler(const u8 **cur_cmd, u8 **cur_dst, I2cSessionImpl& session) {
+    I2cTransactionOption option = static_cast<I2cTransactionOption>(
+        (((**cur_cmd) & (1 << 6)) ? I2cTransactionOption_Start : 0) | (((**cur_cmd) & (1 << 7)) ? I2cTransactionOption_Stop : 0)
+    );
+    (*cur_cmd)++;
+
+    size_t num_bytes = (**cur_cmd);
+    (*cur_cmd)++;
+
+    Result rc = I2cDriver::Receive(session, *cur_dst, num_bytes, option);
+    if (R_FAILED(rc)) {
+        return rc;
+    }
+    (*cur_dst) += num_bytes;
+
+    return ResultSuccess;
+}
+
+static Result I2cSubCommandHandler(const u8 **cur_cmd, u8 **cur_dst, I2cSessionImpl& session) {
+    const I2cSubCommand sub_cmd = static_cast<I2cSubCommand>((**cur_cmd) >> 2);
+    (*cur_cmd)++;
+
+    switch (sub_cmd) {
+        case I2cSubCommand_Sleep:
+            {
+                const size_t us = (**cur_cmd);
+                (*cur_cmd)++;
+                svcSleepThread(us * 1'000ul);
+            }
+            break;
+        default:
+            std::abort();
+    }
+    return ResultSuccess;
+}
+
+static constexpr CommandHandler g_cmd_handlers[I2cCommand_Count] = {
+    I2cSendHandler,
+    I2cReceiveHandler,
+    I2cSubCommandHandler,
+};
+
+static inline I2cResourceManager &GetResourceManager() {
+    return I2cResourceManager::GetInstance();
+}
+
+static inline void CheckInitialized() {
+    if (!GetResourceManager().IsInitialized()) {
+        std::abort();
+    }
+}
+
+void I2cDriver::Initialize() {
+    GetResourceManager().Initialize();
+}
+
+void I2cDriver::Finalize() {
+    GetResourceManager().Finalize();
+}
+
+void I2cDriver::OpenSession(I2cSessionImpl *out_session, I2cDevice device) {
+    CheckInitialized();
+    if (!IsI2cDeviceSupported(device)) {
+        std::abort();
+    }
+
+    const I2cBus bus = GetI2cDeviceBus(device);
+    const u32 slave_address = GetI2cDeviceSlaveAddress(device);
+    const AddressingMode addressing_mode = GetI2cDeviceAddressingMode(device);
+    const SpeedMode speed_mode = GetI2cDeviceSpeedMode(device);
+    const u32 max_retries = GetI2cDeviceMaxRetries(device);
+    const u64 retry_wait_time = GetI2cDeviceRetryWaitTime(device);
+    GetResourceManager().OpenSession(out_session, bus, slave_address, addressing_mode, speed_mode, max_retries, retry_wait_time);
+}
+
+void I2cDriver::CloseSession(I2cSessionImpl &session) {
+    CheckInitialized();
+    GetResourceManager().CloseSession(session);
+}
+
+Result I2cDriver::Send(I2cSessionImpl &session, const void *src, size_t size, I2cTransactionOption option) {
+    CheckInitialized();
+    if (src == nullptr || size == 0) {
+        std::abort();
+    }
+
+    std::scoped_lock<HosMutex &> lk(GetResourceManager().GetTransactionMutex(session.bus));
+    return GetResourceManager().GetSession(session.session_id).DoTransactionWithRetry(nullptr, src, size, option, DriverCommand_Send);
+}
+
+Result I2cDriver::Receive(I2cSessionImpl &session, void *dst, size_t size, I2cTransactionOption option) {
+    CheckInitialized();
+    if (dst == nullptr || size == 0) {
+        std::abort();
+    }
+
+    std::scoped_lock<HosMutex &> lk(GetResourceManager().GetTransactionMutex(session.bus));
+    return GetResourceManager().GetSession(session.session_id).DoTransactionWithRetry(dst, nullptr, size, option, DriverCommand_Receive);
+}
+
+Result I2cDriver::ExecuteCommandList(I2cSessionImpl &session, void *dst, size_t size, const void *cmd_list, size_t cmd_list_size) {
+    CheckInitialized();
+    if (dst == nullptr || size == 0 || cmd_list == nullptr || cmd_list_size == 0) {
+        std::abort();
+    }
+
+    u8 *cur_dst = static_cast<u8 *>(dst);
+    const u8 *cur_cmd = static_cast<const u8 *>(cmd_list);
+    const u8 *cmd_list_end = cur_cmd + cmd_list_size;
+
+    while (cur_cmd < cmd_list_end) {
+        I2cCommand cmd = static_cast<I2cCommand>((*cur_cmd) & 3);
+        if (cmd >= I2cCommand_Count) {
+            std::abort();
+        }
+
+        Result rc = g_cmd_handlers[cmd](&cur_cmd, &cur_dst, session);
+        if (R_FAILED(rc)) {
+            return rc;
+        }
+    }
+
+    return ResultSuccess;
+}
+
+void I2cDriver::SuspendBuses() {
+    GetResourceManager().SuspendBuses();
+}
+
+void I2cDriver::ResumeBuses() {
+    GetResourceManager().ResumeBuses();
+}
+
+void I2cDriver::SuspendPowerBus() {
+    GetResourceManager().SuspendPowerBus();
+}
+
+void I2cDriver::ResumePowerBus() {
+    GetResourceManager().ResumePowerBus();
+}

stratosphere/boot/source/i2c_driver/i2c_api.hpp

@@ -0,0 +1,38 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+#include <stratosphere.hpp>
+
+#include "i2c_types.hpp"
+#include "i2c_command_list.hpp"
+
+class I2cDriver {
+    public:
+        static void Initialize();
+        static void Finalize();
+        static void OpenSession(I2cSessionImpl *out_session, I2cDevice device);
+        static void CloseSession(I2cSessionImpl &session);
+        static Result Send(I2cSessionImpl &session, const void *src, size_t size, I2cTransactionOption option);
+        static Result Receive(I2cSessionImpl &session, void *dst, size_t size, I2cTransactionOption option);
+        static Result ExecuteCommandList(I2cSessionImpl &session, void *dst, size_t size, const void *cmd_list, size_t cmd_list_size);
+
+        static void SuspendBuses();
+        static void ResumeBuses();
+        static void SuspendPowerBus();
+        static void ResumePowerBus();
+};

stratosphere/boot/source/i2c_driver/i2c_bus_accessor.cpp

@@ -0,0 +1,507 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include <switch.h>
+#include <stratosphere.hpp>
+
+#include "i2c_bus_accessor.hpp"
+#include "boot_pcv.hpp"
+
+void I2cBusAccessor::Open(I2cBus bus, SpeedMode speed_mode) {
+    std::scoped_lock<HosMutex> lk(this->open_mutex);
+    /* Open new session. */
+    this->open_sessions++;
+
+    /* Ensure we're good if this isn't our first session. */
+    if (this->open_sessions > 1) {
+        if (this->speed_mode != speed_mode) {
+            std::abort();
+        }
+        return;
+    }
+
+    /* Set all members for chosen bus. */
+    {
+        std::scoped_lock<HosMutex> lk(this->register_mutex);
+        /* Set bus/registers. */
+        this->SetBus(bus);
+        /* Set pcv module. */
+        switch (bus) {
+            case I2cBus_I2c1:
+                this->pcv_module = PcvModule_I2C1;
+                break;
+            case I2cBus_I2c2:
+                this->pcv_module = PcvModule_I2C2;
+                break;
+            case I2cBus_I2c3:
+                this->pcv_module = PcvModule_I2C3;
+                break;
+            case I2cBus_I2c4:
+                this->pcv_module = PcvModule_I2C4;
+                break;
+            case I2cBus_I2c5:
+                this->pcv_module = PcvModule_I2C5;
+                break;
+            case I2cBus_I2c6:
+                this->pcv_module = PcvModule_I2C6;
+                break;
+            default:
+                std::abort();
+        }
+        /* Set speed mode. */
+        this->speed_mode = speed_mode;
+        /* Setup interrupt event. */
+        this->CreateInterruptEvent(bus);
+    }
+}
+
+void I2cBusAccessor::Close() {
+    std::scoped_lock<HosMutex> lk(this->open_mutex);
+    /* Close current session. */
+    this->open_sessions--;
+    if (this->open_sessions > 0) {
+        return;
+    }
+
+    /* Close interrupt event. */
+    eventClose(&this->interrupt_event);
+
+    /* Close PCV. */
+    Pcv::Finalize();
+
+    this->suspended = false;
+}
+
+void I2cBusAccessor::Suspend() {
+    std::scoped_lock<HosMutex> lk(this->open_mutex);
+    std::scoped_lock<HosMutex> lk_reg(this->register_mutex);
+
+    if (!this->suspended) {
+        this->suspended = true;
+
+        if (this->pcv_module != PcvModule_I2C5) {
+            this->DisableClock();
+        }
+    }
+}
+
+void I2cBusAccessor::Resume() {
+    if (this->suspended) {
+        this->DoInitialConfig();
+        this->suspended = false;
+    }
+}
+
+void I2cBusAccessor::DoInitialConfig() {
+    std::scoped_lock<HosMutex> lk(this->register_mutex);
+
+    if (this->pcv_module != PcvModule_I2C5) {
+        Pcv::Initialize();
+    }
+
+    this->ResetController();
+    this->SetClock(this->speed_mode);
+    this->SetPacketMode();
+    this->FlushFifos();
+}
+
+size_t I2cBusAccessor::GetOpenSessions() const {
+    return this->open_sessions;
+}
+
+bool I2cBusAccessor::GetBusy() const {
+    /* Nintendo has a loop here that calls a member function to check if busy, retrying a few times. */
+    /* This member function does "return false". */
+    /* We will not bother with the loop. */
+    return false;
+}
+
+void I2cBusAccessor::OnStartTransaction() const {
+    /* Nothing actually happens here. */
+}
+
+void I2cBusAccessor::OnStopTransaction() const {
+    /* Nothing actually happens here. */
+}
+
+Result I2cBusAccessor::StartTransaction(DriverCommand command, AddressingMode addressing_mode, u32 slave_address) {
+    /* Nothing actually happens here... */
+    return ResultSuccess;
+}
+
+Result I2cBusAccessor::Send(const u8 *data, size_t num_bytes, I2cTransactionOption option, AddressingMode addressing_mode, u32 slave_address) {
+    std::scoped_lock<HosMutex> lk(this->register_mutex);
+    const u8 *cur_src = data;
+    size_t remaining = num_bytes;
+    Result rc;
+
+    /* Set interrupt enable, clear interrupt status. */
+    WriteRegister(&this->i2c_registers->I2C_INTERRUPT_MASK_REGISTER_0,   0x8E);
+    WriteRegister(&this->i2c_registers->I2C_INTERRUPT_STATUS_REGISTER_0, 0xFC);
+
+    ON_SCOPE_EXIT { this->ClearInterruptMask(); };
+
+    /* Send header. */
+    this->WriteTransferHeader(TransferMode_Send, option, addressing_mode, slave_address, num_bytes);
+
+    /* Send bytes. */
+    while (true) {
+        const u32 fifo_status = ReadRegister(&this->i2c_registers->I2C_FIFO_STATUS_0);
+        const size_t fifo_cnt = (fifo_status >> 4);
+
+        for (size_t fifo_idx = 0; remaining > 0 && fifo_idx < fifo_cnt; fifo_idx++) {
+            const size_t cur_bytes = std::min(remaining, sizeof(u32));
+            u32 val = 0;
+            for (size_t i = 0; i < cur_bytes; i++) {
+                val |= cur_src[i] << (8 * i);
+            }
+            WriteRegister(&this->i2c_registers->I2C_I2C_TX_PACKET_FIFO_0, val);
+
+            cur_src += cur_bytes;
+            remaining -= cur_bytes;
+        }
+
+        if (remaining == 0) {
+            break;
+        }
+
+        eventClear(&this->interrupt_event);
+        if (R_FAILED(eventWait(&this->interrupt_event, InterruptTimeout))) {
+            this->HandleTransactionResult(ResultI2cBusBusy);
+            eventClear(&this->interrupt_event);
+            return ResultI2cTimedOut;
+        }
+
+        if (R_FAILED((rc = this->GetAndHandleTransactionResult()))) {
+            return rc;
+        }
+    }
+
+    WriteRegister(&this->i2c_registers->I2C_INTERRUPT_MASK_REGISTER_0, 0x8C);
+
+    /* Wait for successful completion. */
+    while (true) {
+        if (R_FAILED((rc = this->GetAndHandleTransactionResult()))) {
+            return rc;
+        }
+
+        /* Check PACKET_XFER_COMPLETE */
+        const u32 interrupt_status = ReadRegister(&this->i2c_registers->I2C_INTERRUPT_STATUS_REGISTER_0);
+        if (interrupt_status & 0x80) {
+            if (R_FAILED((rc = this->GetAndHandleTransactionResult()))) {
+                return rc;
+            }
+            break;
+        }
+
+        eventClear(&this->interrupt_event);
+        if (R_FAILED(eventWait(&this->interrupt_event, InterruptTimeout))) {
+            this->HandleTransactionResult(ResultI2cBusBusy);
+            eventClear(&this->interrupt_event);
+            return ResultI2cTimedOut;
+        }
+    }
+
+    return ResultSuccess;
+}
+
+Result I2cBusAccessor::Receive(u8 *out_data, size_t num_bytes, I2cTransactionOption option, AddressingMode addressing_mode, u32 slave_address) {
+    std::scoped_lock<HosMutex> lk(this->register_mutex);
+    u8 *cur_dst = out_data;
+    size_t remaining = num_bytes;
+    Result rc;
+
+    /* Set interrupt enable, clear interrupt status. */
+    WriteRegister(&this->i2c_registers->I2C_INTERRUPT_MASK_REGISTER_0,   0x8D);
+    WriteRegister(&this->i2c_registers->I2C_INTERRUPT_STATUS_REGISTER_0, 0xFC);
+
+    /* Send header. */
+    this->WriteTransferHeader(TransferMode_Receive, option, addressing_mode, slave_address, num_bytes);
+
+    /* Receive bytes. */
+    while (remaining > 0) {
+        eventClear(&this->interrupt_event);
+        if (R_FAILED(eventWait(&this->interrupt_event, InterruptTimeout))) {
+            this->HandleTransactionResult(ResultI2cBusBusy);
+            this->ClearInterruptMask();
+            eventClear(&this->interrupt_event);
+            return ResultI2cTimedOut;
+        }
+
+        if (R_FAILED((rc = this->GetAndHandleTransactionResult()))) {
+            return rc;
+        }
+
+        const u32 fifo_status = ReadRegister(&this->i2c_registers->I2C_FIFO_STATUS_0);
+        const size_t fifo_cnt = std::min((remaining + 3) >> 2, static_cast<size_t>(fifo_status & 0xF));
+
+        for (size_t fifo_idx = 0; remaining > 0 && fifo_idx < fifo_cnt; fifo_idx++) {
+            const u32 val = ReadRegister(&this->i2c_registers->I2C_I2C_RX_FIFO_0);
+            const size_t cur_bytes = std::min(remaining, sizeof(u32));
+            for (size_t i = 0; i < cur_bytes; i++) {
+                cur_dst[i] = static_cast<u8>((val >> (8 * i)) & 0xFF);
+            }
+
+            cur_dst += cur_bytes;
+            remaining -= cur_bytes;
+        }
+    }
+
+    /* N doesn't do ClearInterruptMask. */
+    return ResultSuccess;
+}
+
+void I2cBusAccessor::SetBus(I2cBus bus) {
+    this->bus = bus;
+    this->i2c_registers = GetI2cRegisters(bus);
+    this->clkrst_registers.SetBus(bus);
+}
+
+void I2cBusAccessor::CreateInterruptEvent(I2cBus bus) {
+    static constexpr u64 s_interrupts[] = {
+        0x46, 0x74, 0x7C, 0x98, 0x55, 0x5F
+    };
+    if (static_cast<size_t>(bus) >= sizeof(s_interrupts) / sizeof(s_interrupts[0])) {
+        std::abort();
+    }
+
+    Handle evt_h;
+    if (R_FAILED(svcCreateInterruptEvent(&evt_h, s_interrupts[static_cast<size_t>(bus)], 1))) {
+        std::abort();
+    }
+
+    eventLoadRemote(&this->interrupt_event, evt_h, false);
+}
+
+void I2cBusAccessor::SetClock(SpeedMode speed_mode) {
+    u32 t_high, t_low;
+    u32 clk_div, src_div;
+    u32 debounce;
+
+    switch (speed_mode) {
+        case SpeedMode_Normal:
+            t_high = 2;
+            t_low = 4;
+            clk_div = 0x19;
+            src_div = 0x13;
+            debounce = 2;
+            break;
+        case SpeedMode_Fast:
+            t_high = 2;
+            t_low = 4;
+            clk_div = 0x19;
+            src_div = 0x04;
+            debounce = 2;
+            break;
+        case SpeedMode_FastPlus:
+            t_high = 2;
+            t_low = 4;
+            clk_div = 0x10;
+            src_div = 0x02;
+            debounce = 0;
+            break;
+        case SpeedMode_HighSpeed:
+            t_high = 3;
+            t_low = 8;
+            clk_div = 0x02;
+            src_div = 0x02;
+            debounce = 0;
+            break;
+        default:
+            std::abort();
+    }
+
+    if (speed_mode == SpeedMode_HighSpeed) {
+        WriteRegister(&this->i2c_registers->I2C_I2C_HS_INTERFACE_TIMING_0_0, (t_high << 8) | (t_low));
+        WriteRegister(&this->i2c_registers->I2C_I2C_CLK_DIVISOR_REGISTER_0, clk_div);
+    } else {
+        WriteRegister(&this->i2c_registers->I2C_I2C_INTERFACE_TIMING_0_0, (t_high << 8) | (t_low));
+        WriteRegister(&this->i2c_registers->I2C_I2C_CLK_DIVISOR_REGISTER_0, (clk_div << 16));
+    }
+
+    WriteRegister(&this->i2c_registers->I2C_I2C_CNFG_0, debounce);
+    ReadRegister(&this->i2c_registers->I2C_I2C_CNFG_0);
+
+    if (this->pcv_module != PcvModule_I2C5) {
+        if (R_FAILED(Pcv::SetReset(this->pcv_module, true))) {
+            std::abort();
+        }
+        if (R_FAILED(Pcv::SetClockRate(this->pcv_module, (408'000'000) / (src_div + 1)))) {
+            std::abort();
+        }
+        if (R_FAILED(Pcv::SetReset(this->pcv_module, false))) {
+            std::abort();
+        }
+    }
+}
+
+void I2cBusAccessor::ResetController() const {
+    if (this->pcv_module != PcvModule_I2C5) {
+        if (R_FAILED(Pcv::SetReset(this->pcv_module, true))) {
+            std::abort();
+        }
+        if (R_FAILED(Pcv::SetClockRate(this->pcv_module, 81'600'000))) {
+            std::abort();
+        }
+        if (R_FAILED(Pcv::SetReset(this->pcv_module, false))) {
+            std::abort();
+        }
+    }
+}
+
+void I2cBusAccessor::ClearBus() const {
+    bool success = false;
+    for (size_t i = 0; i < 3 && !success; i++) {
+        success = true;
+
+        this->ResetController();
+
+        WriteRegister(&this->i2c_registers->I2C_I2C_BUS_CLEAR_CONFIG_0, 0x90000);
+        SetRegisterBits(&this->i2c_registers->I2C_I2C_BUS_CLEAR_CONFIG_0, 0x4);
+        SetRegisterBits(&this->i2c_registers->I2C_I2C_BUS_CLEAR_CONFIG_0, 0x2);
+
+        SetRegisterBits(&this->i2c_registers->I2C_I2C_CONFIG_LOAD_0, 0x1);
+        {
+            u64 start_tick = armGetSystemTick();
+            while (ReadRegister(&this->i2c_registers->I2C_I2C_CONFIG_LOAD_0) & 1) {
+                if (armTicksToNs(armGetSystemTick() - start_tick) > 1'000'000) {
+                    success = false;
+                    break;
+                }
+            }
+        }
+        if (!success) {
+            continue;
+        }
+
+        SetRegisterBits(&this->i2c_registers->I2C_I2C_BUS_CLEAR_CONFIG_0, 0x1);
+        {
+            u64 start_tick = armGetSystemTick();
+            while (ReadRegister(&this->i2c_registers->I2C_I2C_BUS_CLEAR_CONFIG_0) & 1) {
+                if (armTicksToNs(armGetSystemTick() - start_tick) > 1'000'000) {
+                    success = false;
+                    break;
+                }
+            }
+        }
+        if (!success) {
+            continue;
+        }
+
+        {
+            u64 start_tick = armGetSystemTick();
+            while (ReadRegister(&this->i2c_registers->I2C_I2C_BUS_CLEAR_STATUS_0) & 1) {
+                if (armTicksToNs(armGetSystemTick() - start_tick) > 1'000'000) {
+                    success = false;
+                    break;
+                }
+            }
+        }
+        if (!success) {
+            continue;
+        }
+    }
+}
+
+void I2cBusAccessor::DisableClock() {
+    if (R_FAILED(Pcv::SetClockEnabled(this->pcv_module, false))) {
+        std::abort();
+    }
+}
+
+void I2cBusAccessor::SetPacketMode() {
+    /* Set PACKET_MODE_EN, MSTR_CONFIG_LOAD */
+    SetRegisterBits(&this->i2c_registers->I2C_I2C_CNFG_0, 0x400);
+    SetRegisterBits(&this->i2c_registers->I2C_I2C_CONFIG_LOAD_0, 0x1);
+
+    /* Set TX_FIFO_TRIGGER, RX_FIFO_TRIGGER */
+    WriteRegister(&this->i2c_registers->I2C_FIFO_CONTROL_0, 0xFC);
+}
+
+Result I2cBusAccessor::FlushFifos() {
+    WriteRegister(&this->i2c_registers->I2C_FIFO_CONTROL_0, 0xFF);
+
+    /* Wait for flush to finish, check every ms for 5 ms. */
+    for (size_t i = 0; i < 5; i++) {
+        if (!(ReadRegister(&this->i2c_registers->I2C_FIFO_CONTROL_0) & 3)) {
+            return ResultSuccess;
+        }
+        svcSleepThread(1'000'000ul);
+    }
+
+    return ResultI2cBusBusy;
+}
+
+Result I2cBusAccessor::GetTransactionResult() const {
+    const u32 packet_status = ReadRegister(&this->i2c_registers->I2C_PACKET_TRANSFER_STATUS_0);
+    const u32 interrupt_status = ReadRegister(&this->i2c_registers->I2C_INTERRUPT_STATUS_REGISTER_0);
+
+    /* Check for no ack. */
+    if ((packet_status & 0xC) || (interrupt_status & 0x8)) {
+        return ResultI2cNoAck;
+    }
+
+    /* Check for arb lost. */
+    if ((packet_status & 0x2) || (interrupt_status & 0x4)) {
+        this->ClearBus();
+        return ResultI2cBusBusy;
+    }
+
+    return ResultSuccess;
+}
+
+void I2cBusAccessor::HandleTransactionResult(Result result) {
+    if (R_FAILED(result)) {
+        if (result == ResultI2cNoAck || result == ResultI2cBusBusy) {
+            this->ResetController();
+            this->SetClock(this->speed_mode);
+            this->SetPacketMode();
+            this->FlushFifos();
+        } else {
+            std::abort();
+        }
+    }
+}
+
+Result I2cBusAccessor::GetAndHandleTransactionResult() {
+    Result rc = this->GetTransactionResult();
+    this->HandleTransactionResult(rc);
+
+    if (R_FAILED(rc)) {
+        this->ClearInterruptMask();
+        eventClear(&this->interrupt_event);
+        return rc;
+    }
+    return ResultSuccess;
+}
+
+void I2cBusAccessor::WriteTransferHeader(TransferMode transfer_mode, I2cTransactionOption option, AddressingMode addressing_mode, u32 slave_address, size_t num_bytes) {
+    this->FlushFifos();
+
+    WriteRegister(&this->i2c_registers->I2C_I2C_TX_PACKET_FIFO_0, 0x10);
+    WriteRegister(&this->i2c_registers->I2C_I2C_TX_PACKET_FIFO_0, static_cast<u32>(num_bytes - 1) & 0xFFF);
+
+    const u32 slave_addr_val = ((transfer_mode == TransferMode_Receive) & 1) | ((slave_address & 0x7F) << 1);
+    u32 hdr_val = 0;
+    hdr_val |= ((this->speed_mode == SpeedMode_HighSpeed) & 1) << 22;
+    hdr_val |= ((transfer_mode == TransferMode_Receive) & 1) << 19;
+    hdr_val |= ((addressing_mode != AddressingMode_7Bit) & 1) << 18;
+    hdr_val |= (1 << 17);
+    hdr_val |= (((option & I2cTransactionOption_Stop) == 0) & 1) << 16;
+    hdr_val |= slave_addr_val;
+
+    WriteRegister(&this->i2c_registers->I2C_I2C_TX_PACKET_FIFO_0, hdr_val);
+}

stratosphere/boot/source/i2c_driver/i2c_bus_accessor.hpp

@@ -0,0 +1,82 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#pragma once
+#include <switch.h>
+#include <stratosphere.hpp>
+
+#include "i2c_types.hpp"
+#include "i2c_registers.hpp"
+
+class I2cBusAccessor {
+    private:
+        enum TransferMode {
+            TransferMode_Send = 0,
+            TransferMode_Receive = 1,
+        };
+        static constexpr u64 InterruptTimeout = 100'000'000ul;
+    private:
+        Event interrupt_event;
+        HosMutex open_mutex;
+        HosMutex register_mutex;
+        I2cRegisters *i2c_registers = nullptr;
+        ClkRstRegisters clkrst_registers;
+        SpeedMode speed_mode = SpeedMode_Fast;
+        size_t open_sessions = 0;
+        I2cBus bus = I2cBus_I2c1;
+        PcvModule pcv_module = PcvModule_I2C1;
+        bool suspended = false;
+    public:
+        I2cBusAccessor() {
+            /* ... */
+        }
+    private:
+        inline void ClearInterruptMask() const {
+            WriteRegister(&i2c_registers->I2C_INTERRUPT_MASK_REGISTER_0, 0);
+            ReadRegister(&i2c_registers->I2C_INTERRUPT_MASK_REGISTER_0);
+        }
+
+        void SetBus(I2cBus bus);
+        void CreateInterruptEvent(I2cBus bus);
+        void SetClock(SpeedMode speed_mode);
+
+        void ResetController() const;
+        void ClearBus() const;
+        void DisableClock();
+        void SetPacketMode();
+        Result FlushFifos();
+
+        Result GetTransactionResult() const;
+        void HandleTransactionResult(Result result);
+        Result GetAndHandleTransactionResult();
+
+        void WriteTransferHeader(TransferMode transfer_mode, I2cTransactionOption option, AddressingMode addressing_mode, u32 slave_address, size_t num_bytes);
+    public:
+        void Open(I2cBus bus, SpeedMode speed_mode);
+        void Close();
+        void Suspend();
+        void Resume();
+        void DoInitialConfig();
+
+        size_t GetOpenSessions() const;
+        bool GetBusy() const;
+
+        void OnStartTransaction() const;
+        Result StartTransaction(DriverCommand command, AddressingMode addressing_mode, u32 slave_address);
+        Result Send(const u8 *data, size_t num_bytes, I2cTransactionOption option, AddressingMode addressing_mode, u32 slave_address);
+        Result Receive(u8 *out_data, size_t num_bytes, I2cTransactionOption option, AddressingMode addressing_mode, u32 slave_address);
+        void OnStopTransaction() const;
+};

stratosphere/boot/source/i2c_driver/i2c_command_list.cpp

@@ -0,0 +1,70 @@
+/*
+ * Copyright (c) 2018-2019 Atmosphère-NX
+ *
+ * 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/>.
+ */
+
+#include <switch.h>
+#include <stratosphere.hpp>
+
+#include "i2c_command_list.hpp"
+
+Result I2cCommandListFormatter::CanEnqueue(size_t size) const {
+    if (this->cmd_list_size - this->cur_index < size) {
+        return ResultI2cFullCommandList;
+    }
+    return ResultSuccess;
+}
+
+Result I2cCommandListFormatter::EnqueueSendCommand(I2cTransactionOption option, const void *src, size_t size) {
+    Result rc = this->CanEnqueue(SendCommandSize + size);
+    if (R_FAILED(rc)) { return rc; }
+
+    this->cmd_list[this->cur_index] = I2cCommand_Send;
+    this->cmd_list[this->cur_index] |= ((option & I2cTransactionOption_Start) != 0) << 6;
+    this->cmd_list[this->cur_index] |= ((option & I2cTransactionOption_Stop) != 0) << 7;
+    this->cur_index++;
+
+    this->cmd_list[this->cur_index++] = size;
+
+    const u8 *src_u8 = reinterpret_cast<const u8 *>(src);
+    for (size_t i = 0; i < size; i++) {
+        this->cmd_list[this->cur_index++] = src_u8[i];
+    }
+    return ResultSuccess;
+}
+
+Result I2cCommandListFormatter::EnqueueReceiveCommand(I2cTransactionOption option, size_t size) {
+    Result rc = this->CanEnqueue(ReceiveCommandSize);
+    if (R_FAILED(rc)) { return rc; }
+
+    this->cmd_list[this->cur_index] = I2cCommand_Receive;
+    this->cmd_list[this->cur_index] |= ((option & I2cTransactionOption_Start) != 0) << 6;
+    this->cmd_list[this->cur_index] |= ((option & I2cTransactionOption_Stop) != 0) << 7;
+    this->cur_index++;
+
+    this->cmd_list[this->cur_index++] = size;
+    return ResultSuccess;
+}
+
+Result I2cCommandListFormatter::EnqueueSleepCommand(size_t us) {
+    Result rc = this->CanEnqueue(SleepCommandSize);
+    if (R_FAILED(rc)) { return rc; }
+
+    this->cmd_list[this->cur_index] = I2cCommand_SubCommand;
+    this->cmd_list[this->cur_index] |= I2cSubCommand_Sleep << 2;
+    this->cur_index++;
+
+    this->cmd_list[this->cur_index++] = us;
+    return ResultSuccess;
+}