diff options
Diffstat (limited to 'src')
-rw-r--r-- | src/survive_process.c | 3 |
1 files changed, 2 insertions, 1 deletions
diff --git a/src/survive_process.c b/src/survive_process.c index e45a979..fe6dc45 100644 --- a/src/survive_process.c +++ b/src/survive_process.c @@ -109,7 +109,8 @@ void survive_default_button_process(SurviveObject * so, uint8_t eventType, uint8 void survive_default_raw_pose_process(SurviveObject *so, uint8_t lighthouse, SurvivePose *pose) { // print the pose; //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]); - + so->OutPose = *pose; + so->FromLHPose[lighthouse] = *pose; } void survive_default_lighthouse_pose_process(SurviveContext *ctx, uint8_t lighthouse, SurvivePose *pose) { |