|
|
@ -55,14 +55,14 @@ void Sub::Log_Write_Attitude() |
|
|
|
{ |
|
|
|
{ |
|
|
|
Vector3f targets = attitude_control.get_att_target_euler_cd(); |
|
|
|
Vector3f targets = attitude_control.get_att_target_euler_cd(); |
|
|
|
targets.z = wrap_360_cd(targets.z); |
|
|
|
targets.z = wrap_360_cd(targets.z); |
|
|
|
logger.Write_Attitude(ahrs, targets); |
|
|
|
logger.Write_Attitude(targets); |
|
|
|
|
|
|
|
|
|
|
|
AP::ahrs_navekf().Log_Write(); |
|
|
|
AP::ahrs_navekf().Log_Write(); |
|
|
|
logger.Write_AHRS2(ahrs); |
|
|
|
logger.Write_AHRS2(); |
|
|
|
#if CONFIG_HAL_BOARD == HAL_BOARD_SITL |
|
|
|
#if CONFIG_HAL_BOARD == HAL_BOARD_SITL |
|
|
|
sitl.Log_Write_SIMSTATE(); |
|
|
|
sitl.Log_Write_SIMSTATE(); |
|
|
|
#endif |
|
|
|
#endif |
|
|
|
logger.Write_POS(ahrs); |
|
|
|
logger.Write_POS(); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
struct PACKED log_MotBatt { |
|
|
|
struct PACKED log_MotBatt { |
|
|
|