diff --git a/clever/src/simple_offboard.py b/clever/src/simple_offboard.py index 745d5732..2a319fcf 100755 --- a/clever/src/simple_offboard.py +++ b/clever/src/simple_offboard.py @@ -284,13 +284,13 @@ def handle(req): try: with handle_lock: - stamp = rospy.get_rostime() - current_req = req - current_pub, current_msg = get_publisher_and_message(req, stamp, False) - rospy.loginfo('Topic: %s, message: %s', current_pub.name, current_msg) + stamp = rospy.get_rostime() + current_req = req + current_pub, current_msg = get_publisher_and_message(req, stamp, False) + rospy.loginfo('Topic: %s, message: %s', current_pub.name, current_msg) - current_msg.header.stamp = stamp - current_pub.publish(current_msg) + current_msg.header.stamp = stamp + current_pub.publish(current_msg) if req.auto_arm: offboard_and_arm()