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

logger: add Ulog sync bytes at 1Hz and tagged log message definition (#12144)

Browse Source
This commit is contained in:
Bharat Tak
2019-06-11 11:00:55 +02:00
committed by Beat Küng
parent 736a1c4778
commit 1ebf5d04d9
3 changed files with 34 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/logger/logger.cpp
+22
View File
@@ -80,6 +80,7 @@
#endif /* defined(DBGPRINT) */
using namespace px4::logger;
using namespace time_literals;
struct timer_callback_data_s {
@@ -1160,6 +1161,27 @@ void Logger::run()
}
}
// Add sync magic
if (loop_time - _last_sync_time > 500_ms) {
uint16_t write_msg_size = static_cast<uint16_t>(sizeof(ulog_message_sync_s) - ULOG_MSG_HEADER_LEN);
_msg_buffer[0] = (uint8_t)write_msg_size;
_msg_buffer[1] = (uint8_t)(write_msg_size >> 8);
_msg_buffer[2] = static_cast<uint8_t>(ULogMessageType::SYNC);
// sync byte sequence
_msg_buffer[3] = 0x2F;
_msg_buffer[4] = 0x73;
_msg_buffer[5] = 0x13;
_msg_buffer[6] = 0x20;
_msg_buffer[7] = 0x25;
_msg_buffer[8] = 0x0C;
_msg_buffer[9] = 0xBB;
_msg_buffer[10] = 0x12;
write_message(LogType::Full, _msg_buffer, write_msg_size + ULOG_MSG_HEADER_LEN);
_last_sync_time = loop_time;
}
// update buffer statistics
for (int i = 0; i < (int)LogType::Count; ++i) {
if (!_statistics[i].dropout_start && _writer.get_buffer_fill_count_file((LogType)i) > _statistics[i].high_water) {