From d89e5eada7ae4326d15dcfb1b86b08dde222b4a5 Mon Sep 17 00:00:00 2001 From: Oleg Kalachev Date: Tue, 1 Feb 2022 07:00:01 +0300 Subject: [PATCH] selfcheck.py: add checking map=>body transform --- clover/src/selfcheck.py | 3 +++ 1 file changed, 3 insertions(+) diff --git a/clover/src/selfcheck.py b/clover/src/selfcheck.py index f8c8f5cc..3093f813 100755 --- a/clover/src/selfcheck.py +++ b/clover/src/selfcheck.py @@ -488,6 +488,9 @@ def check_local_position(): if not tf_buffer.can_transform('base_link', pose.header.frame_id, rospy.get_rostime(), rospy.Duration(0.5)): failure('can\'t transform from %s to base_link (timeout 0.5 s): is TF enabled?', pose.header.frame_id) + if not tf_buffer.can_transform('body', pose.header.frame_id, rospy.get_rostime(), rospy.Duration(0.5)): + failure('can\'t transform from %s to body (timeout 0.5 s)', pose.header.frame_id) + except rospy.ROSException: failure('no local position')