陳鵬 閔永軍 程志國 朱慶華 潘義勇
摘 要:針對目前國內霧天高速公路管理措施過于簡化、消極的問題,設計一種以自編隊行駛方案為基礎,以多信道通信技術為核心的嵌入式移動無線節(jié)點系統(tǒng)。該系統(tǒng)以STM32F103為主控芯片,將由GPS報文解析得到的本車位置和速度等信息通過SI4463射頻模塊傳送給相鄰車輛,以提高駕駛員對周圍車輛運行狀態(tài)和位置的感知能力。實驗表明,該系統(tǒng)運行穩(wěn)定,數(shù)據(jù)收發(fā)準確,能夠提高霧天高速公路的安全性能和通行能力,達到交通管理部門“少封路、少降速”的要求。
關鍵詞:霧天;高速公路;自編隊行駛方案;多信道通信;輔助駕駛系統(tǒng)
中圖分類號:U495文獻標識碼:A文章編號:1006-8023(2018)06-0055-07
Design and Implementation of an Assisted Driving System for Foggy Expressway
CHEN Peng,MIN Yongjun*,CHENG Zhiguo,ZHU Qinghua,PAN Yiyong
(College of Automobile and Traffic Engineering, Nanjing Forestry University, Nanjing 210037)
Abstract: Regarding the problem of oversimplified and negative management measures of china,s freeway in fog, an embedded mobile node system based on the self-teaming driving programs and multi-channel communication technology is designed, which is wireless. With STM32F103 as the main control chip, the system transmits the information such as the position and speed of the vehicle, which is analyzed by the GPS message, to the adjacent vehicles through the SI4463 RF module, so as to enhance the driver,s ability to sense the running status and position of the surrounding vehicles. The test results show that the system has been stable in operation, sent and received data accurately, and can not only improve the safety performance and traffic capacity of the freeway under the foggy weather, but also meet the requirements of the traffic management department for
''less sealing and less speed reduction''.
Keywords: Foggy weather; freeway; self-teaming driving program; multi-channel communication; assisted driving system
0 引言
霧天環(huán)境下的安全行車問題已經成為制約高速公路帶來經濟效益的瓶頸[1-3]。目前對于濃霧天氣,管理部門主要采取封閉高速公路的措施來保障安全,但實際上只是將事故轉移到了其它道路[4]。因此,開發(fā)一種能夠引導駕駛員在高速公路霧天環(huán)境下安全行駛的輔助駕駛系統(tǒng)具有重要的意義。
隨著傳感器技術的發(fā)展,超聲波、紅外線、激光、毫米波雷達和機器視覺等技術開始用于探測車輛周圍的行駛環(huán)境,并給駕駛員提供相應的預警信息,但由于技術自身的限制,很難在霧天環(huán)境下獲得良好的效果[5-6]。
智能交通系統(tǒng)(ITS)為解決霧天高速公路安全行車的問題提供了新的技術手段。卜祥元等[7]提出利用無線射頻天線周期性的收發(fā)GPS模塊獲取的位置信息,以信息交互的方式推算與鄰車的位置關系從而提高霧天駕駛員對周圍車輛的感知能力。邢剛等[8]利用通用分組無線服務技術(GPRS)將GPS接收的位置信息在車輛間相互轉發(fā),并通過設置無線數(shù)據(jù)中狀態(tài)位來辨別行駛方向。文獻[7-8]采用車車通信(V2V)的相關技術能夠避免障礙物和反向行駛車輛的干擾,但由于現(xiàn)在通用GPS定位精度達不到車道級定位要求[9],同向相鄰車道車輛與本車不在同一個車道,對本身并無威脅,系統(tǒng)卻因無法判別兩車所行車道,預警距離內就會產生誤報,導致不能充分地利用高速公路資源。
本文主要針對上述不能區(qū)分同向車道的問題,參考交通學跟馳理論,制定自編隊行駛方案,并基于多信道通信技術開發(fā)了一套輔助駕駛系統(tǒng)。系統(tǒng)按車道劃分不同的無線通信中心頻率,同車道各車隊采用中心頻率附近的不同信道進行車隊內部通信,可避免由于定位精度不足產生不能區(qū)分同向車道的現(xiàn)象,保證車輛在霧天高速公路環(huán)境下安全高效的行駛。通過相關試驗測試表明,系統(tǒng)基本能達到預期的目標。
1 系統(tǒng)的總體方案
自編隊行駛方案要求進入高速公路的車輛以編隊行駛的方式通過霧區(qū)。每個車道上行駛的若干個由領頭車、中間車輛和尾車組成的子車隊統(tǒng)稱為主線車隊。主線車隊之間采用不同的中心頻率通信,其內部各子車隊采用該中心頻率附近的信道通信,確保每個子車隊擁有獨立的通信信道[10]。
系統(tǒng)的總體方案如圖1所示,車輛在進入高速公路前,由交通管理部門人員進行編隊并發(fā)放駕駛輔助系統(tǒng),告知駕駛員開啟系統(tǒng)并按提示信息輸入起始信息。起始信息包括通信信道的頻率值和車輛所處車隊內位置等信息,即領頭車、中間車輛或者尾車的位置信息。信息設定結束后,由領頭車的系統(tǒng)直接向其它車輛發(fā)送位置請求信息,其它車輛的系統(tǒng)采用載波監(jiān)聽多路訪問/沖突避免(CSMA/CA) 的方式向領頭車的系統(tǒng)發(fā)送自車的位置信息[11]。隨后領頭車的系統(tǒng)按距離的遠近向子車隊內其它車輛的系統(tǒng)分配逐漸增大的獨立的ID號和通信時隙[12]。最后系統(tǒng)在完成按通信時隙與后方車輛的系統(tǒng)握手通信(RTS/CTS信號)后才開始真正的數(shù)據(jù)傳遞[13]。上述操作完成后,子車隊方可駛入高速公路。
子車隊在行駛過程中,車輛不斷的接收并解析GPS報文,并在自車的通信時隙內將最新的行駛信息發(fā)送給后方的車輛;在自車通信時隙的上一個時隙,接收來自前車的行駛信息。領頭車和尾車由于處在特殊的位置,會在空閑的時隙內開啟信道檢測功能,與其它車隊的領頭車和尾車建立起通信[14]。車載系統(tǒng)在獲得前方車輛行駛信息的情況下,結合自車的行駛信息進行計算,并給駕駛員發(fā)出行車提示或警告,控制前后兩車保持安全的車距,以保證霧天高速公路環(huán)境下的行車安全。
本嵌入式移動無線節(jié)點系統(tǒng)主要由主控模塊、無線射頻模塊、GPS模塊、人機交互模塊和報警模塊等組成。主控模塊通過UART接口與GPS模塊通信,通過I/O口和SPI接口與其它模塊通信,在主控模塊的管理下,無線射頻模塊負責在車輛間建立起通信聯(lián)系、完成獨立ID號的分配和行駛信息的共享,GPS模塊負責為系統(tǒng)提供時間、位置和速度信息,人機交互模塊接收駕駛員提供的起始信息,并通過報警模塊發(fā)出提示或警告信息引導駕駛員安全行駛。
2 系統(tǒng)的硬件設計
2.1 ARM MCU的選擇
本文主控模塊選用的MCU是意法半導體(ST)公司基于Cortex-M3內核生產的STM32F103ZET6芯片,其采用ARM Cortex-M3內核用于要求功耗低、性能高、成本低的場合。STM32F103ZET6內部集成了豐富的片上資源,簡化了硬件電路,提高了系統(tǒng)的抗干擾能量,因此處理的數(shù)據(jù)更加穩(wěn)定和精確[15]。
2.2 SI4463射頻模塊電路的設計
SI4463是一款具有發(fā)送器、接收器和收發(fā)器的高度集成單片無線ISM芯片。通信距離可達2 500 m,可提供433、868、915 MHz 3個中心頻率各50個信道的大范圍頻率信號,同時兼容空閑信道評估與檢測(CCA)和自動頻率控制(AFC)等功能,相鄰信道射頻互調抗拒比可達60 dB,能夠滿足自編隊通信的需求,其中無線射頻模塊電路圖如圖2所示。
SI4463芯片的GPIO0 ~ 3引腳與MCU的SPI接口相連,用以接收主芯片的控制指令。其中,SCLK、SDI引腳分別為串行時鐘和數(shù)據(jù)輸入,SDO是數(shù)字輸出引腳,NSEL引腳為系統(tǒng)提供選擇、使能功能,NIRQ是中斷輸出引腳。RX和TX引腳分別為信號的輸入和輸出端,左上角UPG2214TP芯片作為Si4463芯片的專用天線使用。
為保證無線信號收發(fā)的穩(wěn)定性,電路圖下方電容C12、C13、C14和C15與電源并聯(lián),濾除雜波脈沖提供穩(wěn)定的電壓輸入。左邊專用天線收發(fā)端以電容C6 、C7、C4和電感L3組成低通濾波電路,避免低頻信號的干擾。上方C1、L1、L2等為輸入阻抗匹配電路,左下方C10、L5、L6等為輸出阻抗匹配電路。
2.3 GPS模塊的選擇
系統(tǒng)要求GPS模塊擁有足夠的刷新速率,以便及時更新車輛的行駛信息?;谏鲜隹紤],本文選用瑞士U-blox公司以U-BLOX NEO-6M芯片為基礎開發(fā)的ATK-NEO-6M高性能GPS定位模塊,該模塊自帶MAXIM 20.5dB高增益LNA芯片和陶瓷天線,信號穩(wěn)定且搜星能力強。該模塊各參數(shù)見表1。
ATK-NEO-6M GPS模塊兼容5V/3.3V單片機系統(tǒng),與本系統(tǒng)MCU的通信通過UART(串口)來實現(xiàn),輸出的定位數(shù)據(jù)采用NMEA-0183協(xié)議,控制協(xié)議為UBX協(xié)議,5Hz的刷新速率足以滿足通信的需求。
3 系統(tǒng)的軟件設計
本系統(tǒng)采用C語言在Keil軟件平臺上完成軟件設計的部分編譯和調試,包含主程序設計、SI4463無線射頻模塊初始化、GPS報文接收模塊初始化、按鍵掃描程序設計和行車預警模塊程序設計等,下面主要介紹主程序MCU、SI4463無線射頻模塊和行車預警模塊,其它僅作簡要說明。
3.1 主程序MCU軟件設計
系統(tǒng)復位后主程序首先完成程序的初始化:初始化STM32,配置SPI、SI4463以及GPS配置的初始化。接著按鍵掃描模塊檢測駕駛員輸入的起始信息,并由領頭車分配獨立的ID號和通信時隙,執(zhí)行握手通信。當握手通信成功后,主程序開始循環(huán)執(zhí)行行車預警模塊的程序,具體的流程如圖3所示。
3.2 SI4463無線射頻模塊軟件設計
系統(tǒng)無線通信模塊初始化函數(shù)為:
void SI4463_Init(void)
{ SI4463_IOSET(void);
SI446X_RESET(void);
SI446X_CONFIG_INIT(void);}
其中void SI4463_IOSET(void)是SI4463模塊的IO口(不包括SPI口)配置,具體配置SI4463芯片的不同功能。void SI446X_RESET(void)為無線傳輸模塊復位子程序。SI446X_CONFIG_INIT(void)為硬件的配置,包括傳輸數(shù)據(jù)包配置和參數(shù)配置,具體設置發(fā)射功率為+20 dBm,調制方式是FSK,傳輸方式為FIFO模式,有效數(shù)據(jù)包的載荷為64個字節(jié)等。
3.3 行車預警模塊軟件設計
圖4為預警模塊的工作流程是主程序的一個環(huán)節(jié)。系統(tǒng)先調取自車與前車最新的行駛信息并進行判斷,當實際車距與理論車距偏差較大時,會提示駕駛人員執(zhí)行加速或減速操作,以避免發(fā)生車輛碰撞或掉隊的現(xiàn)象。
考慮到高速公路霧天行車環(huán)境的復雜性,本文以最小安全距離作為理論的行車間距。從駕駛員意識到前方發(fā)生突發(fā)狀況,到經過一定的反應時間開始制動直到車輛停止并正好不與前方車輛產生碰撞的距離為最小安全距離[16]。圖5是同車道行駛車輛不發(fā)生碰撞時的安全距離示意圖,本系統(tǒng)為了確保行車的安全性,只考慮Vb0≥Va0和Sa = 0這兩種極端情況。
經運動學分析和綜合考慮實際行駛工況[17],車輛B要避免追尾車輛A,需要滿足以下條件:
式中:L為B車制動開始時A、B兩車的實際距離,單位為m;Sb1為在駕駛員反應階段(tr1)、制動器協(xié)調階段(tr2)和減速度增長時間(ti)車輛B行駛的距離,Sb2為持續(xù)制動階段車輛B行駛的距離;tr = tr1+ tr2,取tr = 1.5 s,ti = 0.1 ~ 0.2 s;同時考慮到霧天環(huán)境下道路附著系數(shù)降低,可取最大制動減速度amax = 5 m/s2。另外,考慮到GPS的精度誤差、刷新的速率和車身長度等因素,取縱向預留間隙Dsafe為30 m。
由公式(3)可知,B車行駛的距離主要取決于B車采取制動時的初速度,系統(tǒng)通過GPS模塊測得自車的速度并進行理論距離的計算,從而實現(xiàn)速度預警的控制策略。
4 系統(tǒng)性能測試及數(shù)據(jù)分析
為了驗證本輔助系統(tǒng)的可行性,同時考慮到霧天環(huán)境對GPS報文和無線數(shù)據(jù)的收發(fā)并無任何的影響,所以選擇某段流量稀少的雙車道道路進行實車實驗,如圖6所示。GPS接收設備和輔助駕駛系統(tǒng)安放在車內,GPS接收天線放置在車頂。
經測試,系統(tǒng)能夠正常的運行,不同信道移動無線節(jié)點之間無明顯干擾,同信道移動無線節(jié)點在車輛組隊行駛中能維持良好的通信,響應時間在0.27 s內,可滿足車輛間信息通信的需求。GPS信號穩(wěn)定,經緯度、速度和時間等數(shù)據(jù)均能準確接收和存儲。其中同頻通信的實驗數(shù)據(jù)和分析見表2。
通信測試表明:當測試采用相同的通信距離時,高頻通信的丟包率和誤包率通常要高于低頻通信,而且在通信距離增加時,進行高頻通信的丟包和誤包概率也隨之增加。盡管在200 m的測試距離內丟包和誤包的概率在容錯范圍內,但為了保證系統(tǒng)足夠的安全,無線射頻模塊在使用不同頻率進行通信時應盡量避免采用高頻進行通信。
5 結束語
本文以自編隊行駛方案為基礎,結合多信道通信技術設計并實現(xiàn)了一個高速公路霧天行車輔助駕駛系統(tǒng),該系統(tǒng)能夠很好的解決霧天高速公路環(huán)境下由于GPS定位精度不足產生的誤報問題,同時也為智能網聯(lián)汽車和環(huán)境感知技術等方面的研究提供了參考。
雖然系統(tǒng)已實現(xiàn)了基本功能,還具有良好的穩(wěn)定性,但在細節(jié)方面尚有改進的余地。尤其是在理論車距的計算方面,只是著重的從安全性能的方面做出考慮,未來將進一步結合高速公路的通行效率進行研究。
【參 考 文 獻】
[1]張金滿,譚桂容,武輝芹,等. 災害性天氣交通事故特征及霧天公路通行預警指標體系[J]. 干旱氣象,2016,34(2):370-375.
ZHANG J M, TAN G R, WU H Q, et al. Characteristics of severe weather traffic accidents and traffic warning system of fog and sky highway[J]. Arid Meteorology, 2016, 34(2): 370-375.
[2]李曉夢,閆學東,趙佳,等. 霧天對彎道駕駛行為的影響研究 [J]. 交通信息與安全,2014,32(5):120-125.
LI X M, YAN X D, ZHAO J, et al. Study on the influence of foggy weather on curved driving behavior[J]. Traffic Information and Security, 2014, 32(5):120-125.
[3] 侯偉明,張磊. 霧天區(qū)域公路網通行安全性預警方法研究 [J]. 公路工程,2015,40(4):210-214.
HOU W M, ZHANG L. Research on the early warning method of highway network safety in foggy area[J]. Road Construction, 2015, 40(4): 210-214.
[4]程志國. 霧天高速輔助駕駛裝置研究與開發(fā)[D].南京:南京林業(yè)大學,2016.
CHENG Z G. Research and development of foggy high speed assisted driving device[D]. Nanjing: Nanjing Forestry University, 2016.
[5]初秀民,萬劍,嚴新平,等. 基于車載機器視覺的汽車安全技術[J].中國安全科學學報,2008,18(5):154-161.
CHU X M, WAN J, YAN X P, et al. Vehicle safety technology based on vehicle vision[J]. Chinese Journal of Safety Science, 2008, 18(5): 154-161.
[6]高宏偉,王輝,劉玉影,等. 基于圖像測距的汽車防撞系統(tǒng)關鍵技術研究[J].電子測量與儀器學報,2017,31(6),820-826.
GAO H W, WANG H, LIU Y Y, et al. Research on key techniques of car collision avoidance system based on image ranging[J]. Journal of Electronic Measurement and Instrument, 2017, 31(6): 820-826.
[7]卜祥元,盧繼華,張軍,等.基于GPS廣播方式的高速公路汽車防撞系統(tǒng)[P].中國:CN201110392370,2012-12-01.
BO X Y, LU J H, ZHANG J, et al. GPS car-based anti-collision system for freeway cars[P]. China Patent: CN201110392370, 2012.
[8] 邢剛,王永瑞,黃學戰(zhàn),等.高速公路安全行車系統(tǒng)[P].中國:CN102194330A.發(fā)布日期:2011-09-21.
XING G, WANG Y R, HUANG X Z, et al. Highway safety system[P]. China Patent: CN102194330A, 2011.
[9]曹立波,陳崢,顏凌波,等. 基于RFID、視覺和UWB的車輛定位系統(tǒng)[J].汽車工程,2017,39(2):225-231.
CAO L B, CHEN Z, YAN L B, et al. RFID, vision and UWB based vehicle positioning system[J]. Automotive Engineering, 2017, 39(2): 225-231.
[10]劉文彬,楊波,李香寶,等.無線傳感器網絡中基于物理干涉模型的最小通信信道分配算法[J].計算機應用研究,2014,31(6):1771-1774.
LIU W B, YANG B, LI X B, et al. Minimum communication channel allocation algorithm based on physical interference model in wireless sensor networks[J]. Application Research of Computers, 2014, 31(6):1771-1774.
[11] 崔佳琪,楊劍鋒,徐俊,等. CSMA/CA在CSMA/TDMA混合網絡中的性能分析[J].計算機工程與應用,2017,53(20):83-88,127.
CUI J Q, YANG J F, XU J, et al. Performance analysis of CSMA/CA in CSMA/TDMA hybrid network[J]. Computer Engineering and Applications, 2017, 53(20):83-88,127.
[12] 李安濤,李建東. 時隙CSMA多跳分組無線移動通信網的遲延性能分析[J].通信學報,1991,12(1):78-82.
LI A T, LI J D. Delay performance analysis of multi-hop packet wireless mobile communication network based on time slot CSMA[J]. Journal of Communications, 1991, 12(1):78-82.
[13] MOHAND Y, DJAMIL A, LOUIZA B M, et al. Modeling and enhancement of the IEEE 802.11 RTS/CTS scheme in an error-prone channel[J]. Formal Aspects of Computing, 2015, 27(1):33-52.
[14] 秦臻,周劍剛,薛峰,等. 最小信道檢測開銷的協(xié)作頻譜感知算法[J].西安電子科技大學學報,2015,42(2):206-212.
QIN Z, ZHOU J G, XU F, et al. Cooperative spectrum sensing algorithm with minimum channel detection overhead[J]. Journal of Xian University, 2015, 42(2): 206-212.
[15] 陸萬田,王崴,徐曉東,等. 基于STM32的無線光電傳感器設計[J].傳感器與微系統(tǒng),2014,33(9):74-80.
LU W T, WANG W, XU X D, et al. Design of wireless photoelectric sensor based on STM32[J]. Sensors and Microsystems, 2014, 33(9):74-80.
[16]MILANES V, PEREZ J, GODOY J, et al. A fuzzy aid rear-end collision warning/avoidance system[J]. Expert System with Applications, 2012, 39(10): 9097-9107.
[17]JAMES R W, GABRIEL A, STEWART W, et al. Extending time to collision for probabilistic reasoning in general traffic scenarios[J]. Transportation Research Part C Emerging Technologies, 2015, 51:66-82.