#include <switch.h>
#include "mainLoop.h"
#include <variant>
#include "log.h"

#include "SwitchUSBDevice.h"
#include "ControllerHelpers.h"
#include "SwitchHDLHandler.h"
#include "SwitchAbstractedPadHandler.h"
#include "configFile.h"

#define APP_VERSION "0.5.1"

#define DS3EVENT_INDEX 0
#define DS4EVENT_INDEX 1
#define ALLEVENT_INDEX 2

static const bool useAbstractedPad = hosversionBetween(5, 7);
std::vector<std::unique_ptr<SwitchVirtualGamepadHandler>> controllerInterfaces;

static GlobalConfig _globalConfig{};

void LoadGlobalConfig(const GlobalConfig *config)
{
    _globalConfig = *config;
}

Result CallInitHandler(std::unique_ptr<IController> &controllerPtr)
{
    if (controllerPtr)
    {
        std::unique_ptr<SwitchVirtualGamepadHandler> switchHandler;
        if (useAbstractedPad)
            switchHandler = std::make_unique<SwitchAbstractedPadHandler>(std::move(controllerPtr));
        else
            switchHandler = std::make_unique<SwitchHDLHandler>(std::move(controllerPtr));

        Result rc = switchHandler->Initialize();
        if (R_SUCCEEDED(rc))
        {
            controllerInterfaces.push_back(std::move(switchHandler));
            WriteToLog("Interface created successfully");
            return 0;
        }
        else
        {
            WriteToLog("Error creating interface with error ", rc);
            return rc;
        }
    }
    return 1;
}

Result CreateDualshck3AvailableEvent(Event &out)
{
    UsbHsInterfaceFilter filter;
    filter.Flags = UsbHsInterfaceFilterFlags_idVendor | UsbHsInterfaceFilterFlags_idProduct;
    filter.idVendor = VENDOR_SONY;
    filter.idProduct = PRODUCT_DUALSHOCK3;
    Result rc = usbHsCreateInterfaceAvailableEvent(&out, true, DS3EVENT_INDEX, &filter);
    return rc;
}

Result CreateDualshock4AvailableEvent(Event &out)
{
    UsbHsInterfaceFilter filter;
    filter.Flags = UsbHsInterfaceFilterFlags_idVendor | UsbHsInterfaceFilterFlags_idProduct;
    filter.idVendor = VENDOR_SONY;
    filter.idProduct = _globalConfig.dualshock4_productID;
    Result rc = usbHsCreateInterfaceAvailableEvent(&out, true, DS4EVENT_INDEX, &filter);
    return rc;
}

Result CreateAllAvailableEvent(Event &out)
{
    UsbHsInterfaceFilter filter;
    filter.Flags = UsbHsInterfaceFilterFlags_bcdDevice_Min;
    filter.bcdDevice_Min = 0;
    Result rc = usbHsCreateInterfaceAvailableEvent(&out, true, ALLEVENT_INDEX, &filter);
    return rc;
}

Result QueryInterfaces(UsbHsInterface *interfaces, size_t interfaces_size, s32 *total_entries, u8 infclass, u8 infsubclass, u8 infprotocol)
{
    UsbHsInterfaceFilter filter;
    filter.Flags = UsbHsInterfaceFilterFlags_bInterfaceClass | UsbHsInterfaceFilterFlags_bInterfaceSubClass | UsbHsInterfaceFilterFlags_bInterfaceProtocol;
    filter.bInterfaceClass = infclass;
    filter.bInterfaceSubClass = infsubclass;
    filter.bInterfaceProtocol = infprotocol;
    Result rc = usbHsQueryAvailableInterfaces(&filter, interfaces, interfaces_size, total_entries);
    if (R_SUCCEEDED(rc) && *total_entries != 0)
        return 0;
    else
        return 1;
}

Result QueryVendorProduct(UsbHsInterface *interfaces, size_t interfaces_size, s32 *total_entries, uint16_t vendor_id, uint16_t product_id)
{
    UsbHsInterfaceFilter filter;
    filter.Flags = UsbHsInterfaceFilterFlags_idVendor | UsbHsInterfaceFilterFlags_idProduct;
    filter.idVendor = vendor_id;
    filter.idProduct = product_id;
    Result rc = usbHsQueryAvailableInterfaces(&filter, interfaces, interfaces_size, total_entries);
    if (R_SUCCEEDED(rc) && *total_entries != 0)
        return 0;
    else
        return 1;
}

Event catchAllEvent;
Event ds3Event;
Event ds4Event;

Result inline OpenEvents()
{
    Result rc = CreateAllAvailableEvent(catchAllEvent);
    if (R_FAILED(rc))
        return 3;
    rc = CreateDualshck3AvailableEvent(ds3Event);
    if (R_FAILED(rc))
        return 1;
    rc = CreateDualshock4AvailableEvent(ds4Event);
    if (R_FAILED(rc))
        return 2;

    return 0;
}

void inline CloseEvents()
{
    usbHsDestroyInterfaceAvailableEvent(&ds3Event, DS3EVENT_INDEX);
    usbHsDestroyInterfaceAvailableEvent(&ds4Event, DS4EVENT_INDEX);
    usbHsDestroyInterfaceAvailableEvent(&catchAllEvent, ALLEVENT_INDEX);
}

