Skip to content

Commit

Permalink
Sub: log ANG attitude message
Browse files Browse the repository at this point in the history
  • Loading branch information
andyp1per committed Sep 10, 2024
1 parent d9e1d5b commit d8304bf
Showing 1 changed file with 2 additions and 0 deletions.
2 changes: 2 additions & 0 deletions ArduSub/ArduSub.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -183,6 +183,7 @@ void Sub::ten_hz_logging_loop()
// log attitude data if we're not already logging at the higher rate
if (should_log(MASK_LOG_ATTITUDE_MED) && !should_log(MASK_LOG_ATTITUDE_FAST)) {
Log_Write_Attitude();
attitude_control.Write_Attitude();
attitude_control.Write_Rate(pos_control);
if (should_log(MASK_LOG_PID)) {
logger.Write_PID(LOG_PIDR_MSG, attitude_control.get_rate_roll_pid().get_pid_info());
Expand Down Expand Up @@ -222,6 +223,7 @@ void Sub::twentyfive_hz_logging()
{
if (should_log(MASK_LOG_ATTITUDE_FAST)) {
Log_Write_Attitude();
attitude_control.Write_Attitude();
attitude_control.Write_Rate(pos_control);
if (should_log(MASK_LOG_PID)) {
logger.Write_PID(LOG_PIDR_MSG, attitude_control.get_rate_roll_pid().get_pid_info());
Expand Down

0 comments on commit d8304bf

Please sign in to comment.