董　芒， 顧寶興， 姬長英， 張慶怡， 查啟明

(南京農(nóng)業(yè)大學(xué) 工學(xué)院， 江蘇 南京 210031)

?

水果采摘機器人智能移動平臺的設(shè)計與試驗

董芒， 顧寶興， 姬長英， 張慶怡， 查啟明

(南京農(nóng)業(yè)大學(xué) 工學(xué)院， 江蘇 南京 210031)

摘要：【目的】基于三自由度水果采摘機械臂，設(shè)計一種輪式智能移動平臺?！痉椒ā扛鶕?jù)農(nóng)田工作環(huán)境，設(shè)計了轉(zhuǎn)向機構(gòu)和防撞梁機構(gòu)；借助ANSYS對車架在3種工況下的變形情況進行仿真分析；使用Simulink模塊對車載電機進行了基于最大轉(zhuǎn)矩電流比矢量控制(MPTA)以及ID=0模式下的仿真；使用VC++語言編寫了運動控制程序，開發(fā)人機交互界面；在南京市江浦農(nóng)場進行樣機行走試驗?！窘Y(jié)果】彎扭工況下車架變形量最大為14.1 mm，應(yīng)力值小于材料屈服極限；基于MPTA控制下的電機約0.8 ms達(dá)到穩(wěn)定；該平臺最大爬坡角度約為10°，1.5 m·s-1行進時跟蹤路徑的橫向偏差約為0.22 m?！窘Y(jié)論】該移動平臺結(jié)構(gòu)合理，強度和剛度較高，運動精度高，符合實際工作要求。

關(guān)鍵詞：水果采摘機器人；智能移動平臺；ANSYS；有限元分析；直線追蹤試驗

我國水果生產(chǎn)總量逐年增加，預(yù)計2016年將達(dá)到2.7億t[1]。水果采摘在生產(chǎn)中耗時費力，需投入整個生產(chǎn)過程40%的勞動力。為降低水果采摘成本、減少對勞動力的依賴、提高采摘效率，智能采摘機器人的研究成為熱點[2]。移動平臺是農(nóng)業(yè)機器人運動的基礎(chǔ)，是采摘機器人研制的關(guān)鍵環(huán)節(jié)之一，決定著農(nóng)業(yè)機器人運動的靈活性和控制的復(fù)雜性[3]。國內(nèi)外針對移動平臺的研究較多[4- 6]。比利時的Beaten等[7]研制的蘋果采摘機器人的整個采摘機械臂及其控制系統(tǒng)安裝在拖拉機后端，并設(shè)計提升裝置可上下移動機械臂，但機器人體積較大，作業(yè)靈活性較差。對農(nóng)業(yè)機器人的研究主要側(cè)重于機器人末端執(zhí)行機構(gòu)及機械手的機構(gòu)與控制以及機器人本體在三維空間中的連續(xù)運動控制技術(shù)[8]，有些研究[9-10]是在拖拉機等農(nóng)業(yè)機械裝備上開發(fā)導(dǎo)航控制系統(tǒng)和變量輸入控制系統(tǒng)，其操作較為復(fù)雜，在農(nóng)田環(huán)境中的適應(yīng)性較差。因此開發(fā)一款結(jié)構(gòu)簡單、緊湊、經(jīng)濟性好，符合農(nóng)田環(huán)境實際要求的移動平臺，對促進農(nóng)業(yè)現(xiàn)代化、智能化、信息化顯得頗為重要。

本文在對矮化標(biāo)準(zhǔn)蘋果園實地調(diào)研后，結(jié)合水果采摘的具體要求，設(shè)計一種輪式智能移動平臺，該平臺搭載控制柜、機械臂、末端執(zhí)行器、水果分級裝置、GPS裝置等部件，合理布置各工作部件，使之互不干涉、結(jié)構(gòu)緊湊、適應(yīng)性強、自主導(dǎo)航。

1結(jié)構(gòu)與主要部件

1.1總體結(jié)構(gòu)及要求

