def get_rms_position_error(positions, position_set_point, index,
print_output=True):
pos_rms_error = analyze_bag.xyz_rms_error(position_set_point, positions)
if print_output:
print("[Waypoint %d]: Position RMS error: %.3f m"
% (index, pos_rms_error))
return pos_rms_error
def get_rms_angular_velocity_error(angular_velocities,
angular_velocity_set_point, index,
print_output=True):
pqr_rms_error = analyze_bag.xyz_rms_error(angular_velocity_set_point,
angular_velocities)
if print_output:
print("[Waypoint %d]: Angular velocity RMS error: %.3f rad/s"
% (index, pqr_rms_error))
return pqr_rms_error