diff --git a/libraries/DataFlash/LogStructure.h b/libraries/DataFlash/LogStructure.h index c519c6a041..833813a8bb 100644 --- a/libraries/DataFlash/LogStructure.h +++ b/libraries/DataFlash/LogStructure.h @@ -899,6 +899,24 @@ struct PACKED log_SRTL { float D; }; +struct PACKED log_DSTL { + LOG_PACKET_HEADER; + uint64_t time_us; + uint8_t stage; + float target_heading; + int32_t target_lat; + int32_t target_lng; + int32_t target_alt; + int16_t crosstrack_error; + int16_t travel_distance; + float l1_i; + int32_t loiter_sum_cd; + float desired; + float P; + float I; + float D; +}; + // #endif // SBP_HW_LOGGING #define ACC_LABELS "TimeUS,SampleUS,AccX,AccY,AccZ" @@ -1154,8 +1172,8 @@ Format characters in the format string for binary log messages "PIDA", PID_FMT, PID_LABELS }, \ { LOG_PIDS_MSG, sizeof(log_PID), \ "PIDS", PID_FMT, PID_LABELS }, \ - { LOG_PIDL_MSG, sizeof(log_PID), \ - "PIDL", PID_FMT, PID_LABELS }, \ + { LOG_DSTL_MSG, sizeof(log_DSTL), \ + "DSTL", "QBfLLeccfeffff", "TimeUS,Stg,THdg,Lat,Lng,Alt,XT,Travel,L1I,Loiter,Des,P,I,D" }, \ { LOG_BAR2_MSG, sizeof(log_BARO), \ "BAR2", BARO_FMT, BARO_LABELS }, \ { LOG_BAR3_MSG, sizeof(log_BARO), \ @@ -1265,7 +1283,7 @@ enum LogMessages { LOG_PIDY_MSG, LOG_PIDA_MSG, LOG_PIDS_MSG, - LOG_PIDL_MSG, + LOG_DSTL_MSG, LOG_VIBE_MSG, LOG_IMUDT_MSG, LOG_IMUDT2_MSG,