34 puts(
"***************** Distance-based system example *****************");
35 matrix_t ref_pos_matrix[4][3] = { { 0, 0, 1.67 },
41 matrix_t true_pos[3] = { 1.0000, 3.0000, 0.0000 };
43 matrix_t measured_dist_arr[4] = { 3.577157155, 4.685985423, 3.883094303,
47 uint8_t ref_point_num = 4;
51 printf(
"true position = ");
55 printf(
"estimated position = ");