?
基于自動(dòng)導(dǎo)引車路徑跟蹤的路徑重規(guī)劃和控制器設(shè)計(jì)
當(dāng)前的物流領(lǐng)域多利用自動(dòng)導(dǎo)引車提高物流過程的自動(dòng)化程度,降低物流成本。但是與人工運(yùn)送相比,自動(dòng)導(dǎo)引車還不夠智能化,其在工作過程中經(jīng)常與已知或未知的障礙物發(fā)生碰撞。與已知的障礙物發(fā)生碰撞,多由路徑跟蹤控制器控制性能較差所導(dǎo)致,使用高性能的路徑跟蹤控制器可以解決該問題。與未知的障礙物發(fā)生碰撞,多由傳感器引起,其在路徑規(guī)劃后不能檢測(cè)出事先未標(biāo)識(shí)的障礙物,將路徑重規(guī)劃算法應(yīng)用在自動(dòng)導(dǎo)引車上可以解決該問題。本文利用D* Lite算法進(jìn)行路徑重規(guī)劃并基于反步法進(jìn)行控制器設(shè)計(jì)。
所使用的自動(dòng)導(dǎo)引車采用差動(dòng)驅(qū)動(dòng)系統(tǒng),左右兩側(cè)各有一個(gè)驅(qū)動(dòng)輪,前后各安裝一個(gè)被動(dòng)輪維持自動(dòng)導(dǎo)引車平衡,尺寸為100×60×210cm。該系統(tǒng)結(jié)構(gòu)可以分為控制器、傳感器和執(zhí)行器3個(gè)部分??刂破靼üI(yè)控制計(jì)算機(jī)Tank 800、無線鍵盤和鼠標(biāo)以及觸摸屏顯示器。傳感器使用激光測(cè)量系統(tǒng)LMS-151和激光導(dǎo)航系統(tǒng)NAV-200,用于障礙物檢測(cè)和定位。使用具有高性能編碼器的兩個(gè)大功率無刷直流電機(jī)作為執(zhí)行器。給出了自動(dòng)導(dǎo)引車的運(yùn)動(dòng)方程,并對(duì)路徑重規(guī)劃算法進(jìn)行說明。目前,常用的路徑規(guī)劃算法為A*、LPA*、D*和D* Lite。由于D* Lite算法不是在事前進(jìn)行路徑重規(guī)劃,而是利用工作過程收集的數(shù)據(jù)進(jìn)行重規(guī)劃,且D* Lite算法所消耗的時(shí)間較多,因而其非常適合進(jìn)行短時(shí)間路徑重規(guī)劃。給出D* Lite算法的詳細(xì)計(jì)算過程,為方便理解該算法,又利用圖形對(duì)D* Lite算法進(jìn)行描述。對(duì)如何設(shè)計(jì)路徑跟蹤控制器進(jìn)行說明。通過考慮自動(dòng)導(dǎo)引車的線速度和角速度,基于反步法設(shè)計(jì)路徑跟蹤控制器,使自動(dòng)導(dǎo)引車輛依據(jù)參考位置和參考方向進(jìn)行路徑跟蹤。給出了自動(dòng)導(dǎo)引車進(jìn)行路徑跟蹤的誤差表達(dá)式和一個(gè)李雅普諾夫函數(shù)。利用李雅普諾夫穩(wěn)定性理論判斷控制系統(tǒng)的穩(wěn)定性。依據(jù)上述設(shè)計(jì)給出控制系統(tǒng)框圖。通過仿真和實(shí)車試驗(yàn),對(duì)上述算法和路徑跟蹤控制器的性能進(jìn)行驗(yàn)證。結(jié)果表明,D* Lite算法和新設(shè)計(jì)的路徑跟蹤控制器能很好地躲避障礙并以很小的誤差實(shí)現(xiàn)路徑跟蹤。
Yuhanes Dedy Setiawan et al. International Conference on Advances in Computing, Communications and Informatics, New Delhi-Sept. 24-27, 2014.
編譯:王維