From d0c6636b7ff0d1e83a973a32e67d7ed1bd75a28c Mon Sep 17 00:00:00 2001 From: Marcel Stuettgen Date: Sat, 28 Feb 2015 17:25:51 +0100 Subject: [PATCH] added debug code to check if the values are really changing --- src/examples/rover_steering_control/main.cpp | 17 +++++++++++++++++ 1 file changed, 17 insertions(+) diff --git a/src/examples/rover_steering_control/main.cpp b/src/examples/rover_steering_control/main.cpp index 7ef9140980..67ff489166 100644 --- a/src/examples/rover_steering_control/main.cpp +++ b/src/examples/rover_steering_control/main.cpp @@ -156,6 +156,23 @@ void control_attitude(const struct vehicle_attitude_setpoint_s *att_sp, const st struct actuator_controls_s *actuators) { + //double r,p,y,t; + + + + //printf("vehicle_attitude_setpoint:\n"); + //print values only when they change to get less spam in console + if((double)att_sp->roll_body > 0.0) { printf("att_sp->roll_body: %8.4f\n" , (double)att_sp->roll_body); } + if((double)att_sp->pitch_body > 0.0) {printf("att_sp->pitch_body: %8.4f\n" , (double)att_sp->pitch_body); } + if((double)att_sp->yaw_body > 0.0) { printf("att_sp->yaw_body: %8.4f\n" , (double)att_sp->yaw_body); } + if((double)att_sp->thrust > 0.0) { printf("att_sp->throttle: %8.4f\n" , (double)att_sp->thrust); } + + // r = (double)att_sp->roll_body; + // p = (double)att_sp->pitch_body; + // y = (double)att_sp->yaw_body; + // t = (double)att_sp->thrust; + + /* * The PX4 architecture provides a mixer outside of the controller. * The mixer is fed with a default vector of actuator controls, representing