類壁虎農田信息采集機器人運動控制系統的研究

傅 瑤

(重慶工業職業技術學院，重慶 401120)

?

類壁虎農田信息采集機器人運動控制系統的研究

傅 瑤

(重慶工業職業技術學院，重慶 401120)

機器人作為引領未來的高科技產品，在各個行業的作用非常明顯，發展前景十分廣闊。類壁虎機器人是特種機器人的一個重要分支，具有高靈活性和機動性，可替代人完成重復、繁瑣或者危險的勞動，不但可以對大型機器設備零部件進行探傷檢測和災后搜救工作，也可以應用于信息收集、軍事、深山探險等領域。以DSP智能控制平臺為核心模板，通過研究類壁虎機器人運動規劃與控制系統，對農田信息進行實時采集，并根據農田作物的發病情況進行預警。實驗表明：本文設計的農田信息采集機器人具有智能化程度高、控制精度高、靈活性大、可靠性強及開發周期短等顯著特點，應用前景十分廣闊。

類壁虎；DSP；農田信息采集機器人；運動控制

0 引言

目前，美國、日本、德國、韓國等國紛紛推出與發展新一代機器人相關的新戰略，希望借助機器人自主化、信息化、網絡化技術推進再工業化和產業數據化，提高國際競爭力。我國提出的“中國制造2025”計劃，將會加快智能化制造，各省市都將強化智能機器人制造的產業布局，過去5年，中國機器人市場年均增長36%，機器人市場需求大。

壁虎足墊和腳趾下的鱗上密布著上百萬根一排一排的、成束的、同人類頭發絲粗細的象絨毛一樣微絨毛，如同一只只彎形的小鉤，使其能夠輕而易舉地抓牢物體，并可以在墻壁甚至玻璃上爬行。類壁虎機器人模擬壁虎的移動方式可以在三維空間輕松、無障礙的爬行。本文主要基于DSP嵌入式開發平臺，模擬仿照壁虎的運動行為和爬行特點，分析類壁虎機器人運動學原理，研究其運動控制系統。

1 信息采集系統

類壁虎農田信息采集機器人主要依靠射頻通訊和無線WIFI進行農作物信息采集，其信息采集系統主要依靠無線網絡雙CCD高清攝像機對農作物的生長及健康情況進行回傳，并由DSP與ARM控制系統進行迭代學習與分析。該系統可根據具體需要，搭載多種信息傳感器，收集農作物不同部位的生長信息或者生長環境的溫濕度信息，由嵌入式控制系統進行數據分析與處理，并最終傳回電腦終端控制站，為農民提供高效有用的技術指導，以提高種植效益。信息采集系統結構圖如圖1所示。

圖1 信息采集系統框架圖

2 整體結構和運動學分析

通過觀察研究壁虎的身體結構和爬行規則及其在各種平面運動的規律，研究和開發了一種類壁虎的農田信息采集系統，在ADAMS仿真軟件中的模型構造如圖2所示。

2.1 機器人結構設計

本文設計的農田信息采集機器人機械結構對稱，根據平衡學原理設置4條腿，前進方向與腿所在的平面呈90°垂直。由于其在直線運動的過程中機架和電機之間協調起來比較麻煩，因此給每條腿配備3個旋轉自由度。其中，電機1負責機器人各個腳的抬起和放下動作，給機器人前進提供動力；電機2可以根據機器人的需要進行平面內90°的轉彎動作；電機3主要控制機器人運動過程中腳掌在平面內的定位。在設計整體結構的時候，刻意增大3個電機之間的水平距離，最大限度地減少電機對機器人行進的干擾。傳感器與機器人的4條腿相連，用來檢測行進過程中路面的平整狀況，然后將信息反饋到DSP智能控制系統中，實時根據路況調整行走方式，避開前方障礙物，使其在爬行過程中自主性比較強，提高其適應能力。

圖2 農田信息采集機器人的結構模型

2.2 機器人運動學分析

類壁虎農田信息采集機器人是一個完整的系統，其運動過程比較復雜，整個運動過程中滿足方程：

(1)

其中，i、j為正整數；R為關聯系數；g為外力；a為鉸鏈作用。

機器人在運動過程中，常常需要經過松軟和較硬的地面，而在不同的地面上，機器人腿掌的受力情況不同。一般通過力學傳感器收集信息后，控制系統根據路面情況需要對驅動電機作出調整，使其可以在各類不同的地面順利前行。

針對該機器人的左后腳，分析其在軟、硬地面的運動力學。該足端腳掌在硬地面的受力情況如圖3所示。

根據力學平衡原理有

R=Q

(2)

(3)

T=Fqr

(4)

Fd=Fq-Ff=μQ-fQ

