diff options
Diffstat (limited to 'include/libsurvive/survive_imu.h')
-rw-r--r-- | include/libsurvive/survive_imu.h | 5 |
1 files changed, 5 insertions, 0 deletions
diff --git a/include/libsurvive/survive_imu.h b/include/libsurvive/survive_imu.h index 124ad7e..8a86425 100644 --- a/include/libsurvive/survive_imu.h +++ b/include/libsurvive/survive_imu.h @@ -22,12 +22,17 @@ typedef struct { SurvivePose lastGT; uint32_t lastGTTime; + FLT P[7]; // estimate variance + float integralFBx, integralFBy, integralFBz; // integral error terms scaled by Ki } SurviveIMUTracker; void survive_imu_tracker_set_pose(SurviveIMUTracker *tracker, uint32_t timecode, SurvivePose *pose); + 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 }; |