基于LabVIEW探測車運動功能的設(shè)計

路 朋, 謝麗蓉, 常一峰, 胡婷婷

(新疆大學 電氣工程學院, 新疆 烏魯木齊 830047)

基于LabVIEW探測車運動功能的設(shè)計

路 朋, 謝麗蓉, 常一峰, 胡婷婷

(新疆大學 電氣工程學院, 新疆 烏魯木齊 830047)

設(shè)計了一臺多功能探測車,介紹了探測車的各項功能設(shè)計過程。該設(shè)計以PC機和DaNI探測車的硬件平臺為基礎(chǔ),以LabVIEW 2013為主軟件開發(fā)平臺,以LabVIEW Robotics、FPGA、Real-Time為輔助軟件,并配備了超聲波傳感器。通過LabVIEW Robotics 2013軟件編寫程序,可以控制探測車的運動,完成自動避開障礙物、手動運行、正多邊形運行和S形軌跡運行等多種功能。

探測車； LabVIEW； DaNI平臺； 運動控制； 避障功能

為了使探測車順利完成探測任務(wù),通常要求探測車的移動具有靈活避障、越障、爬坡和較好被動適應(yīng)地形的能力。先進的導航技術(shù)和控制技術(shù)固然可使探測車的避障能力得以加強,然而發(fā)展先進的移動系統(tǒng)、提高移動系統(tǒng)在執(zhí)行任務(wù)中的行駛性能和工作穩(wěn)定性也是探測車研制的重要內(nèi)容[1]。在很多文獻中都有利用LabVIEW軟件進行實驗系統(tǒng)設(shè)計的記載[2-13],本文根據(jù)這些文獻的思路,以LabVIEW 2013為主軟件,以DaNI為測試平臺,以LabVIEW Robotics、FPGA、Real-Time為輔助軟件,完成了探測車自動避障、手動控制、S形行走軌跡等功能的設(shè)計。

1 硬件系統(tǒng)介紹

采用的硬件為PC機和美國NI公司開發(fā)的DaNI探測車測試平臺(見圖1)及其配套設(shè)備。NI LabVIEW探測車起步包,也被稱為DaNI(NI公司研制的小型運動機器人),是一類工業(yè)級、現(xiàn)成的探測車平臺,在設(shè)計上既適合傳授探測車和機電一體化概念,也適合探測車系統(tǒng)的原型開發(fā)。該套件提供了傳感器、電機以及用于嵌入式控制的NI Single-Board RIO設(shè)備,采用LabVIEW圖形化開發(fā)環(huán)境,可對套件內(nèi)含的探測車進行編程。

圖1 DaNI 2.0探測車測試平臺

控制模塊以NI Single-Board 9632為核心模塊,以FPGA模塊、Real-Time模塊為輔助模塊。電機采用2個12 V直流電機,分別驅(qū)動探測車的左右輪。所需電流范圍為0～4.66 A和堵轉(zhuǎn)電流4.6 A。Single-Board RIO嵌入式控制器的輸出電流為3 mA；傳感器采用頻率為40 kHz的超聲波傳感器,可以探測障礙物的最小距離為2 cm、最大距離為3 m。超聲波傳感器可在伺服電機的帶動下轉(zhuǎn)向,在運動過程中可以探測到前方180°范圍內(nèi)的障礙物。

2 運動功能系統(tǒng)總體設(shè)計

探測車多功能運動測試系統(tǒng)由DaNI測試平臺、Single-Board RIO、超聲波傳感器和系統(tǒng)軟件構(gòu)成,總體設(shè)計結(jié)構(gòu)框圖如圖2所示。

圖2 探測車運動功能總體設(shè)計框圖

NI sbRIO-9632嵌入式控制器是DaNI探測車的核心,具有400 MHz工業(yè)處理器,內(nèi)部嵌有FPGA模塊,110條3.3 V(容限SV/兼容TTL)數(shù)字I/O線,32路單端/16路差分電路、16位分辨率、最高采樣速率達250 kS/s的模擬輸入通道,4路16位分辨率、最高更新率達100 kS/s的模擬輸出通道。另外還有3個連接器,適用于使用板卡級NIC系列I/O模塊的擴展I/O。

可重新配置的I/O功能允許為DaNI探測車pigtail擴展設(shè)計和開發(fā)所需的各種傳感器,如雷達、紅外線、陀螺儀等。sbRIO-9632在設(shè)計上能夠輕松嵌入高容量應(yīng)用,實現(xiàn)靈活性、可靠性和高性能。

超聲波傳感器可測量到距離2 cm～3 m的障礙物,頻率為40 kHz。有一個伺服電機控制其掃描角度，可以掃描180°的周圍環(huán)境。

