void alglibCG(VectorParametrizedModel * vpm) {

    double epsg = 0.000001;
    double epsf = 0;
    double epsx = 0;
    double stpmax = 0.1;
    alglib::ae_int_t maxits = 0;

    alglib::real_1d_array x;
    x.setcontent((*vpm).theta.rows(), (*vpm).theta.data());

    alglib::mincgstate state;
    alglib::mincgreport rep;

    alglib::mincgcreate(x,state);
    alglib::mincgsetcond(state, epsg, epsf, epsx, maxits);
    alglib::mincgsetstpmax(state, stpmax);

    alglib::mincgoptimize(state, alglibCostAndGradient, NULL, vpm);
    alglib::mincgresults(state, x, rep);

    std::cout << x.tostring((*vpm).theta.rows()).c_str() << "\n";
    std::cout << int(rep.terminationtype) << "\n";
   
    for (int i=0; i< (*vpm).theta.rows(); ++i) {
        (*vpm).theta(i) = x[i];
    }
}

void alglibCostAndGradient(const alglib::real_1d_array &x,
        double &func, alglib::real_1d_array &grad, void * ptr) {
    VectorParametrizedModel * vpm = static_cast<VectorParametrizedModel*>(ptr);
    (*vpm).computeCostAndGradient();
    func = (*vpm).cost;
    for (int i=0; i< (*vpm).gradient.rows(); ++i) {
        grad[i] = (*vpm).gradient(i);
    }
}