基于多傳感器數(shù)據(jù)融合的智能機器人設(shè)計
3 硬件結(jié)構(gòu)
為減輕主控器的負擔(dān),系統(tǒng)采用主從式控制系統(tǒng)。分別用三個MCS-96單片機處理來自測距傳感器、超聲傳感器、尋找目標傳感器的數(shù)據(jù),并進行數(shù)據(jù)融合;最后把處理好的數(shù)據(jù)通過RS-232串口上傳至上位機PC/104 386SX系統(tǒng)。由PC/104主機做出下一步的處理。系統(tǒng)硬件結(jié)構(gòu)框圖如圖1所示。
PC/104主機主要用來完成對三個下位機所處理的數(shù)據(jù)進行采集,然后根據(jù)情況調(diào)整小車前向電機、轉(zhuǎn)向電機的運動,并將光電編碼器測量到的小車速度等信息顯示在液晶屏幕上,如果發(fā)生碰撞現(xiàn)象,還可用語音進行報警等操作。上位機選用PC/104主機是因為:第一,386系統(tǒng)處理速度比單片機要迅速;第二,為了便于以后系統(tǒng)的擴展。
為避免其它不可預(yù)知的故障出現(xiàn),使機器不能正常運行,系統(tǒng)還設(shè)置了一個硬復(fù)位按鈕。
各個下位機的軟件設(shè)計流程是先檢測各類傳感器的數(shù)據(jù),再用D-S法進行數(shù)據(jù)融合,最后等待主機的指令,把融合后的數(shù)據(jù)上傳至主機。
主機的軟件設(shè)計流程是通過串口循環(huán)接收來自三個不同下位機的數(shù)據(jù)(三個下位機的通訊握手地址不同)。根據(jù)尋找目標傳感器所測到的目標位置,進行路徑規(guī)劃,調(diào)整前向電機與轉(zhuǎn)向電機的運動方向。再根據(jù)測距傳感器所測到的目標距離,調(diào)整電機的運動速度。當避障傳感器發(fā)現(xiàn)前方有障礙物或小車與障礙物發(fā)生碰撞時,要立即停止運行,重新規(guī)劃路徑。讀取光電編碼器的值,把小車速度顯示在液晶顯示器上。如果出現(xiàn)小車與障礙物發(fā)生碰撞或找不到目標光源物體時要通過語音芯片進行報警。
主機和下位機程序內(nèi)部均設(shè)有看門狗程序,避免程序跑飛。
5 總結(jié)
本系統(tǒng)設(shè)計了一個基于多傳感器數(shù)據(jù)融合技術(shù)的智能機器人。該設(shè)計運用了多傳感器數(shù)據(jù)融合技術(shù),采用了主從式控制系統(tǒng),使機器人能夠更準確的尋找目標與避障,有很好的魯棒性。
本文作者創(chuàng)新點:(1)提出一種基于多傳感器數(shù)據(jù)融合技術(shù)的智能機器人系統(tǒng)設(shè)計,軟硬件工作可靠。(2)用到D-S融合算法,提供與環(huán)境有關(guān)的關(guān)于系統(tǒng)狀態(tài)的足夠的與可靠的信息,使機器人能夠自主規(guī)劃路徑、躲避障礙物,最終向目標靠近。(3)系統(tǒng)采用了主從式控制系統(tǒng),有很好的擴展性。(4)良好的抗干擾能力。
評論