2026年5月23日土曜日

LiDARを使った相対速度計(その4)

 とりあえず基板を百均のクリアトレー(ミニ)を加工した箱に入れた。


LiDARは毎秒50回、反射物までの距離の測定を行う、センサー部はこの10回分を平均して、即ち0.2秒毎に距離をcm単位で報告してくる。

相対速度はこの0.2妙毎の距離の変化(差分)から算出すればよい。具体的には差分(m/0.2sec)を18000倍(=5×60×60)して100000で割ることで時速(Km/h)に変換できる。

7セグLEDの表示はこの相対速度(Km/h)と距離(cm)をスイッチで切り替えられるようにした。 またセンサー部からの入力が無い場合は全桁ドット(.)を、センサーの探知範囲外は全桁ダッシュ(-)を表示する。

左端の緑、黄、赤のLEDは次の様に点灯させる。赤は相対速度が負の場合に点灯、緑は相対速度が正の場合に点灯、 赤と緑の点灯には閾値を設定している。黄色は相対速度が0の状態が3秒以上続いた場合に静止状態と判断し、点灯する。黄色から緑へ点灯が変化する場合、即ち信号待ちで停車中に前車が発射知った場合にブザーをピッと鳴動させる。

これで予定した基本的な機能は実装できたはずである。

(続く) 

 

0 件のコメント:

コメントを投稿