From 91f3a61a55b6634de0e96a92a1f7726520ae7324 Mon Sep 17 00:00:00 2001 From: Gustavo Goretkin Date: Tue, 5 Dec 2023 11:53:20 -0500 Subject: [PATCH] Use `self.frame_prefix` instead of `frame_prefix` --- spot_driver/spot_driver/spot_ros2.py | 19 +++++++++++++------ 1 file changed, 13 insertions(+), 6 deletions(-) diff --git a/spot_driver/spot_driver/spot_ros2.py b/spot_driver/spot_driver/spot_ros2.py index f6a0f2344..8f8dbb936 100644 --- a/spot_driver/spot_driver/spot_ros2.py +++ b/spot_driver/spot_driver/spot_ros2.py @@ -352,22 +352,29 @@ def __init__(self, parameter_list: Optional[typing.List[Parameter]] = None, **kw frame_prefix = self.name + "/" self.frame_prefix: str = frame_prefix self.preferred_odom_frame: Parameter = self.declare_parameter( - "preferred_odom_frame", frame_prefix + "odom" + "preferred_odom_frame", self.frame_prefix + "odom" ) # 'vision' or 'odom' - self.tf_name_kinematic_odom: Parameter = self.declare_parameter("tf_name_kinematic_odom", frame_prefix + "odom") + self.tf_name_kinematic_odom: Parameter = self.declare_parameter( + "tf_name_kinematic_odom", self.frame_prefix + "odom" + ) self.tf_name_raw_kinematic: str = frame_prefix + "odom" - self.tf_name_vision_odom: Parameter = self.declare_parameter("tf_name_vision_odom", frame_prefix + "vision") - self.tf_name_raw_vision: str = frame_prefix + "vision" + self.tf_name_vision_odom: Parameter = self.declare_parameter( + "tf_name_vision_odom", self.frame_prefix + "vision" + ) + self.tf_name_raw_vision: str = self.frame_prefix + "vision" if ( self.preferred_odom_frame.value != self.tf_name_raw_kinematic and self.preferred_odom_frame.value != self.tf_name_raw_vision ): - error_msg = f'rosparam "preferred_odom_frame" should be "{frame_prefix}odom" or "{frame_prefix}vision".' + error_msg = ( + f'rosparam "preferred_odom_frame" should be "{self.tf_name_raw_kinematic}" or' + f' "{self.tf_name_raw_vision}".' + ) self.get_logger().error(error_msg) raise ValueError(error_msg) - self.tf_name_graph_nav_body: str = frame_prefix + "body" + self.tf_name_graph_nav_body: str = self.frame_prefix + "body" # logger for spot wrapper name_with_dot = ""