boot: split out gpio, pinmux.

2019-06-22 11:34:18 -07:00
parent 6d1d226842
commit 804e5d49bb
29 changed files with 52 additions and 51 deletions
--- a/stratosphere/boot/source/gpio/gpio_initial_configuration.cpp
+++ b/stratosphere/boot/source/gpio/gpio_initial_configuration.cpp
@@ -0,0 +1,103 @@
+/*
+ * 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 "gpio_initial_configuration.hpp"
+#include "gpio_utils.hpp"
+
+/* TODO: Better way? */
+#include "../boot_spl_utils.hpp"
+
+namespace sts::gpio {
+
+    namespace {
+
+        struct InitialConfig {
+            u32 pad_name;
+            GpioDirection direction;
+            GpioValue value;
+        };
+
+        /* Include all initial configuration definitions. */
+#include "gpio_initial_configuration_icosa.inc"
+#include "gpio_initial_configuration_copper.inc"
+#include "gpio_initial_configuration_hoag.inc"
+#include "gpio_initial_configuration_iowa.inc"
+
+    }
+
+    void SetInitialConfiguration() {
+        const InitialConfig *configs = nullptr;
+        size_t num_configs = 0;
+        const auto hw_type = spl::GetHardwareType();
+        const FirmwareVersion fw_ver = GetRuntimeFirmwareVersion();
+
+        /* Choose GPIO map. */
+        if (fw_ver >= FirmwareVersion_200) {
+            switch (hw_type) {
+                case spl::HardwareType::Icosa:
+                    {
+                        if (fw_ver >= FirmwareVersion_400) {
+                            configs = InitialConfigsIcosa4x;
+                            num_configs = NumInitialConfigsIcosa4x;
+                        } else {
+                            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();
+            }
+        } else {
+            /* Until 2.0.0, the GPIO map for Icosa was used for all hardware types. */
+            configs = InitialConfigsIcosa;
+            num_configs = NumInitialConfigsIcosa;
+        }
+
+        /* Ensure we found an appropriate config. */
+        if (configs == nullptr) {
+            std::abort();
+        }
+
+        for (size_t i = 0; i < num_configs; i++) {
+            /* Configure the GPIO. */
+            Configure(configs[i].pad_name);
+
+            /* Set the GPIO's direction. */
+            SetDirection(configs[i].pad_name, configs[i].direction);
+
+            if (configs[i].direction == GpioDirection_Output) {
+                /* Set the GPIO's value. */
+                SetValue(configs[i].pad_name, configs[i].value);
+            }
+        }
+    }
+
+}
+