智能移動平臺分為控制系統(tǒng)與機械執(zhí)行系統(tǒng)，其外觀設(shè)計如圖1所示，整車長2 500 mm，寬1 200 mm，離地600 mm。主要包括后橋轉(zhuǎn)向機構(gòu)、前橋驅(qū)動機構(gòu)、剎車裝置、水果收集機構(gòu)、控制柜、GPS裝置、防撞機構(gòu)、車架等，搭載三自由度機械臂、四手抓末端執(zhí)行器、水果分級裝置等部件?？刂葡到y(tǒng)主要由工控機、雙目攝像機、MP2100板卡、編碼器、光電開關(guān)等組成。

1：雙目攝像機；2：機械臂Y軸；3：機械臂X軸；4：末端執(zhí)行器；5：水果分級裝置；6：防撞梁；7：前橋；8；車架；9；果實收集盒；10：后橋；11：轉(zhuǎn)向系統(tǒng)；12：剎車裝置；13：控制柜；14：人機交互模塊。

圖1智能采摘機器人移動平臺結(jié)構(gòu)簡圖

Fig.1Structure of the intelligent mobile platform loaded with a fruit picking robot

要求結(jié)構(gòu)簡單，在田間地面環(huán)境通過性良好；機械臂、控制柜、水果分級裝置間不發(fā)生干涉；能順利通過8°左右的坡道；工作速度可保持0.5 m·s-1，最大速度1.5 m·s-1，加速度不小于0.2 m·s-2。

1.1.1三自由度機械臂目前，農(nóng)業(yè)采摘機器人多選用工業(yè)關(guān)節(jié)型機械臂，控制比較復(fù)雜，成本較高。本采摘機器人采用自行設(shè)計的三自由度機械臂[11]，包含1個旋轉(zhuǎn)關(guān)節(jié)和2個移動關(guān)節(jié)。以垂直軸電機中心線和 X、Y 水平面相交的位置，定義為機器人坐標(biāo)軸水平面的0點，坐標(biāo)軸的方向符合右手法則。將垂直軸電機中心線上離機器人水平底座最下邊垂直距離為 823 mm的位置定義為 Z 軸的0點，TCP 點的定義坐標(biāo)為(-398，190，0)。

1.1.2轉(zhuǎn)向系統(tǒng)農(nóng)田路面情況較為復(fù)雜，存在地面不平、土壤堅實度不均、果樹平齊度較差等問題。機器人移動平臺在導(dǎo)航運動過程中，在行駛到坡度起伏較大或者果園死角的時候，單靠轉(zhuǎn)向電機較難按照設(shè)定的角度和路徑運動，從而影響了正常的采摘作業(yè)。本移動平臺在電子助力轉(zhuǎn)向系統(tǒng)(EPS)的基礎(chǔ)上，設(shè)計了一種新型鉸軸轉(zhuǎn)向機構(gòu)(圖2)。在原有的機械管柱上附加了轉(zhuǎn)向電機，出現(xiàn)電氣故障或者電動轉(zhuǎn)向困難時，通過上位機關(guān)閉轉(zhuǎn)向電機，此時系統(tǒng)恢復(fù)到原有的機械轉(zhuǎn)向狀態(tài)，使用方向盤控制前橋進行轉(zhuǎn)向，從而有效地輔助機器人較快地度過轉(zhuǎn)向困難處，提高工作效率。在轉(zhuǎn)向機構(gòu)上添加了扭矩傳感器，當(dāng)檢測到轉(zhuǎn)向扭矩異常時，將信號發(fā)送至上位機，執(zhí)行剎車命令。

1：方向盤；2：方向盤軸；3：套筒；4：換向器；5：聯(lián)軸器；6：扭矩傳感器；7：EPS管柱；8：減速機；9：電機。

圖2轉(zhuǎn)向系統(tǒng)結(jié)構(gòu)簡圖

Fig.2Structure of the steering system

