Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_ServoRelayEvents: fixed disabling repeated events on set_servo()

This commit is contained in:
Andrew Tridgell 2014-02-06 10:03:26 +11:00
parent 058e058487
commit 264c092aa6
1 changed files with 5 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
libraries/AP_ServoRelayEvents/AP_ServoRelayEvents.cpp
View File

@ -25,19 +25,19 @@
extern const AP_HAL::HAL& hal; extern const AP_HAL::HAL& hal;
bool AP_ServoRelayEvents::do_set_servo(uint8_t channel, uint16_t pwm) bool AP_ServoRelayEvents::do_set_servo(uint8_t _channel, uint16_t pwm)
{ {
if (!(mask & 1U<<(channel-1))) { if (!(mask & 1U<<(_channel-1))) {
// not allowed // not allowed
return false; return false;
} }
if (type == EVENT_TYPE_SERVO && if (type == EVENT_TYPE_SERVO &&
channel == channel) { channel == _channel) {
// cancel previous repeat // cancel previous repeat
repeat = 0; repeat = 0;
} }
hal.rcout->enable_ch(channel-1); hal.rcout->enable_ch(_channel-1);
hal.rcout->write(channel-1, pwm); hal.rcout->write(_channel-1, pwm);
return true; return true;
} }