Commit 5ddd82f5 authored by Don Gagne's avatar Don Gagne

Add more fake commands to support unit testing

parent 7bba3b1d
...@@ -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;
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment