Skip to content
Snippets Groups Projects
Commit 44d6c582 authored by stevet's avatar stevet
Browse files

total tim is just sum of entries

parent da93781e
No related branches found
No related tags found
No related merge requests found
......@@ -302,7 +302,7 @@ double computeTotalTime(const VectorX& Ts)
ResultDataCOMTraj solveOnestep(const ProblemData& pData, const VectorX& Ts,const Vector3& init_guess,
const int pointsPerPhase, const double /*feasability_treshold*/){
assert(Ts.size() == pData.contacts_.size());
double T = computeTotalTime(Ts);
double T = Ts.sum();
std::pair<MatrixXX, VectorX> Ab = computeConstraintsOneStep(pData,Ts,T,pointsPerPhase);
std::pair<MatrixXX, VectorX> Hg = genCostFunction(pData,Ts,T,pointsPerPhase);
VectorX x = VectorX::Zero(numCol); x.head<3>() = init_guess;
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment