mirror of https://github.com/ArduPilot/ardupilot
Plane: log to dataflash statustext messages from my_gcs
This commit is contained in:
parent
42cd8e9721
commit
31321b3b60
|
@ -1150,6 +1150,20 @@ void GCS_MAVLINK_Plane::handleMessage(mavlink_message_t* msg)
|
|||
break;
|
||||
}
|
||||
|
||||
case MAVLINK_MSG_ID_STATUSTEXT:
|
||||
{
|
||||
// ignore any statustext messages not from our GCS:
|
||||
if (msg->sysid != plane.g.sysid_my_gcs) {
|
||||
break;
|
||||
}
|
||||
mavlink_statustext_t packet;
|
||||
mavlink_msg_statustext_decode(msg, &packet);
|
||||
char text[MAVLINK_MSG_STATUSTEXT_FIELD_TEXT_LEN+1+4] = { 'G','C','S',':'};
|
||||
memcpy(&text[4], packet.text, MAVLINK_MSG_STATUSTEXT_FIELD_TEXT_LEN);
|
||||
plane.DataFlash.Log_Write_Message(text);
|
||||
break;
|
||||
}
|
||||
|
||||
case MAVLINK_MSG_ID_COMMAND_INT:
|
||||
{
|
||||
// decode
|
||||
|
|
Loading…
Reference in New Issue