|
|
|
@ -972,10 +972,12 @@ static void ten_hz_logging_loop()
@@ -972,10 +972,12 @@ static void ten_hz_logging_loop()
|
|
|
|
|
if (should_log(MASK_LOG_ATTITUDE_MED) && !should_log(MASK_LOG_ATTITUDE_FAST)) { |
|
|
|
|
Log_Write_Attitude(); |
|
|
|
|
Log_Write_Rate(); |
|
|
|
|
DataFlash.Log_Write_PID(LOG_PIDR_MSG, g.pid_rate_roll.get_pid_info() ); |
|
|
|
|
DataFlash.Log_Write_PID(LOG_PIDP_MSG, g.pid_rate_pitch.get_pid_info() ); |
|
|
|
|
DataFlash.Log_Write_PID(LOG_PIDY_MSG, g.pid_rate_yaw.get_pid_info() ); |
|
|
|
|
DataFlash.Log_Write_PID(LOG_PIDA_MSG, g.pid_accel_z.get_pid_info() ); |
|
|
|
|
if (should_log(MASK_LOG_PID)) { |
|
|
|
|
DataFlash.Log_Write_PID(LOG_PIDR_MSG, g.pid_rate_roll.get_pid_info() ); |
|
|
|
|
DataFlash.Log_Write_PID(LOG_PIDP_MSG, g.pid_rate_pitch.get_pid_info() ); |
|
|
|
|
DataFlash.Log_Write_PID(LOG_PIDY_MSG, g.pid_rate_yaw.get_pid_info() ); |
|
|
|
|
DataFlash.Log_Write_PID(LOG_PIDA_MSG, g.pid_accel_z.get_pid_info() ); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
if (should_log(MASK_LOG_MOTBATT)) { |
|
|
|
|
Log_Write_MotBatt(); |
|
|
|
@ -1004,10 +1006,12 @@ static void fifty_hz_logging_loop()
@@ -1004,10 +1006,12 @@ static void fifty_hz_logging_loop()
|
|
|
|
|
if (should_log(MASK_LOG_ATTITUDE_FAST)) { |
|
|
|
|
Log_Write_Attitude(); |
|
|
|
|
Log_Write_Rate(); |
|
|
|
|
DataFlash.Log_Write_PID(LOG_PIDR_MSG, g.pid_rate_roll.get_pid_info() ); |
|
|
|
|
DataFlash.Log_Write_PID(LOG_PIDP_MSG, g.pid_rate_pitch.get_pid_info() ); |
|
|
|
|
DataFlash.Log_Write_PID(LOG_PIDY_MSG, g.pid_rate_yaw.get_pid_info() ); |
|
|
|
|
DataFlash.Log_Write_PID(LOG_PIDA_MSG, g.pid_accel_z.get_pid_info() ); |
|
|
|
|
if (should_log(MASK_LOG_PID)) { |
|
|
|
|
DataFlash.Log_Write_PID(LOG_PIDR_MSG, g.pid_rate_roll.get_pid_info() ); |
|
|
|
|
DataFlash.Log_Write_PID(LOG_PIDP_MSG, g.pid_rate_pitch.get_pid_info() ); |
|
|
|
|
DataFlash.Log_Write_PID(LOG_PIDY_MSG, g.pid_rate_yaw.get_pid_info() ); |
|
|
|
|
DataFlash.Log_Write_PID(LOG_PIDA_MSG, g.pid_accel_z.get_pid_info() ); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// log IMU data if we're not already logging at the higher rate |
|
|
|
|