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

ManualControlSelector: Allow disabling stick input

Browse Source
This commit is contained in:
Matthias Grob
2021-12-09 11:36:14 +01:00
committed by Daniel Agar
parent 300e439144
commit 897775f38d
2 changed files with 30 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/manual_control/ManualControlSelectorTest.cpp
+28
View File
@@ -219,6 +219,34 @@ TEST(ManualControlSelector, FirstInput)
EXPECT_EQ(selector.instance(), 0);
}
TEST(ManualControlSelector, DisabledInput)
{
ManualControlSelector selector;
selector.setRcInMode(4);
selector.setTimeout(500_ms);
uint64_t timestamp = some_time;
manual_control_setpoint_s input {};
// Reject MAVLink stick input
input.data_source = manual_control_setpoint_s::SOURCE_MAVLINK_0;
input.timestamp_sample = timestamp;
selector.updateWithNewInputSample(timestamp, input, 0);
EXPECT_FALSE(selector.setpoint().valid);
EXPECT_EQ(selector.instance(), -1);
timestamp += 100_ms;
// Reject RC stick input
input.data_source = manual_control_setpoint_s::SOURCE_RC;
input.timestamp_sample = timestamp;
selector.updateWithNewInputSample(timestamp, input, 1);
EXPECT_FALSE(selector.setpoint().valid);
EXPECT_EQ(selector.instance(), -1);
}
TEST(ManualControlSelector, RcTimeout)
{
ManualControlSelector selector;