1.1.3防撞系統(tǒng)采摘機器人在果園環(huán)境中工作，發(fā)生碰撞的幾率較大。碰撞是一個瞬時的復(fù)雜物理過程[12]，容易對移動平臺上的機械臂、末端執(zhí)行器、控制柜等部件產(chǎn)生沖擊，導(dǎo)致系統(tǒng)無法正常工作。移動平臺正面發(fā)生碰撞的概率最大，因此為移動平臺前面設(shè)計了一套防撞梁系統(tǒng)(圖3)。其中，液壓緩沖器[13]最大吸收能量為40 J，最大撞擊速度為4 m·s-1；防撞梁前部橫梁采用厚度為1.0 mm的合金結(jié)構(gòu)鋼。3個同型號NPN常開光電開關(guān)，其檢測距離0～300 mm可調(diào)，響應(yīng)時間≤2 ms。光電開關(guān)與橫梁內(nèi)壁之間的距離X1、X2、X3以及光電開關(guān)的檢測距離Y1、Y2、Y3是該防撞系統(tǒng)的研究重點：檢測距離較小時，當(dāng)移動平臺與一般樹枝碰撞時，會導(dǎo)致碰撞信號的誤報；而如果檢測距離過大發(fā)生碰撞時，留給上位機處理信號以及平臺制動的時間縮短，安全保護效果不明顯。為確定最佳的檢測距離，設(shè)計了碰撞模擬試驗，使用直徑為10、20、30、40 mm的樹枝以2 m·s-1的速度在橫梁左、中、右垂直碰撞，最終確定X1、X2、X3，Y1、Y2、Y3分別為120、95、95、90、80、80 mm。

1：支架；2：液壓緩沖器；3：緩沖彈簧；4：橫梁；5：吸能盒；6：光電開關(guān)。

圖3防撞測撞梁結(jié)構(gòu)簡圖

Fig.3Structure of the anti-collision beam

1.2車架的有限元分析

移動平臺在實際工作中行駛速度慢、加速度小、轉(zhuǎn)彎半徑大，因此無需考慮起步、轉(zhuǎn)彎、制動等工況。本文重點選取純彎曲、彎扭聯(lián)合、采摘運動等工況進行仿真分析，方法參照文獻[14]。ANSYS有限元分析之前對車架模型進行簡化，具體規(guī)則為：省略非承載件，如車鉤、防撞梁等部件；去除非裝配孔；假設(shè)車架中焊接部位為理想焊接，焊接處材料與其他區(qū)域相同。

將簡化后的車架三維模型導(dǎo)入ANSYS 14.5中。車架材料選用Q235A，屈服極限為510 MPa，截面尺寸60 mm×60 mm，厚度4 mm，其EX=2.1×1011，μ=0.28。單元類型選取Solid 186，采用自由劃分方式，網(wǎng)格大小設(shè)置為10 mm。在機械臂等應(yīng)力較集中的地方將網(wǎng)格細(xì)化到6 mm。對車架離散后，共得到單元數(shù)96 061個，節(jié)點數(shù)187 733個。

主要部件控制柜、機械臂、收集盒、分級裝置的質(zhì)量分別為40、270、40、75 kg；控制柜、機械臂、收集盒、分級裝置車架的接觸面積(長×寬)分別為1 100 mm×700 mm、3 600 mm×410 mm、1 100 mm×206 mm、840 mm×300 mm。

純彎曲工況主要是模擬移動平臺靜止或者勻速前進時車架的變形情況，此時車架主要受自身重力以及各部件向下的壓力。添加載荷后，將左前輪UX、UY、UZ，右前輪UX，右后輪UX、UY，左后輪UX方向的自由度進行約束[15],最后得到純彎曲工況下的等效位移云圖(圖4)，此工況下車架第3根橫梁中部變形最大，最大變形量為18.4 mm，最大應(yīng)力值為61.4 MPa，遠(yuǎn)小于材料屈服極限。因此在純彎曲工況下車架強度完全滿足要求。

圖4　純彎曲工況下車架等效位移云圖

Fig.4Equivalent displacement image of the platform frame under pure bending working condition

