fullseye

spin_from_marker_sequence — DRIVE balltrack op

使い方

コマの列の模様の向き dirs[k]((M_k, 3) の単位ベクトル、見つからないコマは None)から角速度を読む(2 段)。

1 段目: 隣のコマ同士で、向きが max_angle [rad] 以内で最も近い模様を組にして Kabsch(:func:spin_from_markers)、 その中央値を ω₁ とする。2 段目: lag コマ離れた組を、前のコマを ω₁ で回した予測に最も近い模様(max_angle/2 以内)と 組んで当て直す —— 回転角が lag 倍になるので、模様の位置の誤差が効く割合は 1/lag。★1 コマの回転角は max_angle より十分小さいこと(模様の取り違え)、lag コマの回転は π より小さいこと(Kabsch は最短の回転を返す)。 返り値 {"omega", "omega_stage1", "n_pairs", "per_pair" (N, 3)}(ω は dirs と同じ座標系)。組が 1 つも無ければ ω は NaN。模様が見えた向きの組が要るので、各コマ 2 個以上の模様が要る。

空の入力(dirs が 0 件)は ValueError。

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

実行できる例(この 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 · kalman_ca · triangulate_dlt · track_triangulate · bounce_detect · marker_direction · spin_from_markers


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

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