fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-31 03:21:36 +08:00
Code Issues Packages Projects Releases Wiki Activity

Fixed zero offset in HIL

Browse Source
This commit is contained in:
Lorenz Meier
2012-11-10 19:06:58 +01:00
parent 6adab3b319
commit fb022f40e5
1 changed files with 9 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files
apps/mavlink/orb_listener.c
+9 -9
View File
@@ -447,25 +447,25 @@ l_actuator_outputs(struct listener *l)
if (isfinite(act_outputs.output[3]) if (isfinite(act_outputs.output[3])
&& act_outputs.output[3] > 800 && act_outputs.output[3] < 2200) { && act_outputs.output[3] > 800 && act_outputs.output[3] < 2200) {
/* throttle is fourth output */ /* throttle is fourth output */
rudder = (act_outputs.output[2] - 1000.0f) / 1000.0f; rudder = (act_outputs.output[2] - 1500.0f) / 1000.0f;
throttle = (act_outputs.output[3] - 1000.0f) / 1000.0f; throttle = (act_outputs.output[3] - 1500.0f) / 1000.0f;
} else { } else {
/* only three outputs, put throttle on position 4 / index 3 */ /* only three outputs, put throttle on position 4 / index 3 */
rudder = 0; rudder = 0;
throttle = (act_outputs.output[2] - 1000.0f) / 1000.0f; throttle = (act_outputs.output[2] - 1500.0f) / 1000.0f;
} }
/* HIL message as per MAVLink spec */ /* HIL message as per MAVLink spec */
mavlink_msg_hil_controls_send(chan, mavlink_msg_hil_controls_send(chan,
hrt_absolute_time(), hrt_absolute_time(),
(act_outputs.output[0] - 1000.0f) / 1000.0f, (act_outputs.output[0] - 1500.0f) / 1000.0f,
(act_outputs.output[1] - 1000.0f) / 1000.0f, (act_outputs.output[1] - 1500.0f) / 1000.0f,
rudder, rudder,
throttle, throttle,
(act_outputs.output[4] - 1000.0f) / 1000.0f, (act_outputs.output[4] - 1500.0f) / 1000.0f,
(act_outputs.output[5] - 1000.0f) / 1000.0f, (act_outputs.output[5] - 1500.0f) / 1000.0f,
(act_outputs.output[6] - 1000.0f) / 1000.0f, (act_outputs.output[6] - 1500.0f) / 1000.0f,
(act_outputs.output[7] - 1000.0f) / 1000.0f, (act_outputs.output[7] - 1500.0f) / 1000.0f,
mavlink_mode, mavlink_mode,
0); 0);
} }