Browse Source

Fixed zero offset in HIL

sbg
Lorenz Meier 12 years ago
parent
commit
fb022f40e5
  1. 18
      apps/mavlink/orb_listener.c

18
apps/mavlink/orb_listener.c

@ -447,25 +447,25 @@ l_actuator_outputs(struct listener *l) @@ -447,25 +447,25 @@ l_actuator_outputs(struct listener *l)
if (isfinite(act_outputs.output[3])
&& act_outputs.output[3] > 800 && act_outputs.output[3] < 2200) {
/* throttle is fourth output */
rudder = (act_outputs.output[2] - 1000.0f) / 1000.0f;
throttle = (act_outputs.output[3] - 1000.0f) / 1000.0f;
rudder = (act_outputs.output[2] - 1500.0f) / 1000.0f;
throttle = (act_outputs.output[3] - 1500.0f) / 1000.0f;
} else {
/* only three outputs, put throttle on position 4 / index 3 */
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 */
mavlink_msg_hil_controls_send(chan,
hrt_absolute_time(),
(act_outputs.output[0] - 1000.0f) / 1000.0f,
(act_outputs.output[1] - 1000.0f) / 1000.0f,
(act_outputs.output[0] - 1500.0f) / 1000.0f,
(act_outputs.output[1] - 1500.0f) / 1000.0f,
rudder,
throttle,
(act_outputs.output[4] - 1000.0f) / 1000.0f,
(act_outputs.output[5] - 1000.0f) / 1000.0f,
(act_outputs.output[6] - 1000.0f) / 1000.0f,
(act_outputs.output[7] - 1000.0f) / 1000.0f,
(act_outputs.output[4] - 1500.0f) / 1000.0f,
(act_outputs.output[5] - 1500.0f) / 1000.0f,
(act_outputs.output[6] - 1500.0f) / 1000.0f,
(act_outputs.output[7] - 1500.0f) / 1000.0f,
mavlink_mode,
0);
}

Loading…
Cancel
Save