boot: split out gpio, pinmux.

stratosphere/boot/source/pinmux/pinmux_initial_configuration.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 "pinmux_initial_configuration.hpp"
+#include "pinmux_utils.hpp"
+
+/* TODO: Better way? */
+#include "../boot_spl_utils.hpp"
+
+namespace sts::pinmux {
+
+    namespace {
+
+        struct InitialConfig {
+            u32 name;
+            u32 val;
+            u32 mask;
+        };
+
+        /* Include all initial configuration definitions. */
+#include "pinmux_initial_configuration_icosa.inc"
+#include "pinmux_initial_configuration_copper.inc"
+#include "pinmux_initial_configuration_hoag.inc"
+#include "pinmux_initial_configuration_iowa.inc"
+#include "pinmux_initial_drive_pad_configuration.inc"
+
+
+        /* Configuration helpers. */
+        void ConfigureInitialPads() {
+            const InitialConfig *configs = nullptr;
+            size_t num_configs = 0;
+            const auto hw_type = spl::GetHardwareType();
+
+            switch (hw_type) {
+                case spl::HardwareType::Icosa:
+                    configs = InitialConfigsIcosa;
+                    num_configs = NumInitialConfigsIcosa;
+                    break;
+                case spl::HardwareType::Copper:
+                    configs = InitialConfigsCopper;
+                    num_configs = NumInitialConfigsCopper;
+                    break;
+                case spl::HardwareType::Hoag:
+                    configs = InitialConfigsHoag;
+                    num_configs = NumInitialConfigsHoag;
+                    break;
+                case spl::HardwareType::Iowa:
+                    configs = InitialConfigsIowa;
+                    num_configs = NumInitialConfigsIowa;
+                    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++) {
+                UpdatePad(configs[i].name, configs[i].val, configs[i].mask);
+            }
+
+            /* Extra configs for iowa only. */
+            if (hw_type == spl::HardwareType::Iowa) {
+                static constexpr u32 ExtraIowaPadNames[] = {
+                    0xAA, 0xAC, 0xA2, 0xA3, 0xA4, 0xA5, 0xA6, 0xA7, 0xA8, 0xA9
+                };
+                for (size_t i = 0; i < sizeof(ExtraIowaPadNames) / sizeof(ExtraIowaPadNames[0]); i++) {
+                    UpdatePad(ExtraIowaPadNames[i], 0x2000, 0x2000);
+                }
+            }
+        }
+
+        void ConfigureInitialDrivePads() {
+            const InitialConfig *configs = InitialDrivePadConfigs;
+            for (size_t i = 0; i < NumInitialDrivePadConfigs; i++) {
+                UpdateDrivePad(configs[i].name, configs[i].val, configs[i].mask);
+            }
+        }
+
+    }
+
+    void SetInitialConfiguration() {
+        /* Update all parks. */
+        UpdateAllParks();
+
+        /* Dummy read all drive pads. */
+        DummyReadAllDrivePads();
+
+        /* Set initial pad configs. */
+        ConfigureInitialPads();
+
+        /* Set initial drive pad configs. */
+        ConfigureInitialDrivePads();
+    }
+
+}