diff --git a/include/hpp/bezier-com-traj/solve_end_effector.hh b/include/hpp/bezier-com-traj/solve_end_effector.hh index 04b898ce6d4a9a2a3f19fef5a36a9193be9d5f69..0b75d4e6eb78714c623b109418617be00013d2ab 100644 --- a/include/hpp/bezier-com-traj/solve_end_effector.hh +++ b/include/hpp/bezier-com-traj/solve_end_effector.hh @@ -364,13 +364,13 @@ ResultDataCOMTraj solveEndEffector(const ProblemData& pData,const Path& path, co if(verbose){ std::cout<<"End eff H = "<<std::endl<<H<<std::endl; std::cout<<"End eff g = "<<std::endl<<g<<std::endl; + std::cout<<"Dim Var = "<<dimVar(pData)<<std::endl; + std::cout<<"Dim H = "<<H.rows()<<" x "<<H.cols()<<std::endl; + std::cout<<"Dim g = "<<g.rows()<<std::endl; + std::cout<<"Dim A = "<<A.rows()<<" x "<<A.cols()<<std::endl; + std::cout<<"Dim b = "<<b.rows()<<std::endl; } - // call the solver - std::cout<<"Dim Var = "<<dimVar(pData)<<std::endl; - std::cout<<"Dim H = "<<H.rows()<<" x "<<H.cols()<<std::endl; - std::cout<<"Dim g = "<<g.rows()<<std::endl; - std::cout<<"Dim A = "<<A.rows()<<" x "<<A.cols()<<std::endl; - std::cout<<"Dim b = "<<b.rows()<<std::endl; + VectorX init = VectorX(dimVar(pData)); // init = (pData.c0_ + pData.c1_)/2.;