基于超聲波“一發射兩接收”模式的運動中測速新型算法

代沈雪，杜 增，薛名揚

（遼寧大學，沈陽 110136）

近年來，隨著我國經濟的高速發展，我國汽車產業迅速崛起。據工信部網站公布的統計數據，2021年我國汽車年產量為2 608.2萬輛，銷售量為2 627.5萬輛，已經連續7年位居世界首位。據中國政府網公布的相關信息，2021年全國汽車保有量為3.02億輛，汽車駕駛人達4.44億人。根據中國統計年鑒公布的統計數據，2020年我國發生交通事故24 467起，由交通事故造成的直接財產損失為131 360.6萬元。行車安全已經成為關乎每個家庭和個人生活質量的重大公共問題。如何通過技術手段不斷提高汽車駕駛的安全系數，減少交通事故發生的概率，在發生交通事故后能夠為交管部門進行交通違法行為判罰和交通事故責任認定提供科學、準確、客觀的數據信息等系列問題具有重要的實際應用價值和社會意義，也是眾多汽車廠商和科研團隊進行技術研發的重點方向。日前，工信部要求自2022年1月起，新生產的乘用車必須配備符合GB 39732—2020《汽車事件數據記錄系統》規定的事件數據記錄系統（Event Data Recorder，簡稱EDR），也被稱為汽車黑匣子。EDR大多被集成安裝在安全氣囊控制單元（ACM）模塊內[1]。當車輛發生碰撞等突發情況導致速度劇烈變化達到閾值時，EDR系統將被觸發工作，自動記錄碰撞前、碰撞中及碰撞后3個階段數秒的汽車運行速度、縱向加速度、發動機轉數、剎車開關狀態和方向盤轉向角度等多方面關鍵數據[2]。目前，EDR系統只能在汽車速度發生急劇變化達到閾值時，才能被動觸發進行記錄，且存在數據記錄容易被覆蓋、丟失等問題，更無法實現對車輛自身行駛狀態以及車輛以外其它車輛或物體的運行狀態進行主動記錄等功能，不能主動有效規避交通事故發生風險。

1 概述

一直以來，車輛行駛速度的測量和行駛軌跡的記錄在交通安全管控中具有極其重要的意義，但傳統的車輛行駛速度測量方式采用靜態測量平臺，即需要測量設備處于靜止裝態時才能實現對車輛運動速度進行測量。如果能夠實現測量設備在運動狀態下對迎面或周圍行駛的車輛等物體進行速度測量及行駛軌跡記錄甚至行駛軌跡預判，一方面可以用來有效地減少或避免交通事故的發生，另一方面在交通事故發生后也可以為交通違法行為判罰和交通事故責任認定提供科學、準確、客觀的數據信息。因此，對于此類技術的研究具有極為重要的實際應用價值和社會意義。

本文提出了一種在測量方與被測量方均處于運動狀態下的速度測量方案，在對實際問題中車輛等物體進行簡化后，構建了一個在二維平面內運動狀態下進行速度測量的新型測速模型。通過數學建模和實驗模擬，計算得出了被測方的運動速度，在理論上驗證了這種測量方法的有效性，同時也為未來進行多物體速度測量及描述被測物體運動軌跡做了準備工作。

2 基本原理

首先，把在路面上行駛的汽車進行模型化，將測量車與被測量車的位置關系投影到二維平面內進行模擬，根據此模型中物體間的幾何關系，計算出被測車相對于測量車的距離、速度等物理量。

目前，常見的測距或測距方法有激光、超聲波及紅外線等，在進行理論建模和實際模擬時選擇使用了超聲波測距模塊，主要考慮到超聲波測量在技術上容易實現、操作相對簡單、適用范圍廣和受環境因素影響較小等優點[3-5]。超聲傳感器測距模塊可以連接在單片機上，通過計算源聲波信號發送時刻和反射回波信號接收時刻的時間間隔并結合超聲波在空氣中傳播速度來獲取被測量物的距離信息，再連續對多次測量的結果進行存儲、編程，可自動計算求得被測物體相對測量物體的運動速度等物理量[6]。本文采用的新型“一發射兩接收”超聲波測距測速模型，在實驗中是通過搭載單片機的智能小車機器人來實現的。2臺機器人小車間通過單片機實現實時通訊，被測方（對方）小車的單一發射器發射的一個超聲波信號被測量方（己方）小車的2個接收器接收后，可測得被測方（對方）小車分別相對測量方（己方）小車2個接收器的距離。再根據已知的2個接收器間距離，可構成1個三角形的三邊關系，通過計算三角形三邊的數量關系并對測量和計算結果進行存儲和編程，可以計算得到2個小車之間的相對距離和相對速度。結合測量方小車的定位模塊提供的位置、速度等信息，即可計算得到被測方小車的實時位置、速度乃至運動軌跡等信息。

3 所用傳感器模塊

