CPD rigid with scaling

rigid.cpp

#include <cpd/jsoncpp.hpp>
#include <cpd/rigid.hpp>
#include <fstream>
#include <iostream>

int main(int argc, char** argv) {
    if (argc != 4) {
        std::cout << "ERROR: invalid usage" << std::endl;
        std::cout << "USAGE: cpd-rigid <fixed> <moving> <outfile>" << std::endl;
        return 1;
    }
    cpd::Matrix fixed = cpd::matrix_from_path(argv[1]);
    cpd::Matrix moving = cpd::matrix_from_path(argv[2]);
    std::string outfile = argv[3];
    cpd::Rigid rigid;
    rigid.scale(true);
    cpd::RigidResult result = rigid.run(fixed, moving);
    std::ofstream out(outfile);
    out << result.points;
    out.close();
    std::cout << cpd::to_json(result) << std::endl;
    return 0;
}