Browse Source

add warning if fit error is high

pull/7/head
Charlie Kemp 4 years ago
parent
commit
0f6ce3a3c8
1 changed files with 5 additions and 1 deletions
  1. +5
    -1
      stretch_calibration/nodes/process_head_calibration_data

+ 5
- 1
stretch_calibration/nodes/process_head_calibration_data View File

@ -254,8 +254,12 @@ class HeadCalibrator:
def check_fit_error(self, fit_error): def check_fit_error(self, fit_error):
fit_error_threshold = 0.05 fit_error_threshold = 0.05
fit_warning_threshold = 0.03
if fit_error > fit_error_threshold: if fit_error > fit_error_threshold:
rospy.logerr('The fit error is unusually high: {0} > {1} (fit_error > fit_error_threshold)'.format(fit_error, fit_error_threshold))
rospy.logerr('The fit error is very high: {0} > {1} (fit_error > fit_error_threshold)'.format(fit_error, fit_error_threshold))
elif fit_error > fit_warning_threshold:
rospy.logwarn('The fit error is high: {0} > {1} (fit_error > fit_warning_threshold)'.format(fit_error, fit_warning_threshold))
def get_calibration_options(self): def get_calibration_options(self):
# Return the current calibration options # Return the current calibration options

Loading…
Cancel
Save