word logic better

TAMS-Group · Jan 26, 2023 · 2f06f2c · 2f06f2c
1 parent 9f6db75
commit 2f06f2c
Show file tree

Hide file tree

Showing 2 changed files with 3 additions and 3 deletions.
diff --git a/include/bio_ik/robot_info.h b/include/bio_ik/robot_info.h
@@ -98,7 +98,7 @@ class RobotInfo
             info.max_velocity_rcp = info.max_velocity > 0.0 ? 1.0 / info.max_velocity : 0.0;
 
             variables.push_back(info);
-            has_bounds.push_back(!bounded);
+            has_bounds.push_back(bounded);
         }
 
         for(size_t ivar = 0; ivar < model->getVariableCount(); ivar++)

diff --git a/src/kinematics_plugin.cpp b/src/kinematics_plugin.cpp
@@ -611,8 +611,8 @@ struct BioIKKinematicsPlugin : kinematics::KinematicsBase {
       }
       state[ivar] = v;
 
-      // wrap angles that are not continuous
-      if(!robot_info.hasBounds(ivar))
+      // wrap angles that are bounded
+      if(robot_info.hasBounds(ivar))
       {
         auto* joint_model = robot_model->getJointOfVariable(ivar);
         joint_model->enforcePositionBounds(state.data() + ivar, joint_model->getVariableBounds());