彎扭聯(lián)合工況時，農(nóng)田地面具有非線性特征，一般來說，移動平臺在工作中，4個車輪不會處于同一個平面，最高點與最低點垂直距離可達(dá)到90 mm。此工況下在左前輪UX方向設(shè)置向上的45 mm位移約束，在右后輪UX設(shè)置向下的45 mm位移約束，對右前輪UX進行約束，動載荷系數(shù)取1.5,最后得到彎扭工況下的等效位移云圖(圖5)，彎扭工況下車架變形最為嚴(yán)重，最大變形處位移減去施加的45 mm位移約束后仍達(dá)到14.1 mm，且應(yīng)力集中的地方多為焊接部位。此時應(yīng)在車架與前后橋的支柱上焊接支撐件，并采用電弧焊等特種焊接技術(shù)。

圖5　彎扭工況下車架等效位移云圖

Fig.5Equivalent displacement image of the platform frame under twisting working condition

采摘工況為移動平臺特有工況，采摘機器人在進行田間作業(yè)時，圓柱式機械臂X軸做上下變速以及旋轉(zhuǎn)運動，在其加速以及減速運動中對車架產(chǎn)生沖擊。為獲得采摘工況下機械臂對車架的作用力，將機械臂模型處理后導(dǎo)入ADAMS軟件中進行分析。

以水平軸做縱向變速運動為例，在ADAMS中，首先對機械臂主要部件進行定義，創(chuàng)建各部件之間的運動副。設(shè)定0～0.5 s為加速階段，1.5～2.0 s為減速階段，其余為勻速階段。最后得到此時機械臂對底座的作用力如圖6所示,此時機械臂對底座作用力最大為2 651N，加上旋轉(zhuǎn)軸重力后共計3 228 N。同理可得機械臂旋轉(zhuǎn)運動對底座的扭矩為152.4 N·m。將獲得的壓力與扭矩重新加載到車架上，獲得采摘工況下車架的等效位移云圖(圖7)，該工況下由于施加了扭矩作用，車架在水平面上發(fā)生了扭曲，最大變形處為2.7 mm，變形量較小，符合要求。

圖6　采摘工況下底座受力曲線

Fig.6Force curve of the platform base under picking working condition

圖7　采摘工況下車架等效位移云圖

Fig.7Equivalent displacement image of the platform frame under picking working condition

綜上分析，該車架在滿足各部件合理布局的基礎(chǔ)上，在各種工況下比較穩(wěn)定，滿足設(shè)計要求。

1.3電機的選擇與仿真

1.3.1車載電機的選擇電機容量和移動平臺行進需要的驅(qū)動力以及所受地面摩擦力、迎風(fēng)阻力、慣性阻力等有關(guān)。移動平臺的驅(qū)動力應(yīng)該與其所受的運行阻力保持平衡，即

Ft=∑Wall，

式中，F(xiàn)t為驅(qū)動力，∑Wall為所受阻力之和。

根據(jù)公式計算結(jié)果，綜合比較不同類型電機的優(yōu)缺點后，選擇安川永磁同步電機(PMSM)作為驅(qū)動電機，型號為SGMGV-30ADC61，功率 2.9 kW，i=36；轉(zhuǎn)向系統(tǒng)選擇安川永磁同步電機SGMJV- 02ADE6S，功率0.27 kW，減速機i=25。

1.3.2電機控制方式的選擇水果采摘機器人移動平臺在實際工作中的運動并不連續(xù)，在短距離內(nèi)，移動平臺頻繁執(zhí)行剎車、啟動、變速等動作。這就要求車載電機具有快速響應(yīng)、高精度控制、節(jié)能、扭變平滑性等特點。

在工程實踐中，眾多PMSM控制方式里面，最大轉(zhuǎn)矩電流比矢量控制(MPTA)和ID=0控制最為常見[16]。在高速、低轉(zhuǎn)矩條件下，2種控制方式都可以使電機較快達(dá)到穩(wěn)定狀態(tài)，轉(zhuǎn)矩波動較小，但不一定適應(yīng)水果采摘機器人移動平臺特殊的工作方式以及惡劣的工作環(huán)境。

