Skip to content
Snippets Groups Projects
Commit 5ddd82f5 authored by Don Gagne's avatar Don Gagne
Browse files

Add more fake commands to support unit testing

parent 7bba3b1d
No related branches found
No related tags found
No related merge requests found
...@@ -786,19 +786,23 @@ void MockLink::_handleFTP(const mavlink_message_t& msg) ...@@ -786,19 +786,23 @@ void MockLink::_handleFTP(const mavlink_message_t& msg)
void MockLink::_handleCommandLong(const mavlink_message_t& msg) void MockLink::_handleCommandLong(const mavlink_message_t& msg)
{ {
mavlink_command_long_t request; mavlink_command_long_t request;
uint8_t commandResult; uint8_t commandResult = MAV_RESULT_UNSUPPORTED;
mavlink_msg_command_long_decode(&msg, &request); mavlink_msg_command_long_decode(&msg, &request);
if (request.command == MAV_CMD_COMPONENT_ARM_DISARM) { switch (request.command) {
case MAV_CMD_COMPONENT_ARM_DISARM:
if (request.param1 == 0.0f) { if (request.param1 == 0.0f) {
_mavBaseMode &= ~MAV_MODE_FLAG_SAFETY_ARMED; _mavBaseMode &= ~MAV_MODE_FLAG_SAFETY_ARMED;
} else { } else {
_mavBaseMode |= MAV_MODE_FLAG_SAFETY_ARMED; _mavBaseMode |= MAV_MODE_FLAG_SAFETY_ARMED;
} }
commandResult = MAV_RESULT_ACCEPTED; commandResult = MAV_RESULT_ACCEPTED;
} else { break;
commandResult = MAV_RESULT_UNSUPPORTED; case MAV_CMD_PREFLIGHT_CALIBRATION:
case MAV_CMD_PREFLIGHT_STORAGE:
commandResult = MAV_RESULT_ACCEPTED;
break;
} }
mavlink_message_t commandAck; mavlink_message_t commandAck;
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment