Skip to content

Commit 5d66d55

Browse files
committed
Fix error introduced by commit 2d50269
1 parent ba2a0b9 commit 5d66d55

File tree

1 file changed

+3
-1
lines changed

1 file changed

+3
-1
lines changed

src/sot/sot.cpp

Lines changed: 3 additions & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -622,6 +622,8 @@ computeControlLaw( dynamicgraph::Vector& control,const int& iterTime )
622622
{ Proj.resize( mJ,mJ ); Proj.setIdentity(); }
623623

624624
/* --- OLIVIER START --- */
625+
// Update by Joseph Mirabel to match Eigen API
626+
625627
sotDEBUG(2) << "Proj non optimal (rankJ= " <<rankJ
626628
<< ", iterTask =" << iterTask
627629
<< ")";
@@ -630,7 +632,7 @@ computeControlLaw( dynamicgraph::Vector& control,const int& iterTime )
630632
sotDEBUG(2) << "JpxJt = " << Jp*Jt;
631633
sotDEBUG(25) << "Proj-Jp*Jt"<<iterTask<<" = "<< (Proj-Jp*Jt) <<endl;
632634

633-
Proj.noalias() -= Jp * Jt;
635+
Proj.noalias() -= svd.matrixV().leftCols(rankJ) * svd.matrixV().leftCols(rankJ).adjoint();
634636

635637
/* --- OLIVIER END --- */
636638

0 commit comments

Comments
 (0)