aboutsummaryrefslogtreecommitdiff
path: root/src/poser_imu.c
diff options
context:
space:
mode:
authorCNLohr <charles@cnlohr.com>2018-04-04 02:27:42 -0400
committerGitHub <noreply@github.com>2018-04-04 02:27:42 -0400
commitce6322b6b604b12018a2daf427dbd36afc5fbda2 (patch)
tree5929c2793c33c80e5392982a9baaa8d5ccaca724 /src/poser_imu.c
parent6a45298c9bc34aac59cc2ebb9de2d82c7a42756e (diff)
parentc7d9d271796b20f886e2441de852498ecb25ca82 (diff)
downloadlibsurvive-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.c33
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);