/*
 * 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 <stratosphere/spl.hpp>

#include "pinmux_initial_configuration.hpp"
#include "pinmux_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; 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 < util::size(ExtraIowaPadNames); 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();
    }

}