void dist_based_f_i(uint8_t ref_points_num, matrix_t ref_point_mat[ref_points_num][3], matrix_t point[3], matrix_t d_vec[], matrix_t f_vec[])
Defines the error function of a distance-based localization system.
matrix_t dist_based_fi(matrix_t point[3], matrix_t ref_point[3], matrix_t ri)
Defines the error function of a distance-based localization system.