/**********************************************************************
 * This file is used for testing random stuff without running the
 * whole of SatDump, which comes in handy for debugging individual
 * elements before putting them all together in modules...
 *
 * If you are an user, ignore this file which will not be built by
 * default, and if you're a developper in need of doing stuff here...
 * Go ahead!
 *
 * Don't judge the code you might see in there! :)
 **********************************************************************/

#include "logger.h"
#include "common/ccsds/ccsds_1_0_proba/vcdu.h"
#include "common/ccsds/ccsds_1_0_proba/demuxer.h"
#include "common/ccsds/ccsds_1_0_proba/mpdu.h"
#include <fstream>

#include "common/image/image.h"
#include "common/repack.h"

int main(int /*argc*/, char *argv[])
{
    initLogger();

    std::ifstream idk_file(argv[1]);

    std::ofstream idk_file2(argv[2]);

    uint8_t buffer1[1199];

    // int sz = 0;

    ccsds::ccsds_1_0_proba::Demuxer demuxer_vcid1(1016, false);

    image::Image<uint16_t> idk_what_img(8196, 10000, 1);

    int lines = 0;

    uint16_t pixels_bugg[40000];

    while (!idk_file.eof())
    {
        idk_file.read((char *)buffer1, 1199);

        auto vcdu = ccsds::ccsds_1_0_proba::parseVCDU(buffer1);

        //  logger->critical(vcdu.vcid);
        printf("VCID %d\n", vcdu.vcid);

        // 0, 1, 4, 5
        // 0 => Spec => 101
        // 1 => VNIR => 102
        // 4 => Lots
        // if (vcdu.vcid == 0)
        //     idk_file2.write((char *)buffer1, 1199);

#if 1

        if (vcdu.vcid == 0)
        {
            memmove(&buffer1[10], &buffer1[17], 1016); // There is some sort of Insert zone

            // idk_file2.write((char *)&buffer1[0], 1199);

            // auto mpdu = ccsds::ccsds_1_0_proba::parseMPDU(buffer1);

            // logger->critical(mpdu.first_header_pointer);

            std::vector<ccsds::CCSDSPacket> pkts = demuxer_vcid1.work(buffer1);

            for (auto pkt : pkts)
            {
                // logger->critical("{:d} {:d} {:d}", pkt.header.apid, pkt.payload.size(), pkt.header.packet_length + 1);

                printf("APID %d\n", pkt.header.apid);

                if (pkt.header.apid == 101)
                {
                    // pkt.payload.resize(400000 - 6);
                    // idk_file2.write((char *)pkt.header.raw, 6);
                    // idk_file2.write((char *)pkt.payload.data(), 400000 - 6);

                    // printf("len %d\n", pkt.payload.size());

                    if (pkt.payload.size() >= 65536)
                        idk_file2.write((char *)pkt.payload.data(), 65536 - 4);
                }
            }
        }

        if (vcdu.vcid == 1)
        {
            memmove(&buffer1[10], &buffer1[17], 1016); // There is some sort of Insert zone

            // idk_file2.write((char *)&buffer1[0], 1199);

            // auto mpdu = ccsds::ccsds_1_0_proba::parseMPDU(buffer1);

            // logger->critical(mpdu.first_header_pointer);

            std::vector<ccsds::CCSDSPacket> pkts = demuxer_vcid1.work(buffer1);

            for (auto pkt : pkts)
            {
                // logger->critical("{:d} {:d} {:d}", pkt.header.apid, pkt.payload.size(), pkt.header.packet_length + 1);

                printf("APID %d\n", pkt.header.apid);

                if (pkt.header.apid == 102)
                {
                    // pkt.payload.resize(40000 - 6);
                    // idk_file2.write((char *)pkt.header.raw, 6);
                    // idk_file2.write((char *)pkt.payload.data(), 40000 - 6);

                    int marker = pkt.payload[1003] << 8 | pkt.payload[1004];

                    printf("len %d\n", pkt.payload.size());

                    if (pkt.payload.size() >= 17450 && marker == 0x18c1) // 0x18c1)
                    {
                        repackBytesTo16bits(pkt.payload.data() + 1054, 17450 - 1054, pixels_bugg);

                        for (int i = 0; i < 8196; i++)
                            idk_what_img[lines * 8196 + i] = pixels_bugg[i]; // ^ 0xFFFF;
                        lines++;
                    }
                }
            }
        }
#endif
    }

    idk_what_img.crop(0, 0, 8196, lines);

    idk_what_img.save_img("idkfdfd.png");
}