(5)

其中，Q為腳掌對地面的壓力；R為地面對腳掌的支撐力；Ff和Fq為腳掌前后的摩擦力；r為腳掌觸地半徑。

足端腳掌在軟地面的受力情況如圖4所示。

圖3 左后方足端腳掌在硬地面的受力示意圖

圖4 足端腳掌在軟地面的受力情況示意圖

由圖4得

(6)

(7)

Fd=FH-Rc

(8)

(9)

(10)

其中，n=1,2…；0≤θ≤180；W為軟地面對腳掌的支撐力。

根據上述執行機構方程式的變形換算，可以得到該腳掌在三維空間的表達式為

(11)

其中，L1、L2分別為力學傳感器檢測到左右與壁虎目標之間的距離。上述變換式表示了末段執行器三維空間力的傳遞關系，主要研究腳掌位置變換與部件轉角之間的關系，并求出其在操作空間的位移傳遞關系。

3 控制系統的硬件設計

該機器人控制系統中，機體運動依靠3個直流電機驅動，機器人以TMS320F2812為控制系統的核心。該系統主要包括電源電路、電源檢測電路、A/D轉換電路、復位電路、傳感器檢測電路及電機驅動電路等部分，整體框架如圖5所示。

圖5 控制系統整體框架圖

在控制系統中，3個電機采用獨立的驅動方式，即3個電機的運動控制信號不同，可以減少各個電機之間的相互干擾，加大電機的控制靈活度。通過電機之間的相互配合，實時采集、處理傳感器的信息，由智能控制系統協調步行足的步態規劃，實現對機器人各個腳掌快速準確的位置控制。農田信息采集機器人實物如圖6所示。

4 運動步態識別與規劃

類壁虎農田信息采集機器人是指可以靈活地在墻面上爬行和吸附的移動式機器人，是通過長期觀察壁虎身體結構和爬行規律設計出來的，機器人每條腿都可以獨立控制；因采用柔軟材料，機身有一定的柔性，使得其可以自如的進行轉彎動作。其身體結構如圖7所示。

圖6 農田信息采集機器人實物圖

圖7 類壁虎機器人身體結構圖

根據大壁虎爬行時的步態，設計出類壁虎機器人的兩種爬行步態：1234步態和對角線步態。1234步態是指在爬行過程中機器人的4個腳掌依次抬起放下，爬行過程中一直有3個腳掌吸附在墻面上，穩定性能較高； 對角線步態是指相對角的兩個腳掌同時抬起或放下，以此做周期性的動作，此方法因吸附能力強，移動速度很快。本文設計中主要采用對角線步態。

4.1 直線行走方式

該機器人在行進過程中主要采取直線和轉彎兩種行走方式。類壁虎機器人直線移動示意如圖8所示。

圖8 機器人直線移動示意圖

如圖8可知：機器人在直線爬行過程中，1、3腳抬起，2、4腳吸附在壁面，以此反復的作周期性運動，即可以連續的向前沿直線移動。同理，由于機器人x和y方向的移動機構相同，類壁虎機器人也可以實現x方向的直線爬行。

4.2 轉彎行走方式

在直線爬行方式上稍作改進，既可以實現機器人轉彎的動作，主要是通過設置腳掌的落腳點，使其偏轉一定的角度，既可以形成一個圓弧。轉彎行走方式與直線行走方式移動步態的時序一樣，只是角度不同。轉彎行走方式如圖9所示。

圖9 機器人轉彎爬行示意圖

由圖9可知：機器人身體轉動角θ與圓弧半徑R和移動位移s1和s2的關系為

(12)

5 仿真與分析

根據機器人各個部件間的相互聯系，以及4個腳掌的實時狀態，給各個運動部件設定相關的運動約束，根據運動學、物理力學組成機械仿真模塊，運用ADAMS仿真軟件進行機器人的運動仿真。本實驗采用ADAMS軟件實現對類壁虎機器人運動形態的仿真。機器人爬行步態仿真如圖10所示。

圖10 機器人爬行步態仿真圖

在仿真試驗中，機器人在水平墻面進行爬行，因受重力影響，機器人所受摩擦力較大，此時系統會自動調整機器人運動學方程。以機器人左右后腿的運動姿態為例，機器人的運動時間仿真函數如圖11所示。

圖11 機器人的運動時間仿真函數

設計研究的農田信息采集機器人在理論上滿足吸附要求，機器人在上爬行時吸附力較大。但是在實際試驗中，由于植物接觸面積較小，會影響機器人的粘附效果，機器人的運動穩定性會受到一定程度的影響，機器人的吸附能力有待提高。實際測試表明，機器人在果樹上可以實現爬行，運動過程比較穩定，各個機械部件相互無影響，證明了該機器人運動控制規劃的可行性。

