// This file is part of the AliceVision project.
// Copyright (c) 2015 AliceVision contributors.
// This Source Code Form is subject to the terms of the Mozilla Public License,
// v. 2.0. If a copy of the MPL was not distributed with this file,
// You can obtain one at https://mozilla.org/MPL/2.0/.

#include "IFeed.hpp"

#include <aliceVision/system/Logger.hpp>
#include <aliceVision/camera/DistortionRadial.hpp>
#include <aliceVision/camera/Pinhole.hpp>

#include <fstream>
#include <exception>

namespace aliceVision {
namespace dataio {

// the structure of the file is
// int #image width
// int #image height
// double #focal
// double #ppx principal point x-coord
// double #ppy principal point y-coord
// double #k0
// double #k1
// double #k2
void readCalibrationFromFile(const std::string& filename, camera::Pinhole& camIntrinsics)
{
    std::ifstream fs(filename, std::ios::in);
    if (!fs.is_open())
    {
        ALICEVISION_LOG_WARNING("Unable to open the calibration file " << filename);
        throw std::invalid_argument("Unable to open the calibration file " + filename);
    }
    int width = 0;
    int height = 0;
    const size_t numParam = 6;
    std::vector<double> params(numParam, 0);

    fs >> width;
    fs >> height;
    for (size_t i = 0; i < numParam; ++i)
    {
        fs >> params[i];
    }
    camIntrinsics = camera::Pinhole(
      width, height, params[0], params[0], params[1], params[2], std::make_shared<camera::DistortionRadialK3>(params[3], params[4], params[5]));

    fs.close();
}

}  // namespace dataio
}  // namespace aliceVision
