36 puts(
"***************** Magnetic-based system example *****************");
38 { 100.395, 16.781, 1.084 },
39 { 100.937, 22.941, 1.072 },
40 { 106.229, 22.716, 1.064 },
44 matrix_t true_pos[3] = { 102, 18, 2.308 };
47 matrix_t B_vec[4] = { 43.2630, 3.0620, 1.4890, 4.5361 };
49 matrix_t theta_vec[4] = { 31.3710, 12.4870, 11.7280, 0.5352 };
50 uint8_t ref_point_num = 4;
53 for (uint8_t i = 0; i < ref_point_num; i++) {
65 printf(
"true position = ");
69 printf(
"estimated position = ");