goal = ActionGoal()
goal.goal_goal1 = 191.08
goal.goal_goal2 = 223.33
goal.goal_goal3 = 400.54
goal.goal_goal4 = -178.77
goal.goal_goal5 = 1.46
goal.goal_goal6 = 131.84
result = call_server()
print 'The result is:', result
except rospy.ROSInterruptException as e:
print 'Something went wrong:', e
from om_aiv_navigation.msg import ActionAction, ActionGoal
try:
goal = ActionGoal()
goal.goal_goal = "dropoff"
result = call_ld_server()
print 'The result is:', result
print "ld moved to dropoff location"
except rospy.ROSInterruptException as e:
print 'Something went wrong:', e
from tm_motion.msg import ActionAction, ActionGoal
print "TM moving to location to scan tm landmark for dropoff"
try:
goal = ActionGoal()
# goal.goal_goal1 = float(values3[0])
# goal.goal_goal2 = float(values3[1])
# goal.goal_goal3 = float(values3[2])
# goal.goal_goal4 = float(values3[3])
# goal.goal_goal5 = float(values3[4])
def call_ld_server():
client = actionlib.SimpleActionClient('goTo', ActionAction)
client.wait_for_server()
client.send_goal_and_wait(goal)
client.wait_for_result()
result = client.get_result()
return result
if __name__ == "__main__":
rospy.init_node('moma')
print "REMEMBER TO PUT TM ARM IN SAFE POSITION"
try:
goal = ActionGoal()
goal.goal_goal = "pickup"
result = call_ld_server()
print 'The result is:', result
print "ld moved to pickup location"
except rospy.ROSInterruptException as e:
print 'Something went wrong:', e
start_program()
from tm_motion.msg import ActionAction, ActionGoal
print "tm moving to pick location to scan tm landmark"
try:
goal = ActionGoal()
goal.goal_goal1 = 440.52
goal.goal_goal2 = 362.69
goal.goal_goal3 = 706.25
goal.goal_goal4 = 178.59
def call_ld_server():
client = actionlib.SimpleActionClient('goTo', ActionAction)
client.wait_for_server()
client.send_goal(goal, feedback_cb=feedback_cb)
client.wait_for_result(rospy.Duration(0))
result = client.get_result()
return result
if __name__ == "__main__":
rospy.init_node('moma')
print "REMEMBER TO PUT TM ARM IN SAFE POSITION"
try:
goal = ActionGoal()
goal.goal_goal = "pickup"
result = call_ld_server()
print 'The result is:', result
print "ld moved to pickup location"
except rospy.ROSInterruptException as e:
exit(0)
print 'Something went wrong:', e
start_program()
from tm_motion.msg import ActionAction, ActionGoal
print "tm moving to pick location to scan tm landmark"
try:
goal = ActionGoal()
goal.goal_goal1 = 373.52
goal.goal_goal2 = -165
goal.goal_goal3 = 683.37