fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-09 05:01:37 +08:00
Code Issues Packages Projects Releases Wiki Activity

commander: use C API for MC_AIRMODE & RC_MAP_ARM_SW to remove multirotor modules dependency

Browse Source
This commit is contained in:
Beat Küng
2018-12-13 09:50:07 +01:00
parent c665c34d2a
commit 447ed18ab4
2 changed files with 15 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/commander/Commander.cpp
+14 -4
View File
@@ -1200,6 +1200,9 @@ Commander::run()
param_t _param_fmode_5 = param_find("COM_FLTMODE5");
param_t _param_fmode_6 = param_find("COM_FLTMODE6");
param_t _param_airmode = param_find("MC_AIRMODE");
param_t _param_rc_map_arm_switch = param_find("RC_MAP_ARM_SW");
/* failsafe response to loss of navigation accuracy */
param_t _param_posctl_nav_loss_act = param_find("COM_POSCTL_NAVL");
@@ -1391,6 +1394,8 @@ Commander::run()
int32_t geofence_action = 0;
int32_t flight_uuid = 0;
int32_t airmode = 0;
int32_t rc_map_arm_switch = 0;
/* RC override auto modes */
int32_t rc_override = 0;
@@ -1527,10 +1532,15 @@ Commander::run()
param_get(_param_takeoff_finished_action, &takeoff_complete_act);
/* check for unsafe Airmode settings: yaw airmode requires the use of an arming switch */
if (_airmode.get() == 2 && _rc_map_arm_switch.get() == 0) {
_airmode.set(1); // change to roll/pitch airmode
_airmode.commit();
mavlink_log_critical(&mavlink_log_pub, "Yaw Airmode requires the use of an Arm Switch")
if (_param_airmode != PARAM_INVALID && _param_rc_map_arm_switch != PARAM_INVALID) {
param_get(_param_airmode, &airmode);
param_get(_param_rc_map_arm_switch, &rc_map_arm_switch);
if (airmode == 2 && rc_map_arm_switch == 0) {
airmode = 1; // change to roll/pitch airmode
param_set(_param_airmode, &airmode);
mavlink_log_critical(&mavlink_log_pub, "Yaw Airmode requires the use of an Arm Switch")
}
}
param_init_forced = false;