17void so3_skew(
const float v[3],
float S[9]);
18void so3_exp(
const float phi[3],
float R[9]);
22void mat3_mul(
const float A[9],
const float B[9],
float C[9]);
23void mat3_vec(
const float A[9],
const float x[3],
float y[3]);
24void mat3t_vec(
const float A[9],
const float x[3],
float y[3]);
25int mat3_inv(
const float A[9],
float Ai[9]);
28float vec3_dot(
const float a[3],
const float b[3]);
29void vec3_cross(
const float a[3],
const float b[3],
float c[3]);
int mat3_inv(const float A[9], float Ai[9])
0 = OK
void so3_exp(const float phi[3], float R[9])
void mat3_vec(const float A[9], const float x[3], float y[3])
y = A*x
void so3_to_quat(const float R[9], float q[4])
void mat3t_vec(const float A[9], const float x[3], float y[3])
y = A'*x
void vec3_cross(const float a[3], const float b[3], float c[3])
float vec3_norm(const float v[3])
void mat3_mul(const float A[9], const float B[9], float C[9])
C = A*B
void so3_orthonormalize(float R[9])
float vec3_dot(const float a[3], const float b[3])
int vec3_normalize(float v[3])
0 = OK
void so3_skew(const float v[3], float S[9])