fullseye

kalman_ca — DRIVE balltrack op

使い方

等加速度モデルの Kalman フィルタ(位置の観測 (N, D)、状態 = 位置・速度・加速度 × D)。

返り値 {"x" (N, 3D) 更新後, "x_pred" (N, 3D) 予測, "P" (N, 3D, 3D), "innovation" (N, D)}。 q = 加速度の変化の分散(白色ジャーク)、r = 観測の分散。放物線の真値を入れると(モデルが厳密なので)収束後の 新息 → 0、r → 0 で更新後の位置 = 観測(門)。NaN の観測は予測だけ(欠測)。

参考(サンプルデータ・文献)

実行できる例(この op を実際に呼ぶ検証済みサンプル)

型が繋がる次の op(table を入力に取れる)

course_layout · course_occupancy · course_contains · world_build · world_camera · world_move · lidar_scan · rss_longitudinal_same

同カテゴリ(balltrack)

ball_detect · ball_track · triangulate_dlt · track_triangulate · bounce_detect · marker_direction · spin_from_markers · spin_from_marker_sequence


Provenance: balltrack.py — DRIVE operator registry. この per-op ノートは tools/opdocs.py md が自動生成(手編集しない)。

© 2026 Kazufumi Furuse — Fullseye operator documentation. Licensed under Apache-2.0.