void set_T_p_and_q(double& T, VECTOR(double)& p, VECTOR(double) &q ) { T = 1.0; // p[0] = 0.2; p[1] = 0.2; p[2] = 0.1; p[3] = 0.1; // q[0] = 25.0; q[1] = 25.0; q[2] = 25.0; q[3] = 25.0; // return; }