fullseye

doppler_track — DRIVE decide op

使い方

サイレンの音から瞬時周波数を推定し、近づいている / 遠ざかっているを判定する。

  1. 解析信号(FFT の Hilbert 変換)の位相差 → 瞬時周波数 f(t) = arg(z[n+1] z̄[n]) fs / 2π。
  2. 幅 smooth 秒の移動中央値。
  3. 各時刻で公称の 2 音(f_high / f_low)のうち比が近い方を「発した音」とみなし、ドップラー係数 D = f / f_nom、視線速度 v_r = c (1 − 1/D)(doppler_shift を v_r について解いたもの)。
  4. 音が切り替わる所(中央値の跳び > 20 Hz)の前後 guard 秒と、両端 edge 秒は無効(valid = False)。
  5. 判定: 最後の verdict_window 秒の有効な v_r の中央値が +v_tol より大 → "approaching"、−v_tol より小 → "receding"、間 → "abeam"。state は各時刻の同じ判定(無効な所は "unknown")。

公称音の取り違えの限界: 振り分けの境目は幾何平均 √(f_h f_l)。低い音が近づいて境目を越えるのは v_r = c (1 − √(f_l/f_h))、高い音が遠ざかって越えるのは v_r = −c (√(f_h/f_l) − 1)。960/770 Hz では +35.8 m/s(129 km/h)と −40.0 m/s。これより速い視線速度は取り違える(テストで固定)。

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

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

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

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

同カテゴリ(decide)

mirror_reflection_matrix · mirror_virtual_camera · mirror_aim_normal · convex_mirror_fov · mirror_blind_zone · check_sequence_score · signal_phase_plan · signal_state


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

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