int mavlink_missionlib_send_gcs_string(const char *string) { const int len = MAVLINK_MSG_STATUSTEXT_FIELD_TEXT_LEN; mavlink_statustext_t statustext; int i = 0; while (i < len - 1) { statustext.text[i] = string[i]; if (string[i] == '\0') break; i++; } if (i > 1) { /* Enforce null termination */ statustext.text[i] = '\0'; mavlink_message_t msg; mavlink_msg_statustext_encode(mavlink_system.sysid, mavlink_system.compid, &msg, &statustext); return mavlink_missionlib_send_message(&msg); } else { return 1; } }
void Test::sendStatusText(MAV_SEVERITY severity, const char* text) { mavlink_statustext_t msg; memcpy(msg.text, text, 50); msg.severity = severity; mavlink_message_t buf; mavlink_msg_statustext_encode(SYSTEM_ID, COMPONENT_ID, &buf, &msg); testMessage(buf); }
void mavlink_missionlib_send_gcs_string(const char* string) { const int len = 50; mavlink_statustext_t status; int i = 0; while (i < len - 1) { status.text[i] = string[i]; if (string[i] == '\0') break; i++; } status.text[i] = '\0'; // Enforce null termination mavlink_message_t msg; mavlink_msg_statustext_encode(mavlink_system.sysid, mavlink_system.compid, &msg, &status); mavlink_missionlib_send_message(&msg); }