diff options
author | CNLohr <charles@cnlohr.com> | 2018-04-04 02:27:42 -0400 |
---|---|---|
committer | GitHub <noreply@github.com> | 2018-04-04 02:27:42 -0400 |
commit | ce6322b6b604b12018a2daf427dbd36afc5fbda2 (patch) | |
tree | 5929c2793c33c80e5392982a9baaa8d5ccaca724 /src/poser_imu.c | |
parent | 6a45298c9bc34aac59cc2ebb9de2d82c7a42756e (diff) | |
parent | c7d9d271796b20f886e2441de852498ecb25ca82 (diff) | |
download | libsurvive-ce6322b6b604b12018a2daf427dbd36afc5fbda2.tar.gz libsurvive-ce6322b6b604b12018a2daf427dbd36afc5fbda2.tar.bz2 |
Merge pull request #122 from cnlohr/imu
Imu
Diffstat (limited to 'src/poser_imu.c')
-rw-r--r-- | src/poser_imu.c | 33 |
1 files changed, 33 insertions, 0 deletions
diff --git a/src/poser_imu.c b/src/poser_imu.c new file mode 100644 index 0000000..7615170 --- /dev/null +++ b/src/poser_imu.c @@ -0,0 +1,33 @@ +#include <survive.h> +#include <survive_imu.h> + +#include <stdio.h> +#include <stdlib.h> + +int PoserIMU(SurviveObject *so, PoserData *pd) { + PoserType pt = pd->pt; + SurviveContext *ctx = so->ctx; + SurviveIMUTracker *dd = so->PoserData; + + if (!dd) { + so->PoserData = dd = malloc(sizeof(SurviveIMUTracker)); + *dd = (SurviveIMUTracker){}; + } + + switch (pt) { + case POSERDATA_IMU: { + PoserDataIMU *imu = (PoserDataIMU *)pd; + + survive_imu_tracker_integrate(so, dd, imu); + + PoserData_poser_pose_func(pd, so, &dd->pose); + + // if(magnitude3d(dd->pose.Pos) > 1) + // SV_ERROR("IMU drift"); + return 0; + } + } + return -1; +} + +REGISTER_LINKTIME(PoserIMU); |