Tweaked diagnostics.py so that rqt_robot_monitor does not complain about missing joint frequencies

This commit is contained in:
Patrick Goebel 2016-09-13 07:46:23 -07:00
parent be4bb3e219
commit f5b825c8ee

View File

@ -71,9 +71,11 @@ class DiagnosticsUpdater():
self.diag_updater.setHardwareID(self.name)
# Create a frequency monitor that tracks the publishing frequency for this component
# TODO: Need to add frequency check for servo controller (joint_update_rate)
if self.component.rate > 0:
freq_bounds = diagnostic_updater.FrequencyStatusParam({'min': self.component.rate, 'max': self.component.rate}, 0.3, 5)
self.freq_diag = diagnostic_updater.HeaderlessTopicDiagnostic(self.component.name + '_freq', self.diag_updater, freq_bounds)
if "Servo" not in str(self.component):
freq_bounds = diagnostic_updater.FrequencyStatusParam({'min': self.component.rate, 'max': self.component.rate}, 0.3, 5)
self.freq_diag = diagnostic_updater.HeaderlessTopicDiagnostic(self.component.name + '_freq', self.diag_updater, freq_bounds)
# Create an error monitor that tracks timeouts, serial exceptions etc
self.error_diag = diagnostic_updater.FunctionDiagnosticTask(self.name, self.get_error_rate)