本文利用MATLAB/Simulink組件，基于MPTA以及ID=0控制方式的原理，將2種方式集成比較，利用Switch模塊可自由切換。仿真時間設(shè)定為0.8 s，初始轉(zhuǎn)速給定值為500 r·min-1，0.4 s后加速為800 r·min-1。初始扭矩5 N·m，0.6 s后增加為20 N·m。得到電機轉(zhuǎn)速響應(yīng)，IQ、ID(IQ、ID分別表示電機內(nèi)部D、Q軸的電流)給定值與反饋值，電機輸出力矩波形等曲線。以MPTA方式為例，電機轉(zhuǎn)速響應(yīng)曲線以及電機輸出扭矩曲線如圖8所示，電機啟動之后0.08 s左右達(dá)到穩(wěn)定值。電機加速階段，IQ值很大，ID為負(fù)值，產(chǎn)生24 N·m恒定的力矩，當(dāng)轉(zhuǎn)速上升到500 r·min-1且穩(wěn)定后，電機輸出力矩5 N·m。0.4 s時電機轉(zhuǎn)速變?yōu)?00 r·min-1，IQ變大，ID為負(fù)值，電機輸出力矩加大。0.6 s時力矩從5變?yōu)?0 N·m，導(dǎo)致電機轉(zhuǎn)速下降，為了維持轉(zhuǎn)速，控制系統(tǒng)通過調(diào)節(jié),使電機輸出力矩增大到24 N·m左右。轉(zhuǎn)速穩(wěn)定后，電機輸出力矩20 N·m與設(shè)定力矩平衡。

通過Switch開關(guān)切換到基于ID=0控制模式，得到此方式下的仿真曲線，在0.4 s速度給定由500 r·min-1變?yōu)?00 r·min-1時，由于輸出的給定電流飽和，故出現(xiàn)ID和IQ電流無法跟上的情況，同時電機的輸出力矩也會變小，加速變緩慢。

圖8　MPTA控制下永磁同步電機轉(zhuǎn)速和輸出力矩響應(yīng)曲線

Fig.8The speed response curve and torque response curve of PMSM under MPTA control

綜上，PMSM在水果采摘機器人移動平臺特殊的工作環(huán)境下，采用MTPA控制的方式要比ID=0控制方式好，電機輸出力矩響應(yīng)快，同等輸出力矩下電流要小，耗電量更小。2種典型控制方式的比較簡單直觀，對以后的工作實踐具有一定的參考意義。

1.4控制系統(tǒng)的設(shè)計

1.4.1控制系統(tǒng)設(shè)計移動平臺控制系統(tǒng)主要由上位機控制器、下位機控制器和各傳感器系統(tǒng)等組成，硬件結(jié)構(gòu)框圖參見文獻[2]。

上位機選用研華IPC610-H型工控機作為運算控制中心，內(nèi)置數(shù)據(jù)采集卡、1394轉(zhuǎn)換卡等部件與下位機、傳感器通信協(xié)同工作，實現(xiàn)自主導(dǎo)航、自主采摘。移動平臺各部件協(xié)同工作內(nèi)容主要包括：工控機通過RS-232與人機交互模塊通信，可實時調(diào)整水果采摘機器人整體的運行狀態(tài)；工控機實時解析GPS接收機輸出的NMEA語句中包含的速度、位置信號值，實現(xiàn)對移動平臺驅(qū)動速度、轉(zhuǎn)向角度的動態(tài)控制；GPS裝置采用DB9型COM串口通信，采用MAX232芯片進行信號轉(zhuǎn)換，信號輸入單片機后，通過CAN總線輸入到工控機，當(dāng)檢測到GPS坐標(biāo)值到達(dá)終點時，移動平臺停止運行；工控機調(diào)用雙目攝像機自帶TriclopsRCDToXYZ函數(shù)，解析果實在相機坐標(biāo)系下的坐標(biāo)值，對坐標(biāo)值進行轉(zhuǎn)換后，向MP2100板卡發(fā)送運動信號；工控機接收防撞梁光電開關(guān)信號、機械臂故障等信號，接收到信號之后，向MP2100板卡發(fā)送制動命令。

