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

logger: write "sys_name" and "time_ref_utc" info to log file

Browse Source
This commit is contained in:
Beat Küng 2016-05-17 12:28:23 +02:00 committed by Lorenz Meier
parent 908f7eb47f
commit 0ddd7a408c
2 changed files with 29 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

28
src/modules/logger/logger.cpp
View File

@ -931,6 +931,27 @@ void Logger::write_info(const char *name, const char *value)
_writer.unlock();
}
void Logger::write_info(const char *name, uint32_t value)
{
_writer.lock();
uint8_t buffer[sizeof(message_info_header_s)];
message_info_header_s *msg = reinterpret_cast<message_info_header_s *>(buffer);
msg->msg_type = static_cast<uint8_t>(MessageType::INFO);
/* construct format key (type and name) */
msg->key_len = snprintf(msg->key, sizeof(msg->key), "uint32_t %s", name);
size_t msg_size = sizeof(*msg) - sizeof(msg->key) + msg->key_len;
/* copy string value directly to buffer */
memcpy(&buffer[msg_size], &value, sizeof(uint32_t));
msg_size += sizeof(uint32_t);
msg->msg_size = msg_size - 3;
write_wait(buffer, msg_size);
_writer.unlock();
}
void Logger::write_header()
{
@ -954,6 +975,13 @@ void Logger::write_version()
{
write_info("ver_sw", PX4_GIT_VERSION_STR);
write_info("ver_hw", HW_ARCH);
write_info("sys_name", "PX4");
int32_t utc_offset = 0;
if (_log_utc_offset != PARAM_INVALID) {
param_get(_log_utc_offset, &utc_offset);
write_info("time_ref_utc", utc_offset * 60);
}
}
void Logger::write_parameters()

1
src/modules/logger/logger.h
View File

@ -128,6 +128,7 @@ private:
void write_version();
void write_info(const char *name, const char *value);
void write_info(const char *name, uint32_t value);
void write_parameters();