diff --git a/jsk_spot_robot/jsk_spot_startup/apps/sample_elevator/sample_elevator.py b/jsk_spot_robot/jsk_spot_startup/apps/sample_elevator/sample_elevator.py index aba406b27c..00372e57e8 100755 --- a/jsk_spot_robot/jsk_spot_startup/apps/sample_elevator/sample_elevator.py +++ b/jsk_spot_robot/jsk_spot_startup/apps/sample_elevator/sample_elevator.py @@ -19,12 +19,14 @@ client.power_on() client.undock() - behavior_client.send_goal_and_wait(NavigationGoal(target_node_id="eng2_3FElevator")) - result = behavior_client.get_result() + client.reset_current_node('eng2_73B2_dock') + client.execute_behaviors(target_node_id="eng2_3FElevator") + client.wait_execute_behaviors_result() + result = client.get_execute_behaviors_result() rospy.loginfo("Result forward: {} {}".format(result.success, result.message)) - behavior_client.send_goal_and_wait(NavigationGoal(target_node_id="eng2_73B2_dock")) - result = behavior_client.get_result() + client.execute_behaviors(NavigationGoal(target_node_id="eng2_73B2_dock")) + result = client.get_execute_behaviors_result() rospy.loginfo("Result backward: {} {}".format(result.success, result.message)) client.dock(521) diff --git a/jsk_spot_robot/jsk_spot_startup/apps/sample_elevator/sample_elevator.xml b/jsk_spot_robot/jsk_spot_startup/apps/sample_elevator/sample_elevator.xml index a893cf0bbd..f3497f43d5 100644 --- a/jsk_spot_robot/jsk_spot_startup/apps/sample_elevator/sample_elevator.xml +++ b/jsk_spot_robot/jsk_spot_startup/apps/sample_elevator/sample_elevator.xml @@ -2,8 +2,8 @@ - + file="$(find elevator_operation)/launch/elevator_state_publisher.launch"> + +