1.4.2CAN總線設(shè)計移動平臺運動控制系統(tǒng)通信協(xié)議分為以太網(wǎng)和CAN總線控制，其中運動控制板卡MP2100通過TCP/IP協(xié)議與上位機構(gòu)成以太網(wǎng)；同時MP2100通過CANN Open2.0協(xié)議與下位機驅(qū)動器、控制器構(gòu)成CAN總線。

在進行CAN總線設(shè)計之前，應(yīng)確定系統(tǒng)總體功能。MP2100作為主節(jié)點，其他控制節(jié)點作為從節(jié)點[17]，從節(jié)點基本模塊應(yīng)該包括：數(shù)據(jù)采集模塊，采集移動平臺車速、轉(zhuǎn)角以及傳感器信號等；數(shù)據(jù)轉(zhuǎn)換模塊，將采集到的數(shù)據(jù)轉(zhuǎn)換為可以向其他節(jié)點傳輸?shù)母袷?，同時將從其他節(jié)點接受的信息轉(zhuǎn)換為自身可識別的格式；通信模塊，實現(xiàn)相同層次間的信息溝通，即物理層與物理層的信息交換，應(yīng)用層與應(yīng)用層間的信號交換；輸出模塊，對上位機傳輸?shù)男盘栠M行打包，并在編碼、解碼后，通過MDI接口輸出到電機驅(qū)動器上，控制電機的運行。

2直線追蹤試驗設(shè)計與分析

一般來說，智能農(nóng)業(yè)車輛的自主行走主要包括直線追蹤、地頭轉(zhuǎn)向、視覺避障等任務(wù)，其中直線追蹤是一種最基本的導(dǎo)航任務(wù)，通過信息傳感器系統(tǒng)獲取的位姿以及定位信息與預(yù)定航線的比較，實時調(diào)整運行速度以及轉(zhuǎn)向角度，以便回歸到正確航線。移動平臺采用DGPS以及視覺傳感器檢測到的數(shù)據(jù)相融合獲取位姿信息，采用Trimble公司生產(chǎn)的差分式GPS獲取平臺的移動速度以及定位數(shù)據(jù)，并且在上位機中使用VC++編寫自主導(dǎo)航控制程序。其中，差分式GPS標(biāo)稱速度檢測誤差約為0.04 m·s-1，定位誤差約為0.3 m，雙目攝像機測距精度約為0.208 mm，上位機程序處理時間約為0.1 s[18]。

試驗方法及控制策略如下：各設(shè)備自檢并進行初始化操作，若檢測到硬件故障或者程序錯誤，工控機停止導(dǎo)航，移動平臺原地報警[19]；在導(dǎo)航程序中編輯目標(biāo)航線Ax+By+C=0、移動平臺初始坐標(biāo)值、運行速度等信息，上位機讀取GPS和AHRS數(shù)據(jù)，計算行走路線；移動平臺導(dǎo)航開始，上位機實時計算橫向偏差E即平臺中心點(xp，yp)與目標(biāo)航線的距離：

若Axp+Byp>C,則E取正值，反之E取負(fù)值；根據(jù)橫向偏差E，實時調(diào)整移動平臺轉(zhuǎn)向角度。具體規(guī)則如下：當(dāng)橫向偏差E大于最小轉(zhuǎn)彎半徑Rmin時，平臺距離目標(biāo)航線較遠(yuǎn)，此時平臺作直線行駛，轉(zhuǎn)向角α=0°。當(dāng)運行至E≥Rmin時，上位機程序計算最佳轉(zhuǎn)向角并轉(zhuǎn)化為電機實際脈沖數(shù)，開始轉(zhuǎn)向，向目標(biāo)航線逐漸靠近，實現(xiàn)直線追蹤。

