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/poser_sba.c | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) (limited to 'src/poser_sba.c') 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]; -- cgit v1.2.3