struct PSCLoopBuffer
{
    PscPmModule &pscModule;
    bool &pscLoopRunning;
    bool &shouldSleep;
};

void pscLoop(void *buffer)
{

    Waiter pscModuleWaiter = waiterForEvent(&static_cast<PSCLoopBuffer *>(buffer)->pscModule.event);
    PscPmState pscState;
    u32 out_flags;

    while (static_cast<PSCLoopBuffer *>(buffer)->pscLoopRunning)
    {
        Result rc = waitSingle(pscModuleWaiter, U64_MAX);
        if (R_SUCCEEDED(rc))
        {
            rc = pscPmModuleGetRequest(&static_cast<PSCLoopBuffer *>(buffer)->pscModule, &pscState, &out_flags);
            if (R_SUCCEEDED(rc))
            {
                switch (pscState)
                {
                case PscPmState_ReadyAwaken:
                    OpenEvents();
                    static_cast<PSCLoopBuffer *>(buffer)->shouldSleep = false;
                    break;
                case PscPmState_ReadySleep:
                case PscPmState_ReadyShutdown:
                    CloseEvents();
                    static_cast<PSCLoopBuffer *>(buffer)->shouldSleep = true;
                    //controllerInterfaces.clear();
                    break;
                default:
                    break;
                }
                pscPmModuleAcknowledge(&static_cast<PSCLoopBuffer *>(buffer)->pscModule, pscState);
            }
        }
    }
};

