@@ -81,9 +81,34 @@ void FramePublisher::frameBroadcastCallback(const ros::TimerEvent& event)
81
81
transform_msg = tf_buffer_.lookupTransform (from_frame_, to_frame_, ros::Time (0 ), ros::Duration (0.1 ));
82
82
ROS_DEBUG_STREAM (" FramePublisher::frameBroadcastCallback: transform_msg:\n " << transform_msg);
83
83
}
84
+ catch (tf2::ConnectivityException& ex)
85
+ {
86
+ ROS_ERROR_THROTTLE (5.0 , " FramePublisher::frameBroadcastCallback ConnectivityException: \n %s" , ex.what ());
87
+ return ;
88
+ }
89
+ catch (tf2::ExtrapolationException& ex)
90
+ {
91
+ ROS_ERROR_THROTTLE (5.0 , " FramePublisher::frameBroadcastCallback ExtrapolationException: \n %s" , ex.what ());
92
+ return ;
93
+ }
94
+ catch (tf2::InvalidArgumentException& ex)
95
+ {
96
+ ROS_ERROR_THROTTLE (5.0 , " FramePublisher::frameBroadcastCallback InvalidArgumentException: \n %s" , ex.what ());
97
+ return ;
98
+ }
99
+ catch (tf2::LookupException& ex)
100
+ {
101
+ ROS_ERROR_THROTTLE (5.0 , " FramePublisher::frameBroadcastCallback LookupException: \n %s" , ex.what ());
102
+ return ;
103
+ }
104
+ catch (tf2::TimeoutException& ex)
105
+ {
106
+ ROS_ERROR_THROTTLE (5.0 , " FramePublisher::frameBroadcastCallback TimeoutException: \n %s" , ex.what ());
107
+ return ;
108
+ }
84
109
catch (tf2::TransformException& ex)
85
110
{
86
- ROS_ERROR ( " FramePublisher::frameBroadcastCallback: \n %s" , ex.what ());
111
+ ROS_ERROR_THROTTLE ( 5.0 , " FramePublisher::frameBroadcastCallback TransformException : \n %s" , ex.what ());
87
112
return ;
88
113
}
89
114
0 commit comments