本系統(tǒng)采用NI sbRIO-9632嵌入式控制器作為整個測試系統(tǒng)的執(zhí)行單元,通過超聲波傳感器實時采集現(xiàn)場模擬信號。信號經(jīng)過控制器內(nèi)部調(diào)理后,便可下達執(zhí)行指令?？刂破鲀?nèi)置10/100 Mbit/s以太網(wǎng)端口,可實現(xiàn)網(wǎng)絡(luò)與主機內(nèi)置式Web(HTTP)和文件(FTP)服務(wù)器上的編程通信。也可使用RS232串行端口來控制周邊設(shè)備。本文選用GPIB接口進行通信,數(shù)據(jù)傳輸速度可以達到1.5 Mbit/s,且傳輸距離遠、可靠性好。連接方式為總線并行式,儀器直接并聯(lián)在總線上,可與符合國際標準的各類程控儀器連接,構(gòu)成自動化測試系統(tǒng)網(wǎng)。

3 系統(tǒng)軟件設(shè)計

3.1 軟件開發(fā)平臺

采用LabVIEW 2013作為探測車運動功能開發(fā)平臺。LabVIEW的圖形化編程容易,具有豐富的擴展函數(shù)庫和分析子程序,使之在開發(fā)虛擬儀器上具有獨特優(yōu)勢。輔助軟件用NI推出的LabVIEW Robotics 2013,該軟件是圖形化系統(tǒng)設(shè)計(GSD)軟件的新成員,提供了標準的開發(fā)平臺,用于設(shè)計探測車和自主控制系統(tǒng)。此外,LabVIEW Robotics 2013還提供了豐富的探測車函數(shù)庫,可以連接標準探測車的傳感器和執(zhí)行機構(gòu),集成了智能操作和感知的基礎(chǔ)算法,擁有探測車和自主式車輛的運動控制函數(shù)。以上軟件的配合編程,使用起來方便、快捷,大大提高了系統(tǒng)的開發(fā)效率。

3.2 軟件設(shè)計

為使測試系統(tǒng)具有良好的擴展性并便于升級,采用了模塊化、結(jié)構(gòu)化的軟件設(shè)計方法,使功能程序和驅(qū)動程序相對獨立。軟件包括系統(tǒng)初始化、系統(tǒng)參數(shù)配置、傳感器數(shù)據(jù)采集和數(shù)據(jù)保存等模塊,系統(tǒng)設(shè)計流程如圖3所示。當用戶啟動運動系統(tǒng)后,系統(tǒng)進行初始化,然后輸入功能參數(shù),數(shù)據(jù)輸入正確后將執(zhí)行選定的功能。如果數(shù)據(jù)輸入錯誤,則系統(tǒng)重新初始化。

圖3 系統(tǒng)設(shè)計流程圖

3.2.1 多功能環(huán)節(jié)設(shè)計

本文一共設(shè)計了4個功能,分別是自動避障功能、手動控制功能、正多邊形運動以及S形軌跡運動功能?？紤]到便于管理和操作方便等原因,結(jié)合了LabVIEW Robotics自帶的基礎(chǔ)程序,匯編出了一個總程序。在該總程序中,可以方便地選擇不同的功能,不僅直觀、方便,還可以使得界面更為美觀。

3.2.2 自動避障功能設(shè)計

在自動避障功能的設(shè)計中,首先給DaNI多功能探測車初始化,設(shè)定伺服電機帶動超聲波傳感器的轉(zhuǎn)向角度。用一個周期為20 ms的定時循環(huán)來編寫程序,保證電機在運行控制過程中的連續(xù)性和實時性。在程序中,采用了4個移位寄存器，分別將車與FPGA通信數(shù)據(jù)流、車運動數(shù)據(jù)流、掃描障礙數(shù)據(jù)流和錯誤數(shù)據(jù)流在每次循環(huán)的終點又送回下一次循環(huán)的起點,以保證每次循環(huán)正確、可靠地進行。自動避障程序圖如圖4所示。

圖4 自動避障程序圖

3.2.3 手動功能設(shè)計

在手動控制功能程序的前面板中,垂直指針滑動桿和水平指針滑動桿分別代表探測車的前進速度和轉(zhuǎn)向角速度。此外,前面板中還有布爾量開始按鈕、暫停按鈕、停止按鈕、讀取距離按鈕。其中,布爾量開始按鈕用來控制探測車運行,停止按鈕是用來結(jié)束整個程序,讀取距離按鈕用來顯示探測車行走的距離。手動控制功能程序圖如圖5所示。

圖5 手動控制功能程序圖

3.2.4 S形軌跡功能設(shè)計

在探測車的S形軌跡設(shè)計中,前面板設(shè)計較簡單,選取2個數(shù)值量分別表示探測車行走軌跡的半徑和速度,有一個布爾量表示停止。在前面板改變速度即可改變探測車行走一個半圓弧的時間,改變半徑即可改變探測車行走的一個半圓弧。首先通過半徑求出第一個弧長,根據(jù)弧長和速度求出行走時間t,由t來延時第一幀平鋪順序結(jié)構(gòu),用時間t計算出轉(zhuǎn)彎時需要的角速度ω,先設(shè)計出1/2圓弧,計算公式如下:

(1)

將所求出的角度和運動時前進的速度,一同合并成數(shù)組并分別對應(yīng)X坐標數(shù)值和Y坐標數(shù)值,延時時間的單位用毫秒(ms),所以要進行單位轉(zhuǎn)換,把s換成ms。S形軌跡程序圖如圖6所示。

