// Copyright (2019-2024) Paul Scherrer Institute

#include "HDF5DataFilePluginMX.h"
#define RESERVE_IMAGES 1000

HDF5DataFilePluginMX::HDF5DataFilePluginMX(size_t in_max_spots) : max_spots(in_max_spots) {}

void HDF5DataFilePluginMX::OpenFile(HDF5File &data_file, const DataMessage &msg) {
    if (max_spots == 0)
        return;

    spot_x.reserve(max_spots * RESERVE_IMAGES);
    spot_y.reserve(max_spots * RESERVE_IMAGES);
    spot_int.reserve(max_spots * RESERVE_IMAGES);
    npeaks.reserve(RESERVE_IMAGES);
    strong_pixel_count.reserve(RESERVE_IMAGES);
    indexed.reserve(RESERVE_IMAGES);
    indexed_lattice.reserve(9 * RESERVE_IMAGES);

    indexing_drift_beam_center_x_pxl.reserve(RESERVE_IMAGES);
    indexing_drift_beam_center_y_pxl.reserve(RESERVE_IMAGES);
    indexing_drift_detector_distance_mm.reserve(RESERVE_IMAGES);
}

void HDF5DataFilePluginMX::Write(const DataMessage &msg, uint64_t image_number) {
    if (max_spots == 0)
        return;

    if (image_number >= max_image_number) {
        max_image_number = image_number;

        spot_x.resize(max_spots * (max_image_number + 1));
        spot_y.resize(max_spots * (max_image_number + 1));
        spot_int.resize(max_spots * (max_image_number + 1));

        npeaks.resize(max_image_number + 1);
        strong_pixel_count.resize(max_image_number + 1);
        indexed.resize(max_image_number + 1);
        indexed_lattice.resize((max_image_number + 1) * 9);

        indexing_drift_beam_center_x_pxl.resize(max_image_number + 1);
        indexing_drift_beam_center_y_pxl.resize(max_image_number + 1);
        indexing_drift_detector_distance_mm.resize(max_image_number + 1);
    }

    uint32_t spot_cnt = std::min(msg.spots.size(), max_spots);

    for (int i = 0; i < spot_cnt; i++) {
        spot_x[max_spots * image_number + i] = msg.spots[i].x;
        spot_y[max_spots * image_number + i] =  msg.spots[i].y;
        spot_int[max_spots * image_number + i] = msg.spots[i].intensity;
    }

    npeaks[image_number] = spot_cnt;
    strong_pixel_count[image_number] = msg.strong_pixel_count;
    indexed[image_number] = msg.indexing_result;
    if (msg.indexing_lattice.size() == 9) {
        for (int i = 0; i < 9; i++)
            indexed_lattice[image_number * 9 + i] = msg.indexing_lattice[i];
    }
    if (msg.corr_beam_x_pxl) {
        indexing_drift_beam_center_x_pxl[image_number] = msg.corr_beam_x_pxl.value();
        indexing_drift_beam_center_y_pxl[image_number] = msg.corr_beam_y_pxl.value();
        indexing_drift_detector_distance_mm[image_number] = msg.corr_det_dist_mm.value();
    }
}

void HDF5DataFilePluginMX::WriteFinal(HDF5File &data_file) {
    HDF5Group(data_file, "/entry/MX").NXClass("NXcollection");

    if (!spot_x.empty()) {
        data_file.SaveVector("/entry/MX/peakXPosRaw", spot_x, {(hsize_t) (max_image_number + 1), max_spots});
        data_file.SaveVector("/entry/MX/peakYPosRaw", spot_y, {(hsize_t) (max_image_number + 1), max_spots});
        data_file.SaveVector("/entry/MX/peakTotalIntensity", spot_int, {(hsize_t) (max_image_number + 1), max_spots});

        data_file.SaveVector("/entry/MX/nPeaks", npeaks);
        data_file.SaveVector("/entry/MX/strongPixels", strong_pixel_count);
    }

    if (!indexed.empty())
        data_file.SaveVector("/entry/MX/imageIndexed", indexed);
    if (!indexed_lattice.empty())
        data_file.SaveVector("/entry/MX/latticeIndexed", indexed_lattice, {(hsize_t) (max_image_number + 1), 9});

    if (!indexing_drift_beam_center_x_pxl.empty()) {
        data_file.SaveVector("/entry/MX/indexingDriftBeamCenterX", indexing_drift_beam_center_x_pxl)->Units("pxl");
        data_file.SaveVector("/entry/MX/indexingDriftBeamCenterY", indexing_drift_beam_center_y_pxl)->Units("pxl");
        data_file.SaveVector("/entry/MX/indexingDriftDetectorDistance", indexing_drift_detector_distance_mm)->Units("mm");
    }
}