diff options
Diffstat (limited to 'src/survive_vive.c')
| -rwxr-xr-x | src/survive_vive.c | 4 |
1 files changed, 4 insertions, 0 deletions
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 |