#include "common.h"
#include <memory>
#include "PicoLoaderArranger.h"

#define PICO_LOADER_9_PATH    "/_pico/picoLoader9.bin"
#define PICO_LOADER_7_PATH    "/_pico/picoLoader7.bin"

bool PicoLoaderArranger::SetupPicoLoaderInfo(loader_info_t* info) const
{
    auto file = std::make_unique<FIL>();
    if (f_open(file.get(), PICO_LOADER_9_PATH, FA_OPEN_EXISTING | FA_READ) != FR_OK)
    {
        LOG_FATAL("Failed to open picoLoader9.bin\n");
        return false;
    }

    DWORD* clusterTab = (DWORD*)info->clusterMap9;
    clusterTab[0] = sizeof(info->clusterMap9) / sizeof(u32);
    file->cltbl = clusterTab;
    FRESULT seekResult = f_lseek(file.get(), CREATE_LINKMAP);
    if (seekResult != FR_OK)
    {
        LOG_FATAL("Failed to make picoLoader9 cluster table. Result: %d\n", seekResult);
        return false;
    }

    info->clusterShift = __builtin_ctz(file->obj.fs->csize);
    info->picoLoaderBootDrive = gLoaderHeader.bootDrive;
    info->database = file->obj.fs->database;

    if (f_close(file.get()) != FR_OK)
    {
        LOG_FATAL("Failed to close picoLoader9 file\n");
        return false;
    }

    if (f_open(file.get(), PICO_LOADER_7_PATH, FA_OPEN_EXISTING | FA_READ) != FR_OK)
    {
        LOG_FATAL("Failed to open picoLoader7.bin\n");
        return false;
    }

    clusterTab = (DWORD*)info->clusterMap7;
    clusterTab[0] = sizeof(info->clusterMap7) / sizeof(u32);
    file->cltbl = clusterTab;
    seekResult = f_lseek(file.get(), CREATE_LINKMAP);
    if (seekResult != FR_OK)
    {
        LOG_FATAL("Failed to make picoLoader7 cluster table. Result: %d\n", seekResult);
        return false;
    }

    if (f_close(file.get()) != FR_OK)
    {
        LOG_FATAL("Failed to close picoLoader7 file\n");
        return false;
    }

    return true;
}