Skip to content

Commit

Permalink
Update orocos_kdl/src/chainiksolvervel_pinv.cpp
Browse files Browse the repository at this point in the history
formatting style

Co-authored-by: Matthijs van der Burgh <[email protected]>
  • Loading branch information
craigirobot and MatthijsBurgh authored Apr 8, 2023
1 parent d7aefe2 commit c332a23
Showing 1 changed file with 5 additions and 3 deletions.
8 changes: 5 additions & 3 deletions orocos_kdl/src/chainiksolvervel_pinv.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -120,11 +120,13 @@ namespace KDL
Smaxtomin = S;
SortJntArrayMaxToMin(Smaxtomin);
// Minimum of six largest singular values of J is S(5) if number of joints >=6 and 0 for <6
if ( jac.columns() >= 6 ) {
if (jac.columns() >= 6)
{
sigmaMin = Smaxtomin(5);
}
else {
sigmaMin = 0.;
else
{
sigmaMin = 0;
}

// We have to calculate qdot_out = jac_pinv*v_in
Expand Down

0 comments on commit c332a23

Please sign in to comment.