diff options
author | jdavidberger <j.david.berger@gmail.com> | 2018-04-11 10:51:45 -0600 |
---|---|---|
committer | GitHub <noreply@github.com> | 2018-04-11 10:51:45 -0600 |
commit | 0cd7e8d9783e8cdff7be99a330b2096a0648b192 (patch) | |
tree | 09fa3f286dc20d87448220a4f7800fd0e3f04087 /src/poser_sba.c | |
parent | 7af7eec04bc03719aa6b2879fe599ff0cf43e032 (diff) | |
parent | 8469de349450efb8e71fd0735bfe2dd6d3c62063 (diff) | |
download | libsurvive-0cd7e8d9783e8cdff7be99a330b2096a0648b192.tar.gz libsurvive-0cd7e8d9783e8cdff7be99a330b2096a0648b192.tar.bz2 |
Merge pull request #123 from cnlohr/simple_api
Simple async api
Diffstat (limited to 'src/poser_sba.c')
-rw-r--r-- | src/poser_sba.c | 11 |
1 files changed, 4 insertions, 7 deletions
diff --git a/src/poser_sba.c b/src/poser_sba.c index 5166951..8c9e328 100644 --- a/src/poser_sba.c +++ b/src/poser_sba.c @@ -230,7 +230,7 @@ static double run_sba_find_3d_structure(SBAData *d, PoserDataLight *pdl, Survive } failure_count = 0; - SurvivePose soLocation = { 0 }; + SurvivePose soLocation = {0}; if (!general_optimizer_data_record_current_pose(&d->opt, &pdl->hdr, sizeof(*pdl), &soLocation)) { return -1; @@ -389,7 +389,6 @@ int PoserSBA(SurviveObject *so, PoserData *pd) { d->sensor_variance = survive_configf(ctx, "sba-sensor-variance", SC_GET, 1.0); d->use_jacobian_function = survive_configi(ctx, "sba-use-jacobian-function", SC_GET, 1.0); - SV_INFO("Initializing SBA:"); SV_INFO("\tsba-required-meas: %d", d->required_meas); SV_INFO("\tsba-sensor-variance: %f", d->sensor_variance); @@ -416,16 +415,14 @@ int PoserSBA(SurviveObject *so, PoserData *pd) { d->last_lh = lightData->lh; d->last_acode = lightData->acode; - if (error < 0) { - } - else { + } else { if (d->useIMU) { FLT var_meters = 0.5; FLT var_quat = error + .05; - FLT var[7] = { error * var_meters, error * var_meters, error * var_meters, error * var_quat, - error * var_quat, error * var_quat, error * var_quat }; + FLT var[7] = {error * var_meters, error * var_meters, error * var_meters, error * var_quat, + error * var_quat, error * var_quat, error * var_quat}; survive_imu_tracker_integrate_observation(so, lightData->timecode, &d->tracker, &estimate, var); estimate = d->tracker.pose; |