|
|
@ -2857,7 +2857,7 @@ class G1Deploy { |
|
|
"cmd=%.1f/%.1f/%.1f " |
|
|
"cmd=%.1f/%.1f/%.1f " |
|
|
"meas=%.1f/%.1f/%.1f " |
|
|
"meas=%.1f/%.1f/%.1f " |
|
|
"tau=%.2f/%.2f/%.2f Nm " |
|
|
"tau=%.2f/%.2f/%.2f Nm " |
|
|
"mode=%u/%u/%u lost=%u/%u/%u\n", |
|
|
|
|
|
|
|
|
"mode=%d/%d/%d\n", |
|
|
raw_yaw, raw_roll, raw_pitch, |
|
|
raw_yaw, raw_roll, raw_pitch, |
|
|
motor_command_tmp.q_target.at(12) * 180.0/M_PI, |
|
|
motor_command_tmp.q_target.at(12) * 180.0/M_PI, |
|
|
motor_command_tmp.q_target.at(13) * 180.0/M_PI, |
|
|
motor_command_tmp.q_target.at(13) * 180.0/M_PI, |
|
|
@ -2866,8 +2866,7 @@ class G1Deploy { |
|
|
ms[13].q() * 180.0/M_PI, |
|
|
ms[13].q() * 180.0/M_PI, |
|
|
ms[14].q() * 180.0/M_PI, |
|
|
ms[14].q() * 180.0/M_PI, |
|
|
ms[12].tau_est(), ms[13].tau_est(), ms[14].tau_est(), |
|
|
ms[12].tau_est(), ms[13].tau_est(), ms[14].tau_est(), |
|
|
ms[12].mode(), ms[13].mode(), ms[14].mode(), |
|
|
|
|
|
ms[12].lost(), ms[13].lost(), ms[14].lost()); |
|
|
|
|
|
|
|
|
(int)ms[12].mode(), (int)ms[13].mode(), (int)ms[14].mode()); |
|
|
} |
|
|
} |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
|