Browse Source

Merge pull request #264 from DrTon/fmu_pwm_fix

Update servo arm only on real change.
sbg
Lorenz Meier 12 years ago
parent
commit
078ae23cfa
  1. 6
      apps/drivers/px4fmu/fmu.cpp

6
apps/drivers/px4fmu/fmu.cpp

@ -505,7 +505,11 @@ PX4FMU::task_main()
orb_copy(ORB_ID(actuator_armed), _t_armed, &aa); orb_copy(ORB_ID(actuator_armed), _t_armed, &aa);
/* update PWM servo armed status if armed and not locked down */ /* update PWM servo armed status if armed and not locked down */
up_pwm_servo_arm(aa.armed && !aa.lockdown); bool set_armed = aa.armed && !aa.lockdown;
if (set_armed != _armed) {
_armed = set_armed;
up_pwm_servo_arm(set_armed);
}
} }
// see if we have new PPM input data // see if we have new PPM input data

Loading…
Cancel
Save