Files
PX4-Autopilot/docs/ko/msg_docs/VteAidSource1d.md
T

11 KiB

pageClass
pageClass
is-wide-page

VteAidSource1d (UORB message)

Vision Target Estimator 1D fusion aid-source diagnostics (e.g. yaw).

Published by: vision_target_estimator (VTEOrientation) on every fusion attempt, including rejected ones. Subscribed by: logger only. Inspect observation, innovation, test_ratio, and fusion_status to debug why a measurement was or was not fused.

TOPICS: vte_aid_ev_yaw

Fields

명칭 형식 Unit [Frame] Range/Enum 설명
timestamp uint64 us Time since system start
timestamp_sample uint64 us Timestamp of the raw observation
time_last_predict uint64 us Timestamp of last filter prediction
observation float32 Observation attempted to be fused
observation_variance float32 Variance of observation attempted to be fused
innovation float32 Kalman Filter innovation (y = z - Hx)
innovation_variance float32 Kalman Filter variance of the innovation
test_ratio float32 NIS divided by the gate threshold, so above 1 means rejected
fusion_status uint8 VTE_FUSION_STATUS Fusion status code
time_since_meas_ms float32 ms (now - timestamp_sample)
history_steps uint8 Number of steps replayed in OOSM (0 if current or failed)
replayed_count uint8 Stored observations gated again after this one (0 if none)
replay_revised_count uint8 Those whose gate decision changed (0 if none)
replay_test_ratio_max float32 Highest test_ratio among those accepted before the replay (-1 if none)

Enums

VTE_FUSION_STATUS

Used in field(s): fusion_status

명칭 형식 Value 설명

Constants

명칭 형식 Value 설명
STATUS_IDLE uint8 0 No fusion attempted yet
STATUS_FUSED_CURRENT uint8 1 Fused immediately (low latency)
STATUS_FUSED_OOSM uint8 2 Fused via history buffer
STATUS_REJECT_NIS uint8 3 Rejected by Normalized Innovation Squared check
STATUS_REJECT_COV uint8 4 Rejected due to invalid/infinite covariance or numerical error; clears history if a replayed observation failed
STATUS_REJECT_TOO_OLD uint8 5 Rejected: older than buffer limit (kOosmMaxTimeUs) or the oldest snapshot a replay can use
STATUS_REJECT_TOO_NEW uint8 6 Rejected: timestamp in the future (beyond tolerance)
STATUS_REJECT_STALE uint8 7 Rejected: history was reset due to staleness/discontinuity
STATUS_REJECT_EMPTY uint8 8 Rejected: history buffer not yet populated
STATUS_INITIALIZED uint8 9 Accepted as initial state; no prior innovation or repeated fusion

Source Message

Source file (GitHub)

:::details Click here to see original file

# Vision Target Estimator 1D fusion aid-source diagnostics (e.g. yaw).
#
# Published by: vision_target_estimator (VTEOrientation) on every fusion attempt, including rejected ones.
# Subscribed by: logger only. Inspect observation, innovation, test_ratio, and fusion_status to debug why a measurement was or was not fused.

uint64 timestamp # [us] Time since system start
uint64 timestamp_sample # [us] Timestamp of the raw observation
uint64 time_last_predict # [us] Timestamp of last filter prediction

# Observation & Innovation
float32 observation # [-] Observation attempted to be fused
float32 observation_variance # [-] Variance of observation attempted to be fused

float32 innovation # [-] Kalman Filter innovation (y = z - Hx)
float32 innovation_variance # [-] Kalman Filter variance of the innovation

float32 test_ratio # [-] NIS divided by the gate threshold, so above 1 means rejected

uint8 fusion_status # [@enum VTE_FUSION_STATUS] Fusion status code
uint8 STATUS_IDLE = 0 # No fusion attempted yet
uint8 STATUS_FUSED_CURRENT = 1 # Fused immediately (low latency)
uint8 STATUS_FUSED_OOSM = 2 # Fused via history buffer
uint8 STATUS_REJECT_NIS = 3 # Rejected by Normalized Innovation Squared check
uint8 STATUS_REJECT_COV = 4 # Rejected due to invalid/infinite covariance or numerical error; clears history if a replayed observation failed
uint8 STATUS_REJECT_TOO_OLD = 5 # Rejected: older than buffer limit (kOosmMaxTimeUs) or the oldest snapshot a replay can use
uint8 STATUS_REJECT_TOO_NEW = 6 # Rejected: timestamp in the future (beyond tolerance)
uint8 STATUS_REJECT_STALE = 7 # Rejected: history was reset due to staleness/discontinuity
uint8 STATUS_REJECT_EMPTY = 8 # Rejected: history buffer not yet populated
uint8 STATUS_INITIALIZED = 9 # Accepted as initial state; no prior innovation or repeated fusion

# OOSM Diagnostics
float32 time_since_meas_ms # [ms] (now - timestamp_sample)
uint8 history_steps # [-] Number of steps replayed in OOSM (0 if current or failed)
uint8 replayed_count # [-] Stored observations gated again after this one (0 if none)
uint8 replay_revised_count # [-] Those whose gate decision changed (0 if none)
float32 replay_test_ratio_max # [-] Highest test_ratio among those accepted before the replay (-1 if none)

# TOPICS vte_aid_ev_yaw

:::