Skip to content

Commit

Permalink
Changed !(x==y) to (x!=y). Unadvertise when a different control group…
Browse files Browse the repository at this point in the history
… is published.
  • Loading branch information
xgerrmann committed Mar 26, 2018
1 parent cd9f333 commit e303bae
Showing 1 changed file with 5 additions and 2 deletions.
7 changes: 5 additions & 2 deletions src/modules/mavlink/mavlink_receiver.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -1057,11 +1057,14 @@ MavlinkReceiver::handle_message_set_actuator_control_target(mavlink_message_t *m
actuator_controls.timestamp = hrt_absolute_time();
uint8_t control_group = set_actuator_control_target.group_mlx;
static int8_t control_group_previous = -1;
/* Set duty cycles for the servos in actuator_controls_0 */

memcpy(actuator_controls.control, set_actuator_control_target.controls, 8 * sizeof(float));

/* Reset orb advertising when current control group is unequal to the previous control group */
if (!(control_group == control_group_previous)) {
if (control_group != control_group_previous) {

orb_unadvertise(_actuator_controls_pub);

_actuator_controls_pub = nullptr;
}

Expand Down

0 comments on commit e303bae

Please sign in to comment.