From f7420a8a77e1de0480ffbc4d725869dbe28147e9 Mon Sep 17 00:00:00 2001 From: Justin Berger Date: Wed, 14 Mar 2018 00:47:41 -0600 Subject: Added default action for pose process --- src/survive_process.c | 3 ++- 1 file changed, 2 insertions(+), 1 deletion(-) (limited to 'src/survive_process.c') 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) { -- cgit v1.2.3