From ec74d351f0c533da1626b05d1db9e20b678a8f72 Mon Sep 17 00:00:00 2001 From: Chris Hennes Date: Tue, 29 Mar 2022 13:24:17 -0500 Subject: [PATCH] Robot: PR6497 move return statement to new line --- .../Robot/App/kdl_cp/chainiksolverpos_nr.cpp | 3 +- .../App/kdl_cp/chainiksolvervel_pinv.cpp | 3 +- .../App/kdl_cp/chainiksolvervel_wdls.cpp | 3 +- .../Robot/App/kdl_cp/chainjnttojacsolver.cpp | 3 +- src/Mod/Robot/App/kdl_cp/tree.cpp | 6 ++-- .../App/kdl_cp/treeiksolverpos_nr_jl.cpp | 3 +- .../App/kdl_cp/utilities/svd_eigen_HH.cpp | 33 ++++++++++++------- 7 files changed, 36 insertions(+), 18 deletions(-) diff --git a/src/Mod/Robot/App/kdl_cp/chainiksolverpos_nr.cpp b/src/Mod/Robot/App/kdl_cp/chainiksolverpos_nr.cpp index b10dff5ec1..37823f9886 100644 --- a/src/Mod/Robot/App/kdl_cp/chainiksolverpos_nr.cpp +++ b/src/Mod/Robot/App/kdl_cp/chainiksolverpos_nr.cpp @@ -57,7 +57,8 @@ namespace KDL const char* ChainIkSolverPos_NR::strError(const int error) const { - if (E_IKSOLVER_FAILED == error) return "Child IK solver failed"; + if (E_IKSOLVER_FAILED == error) + return "Child IK solver failed"; else return SolverI::strError(error); } } diff --git a/src/Mod/Robot/App/kdl_cp/chainiksolvervel_pinv.cpp b/src/Mod/Robot/App/kdl_cp/chainiksolvervel_pinv.cpp index 979d11b307..8dd23b316d 100644 --- a/src/Mod/Robot/App/kdl_cp/chainiksolvervel_pinv.cpp +++ b/src/Mod/Robot/App/kdl_cp/chainiksolvervel_pinv.cpp @@ -109,7 +109,8 @@ namespace KDL const char* ChainIkSolverVel_pinv::strError(const int error) const { - if (E_SVD_FAILED == error) return "SVD failed"; + if (E_SVD_FAILED == error) + return "SVD failed"; else return SolverI::strError(error); } } diff --git a/src/Mod/Robot/App/kdl_cp/chainiksolvervel_wdls.cpp b/src/Mod/Robot/App/kdl_cp/chainiksolvervel_wdls.cpp index 80bc45022e..119e9268f6 100644 --- a/src/Mod/Robot/App/kdl_cp/chainiksolvervel_wdls.cpp +++ b/src/Mod/Robot/App/kdl_cp/chainiksolvervel_wdls.cpp @@ -175,7 +175,8 @@ namespace KDL const char* ChainIkSolverVel_wdls::strError(const int error) const { - if (E_SVD_FAILED == error) return "SVD failed"; + if (E_SVD_FAILED == error) + return "SVD failed"; else return SolverI::strError(error); } diff --git a/src/Mod/Robot/App/kdl_cp/chainjnttojacsolver.cpp b/src/Mod/Robot/App/kdl_cp/chainjnttojacsolver.cpp index e84bbc7ce7..171e3b5948 100644 --- a/src/Mod/Robot/App/kdl_cp/chainjnttojacsolver.cpp +++ b/src/Mod/Robot/App/kdl_cp/chainjnttojacsolver.cpp @@ -100,7 +100,8 @@ namespace KDL const char* ChainJntToJacSolver::strError(const int error) const { - if (E_JAC_FAILED == error) return "Jac Failed"; + if (E_JAC_FAILED == error) + return "Jac Failed"; else return SolverI::strError(error); } } diff --git a/src/Mod/Robot/App/kdl_cp/tree.cpp b/src/Mod/Robot/App/kdl_cp/tree.cpp index 50425e298c..463e754c13 100644 --- a/src/Mod/Robot/App/kdl_cp/tree.cpp +++ b/src/Mod/Robot/App/kdl_cp/tree.cpp @@ -125,12 +125,14 @@ bool Tree::addTreeRecursive(SegmentMap::const_iterator root, const std::string& parents_chain_root.push_back(s->first); if (s->first == root_name) break; } - if (parents_chain_root.empty() || parents_chain_root.back() != root_name) return false; + if (parents_chain_root.empty() || parents_chain_root.back() != root_name) + return false; for (SegmentMap::const_iterator s=getSegment(chain_tip); s!=segments.end(); s = GetTreeElementParent(s->second)){ parents_chain_tip.push_back(s->first); if (s->first == root_name) break; } - if (parents_chain_tip.empty() || parents_chain_tip.back() != root_name) return false; + if (parents_chain_tip.empty() || parents_chain_tip.back() != root_name) + return false; // remove common part of segment lists SegmentMap::key_type last_segment = root_name; diff --git a/src/Mod/Robot/App/kdl_cp/treeiksolverpos_nr_jl.cpp b/src/Mod/Robot/App/kdl_cp/treeiksolverpos_nr_jl.cpp index 2b0b1a3c8a..ce535b2e5b 100644 --- a/src/Mod/Robot/App/kdl_cp/treeiksolverpos_nr_jl.cpp +++ b/src/Mod/Robot/App/kdl_cp/treeiksolverpos_nr_jl.cpp @@ -58,7 +58,8 @@ namespace KDL { delta_twist->second = diff(f_it->second, f_des_it->second); } double res = iksolver.CartToJnt(q_out, delta_twists, delta_q); - if (res < eps) return res; + if (res < eps) + return res; Add(q_out, delta_q, q_out); diff --git a/src/Mod/Robot/App/kdl_cp/utilities/svd_eigen_HH.cpp b/src/Mod/Robot/App/kdl_cp/utilities/svd_eigen_HH.cpp index 35349039f9..8da1407f6b 100644 --- a/src/Mod/Robot/App/kdl_cp/utilities/svd_eigen_HH.cpp +++ b/src/Mod/Robot/App/kdl_cp/utilities/svd_eigen_HH.cpp @@ -58,14 +58,16 @@ namespace KDL{ s += U(k,i)*U(k,i); } f=U(i,i); // f is the diag elem - if (!(s>=0)) return -3; + if (!(s>=0)) + return -3; g = -SIGN(sqrt(s),f); h=f*g-s; U(i,i)=f-g; for (j=ppi;j=0)) return -5; + if (!(s>=0)) + return -5; g = -SIGN(sqrt(s),f); h=f*g-s; U(i,ppi)=f-g; - if (!(h!=0)) return -6; + if (!(h!=0)) + return -6; for (k=ppi;k=0;i--) { if (iepsilon) { - if (!(U(i,ppi)!=0)) return -7; + if (!(U(i,ppi)!=0)) + return -7; for (j=ppi;j