6 結論

通過觀察壁虎的身體結構和爬行規律，以類壁虎農田信息采集機器人移動步態為基礎，分析了機器人運動過程中的力學和動力學，設計了和研究了其運動控制系統。整個系統以TMS320F2812為控制核心，采用數字信號控制算法，計算能力強、速度快，節省了大量外圍器件。實驗表明：系統整體運行穩定，控制能力強，靈活性高，穩定性能優，易于系統的升級，為仿生機器人的研究提供了很好的研究設計方法。

[1] 孟偲,王田苗,丑武勝,等.仿壁虎機器人的步態設計與路徑規劃[J].機械工程學報, 2010(9):32-37.

[2] 阮鵬,俞志偉,張昊, 等.基于ADAMS的仿壁虎機器人步態規劃及仿真[J].機器人, 2010(4):499-504,509.

[3] 王超炎.基于Atmega128L的類壁虎機器人運動控制系統的實現[D].南京：南京航空航天大學,2007.

[4] 代良全.類壁虎機器人步態規劃研究及運動控制系統研制[D].南京：南京航空航天大學,2008.

[5] 武昌耀.基于ADAMS的大壁虎爬行的動力學仿真分析[D].南京：南京航空航天大學,2009.

[6] 顧文華.大壁虎在不同傾斜表面運動力學測試與比較分析[D].南京：南京航空航天大學,2010.

[7] 阮鵬.基于虛擬樣機技術的仿壁虎機器人步態規劃及運動仿真[D].南京：南京航空航天大學,2010.

[8] 張曉峰.基于MATLAB仿壁虎機器人步態規劃研究與運動仿真[D].南京：南京航空航天大學,2010.

[9] 李冰.柔性仿壁虎機器人的研究[D].合肥：中國科學技術大學,2011.

[10] 于樹林.柔性仿壁虎機器人控制系統研究[D].合肥：中國科學技術大學,2011.

[11] 宮俊.仿壁虎機器人運動控制:力反饋三維傳感器及初步反饋行為[D].南京：南京航空航天大學,2011.

[12] 武昌耀,陶秋帆,郝青青.基于ADAMS的大壁虎地面爬行仿真[J].重慶工學院學報：自然科學版, 2009(3):28-33.

[13] 張龍,劉穎,孟偲,王田苗.基于Labview的舵機驅動爬壁機器人CPG神經網絡運動控制的實現研究[J]. 機器人,2009(3):254-261.

[14] 方曄,汪小華,梅濤.仿壁虎爬壁機器人的結構及其控制系統研究[J].工業儀表與自動化裝置, 2009(3):17-19.

[15] 王田苗,孟偲,官勝國,等.柔性桿連接的仿壁虎機器人結構設計[J].機械工程學報, 2009(10):1-7.

[16] 詹毅仁.舵機電機驅動的類壁虎機器人的運動控制系統[D].南京：南京航空航天大學,2006.

[17] 代良全,張昊,戴振東.仿壁虎機器人足端工作空間分析及其實現協調運動的步態規劃[J].機器人, 2008(2):182-186.

[18] 張昊.大壁虎運動行為研究及仿壁虎機器人研制[D].南京：南京航空航天大學,2010.

[19] 李宏凱.類壁虎機器人的仿生控制:從行為觀測到控制實現[D]. 南京：南京航空航天大學,2010.

[20] 于樹林,梅濤,李冰,等.柔性仿生爬壁機器人控制系統研究[J].自動化與儀表,2011(6):1-3,35.

Design of Cherry Picking Robot Based on PLC High-speed Parallel Automatic Control

Fu Yao

(Chongqing Industry Polytechnic College, Chongqing 401120, China)

As a high-tech product to lead the future, the robot is very obvious in every industry, and its development prospects are very broad. Gecko robot is an important branch of special robot, with high flexibility, mobility, which can replace people to finish the repetitive, tedious or dangerous work.It not only can flaw detection, post disaster search and rescue work of large machinery and equipment parts, also can be application in information gathering, military, exploring mountains etc. As the core template, the DSP intelligent control platform can be studied through gecko robot motion planning and control system, the farmland information for real-time acquisition, and early warning in accordance with the incidence of crop. Experiments show that this paper designs the farmland information collection robot with high intelligence, high control precision, high flexibility, strong reliability, short development cycle and so on.

similar house lizard；DSP; field information collection robot; motion control

2015-11-27

重慶市教育委員會教育信息化試點建設項目(cqjyxxh20150 22)

傅 瑤(1985-)女，重慶人，講師，碩士，(E-mail)fuyao_chq@163.com。

S126;TP242

A

1003-188X(2017)01-0096-05