gg/fts-can
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

added mfts complete check of afts status flags

Browse Source
This commit is contained in:
neo 2024-06-22 18:13:37 +02:00
parent f019f45c74
commit f3d674c7df
1 changed files with 2 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
src/modules/fts_control/fts_control.cpp
View File

@ -80,9 +80,8 @@ FTSController::Run() {
case AUTO_FTS_STATE_DISARMED: case AUTO_FTS_STATE_DISARMED:
{ {
//AFTS IS NOT CURRENTLY ARMED //AFTS IS NOT CURRENTLY ARMED
//TODO ADD GEOFENCE LOADED CHECK ETC if (_auto_fts_message.config_status != 0 && _auto_fts_message.geofence_loaded != 0 && _auto_fts_message.gps_lock != 0) {
//if (_auto_fts_message.config_status != 0 && _auto_fts_message.geofence_loaded != 0 && _auto_fts_message.gps_lock != 0) { //AFTS ARMING CONDITIONS ARE MET
if (_auto_fts_message.gps_lock != 0) {
if (_auto_fts_message.geofence_violated != 0) { if (_auto_fts_message.geofence_violated != 0) {
// FAILSAFE: CANNOT ARM AUTO-FTS WHEN GEOFENCE IS ALREADY VIOLATED // FAILSAFE: CANNOT ARM AUTO-FTS WHEN GEOFENCE IS ALREADY VIOLATED
_auto_fts_state = AUTO_FTS_STATE_ERROR; _auto_fts_state = AUTO_FTS_STATE_ERROR;