attitude update frequency

This commit is contained in:
nuknal
2024-09-13 12:51:02 +08:00
parent ec793d17ba
commit 001ad32b8e
5 changed files with 7 additions and 3 deletions

View File

@@ -112,7 +112,7 @@ func ExtractAttitude(aps []*AuxPlatform) *Attitudes {
sec, microsec = ap.UTCTimeSec, ap.Microsecond
att := Attitude{
UTCTimestampSec: float64(sec) + float64(ReferenceTime2000) +
float64((microsec))/1e6,
float64(transfromGPSandAttMicrosec(microsec))/1e6,
Q0: ap.QuatAttstarQ0,
Q1: ap.QuatAttstarQ1,
Q2: ap.QuatAttstarQ2,