直線追蹤行走試驗在南京農(nóng)業(yè)大學(xué)校園水泥路以及江浦農(nóng)場蘋果園路面進行，移動平臺初始設(shè)置為：橫向偏差E=1.2±0.1 m，轉(zhuǎn)角0°±1°，車速1.0、1.5 m·s-1。橫向偏差的實時變化曲線見圖9，導(dǎo)航初始時，由于E較大，移動平臺作斜直線勻速行駛。土壤路面上行走至22 s時，E趨于穩(wěn)定，由于土壤較為松軟，移動平臺的慣性與地面的摩擦的濾波作用顯著，E的變化總體平滑，最大偏差值為0.22 m左右。水泥路面下橫向偏差最大為0.34 m，視覺處理的延時對誤差有一定影響[20]。

圖9　行走試驗結(jié)果

3結(jié)論

1)基于三自由度機械臂，設(shè)計了一種輪式智能移動平臺，各工作部件之間無干涉、結(jié)構(gòu)緊湊、適應(yīng)性強。

2)基于ANSYS對車架進行了有限元分析，極限工況下最大變形量為14.1 mm，對容易發(fā)生應(yīng)力集中的幾處區(qū)域加強處理后，可滿足農(nóng)田環(huán)境工作要求。使用MATLAB對電機進行了基于MPTA和ID=0控制方式的仿真分析，電機約0.8 ms達(dá)到穩(wěn)定，扭變平滑性較好。

3)使用VC++語言開發(fā)了人機交互界面，編寫了運動控制程序。搭建了基于CAN總線開放式控制系統(tǒng)，協(xié)調(diào)GPS、AHRS、DGPS等設(shè)備，實現(xiàn)了該移動平臺的高精度運動。

參考文獻：

[1] 鄭燕,張吉國,史建民. 我國水果加工業(yè)發(fā)展現(xiàn)狀、問題及對策[J]. 山東農(nóng)業(yè)科學(xué), 2014, 46(4): 121-124.

[2]顧寶興,姬長英,王海青,等. 智能移動水果采摘機器人設(shè)計與試驗[J]. 農(nóng)業(yè)機械學(xué)報, 2012, 43(6): 153-160.

[3]ZHAO D A,LV J D, JI W. Design and control of an apple harvesting robot[J]. Biosyst Eng, 2011, 110(2):112-122.

[4]胡彥福. 基于超聲波傳感器的輪式噴藥機器人移動控制系統(tǒng)研究[D]. 重慶：西南大學(xué)， 2009.

[5]陳飛，蔡建榮. 柑橘收獲機器人技術(shù)研究進展[J]. 農(nóng)機化研究， 2008， 68(7)：232-235.

[6]陳淑艷，陳文家. 履帶式移動機器人研究綜述[J]. 機器人技術(shù)， 2007， 24(12)：232-235.

[7]BAETEN J, DONNE K, BOEDRIJ S, et al.Autonomous fruit picking machine:A robotic apple havester[M] //SICILIANO B,KHATIB O, GROEN F. Springer tracts in advanced robotics：Field and service robotics, Berlin: Springer-Verlag, 2008:531-539.

[8]閆樹兵,姬長英.農(nóng)業(yè)機器人移動平臺的研究現(xiàn)狀與發(fā)展趨勢[J]. 拖拉機與農(nóng)用運輸車, 2007, 34(5): 13-15.

[9]陸懷民.林木果球采摘機器人設(shè)計與試驗[J]. 農(nóng)業(yè)機械學(xué)報, 2001, 32(6): 52-58.

[10]焦俊,孔文，辜麗川，等. 基于 UKF 和 SMO 農(nóng)用履帶機器人滑動參數(shù)計算[J]. 系統(tǒng)仿真學(xué)報, 2015, 27(7): 1577-1583.

[11]張杰,姬長英,顧寶興,等. 三自由度蘋果采摘機器人本體設(shè)計[J]. 計算機工程與應(yīng)用, 2015，51(23)：251-257.

[12]張飛. 欠驅(qū)動機械手末端執(zhí)行器的設(shè)計與研究[D]. 杭州：浙江理工大學(xué)， 2013.