圖6 S形軌跡程序圖

3.2.5 正多邊形軌跡功能設(shè)計

采用2級平鋪順序結(jié)構(gòu)設(shè)計正多邊形軌跡,利用正多邊形內(nèi)角和、外角和計算出角度,輸入角度后需要轉(zhuǎn)化為弧度,之后給舵機賦值為“0”,這樣可以保證探測車的初始位置正好為0°。調(diào)用一個While循環(huán),定時為20 ms,保證程序的連續(xù)性。當程序執(zhí)行到While循環(huán)時,首先讀取角度,轉(zhuǎn)化為弧度后即可按特定多邊形運行。正多邊形程序圖如圖7所示。

圖7 正多邊形程序圖

4 結(jié)束語

本文利用圖形化編程軟件LabVIEW進行了探測車運動功能的開發(fā)及其程序設(shè)計,分別完成了自動避障功能、手動功能、S形軌跡功能、正多邊形軌跡功能的設(shè)計。通過DaNI 2.0探測車平臺進行現(xiàn)場演示,表明設(shè)計是成功的。

References)

[1] 尚偉燕,李舜酩.六輪腿式探測車行走機構(gòu)結(jié)構(gòu)設(shè)計及動力學分析[J].機械制造,2010(10):15-18.

[2] 黃豪彩,楊燦軍,陳道華,等.基于LabVIEW的深海氣密采水器測控系統(tǒng)[J].儀器儀表學報,2011(1):40-45.

[3] 王芃,高震,董景新.一種物美價廉的基于LabVIEW的PID控制實驗裝置設(shè)計[J].實驗技術(shù)與管理,2014,31(1):107-109.

[4] 聶影,馮向軍,廖瑛,等.基于LabVIEW的狀態(tài)機模型研究[J].計算機測量與控制,2007(9):1166-1168,1171.

[5] 葛亞明,于鑫,李軍,等.基于LabVIEW和PCI-1711的過程控制實驗系統(tǒng)設(shè)計[J].實驗技術(shù)與管理,2015,32(1):108-111.

[6] 王建群,南金瑞,孫逢春,等.基于LabVIEW的數(shù)據(jù)采集系統(tǒng)的實現(xiàn)[J].計算機工程與應(yīng)用,2003(21):122-125.

[7] 羅建,雷勇,黃昊,等.基于LabVIEW的遠程電機實驗臺的構(gòu)建[J].實驗技術(shù)與管理,2014,31(3):122-125.

[8] 李偉,陳國明,張傳榮,等.基于LabVIEW的ACFM網(wǎng)絡(luò)實驗平臺開發(fā)與測試[J].實驗技術(shù)與管理,2013,30(3):65-67,73.

[9] 紀仁杰,劉永紅,吳寶貴,等.基于LabVIEW的電火花放電狀態(tài)檢測實驗平臺開發(fā)[J].實驗技術(shù)與管理,2015,32(2):73-76.

[10] 岳洪偉.基于LabVIEW的數(shù)字信號處理虛擬實驗平臺實現(xiàn)[J].實驗技術(shù)與管理,2011,28(8):70-72.

[11] 齊羽.基于LabVIEW的嵌入式系統(tǒng)實驗平臺設(shè)計與實現(xiàn)[J].實驗技術(shù)與管理,2011,28(11):50-51,56.

[12] 周雅,殷志鋒.LabVIEW環(huán)境下信號處理類課程信息化實驗仿真平臺[J].實驗技術(shù)與管理,2013,30(11):137-140.

[13] 師青梅,皮偉.基于虛擬儀器技術(shù)的太陽能電池實驗教學創(chuàng)新[J].實驗技術(shù)與管理,2013,30(2):94-96,100.

Design of rover sport function based on LabVIEW

Lu Peng, Xie Lirong, Chang Yifeng, Hu Tingting

(College of Electrical Engineering, Xinjiang University, Urumqi 830047, China)

This design adopted in PC hardware platform and DaNI robot, mainly 2013 LabVIEW software development platform, LabVIEW Robotics, FPGA, Real-Time for the auxiliary software, and cooperated with ultrasonic sensor to constitute a multifunctional machine sports car. Through LabVIEW Robotics 2013 software program, the movement of the robot can be controlled, to realize automatically avoiding obstacles, manual operation, regular polygon running and S-shaped path and other functions.

robot; LabVIEW; DaNI platform; motion control; obstacle avoidance

2015- 04- 21

國家自然科學基金項目(51264036)；新疆大學“運動控制系統(tǒng)”精品課程建設(shè)項目(XJU201202)

路朋(1989—),男,河南周口,在讀碩士研究生,主要研究方向為控制系統(tǒng)優(yōu)化設(shè)計

E-mail：xjdxlu@163.com

謝麗蓉(1969—),女,湖南衡陽,碩士,副教授,主要研究方向為控制系統(tǒng)優(yōu)化設(shè)計.

E-mail：wzywwwxr@163.com

TP242.6

A

1002-4956(2015)12- 0143- 03