mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-28 22:13:34 +08:00
Map inputs to the controller we actually want
This commit is contained in:
@@ -195,7 +195,7 @@ mc_thread_main(int argc, char *argv[])
|
|||||||
rates_sp.roll = manual.roll;
|
rates_sp.roll = manual.roll;
|
||||||
|
|
||||||
rates_sp.pitch = manual.pitch;
|
rates_sp.pitch = manual.pitch;
|
||||||
rates_sp.yaw = att.yaw + manual.yaw * 2.0f;
|
rates_sp.yaw = manual.yaw;
|
||||||
rates_sp.thrust = manual.throttle;
|
rates_sp.thrust = manual.throttle;
|
||||||
//printf("rates\n");
|
//printf("rates\n");
|
||||||
rates_sp.timestamp = hrt_absolute_time();
|
rates_sp.timestamp = hrt_absolute_time();
|
||||||
@@ -204,9 +204,7 @@ mc_thread_main(int argc, char *argv[])
|
|||||||
if (state.flag_control_attitude_enabled) {
|
if (state.flag_control_attitude_enabled) {
|
||||||
att_sp.roll_body = manual.roll;
|
att_sp.roll_body = manual.roll;
|
||||||
att_sp.pitch_body = manual.pitch;
|
att_sp.pitch_body = manual.pitch;
|
||||||
att_sp.yaw_body = manual.yaw; // XXX Hack, clean up
|
att_sp.yaw_body = att.yaw + manual.yaw * -2.0f;
|
||||||
/* set yaw rate */
|
|
||||||
rates_sp.yaw = manual.yaw;
|
|
||||||
att_sp.thrust = manual.throttle;
|
att_sp.thrust = manual.throttle;
|
||||||
att_sp.timestamp = hrt_absolute_time();
|
att_sp.timestamp = hrt_absolute_time();
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user