mirror of
https://github.com/YikeStone/ros_arduino_bridge.git
synced 2025-08-03 19:24:09 +05:30
Undid last commit since it introduced another bug...
This commit is contained in:
parent
f5b825c8ee
commit
5f35efe852
@ -71,11 +71,13 @@ 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:
|
||||
if "Servo" not in str(self.component):
|
||||
freq_bounds = diagnostic_updater.FrequencyStatusParam({'min': self.component.rate, 'max': self.component.rate}, 0.3, 5)
|
||||
if "Servo" in str(self.component):
|
||||
freq_bounds = diagnostic_updater.FrequencyStatusParam({'min': self.component.device.joint_update_rate, 'max': self.component.device.joint_update_rate}, 0.3, 5)
|
||||
self.freq_diag = diagnostic_updater.HeaderlessTopicDiagnostic(self.component.name + '_freq', self.diag_updater, freq_bounds)
|
||||
else:
|
||||
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)
|
||||
|
Loading…
x
Reference in New Issue
Block a user