From 47141c873ffd3d7af62bfba40b1adbcce0df6574 Mon Sep 17 00:00:00 2001 From: Justin Berger Date: Sun, 1 Jul 2018 04:13:34 +0000 Subject: Finalized reading in and transforming of accel/gyro data --- src/survive_vive.c | 4 ++++ 1 file changed, 4 insertions(+) (limited to 'src/survive_vive.c') diff --git a/src/survive_vive.c b/src/survive_vive.c index 5bf0800..cc2303c 100755 --- a/src/survive_vive.c +++ b/src/survive_vive.c @@ -1021,6 +1021,8 @@ void calibrate_acc(SurviveObject* so, FLT* agm) { agm[1] *= so->acc_scale[1]; agm[2] *= so->acc_scale[2]; } + + quatrotatevector(agm, so->relative_imu_pose.Rot, agm); } void calibrate_gyro(SurviveObject* so, FLT* agm) { @@ -1035,6 +1037,8 @@ void calibrate_gyro(SurviveObject* so, FLT* agm) { agm[1] *= so->gyro_scale[1]; agm[2] *= so->gyro_scale[2]; } + + quatrotatevector(agm, so->relative_imu_pose.Rot, agm); } typedef struct -- cgit v1.2.3