[13]劉海江，張夏，肖麗芳. 基于LS-DYNA的7075鋁合金汽車保險杠碰撞仿真分析[J]. 機械設(shè)計, 2011, 28(2): 19-22.

[14]趙宇楠,司景萍,王二毛,等. 基于ANSYS的礦用自卸車車架結(jié)構(gòu)優(yōu)化設(shè)計[J]. 煤礦機械, 2014, 35(3): 18-21.

[15]康元春,劉瑛. 貨車車架尺寸優(yōu)化設(shè)計[J]. 湖北汽車工業(yè)學(xué)院學(xué)報, 2012, 26(3): 10-12.

[16]史光輝,于佳,張亮. 永磁同步電動機最大轉(zhuǎn)矩電流比控制[J]. 電機技術(shù), 2009, 31(5): 28-31.

[17]佟為明,金顯吉,林景波. 基于C8051F023微控制器的CAN總線實驗系統(tǒng)設(shè)計與實現(xiàn)[J]. 低壓電器, 2007, 37(23): 37- 40.

[18]姜雨彤,楊進華,劉釗,等. 雙目CCD測距系統(tǒng)的高精度標(biāo)定[J]. 計算機工程, 2013, 39(7): 228-232.

[19]田光兆,安秋,姬長英,等. 基于立體視覺的智能農(nóng)業(yè)車輛實時運動檢測[J]. 農(nóng)業(yè)機械學(xué)報, 2013, 44(7): 210-215.

[20]王友權(quán),周俊,姬長英,等. 基于自主導(dǎo)航和全方位轉(zhuǎn)向的農(nóng)用機器人設(shè)計[J]. 農(nóng)業(yè)工程學(xué)報, 2008, 24(7):110-113.

【責(zé)任編輯霍歡】

Design and experiment of an intelligent mobile platform loaded with a fruit picking robot

DONG Mang, GU Baoxing, JI Changying, ZHANG Qingyi, CHA Qiming

(College of Engineering, Nanjing Agricultural University, Nanjing 210031, China)

Abstract：【Objective】To design a prototype of wheeled intelligent mobile platform at the basis of a 3-DOF fruit picking robot hand. 【Method】According to the working environment of farmland, the steering structure and anti-collision beam structure of the platform were designed. The deformation of the platform frame under three working conditions were simulated using ANSYS, and simulation of the motor was carried out using Simulink module based on MPTA or ID=0. The motion control program and human computer interface were programmed with VC++. The prototype walking experiments were carried out in Jiangpu farm, Nanjing.【Result】The maximum deformation of the platform frame was 14.1 mm under the crankle working condition，and the value of stress was under the yield limit of material. The motor based on MPTA control achieved stability after 0.8 ms. The maximum climbing angle of the platform was 10°, and the tracking path lateral deviation was 0.22 m at a speed of 1.5 meter per second. 【Conclusion】This mobile platform has reasonable structure, with high strength, rigidity and motion accuracy, which meets the requirements of practical use.

Key words：fruit picking robot; intelligent mobile platform; ANSYS; finite element analysis; line tracing experiment

收稿日期：2015- 11- 10優(yōu)先出版時間：2016- 06- 01

作者簡介：董芒(1990—)，男，碩士研究生，E-mail:654514386@qq.com；通信作者：姬長英(1957—)，男，教授，博士，E-mail：chyji@njau.edu.cn

基金項目：江蘇省自然科學(xué)基金(BK20140720)；中央高?；究蒲袠I(yè)務(wù)專項基金(KYZ201325)

中圖分類號：S223.2

文獻標(biāo)志碼：A

文章編號：1001- 411X(2016)04- 0128- 06

優(yōu)先出版網(wǎng)址：http://www.cnki.net/kcms/detail/44.1110.s.20160601.1631.060.html

董芒， 顧寶興， 姬長英， 等.水果采摘機器人智能移動平臺的設(shè)計與試驗[J].華南農(nóng)業(yè)大學(xué)學(xué)報，2016,37(4):128- 133.