|
RcdMathLib_doc
Open Source Library for Linear and Non-linear Algebra
|
Go to the documentation of this file.
32 matrix_t ref_pos_matrix[4][3] = { { 0, 0, 1.67 },
39 double A_matrix[m][4];
40 double true_pos[] = { 1, 1, 0 };
42 double pdop_val =
get_PDOP(m, ref_pos_matrix, true_pos);
44 printf(
"pdop_val = %.7f\n", pdop_val);
47 printf(
"A_matrix = ");
Implement the trilateration algorithm.
void trilateration_get_A_matrix(uint8_t m, matrix_t anchor_pos_matrix[m][3], matrix_t A_matrix[m][4])
Computes the matrix of the equation system: .
matrix_t get_PDOP(uint8_t m, matrix_t ref_Matrix[m][3], matrix_t true_pos[m])
Compute the Position Dilution of Precision (PDOP).
void matrix_flex_print(uint8_t m, uint8_t n, matrix_t matrix[m][n], uint8_t before_dec, uint8_t after_dec)
Display the values of the matrix elements.
void pos_algos_common_test(void)
Example of common localization algorithms.
#define matrix_t
Define the data type of the matrix elements.
Compute the Position Dilution of Precision (PDOP).