Result mainLoop()
{
    WriteToLog("\n\nNew sysmodule session started on version " APP_VERSION);
    Result rc = 0;

    std::unique_ptr<IController> controllerPtr;

    UTimer filecheckTimer;
    Waiter filecheckTimerWaiter = waiterForUTimer(&filecheckTimer);
    utimerCreate(&filecheckTimer, 1e+9L, TimerType_Repeating);
    utimerStart(&filecheckTimer);

    PscPmModule pscModule;
    const uint16_t dependencies[] = {PscPmModuleId_Usb};

    rc = pscmGetPmModule(&pscModule, static_cast<PscPmModuleId>(126), dependencies, sizeof(dependencies) / sizeof(uint16_t), true);
    WriteToLog("Get module result: 0x", std::hex, rc);
    //Waiter pscModuleWaiter = waiterForEvent(&pscModule.event);

    bool pscLoopRunning = true;
    bool shouldSleep = false;
    Thread pscThread;
    PSCLoopBuffer loopBuffer{pscModule, pscLoopRunning, shouldSleep};

    threadCreate(&pscThread, pscLoop, &loopBuffer, NULL, 0x300, 0x3B, -2);

    rc = threadStart(&pscThread);
    WriteToLog("PSC thread start: 0x", std::hex, rc);

    CheckForFileChanges();
    LoadAllConfigs();

    rc = OpenEvents();
    if (R_FAILED(rc))
        WriteToLog("Failed to open events: ", rc);

    controllerInterfaces.reserve(10);

    while (appletMainLoop())
    {
        if (!shouldSleep)
        {

#ifdef __APPLET__
            hidScanInput();
            u64 kDown = hidKeysDown(CONTROLLER_P1_AUTO);

            for (int i = 0; i != 8; ++i)
            {
                u64 kHeld = hidKeysDown(static_cast<HidControllerID>(i));
                if (kHeld != 0)
                    WriteToLog("Player ", i + 1, ": ", kHeld);
            }

            if (kDown & KEY_B)
                break;

            for (auto &&handler : controllerInterfaces)
            {
                if (handler->GetController()->m_UpdateCalled)
                {
                    for (int i = 0; i != 64; ++i)
                        printf("0x%02X ", handler->GetController()->m_inputData[i]);
                    printf("\n");
                    handler->GetController()->m_UpdateCalled = false;
                }
            }
#endif
            rc = eventWait(&catchAllEvent, 0);
            if (R_SUCCEEDED(rc))
            {
                WriteToLog("Catch-all event went off");
                if (controllerInterfaces.size() >= 10)
                    WriteToLog("But the controllers table reached its max size!");
                else
                {

                    UsbHsInterface interfaces[16];
                    s32 total_entries;

                    if (R_SUCCEEDED(QueryInterfaces(interfaces, sizeof(interfaces), &total_entries, USB_CLASS_VENDOR_SPEC, 93, 1)))
                    {
                        WriteToLog("Registering Xbox 360 controller");
                        controllerPtr = std::make_unique<Xbox360Controller>(std::make_unique<SwitchUSBDevice>(interfaces, total_entries));
                    }
                    else if (R_SUCCEEDED(QueryInterfaces(interfaces, sizeof(interfaces), &total_entries, USB_CLASS_VENDOR_SPEC, 93, 129)))
                    {
                        WriteToLog("Registering Xbox 360 Wireless adapter");
                        for (int i = 0; i != total_entries; ++i)
                        {
                            controllerPtr = std::make_unique<Xbox360WirelessController>(std::make_unique<SwitchUSBDevice>(interfaces + i, 1));
                            CallInitHandler(controllerPtr);
                        }
                    }
                    else if (R_SUCCEEDED(QueryInterfaces(interfaces, sizeof(interfaces), &total_entries, 0x58, 0x42, 0x00)))
                    {
                        WriteToLog("Registering Xbox One controller");
                        controllerPtr = std::make_unique<XboxController>(std::make_unique<SwitchUSBDevice>(interfaces, total_entries));
                    }
                    else if (R_SUCCEEDED(QueryInterfaces(interfaces, sizeof(interfaces), &total_entries, USB_CLASS_VENDOR_SPEC, 71, 208)))
                    {
                        WriteToLog("Registering Xbox One controller");
                        controllerPtr = std::make_unique<XboxOneController>(std::make_unique<SwitchUSBDevice>(interfaces, total_entries));
                    }
                    /*
                else if (R_SUCCEEDED(QueryInterfaces(interfaces, sizeof(interfaces), &total_entries, USB_CLASS_VENDOR_SPEC, 255, 255)))
                {
                    WriteToLog("Registering Xbox One adapter");
                    controllerPtr = std::make_unique<XboxOneAdapter>(std::make_unique<SwitchUSBDevice>(interfaces, total_entries));
                }
                */
                }
            }
            rc = eventWait(&ds3Event, 0);
            if (R_SUCCEEDED(rc))
            {
                WriteToLog("Dualshock 3 event went off");
                UsbHsInterface interfaces[8];
                s32 total_entries;

                if (R_SUCCEEDED(QueryInterfaces(interfaces, sizeof(interfaces), &total_entries, USB_CLASS_HID, 0, 0)))
                {
                    WriteToLog("Registering DS3 controller");
                    controllerPtr = std::make_unique<Dualshock3Controller>(std::make_unique<SwitchUSBDevice>(interfaces, total_entries));
                }
            }
            rc = eventWait(&ds4Event, 0);
            if (R_SUCCEEDED(rc))
            {
                WriteToLog("Dualshock 4 event went off");
                UsbHsInterface interfaces[8];
                s32 total_entries;

                if (R_SUCCEEDED(QueryInterfaces(interfaces, sizeof(interfaces), &total_entries, USB_CLASS_HID, 0, 0)))
                {
                    WriteToLog("Registering DS4 controller");
                    controllerPtr = std::make_unique<Dualshock4Controller>(std::make_unique<SwitchUSBDevice>(interfaces, total_entries));
                }
            }
            CallInitHandler(controllerPtr);

            //On interface change event, check if any devices were removed, and erase them from memory appropriately
            rc = eventWait(usbHsGetInterfaceStateChangeEvent(), 0);
            if (R_SUCCEEDED(rc))
            {
                WriteToLog("Interface state was changed");
                eventClear(usbHsGetInterfaceStateChangeEvent());

                UsbHsInterface interfaces[16];
                s32 total_entries;

                rc = usbHsQueryAcquiredInterfaces(interfaces, sizeof(interfaces), &total_entries);
                if (R_SUCCEEDED(rc))
                {
                    for (auto it = controllerInterfaces.begin(); it != controllerInterfaces.end(); ++it)
                    {
                        bool found_flag = false;

                        for (auto &&ptr : (*it)->GetController()->GetDevice()->GetInterfaces())
                        {
                            //We check if a device was removed by comparing the controller's interfaces and the currently acquired interfaces
                            //If we didn't find a single matching interface ID, we consider a controller removed
                            for (int i = 0; i != total_entries; ++i)
                            {
                                if (interfaces[i].inf.ID == static_cast<SwitchUSBInterface *>(ptr.get())->GetID())
                                {
                                    found_flag = true;
                                    break;
                                }
                            }
                        }

                        if (!found_flag)
                        {
                            WriteToLog("Erasing controller! ", (*it)->GetController()->GetType());
                            controllerInterfaces.erase(it--);
                            WriteToLog("Controller erased!");
                        }
                    }
                }
            }

            //Checks every 1 second for any changes in config files, then reloads them
            rc = waitSingle(filecheckTimerWaiter, 0);
            if (R_SUCCEEDED(rc))
            {
                if (CheckForFileChanges())
                {
                    WriteToLog("File check succeeded! Loading configs...");
                    LoadAllConfigs();
                    usbHsDestroyInterfaceAvailableEvent(&ds4Event, DS4EVENT_INDEX);
                    CreateDualshock4AvailableEvent(ds4Event);
                }
            }
        }
        else if (controllerInterfaces.size() != 0)
        {
            WriteToLog("Clearing interfaces before going to sleep");
            controllerInterfaces.clear();
        }
#ifdef __APPLET__
        consoleUpdate(nullptr);
#else
        svcSleepThread(1e+7L);
#endif
    }

    //After we break out of the loop, close all events and exit
    WriteToLog("Destroying events");
    CloseEvents();

    pscPmModuleFinalize(&pscModule);
    pscPmModuleClose(&pscModule);

    pscLoopRunning = false;
    threadWaitForExit(&pscThread);
    threadClose(&pscThread);

    controllerInterfaces.clear();
    return rc;
}