|
|
|
@ -18,9 +18,7 @@ RCChannelMonitorController::RCChannelMonitorController(void)
@@ -18,9 +18,7 @@ RCChannelMonitorController::RCChannelMonitorController(void)
|
|
|
|
|
|
|
|
|
|
void RCChannelMonitorController::_rcChannelsChanged(int channelCount, int pwmValues[Vehicle::cMaxRcChannels]) |
|
|
|
|
{ |
|
|
|
|
int maxChannel = std::min(channelCount, _chanMax()); |
|
|
|
|
|
|
|
|
|
for (int channel=0; channel<maxChannel; channel++) { |
|
|
|
|
for (int channel=0; channel<channelCount; channel++) { |
|
|
|
|
int channelValue = pwmValues[channel]; |
|
|
|
|
|
|
|
|
|
if (_chanCount != channelCount) { |
|
|
|
@ -33,8 +31,3 @@ void RCChannelMonitorController::_rcChannelsChanged(int channelCount, int pwmVal
@@ -33,8 +31,3 @@ void RCChannelMonitorController::_rcChannelsChanged(int channelCount, int pwmVal
|
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
int RCChannelMonitorController::_chanMax(void) const |
|
|
|
|
{ |
|
|
|
|
return _vehicle->firmwareType() == MAV_AUTOPILOT_PX4 ? _chanMaxPX4 : _chanMaxAPM; |
|
|
|
|
} |
|
|
|
|