Пример #1
0
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
Пример #2
0
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