Skip to content

Commit

Permalink
added a 'spatula horizontal' constraint
Browse files Browse the repository at this point in the history
This was only switched on for making screenshots.
  • Loading branch information
IngoKresse committed Mar 9, 2014
1 parent e12c8d9 commit 4b04f93
Showing 1 changed file with 6 additions and 0 deletions.
6 changes: 6 additions & 0 deletions feature_constraints_standalone/scripts/constraint_config.py
Original file line number Diff line number Diff line change
Expand Up @@ -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))
Expand All @@ -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))
Expand Down

0 comments on commit 4b04f93

Please sign in to comment.