在本模式中使用超聲波單體發射模塊和單體接收模塊，將2個超聲波接收裝置A、B分別安裝在己方小車的車頭左右，并將此簡化為測量方A、B點與二者之間的連線，將一超聲波發射裝置安裝在對方小車車頭前方中間，并將此簡化為被測方C點，如圖1所示。

圖1 超聲波模塊安裝示意圖

本文使用光電槽型光耦傳感器進行自身車速測量，槽型光耦也被稱作槽型光電開關或者對射式光電開關。此模塊由1對紅外線發射與接收管和光碼盤構成。原理為發射管發射出的紅外線，當沿檢測方向遇到障礙物（光碼盤反射面）時，則反射回來被接收管接收。這樣在電機所連的光碼盤旋轉過程中對紅外線實現阻斷和導通，可在接收管上感應出電流變化并實現開和關的判別。由此得知碼盤所轉周數進而計算出電機轉速和小車速度。

4 算法

在超聲波模塊持續測量過程中，選取一測量方得到距離測量結果的時刻t1和經Δt之后，得到下一次距離測量結果的時刻t2，此時被測方所處位置由C點位移至C’點。則可知在t1時刻被測方C點距測量方A點距離為d1，距測量方B點距離為d2；在t2時刻被測方C’點距測量方A點距離為d1’，距測量方B點距離為d2’。測量方A、B 2點間距安裝時已確定為l。

以測量方A點為坐標系原點，以測量方A點與測量方B點連線所在直線為x軸，建立（圖2）平面直角坐標系。

圖2 平面直角坐標系下的測量模型

則t1時刻有

由本模式原理知，sinα＞0，

設C點坐標為（x1，y1），有

t2時刻有

由本模式原理知，sin β＞0，

設C’點坐標為（x2，y2），有

在Δt時間內，將測量方視為靜止，由于Δt很小，近似地將被測方視為直線運動，可得Δt時間內，被測方發生的位移為C點與C’點間距離為

此時可求得被測方運動的平均速度，并將此近似為瞬時速度，而此速度實際上是測量方與被測方的相對速度，有

將相對速度v沿x方向與y方向分解（圖3），

圖3 相對速度分解

得

規定以x軸正方向為x軸速度分量正方向，以y軸正方向為y軸速度分量正方向。根據測量方A、B點連線上任一點的速度在x軸上的分量vx′與在y軸上的分量vy′，可算出被測方的實際速度vc為

本次速度測量結束后，立刻會進入下一次的速度測量，如此循環進行即可測得被測物的實時速度。

5 誤差

5.1 所用測量模塊誤差

5.1.1 超聲波模塊距離測量誤差

本模式氣介狀態下影響超聲波測距精度的主要因素有：壓力、環境的溫度、介質均勻是否穩定。其中超聲波對溫度的變化更為敏感，當處于有溫度梯度的環境或進行補償時溫度測量誤差大則超聲波測量誤差也會比較大。而在實際恒溫環境下，經監測發現超聲波模塊仍可傳回一些不準確數據。導致此情況的主要因素有：環境的噪聲、落葉等隨機飄動物體、目標體上其他構件或表面不平整等。尤其是在顛簸道路上行進時非常容易出現上述情況[7]。

5.1.2 槽型光耦轉速測量誤差

利用槽型光耦進行轉速測量時產生誤差的主要原因有：器件抗干擾能力差、自身攜帶誤差、傳感器安裝精度不高和入射角度不正確等。尤其是在強光直射場所中應用時應有適當遮擋，當傳感器處于煙塵、水霧較大或是電磁干擾環境中時，也會產生較大誤差。

5.2 方法誤差

在3次連續對被測方的測距中，Δt時間內，將測量方視為靜止，由于Δt很小，近似地將被測方視為直線運動，而實際情況下，被測方并不一定是理想地直線運動。此外，求得被測方運動的平均速度并將此近似為瞬時速度，實則忽略了被測方實際瞬時速度。由此2個將產生方法誤差，其大小主要取決于Δt的大小，根據微元思想，Δt越小，則此誤差越小。

實際上帶來誤差的因素還應包含單片機的數據計算處理速率、超聲波測速模塊和槽型光耦測速模塊數據傳輸回單片機的時效性和對應性等。

6 結束語

以交通軌跡記錄與預判研究為背景，提出了一種新型速度測量算法，即測量方與被測方均處于運動中時，測量方對被測方速度進行測量的一種模式。此模式打破了常規方法的一方處于靜態才能進行速度測量的局限，為與智能碰撞警告等模塊結合并應用于車載軌跡鑒定系統提供可能。本模式也可應用于開拓手持測速儀等測速儀器的功能。

實現交通軌跡記錄與預判能夠在行車過程中異常情況發生當時智能地作出警告以提醒駕駛員或當即采取一定措施阻止交通事故發生，保護生命財產安全；此外，當事故發生后，也能夠為事故原因分析提供依據[8]。此模式不僅是探究交通運動軌跡記錄與預判的基礎，對于交通事故責任判定有直接重大意義，而且對于有同樣速度測量需求的各類研究、應用也有促進意義。