Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-21 13:02:25 +08:00
Code Issues Actions 4 Packages Projects Releases Wiki Activity

commander failsafe: never override user intended termination + unit test
Build all targets / Scan for Board Targets (push) Has been cancelled
Details
Build all targets / Build Group [${{ matrix.group }}] (push) Has been cancelled
Details
Build all targets / Upload Artifacts to S3 (push) Has been cancelled
Details
Build all targets / Create Release and Upload Artifacts (push) Has been cancelled
Details
Ubuntu environment build / Build and Test (ubuntu:22.04) (push) Has been cancelled
Details
Ubuntu environment build / Build and Test (ubuntu:24.04) (push) Has been cancelled
Details
Container build / Build and Push Container (push) Has been cancelled
Details
EKF Update Change Indicator / unit_tests (push) Has been cancelled
Details

Browse Source
This commit is contained in:
Matthias Grob
2025-07-25 13:16:52 +02:00
parent b67c65bfe6
commit af99ebce81
2 changed files with 27 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/commander/failsafe/failsafe_test.cpp
+25
View File
@@ -392,3 +392,28 @@ TEST_F(FailsafeTest, skip_failsafe)
ASSERT_EQ(updated_user_intented_mode, state.user_intended_mode);
ASSERT_EQ(failsafe.selectedAction(), FailsafeBase::Action::Warn);
}
TEST_F(FailsafeTest, user_termination)
{
FailsafeTester failsafe(nullptr);
failsafe_flags_s failsafe_flags{};
FailsafeBase::State state{};
state.armed = true;
state.user_intended_mode = vehicle_status_s::NAVIGATION_STATE_TERMINATION;
state.vehicle_type = vehicle_status_s::VEHICLE_TYPE_ROTARY_WING;
hrt_abstime time = 5_s;
// User intended termination -> failsafe termination
uint8_t updated_user_intented_mode = failsafe.update(time, state, false, false, failsafe_flags);
EXPECT_EQ(updated_user_intented_mode, state.user_intended_mode);
EXPECT_EQ(failsafe.selectedAction(), FailsafeBase::Action::Terminate);
// Links lost during termination -> stay in termination
failsafe_flags.gcs_connection_lost = true;
failsafe_flags.manual_control_signal_lost = true;
updated_user_intented_mode = failsafe.update(time, state, false, false, failsafe_flags);
EXPECT_EQ(updated_user_intented_mode, state.user_intended_mode);
EXPECT_EQ(failsafe.selectedAction(), FailsafeBase::Action::Terminate);
}
src/modules/commander/failsafe/framework.cpp
+2 -1
View File
@@ -437,7 +437,8 @@ void FailsafeBase::getSelectedAction(const State &state, const failsafe_flags_s
returned_state.updated_user_intended_mode = state.user_intended_mode;
returned_state.cause = Cause::Generic;
if (_selected_action == Action::Terminate) { // Terminate never clears
if (state.user_intended_mode == vehicle_status_s::NAVIGATION_STATE_TERMINATION
|| _selected_action == Action::Terminate) { // Terminate never clears
returned_state.action = Action::Terminate;
return;
}