Log CPU loads

This commit is contained in:
Jaeyoung-Lim
2019-10-27 11:47:10 +00:00
committed by Nuno Marques
parent 677c0b4713
commit 58d646e33d
2 changed files with 10 additions and 0 deletions
+1
View File
@@ -643,6 +643,7 @@ void Logger::add_vision_and_avoidance_topics()
add_topic("vehicle_trajectory_waypoint", 200);
add_topic("vehicle_trajectory_waypoint_desired", 200);
add_topic("vehicle_visual_odometry", 30);
add_topic("onboard_computer_status", 200);
}
void Logger::add_system_identification_topics()
+9
View File
@@ -2547,6 +2547,15 @@ MavlinkReceiver::handle_message_onboard_computer_status(mavlink_message_t *msg)
onboard_computer_status_s onboard_computer_status_topic{};
onboard_computer_status_topic.cpu_cores[0] = status_msg.cpu_cores[0];
onboard_computer_status_topic.cpu_cores[1] = status_msg.cpu_cores[1];
onboard_computer_status_topic.cpu_cores[2] = status_msg.cpu_cores[2];
onboard_computer_status_topic.cpu_cores[3] = status_msg.cpu_cores[3];
onboard_computer_status_topic.cpu_cores[4] = status_msg.cpu_cores[4];
onboard_computer_status_topic.cpu_cores[5] = status_msg.cpu_cores[5];
onboard_computer_status_topic.cpu_cores[6] = status_msg.cpu_cores[6];
onboard_computer_status_topic.cpu_cores[7] = status_msg.cpu_cores[7];
_onboard_computer_status_pub.publish(onboard_computer_status_topic);
}