diff --git a/feature_constraints_standalone/scripts/constraint_config.py b/feature_constraints_standalone/scripts/constraint_config.py index 025a247..b4f437e 100755 --- a/feature_constraints_standalone/scripts/constraint_config.py +++ b/feature_constraints_standalone/scripts/constraint_config.py @@ -25,6 +25,9 @@ up = Feature('pancake', 'plane', Feature.PLANE, Vector3(0,0,0), Vector3(0,0,0.3), Vector3(1,0,0)) +tool_normal = Feature('spatula', 'blade_normal', Feature.PLANE, + Vector3(0,0,0), Vector3(0.1,0,0), Vector3(0,0,0)) + c = [] c.append(Constraint('angle', 'angle', tool_center_right, up)) @@ -35,6 +38,9 @@ c.append(Constraint('align_side', 'perpendicular', tool_side, up)) c.append(Constraint('pointing_at', 'pointing_at', tool_forward, up)) +#for turning +#c.append(Constraint('turned', 'perpendicular', tool_normal, up)) + rospy.init_node('constraint_config') pub = rospy.Publisher('/constraint_config', ConstraintConfig, latch=True) pub.publish(ConstraintConfig(c))