blob: 5453e4d2bf3d078772421fe18c19390559c12020 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
|
#ifndef _SURVIVE_IMU_H
#define _SURVIVE_IMU_H
#include "poser.h"
#include "survive.h"
#include "survive_types.h"
#include <stdbool.h>
#include <stdint.h>
#ifdef __cplusplus
extern "C" {
#endif
struct SurviveIMUTracker_p;
typedef struct {
SurviveObject *so;
bool is_initialized;
FLT updir[3];
FLT accel_scale_bias;
LinmathVec3d current_velocity; // Velocity in world frame
PoserDataIMU last_data;
SurvivePose pose;
SurvivePose lastGT;
uint32_t lastGTTime;
FLT P[7]; // estimate variance
LinmathVec3d integralFB;
} SurviveIMUTracker;
void survive_imu_tracker_integrate(SurviveObject *so, SurviveIMUTracker *tracker, PoserDataIMU *data);
void survive_imu_tracker_integrate_observation(SurviveObject *so, uint32_t timecode, SurviveIMUTracker *tracker,
SurvivePose *pose, const FLT *variance);
#ifdef __cplusplus
};
#endif
#endif
|
