ACwing FC firmware
STM32WB55: attitude IEKF, altitude Kalman filter, flight core, protocol v2
Loading...
Searching...
No Matches
so3.h
Go to the documentation of this file.
1
10#ifndef SO3_H
11#define SO3_H
12
13#ifdef __cplusplus
14extern "C" {
15#endif
16
17void so3_skew(const float v[3], float S[9]);
18void so3_exp(const float phi[3], float R[9]);
19void so3_orthonormalize(float R[9]);
20void so3_to_quat(const float R[9], float q[4]);
21
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]);
27float vec3_norm(const float v[3]);
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]);
30int vec3_normalize(float v[3]);
32#ifdef __cplusplus
33}
34#endif
35#endif /* SO3_H */
static struct @10 B
double b[6]
Definition calib_mgr.c:53
static struct @7 A
static struct @11 C
int mat3_inv(const float A[9], float Ai[9])
0 = OK
Definition so3.c:127
void so3_exp(const float phi[3], float R[9])
Definition so3.c:22
void mat3_vec(const float A[9], const float x[3], float y[3])
y = A*x
Definition so3.c:113
void so3_to_quat(const float R[9], float q[4])
Definition so3.c:80
void mat3t_vec(const float A[9], const float x[3], float y[3])
y = A'*x
Definition so3.c:120
void vec3_cross(const float a[3], const float b[3], float c[3])
Definition so3.c:49
float vec3_norm(const float v[3])
Definition so3.c:47
void mat3_mul(const float A[9], const float B[9], float C[9])
C = A*B
Definition so3.c:106
void so3_orthonormalize(float R[9])
Definition so3.c:65
float vec3_dot(const float a[3], const float b[3])
Definition so3.c:46
int vec3_normalize(float v[3])
0 = OK
Definition so3.c:56
void so3_skew(const float v[3], float S[9])
Definition so3.c:15