diff options
author | Mike Turvey <mturvey6@gmail.com> | 2018-01-05 04:09:54 -0700 |
---|---|---|
committer | Mike Turvey <mturvey6@gmail.com> | 2018-01-05 04:09:54 -0700 |
commit | ed85661121c3ed8769a69d059fd3162aec33c6fe (patch) | |
tree | e5fea4c0e03d09122ac90de0f28617f3b62326e6 /src | |
parent | 735a8bd11070b0c563e891ff8b70ce297a52a367 (diff) | |
download | libsurvive-ed85661121c3ed8769a69d059fd3162aec33c6fe.tar.gz libsurvive-ed85661121c3ed8769a69d059fd3162aec33c6fe.tar.bz2 |
Update test.c to do calibration
Diffstat (limited to 'src')
-rw-r--r-- | src/poser_turveytori.c | 12 | ||||
-rw-r--r-- | src/survive_process.c | 2 |
2 files changed, 13 insertions, 1 deletions
diff --git a/src/poser_turveytori.c b/src/poser_turveytori.c index 28e533e..ad30f6c 100644 --- a/src/poser_turveytori.c +++ b/src/poser_turveytori.c @@ -1856,6 +1856,18 @@ int PoserTurveyTori( SurviveObject * so, PoserData * poserData ) // } //} + for (int i=0; i < ctx->activeLighthouses; i++) + { + printf("Lighthouse Pose: [%1.1x][% 08.8f,% 08.8f,% 08.8f] [% 08.8f,% 08.8f,% 08.8f,% 08.8f]\n", + i, + ctx->bsd[i].Pose.Pos[0], + ctx->bsd[i].Pose.Pos[1], + ctx->bsd[i].Pose.Pos[2], + ctx->bsd[i].Pose.Rot[0], + ctx->bsd[i].Pose.Rot[1], + ctx->bsd[i].Pose.Rot[2], + ctx->bsd[i].Pose.Rot[3]); + } config_set_lighthouse(ctx->lh_config, ctx->bsd[0], 0); config_set_lighthouse(ctx->lh_config, ctx->bsd[1], 1); diff --git a/src/survive_process.c b/src/survive_process.c index 42d2897..1df24e9 100644 --- a/src/survive_process.c +++ b/src/survive_process.c @@ -104,7 +104,7 @@ void survive_default_button_process(SurviveObject * so, uint8_t eventType, uint8 void survive_default_raw_pose_process(SurviveObject * so, uint8_t lighthouse, FLT *pos, FLT *quat) { // print the pose; - printf("Pose: [%2.2x][% 08.8f,% 08.8f,% 08.8f] [% 08.8f,% 08.8f,% 08.8f,% 08.8f]\n", lighthouse, pos[0], pos[1], pos[2], quat[0], quat[1], quat[2], quat[3]); + printf("Pose: [%1.1x][%s][% 08.8f,% 08.8f,% 08.8f] [% 08.8f,% 08.8f,% 08.8f,% 08.8f]\n", lighthouse, so->codename, pos[0], pos[1], pos[2], quat[0], quat[1], quat[2], quat[3]); } |