satdump/plugins/cubesat_support/geoscan/module_geoscan_data_decoder.cpp

87 lines
2.9 KiB
C++

#include "module_geoscan_data_decoder.h"
#include "common/utils.h"
#include "image/io.h"
#include "imgui/imgui.h"
#include "logger.h"
#include <cstdint>
namespace geoscan
{
GEOSCANDataDecoderModule::GEOSCANDataDecoderModule(std::string input_file, std::string output_file_hint, nlohmann::json parameters)
: satdump::pipeline::base::FileStreamToFileStreamModule(input_file, output_file_hint, parameters)
{
frame_buffer = new uint8_t[70];
fsfsm_enable_output = false;
}
GEOSCANDataDecoderModule::~GEOSCANDataDecoderModule() { delete[] frame_buffer; }
void GEOSCANDataDecoderModule::process()
{
std::string directory = d_output_file_hint.substr(0, d_output_file_hint.rfind('/')) + "/";
logger->info("Using input frames " + d_input_file);
logger->info("Decoding to " + directory);
std::vector<bool> has_chunks(878, false);
std::vector<uint8_t> img_vector(878 * 56, 0);
while (should_run())
{
// Read buffer
read_data((uint8_t *)frame_buffer, 70);
if (frame_buffer[4] == 0x84) // TLM
{
logger->error("Telemetry Packet. TODO : IMPLEMENT!");
}
else if (frame_buffer[4] == 0x02 || frame_buffer[4] == 0x01) // Imagery
{
// uint16_t hdr = frame_buffer[4 + 1] << 8 | frame_buffer[4 + 0];
// uint8_t data_size = frame_buffer[4 + 2];
// uint16_t msg_type = frame_buffer[4 + 4] << 8 | frame_buffer[4 + 3];
uint16_t pkt_offset = frame_buffer[4 + 6] << 8 | frame_buffer[4 + 5];
if (pkt_offset <= 49112)
{
memcpy(&img_vector[pkt_offset], &frame_buffer[4 + 8], 56);
has_chunks[pkt_offset / 56] = true;
}
// logger->trace("%d", pkt_offset / 56);
}
}
logger->info("Decoding finished");
cleanup();
int cpresent = 0;
for (bool v : has_chunks)
cpresent += v;
logger->info("Image Payload : Got %d/%d", cpresent, 878);
image::Image img;
image::load_jpeg(img, img_vector.data(), img_vector.size());
std::string name = "Image";
image::save_img(img, directory + "/" + name);
}
void GEOSCANDataDecoderModule::drawUI(bool window)
{
ImGui::Begin("Geoscan Data Decoder", NULL, window ? 0 : NOWINDOW_FLAGS);
drawProgressBar();
ImGui::End();
}
std::string GEOSCANDataDecoderModule::getID() { return "geoscan_data_decoder"; }
std::shared_ptr<satdump::pipeline::ProcessingModule> GEOSCANDataDecoderModule::getInstance(std::string input_file, std::string output_file_hint, nlohmann::json parameters)
{
return std::make_shared<GEOSCANDataDecoderModule>(input_file, output_file_hint, parameters);
}
} // namespace geoscan