aboutsummaryrefslogtreecommitdiff
path: root/src/poser_sba.c
diff options
context:
space:
mode:
authorJustin Berger <j.david.berger@gmail.com>2018-03-21 09:11:54 -0600
committerJustin Berger <j.david.berger@gmail.com>2018-03-21 09:11:54 -0600
commit8a0831f2b9e458d8f1976c27f7865166ad8de6a4 (patch)
tree028773b7a0ae042c6bb9b3cc21933a617c939b65 /src/poser_sba.c
parent0bc3b02ff3c4f975004fb19e226c3177fa811b4e (diff)
downloadlibsurvive-8a0831f2b9e458d8f1976c27f7865166ad8de6a4.tar.gz
libsurvive-8a0831f2b9e458d8f1976c27f7865166ad8de6a4.tar.bz2
Moved pose to linmath to support stronger typing
Diffstat (limited to 'src/poser_sba.c')
-rw-r--r--src/poser_sba.c6
1 files changed, 3 insertions, 3 deletions
diff --git a/src/poser_sba.c b/src/poser_sba.c
index b5962f8..870f541 100644
--- a/src/poser_sba.c
+++ b/src/poser_sba.c
@@ -36,7 +36,7 @@ void metric_function(int j, int i, double *aj, double *xij, void *adata) {
SurvivePose obj2world = ctx->obj_pose;
FLT sensorInWorld[3] = {};
- ApplyPoseToPoint(sensorInWorld, obj2world.Pos, &so->sensor_locations[i * 3]);
+ ApplyPoseToPoint(sensorInWorld, &obj2world, &so->sensor_locations[i * 3]);
survive_reproject_from_pose_with_config(so->ctx, &ctx->calibration_config, j, (SurvivePose *)aj, sensorInWorld,
xij);
}
@@ -134,7 +134,7 @@ void str_metric_function_single_sweep(int j, int i, double *bi, double *xij, voi
quatnormalize(obj.Rot, obj.Rot);
FLT xyz[3];
- ApplyPoseToPoint(xyz, obj.Pos, &so->sensor_locations[sensor_idx * 3]);
+ ApplyPoseToPoint(xyz, &obj, &so->sensor_locations[sensor_idx * 3]);
// std::cerr << "Processing " << sensor_idx << ", " << lh << std::endl;
SurvivePose *camera = &so->ctx->bsd[lh].Pose;
@@ -157,7 +157,7 @@ void str_metric_function(int j, int i, double *bi, double *xij, void *adata) {
quatnormalize(obj.Rot, obj.Rot);
FLT xyz[3];
- ApplyPoseToPoint(xyz, obj.Pos, &so->sensor_locations[sensor_idx * 3]);
+ ApplyPoseToPoint(xyz, &obj, &so->sensor_locations[sensor_idx * 3]);
// std::cerr << "Processing " << sensor_idx << ", " << lh << std::endl;
SurvivePose *camera = &so->ctx->bsd[lh].Pose;