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

Copter: correct rc-arming checks concerning trims 

Trims should always be between min and max
This commit is contained in:
Peter Barker 2017-01-20 13:04:22 +11:00 committed by Randy Mackay
parent fdc536e024
commit 078866046a
1 changed files with 25 additions and 23 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

36
ArduCopter/AP_Arming.cpp
View File

@ -343,35 +343,37 @@ void AP_Arming_Copter::pre_arm_rc_checks()
return; return;
} }
RC_Channel *&channel_roll = copter.channel_roll;
RC_Channel *&channel_pitch = copter.channel_pitch;
RC_Channel *&channel_throttle = copter.channel_throttle;
RC_Channel *&channel_yaw = copter.channel_yaw;
// check if radio has been calibrated // check if radio has been calibrated
if (!channel_throttle->min_max_configured()) { if (!copter.channel_throttle->min_max_configured()) {
return; return;
} }
// check channels 1 & 2 have min <= 1300 and max >= 1700 const RC_Channel *channels[] = {
if (channel_roll->get_radio_min() > 1300 || channel_roll->get_radio_max() < 1700 || channel_pitch->get_radio_min() > 1300 || channel_pitch->get_radio_max() < 1700) { copter.channel_roll,
copter.channel_pitch,
copter.channel_throttle,
copter.channel_yaw
};
for (uint8_t i=0; i<ARRAY_SIZE(channels);i++) {
const RC_Channel *channel = channels[i];
if (channel->get_radio_min() > 1300) {
return; return;
} }
if (channel->get_radio_max() < 1700) {
// check channels 3 & 4 have min <= 1300 and max >= 1700
if (channel_throttle->get_radio_min() > 1300 || channel_throttle->get_radio_max() < 1700 || channel_yaw->get_radio_min() > 1300 || channel_yaw->get_radio_max() < 1700) {
return; return;
} }
if (i == 2) {
// check channels 1 & 2 have trim >= 1300 and <= 1700 // skip checking trim for throttle as older code did not check it
if (channel_roll->get_radio_trim() < 1300 || channel_roll->get_radio_trim() > 1700 || channel_pitch->get_radio_trim() < 1300 || channel_pitch->get_radio_trim() > 1700) { continue;
}
if (channel->get_radio_trim() < channel->get_radio_min()) {
return; return;
} }
if (channel->get_radio_trim() > channel->get_radio_max()) {
// check channel 4 has trim >= 1300 and <= 1700
if (channel_yaw->get_radio_trim() < 1300 || channel_yaw->get_radio_trim() > 1700) {
return; return;
} }
}
// if we've gotten this far rc is ok // if we've gotten this far rc is ok
set_pre_arm_rc_check(true); set_pre_arm_rc_check(true);