diff options
author | Justin Berger <jdavidberger@gmail.com> | 2018-07-01 04:13:34 +0000 |
---|---|---|
committer | Justin Berger <jdavidberger@gmail.com> | 2018-07-01 04:13:34 +0000 |
commit | 47141c873ffd3d7af62bfba40b1adbcce0df6574 (patch) | |
tree | 245575a52f46b7fdd163b264eb17ee74863d0c28 /src/poser_sba.c | |
parent | 70ac578a3edfdac2223bb0419445621cfb153c72 (diff) | |
download | libsurvive-47141c873ffd3d7af62bfba40b1adbcce0df6574.tar.gz libsurvive-47141c873ffd3d7af62bfba40b1adbcce0df6574.tar.bz2 |
Finalized reading in and transforming of accel/gyro data
Diffstat (limited to 'src/poser_sba.c')
-rw-r--r-- | src/poser_sba.c | 4 |
1 files changed, 2 insertions, 2 deletions
diff --git a/src/poser_sba.c b/src/poser_sba.c index 8437d4d..1e8637c 100644 --- a/src/poser_sba.c +++ b/src/poser_sba.c @@ -109,12 +109,12 @@ static size_t construct_input_from_scene(SBAData *d, PoserDataLight *pdl, Surviv vmask[sensor * NUM_LIGHTHOUSES + lh] = 1; if (cov) { *(cov++) = d->sensor_variance + - abs((int32_t)pdl->timecode - (int32_t)scene->timecode[sensor][lh][0]) * + fabs((float)pdl->timecode - (float)scene->timecode[sensor][lh][0]) * d->sensor_variance_per_second / (double)so->timebase_hz; *(cov++) = 0; *(cov++) = 0; *(cov++) = d->sensor_variance + - abs((int32_t)pdl->timecode - (int32_t)scene->timecode[sensor][lh][1]) * + fabs((float)pdl->timecode - (float)scene->timecode[sensor][lh][1]) * d->sensor_variance_per_second / (double)so->timebase_hz; } meas[rtn++] = a[0]; |