基于改進PSO的模糊PID高枝修剪機械臂末端抑振算法與試驗

李 揚，侯加林※，苑 進，趙新學(xué)，劉雪美，張 麗

（1. 山東農(nóng)業(yè)大學(xué)機械與電子工程學(xué)院，泰安 271018；2. 山東省園藝機械與裝備重點實驗室，泰安 271018；3. 山東科技大學(xué)資源與土木工程系，泰安 271019）

基于改進PSO的模糊PID高枝修剪機械臂末端抑振算法與試驗

李 揚1,2，侯加林1,2※，苑 進1,2，趙新學(xué)1，劉雪美1,2，張 麗3

（1. 山東農(nóng)業(yè)大學(xué)機械與電子工程學(xué)院，泰安 271018；2. 山東省園藝機械與裝備重點實驗室，泰安 271018；3. 山東科技大學(xué)資源與土木工程系，泰安 271019）

針對設(shè)計的高枝修剪機械臂定位過程易產(chǎn)生振動，難以快速、準確地將待修樹枝對入鋸切口的問題，分析大臂展、高負載自重比臂架系統(tǒng)的柔性特征，在此基礎(chǔ)上研究末端修枝鋸的抑振控制方法，實現(xiàn)末端修枝鋸的快速精準定位。首先介紹了高枝修剪機械臂結(jié)構(gòu)和工作原理，分析了臂架系統(tǒng)的柔性特征對末端修枝鋸定位產(chǎn)生的影響；其次通過結(jié)構(gòu)關(guān)系推導(dǎo)和有限元方法建立了機械臂的數(shù)學(xué)模型并進行動力學(xué)分析，并設(shè)計基于改進粒子群離線優(yōu)化的模糊PID控制方法，實現(xiàn)了對末端修枝鋸的主動抑振控制；最后分別在Simulink環(huán)境中和樣機系統(tǒng)上進行了數(shù)值仿真和試驗驗證。綜合仿真和試驗結(jié)果表明：該文設(shè)計的控制方法可以實現(xiàn)末端修枝鋸的主動抑振，定位過程中修枝鋸能夠在短時間內(nèi)進入穩(wěn)態(tài)，超調(diào)量不足開環(huán)狀態(tài)下的50%，震蕩調(diào)整時間小于1 s，經(jīng)1 s后振幅衰減至峰值的5%以下，從而達到了較好的末端抑振效果，改善了修枝鋸的定位性能，提高了高枝修剪機械臂的作業(yè)效率。相關(guān)研究可為其他具有一定相似柔性特征的機械提供末端抑振和精準定位的控制經(jīng)驗參考。

機械臂；林業(yè)；振動控制；振動抑制；柔性特征；改進粒子群；模糊PID

李 揚，侯加林，苑 進，趙新學(xué)，劉雪美，張 麗. 基于改進PSO的模糊PID高枝修剪機械臂末端抑振算法與試驗[J].農(nóng)業(yè)工程學(xué)報，2017，33(10)：49－58. doi：10.11975/j.issn.1002-6819.2017.10.007 http://www.tcsae.org

Li Yang, Hou Jialin, Yuan Jin, Zhao Xinxue, Liu Xuemei, Zhang Li. Experiment and vibration suppression algorithm for high-branch pruning manipulator based on fuzzy PID with improved PSO[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2017, 33(10): 49－58. (in Chinese with English abstract) doi：10.11975/j.issn.1002-6819.2017.10.007 http://www.tcsae.org

0 引 言

樹木修枝是森林撫育的主要措施之一，對樹木的生長、成材以及森林防火等具有非常積極的意義[1-3]。國外機械化修枝研究起步較早，配套較為齊全[4-5]，8 m以下的側(cè)枝多采用手工工具搭配伸縮臂，也有機械將剪枝工具固定在升降平臺之上，通過升降機升降進行高空輔助作業(yè)[6]。國內(nèi)修枝機械起步較晚，但近年來已取得了一些研究成果。如辛繼紅等[7]設(shè)計了一種背負式修枝機；楊乾華等[8]設(shè)計了一種電動修枝機；焦恩璋等[9]設(shè)計了一種車載式高枝修剪機，以高空作業(yè)車（雙折臂式或伸縮臂式）為基礎(chǔ)，在機械臂末端安裝修枝鋸、擺動機構(gòu)實現(xiàn)樹木修枝，但須有配套的專用汽車，液壓系統(tǒng)復(fù)雜，整機成本很高，操作相對復(fù)雜；華南熱帶作物機械研究所[10]設(shè)計制造了 3SG-8型升降修剪機，工作臺最大起升高度為8.5 m，操作員可以通過安裝在工作臺上的操縱手柄來控制工作臺的位置，提高了工作效率和作業(yè)質(zhì)量。

為填補中國8 m以上修枝機行業(yè)的空白，本文設(shè)計了一種操作簡單、成本較低的移動式高大樹木修枝機械，能方便拖曳至林區(qū)作業(yè)，修枝高度達到15 m，作業(yè)半徑達到6 m，最大修枝直徑10 cm[11-12]。但在鋸切定位過程中，由于機械臂展長，具有一定柔性特征，修枝鋸定位時易產(chǎn)生振動，難以將待修樹枝對入鋸口。

本文重點研究修剪機械臂的柔性特征及末端振動抑制問題，推導(dǎo)結(jié)構(gòu)關(guān)系式并采用有限元法在Simulink環(huán)境中進行修枝臂系統(tǒng)動力學(xué)建模和分析；設(shè)計模糊 PID控制器，將基于改進粒子群參數(shù)整定方法用于數(shù)值模型仿真，智能優(yōu)化模糊論域，實現(xiàn)PID控制器的參數(shù)調(diào)節(jié)，進而抑振修枝鋸的振動；最后在Simulink和實際環(huán)境中分別進行了虛擬仿真和樣機試驗，驗證本文提出的基于改進PSO和模糊PID方法對高枝修剪機械臂末端抑振的有效性。

1 臂架結(jié)構(gòu)與工作原理

林業(yè)高枝修剪機械的臂架結(jié)構(gòu)如圖 1所示。臂架基座被固定在1個升降平臺的回轉(zhuǎn)轉(zhuǎn)盤上，機械臂共3節(jié)，每節(jié)由1個關(guān)節(jié)驅(qū)動繞軸心旋轉(zhuǎn)，第3節(jié)臂末端安裝修枝鋸。關(guān)節(jié)旋轉(zhuǎn)由電動缸伸縮配合連桿動作驅(qū)動，順序定義3個關(guān)節(jié)轉(zhuǎn)角分別為1q(°)、2q(°)、3q(°)，轉(zhuǎn)動范圍由電動缸伸長范圍決定。實際系統(tǒng)中采用535、350、390 mm伸長量的電動缸（GL20-05型，上海光劍自動化設(shè)備有限公司），由臺達ASDA-A2伺服器配伺服電機驅(qū)動，采用單向220 V AC電源供電，形成的轉(zhuǎn)角范圍分別為：

圖1 臂架機械結(jié)構(gòu)示意圖Fig.1 Arm frame mechanical structure diagram

為了實現(xiàn)對 3臺伺服器的協(xié)調(diào)控制，實際設(shè)計系統(tǒng)人機交互界面采用基于Window XP操作系統(tǒng)的工業(yè)平板電腦為主控單元，開發(fā)基于 MFC（microsoft foundation classes）的控制應(yīng)用程序，將臂架系統(tǒng)的運動學(xué)和動力學(xué)正逆解算法集成，并采用RS-485總線與3臺伺服器通訊，驅(qū)動伺服電機實現(xiàn)機械臂系統(tǒng)的姿態(tài)定位和作業(yè)控制，完成修枝鋸自動化修枝工作。

修枝鋸定位控制問題本質(zhì)上是修枝臂的逆動力學(xué)控制問題，即給定機械臂工作空間末端理想位置以及機械臂的初始狀態(tài)求解力矩t(t)，使得實際末端位置x(t)在有限時間內(nèi)逼近但由于高枝修剪機展幅寬、負載自重比大，屬于剛?cè)狁詈咸匦越Y(jié)構(gòu)，存在一定的柔性。這種柔性特征易使臂架在定位作業(yè)時產(chǎn)生振動，不利于末端修枝鋸的精確定位。

2 修枝臂柔性特征分析及建模

就其臂架系統(tǒng)的動力學(xué)特性而言，3個機械臂負載自重比大，容易彎曲變形，建模時必須考慮機械臂的柔性特征。但柔性體系統(tǒng)本身是一個非線性、時變的分布參數(shù)系統(tǒng)，理論上具有無限多個自由度，系統(tǒng)建模難度大，難以在建模精度和模型復(fù)雜性之間平衡。本節(jié)采用有限元法對臂架系統(tǒng)進行建模，可以將微分方程離散化，有利于采用Simulink編制程序進行計算機輔助求解和仿真，進而得到良好的控制效果和較高的控制效率。

2.1 修枝臂結(jié)構(gòu)關(guān)系

機械結(jié)構(gòu)決定了機械臂關(guān)節(jié)角度與電動缸長度存在一一對應(yīng)，在電動缸滿足功率負荷要求的前提下（樣機設(shè)計之初已通過虛擬樣機優(yōu)化設(shè)計確定了每節(jié)臂架電動缸最大輸出功率不大于0.4 kW，即能夠滿足各節(jié)機械臂的負載要求[11]），伸縮量及伸縮速度決定電動缸實時輸出功率，也決定了關(guān)節(jié)轉(zhuǎn)矩的大小，因此在采用有限元法對機械臂進行動力學(xué)建模之前，應(yīng)將關(guān)節(jié)角度轉(zhuǎn)換為電動缸伸長量，進而決定姿態(tài)調(diào)整時實時輸出功率與電動缸伸縮速度之間的對應(yīng)關(guān)系。

2.1.1 關(guān)節(jié)角θ1與電動缸1長度L1的對應(yīng)關(guān)系

對第1關(guān)節(jié)幾何關(guān)系進行分析，其幾何結(jié)構(gòu)圖如圖2所示。

圖2 第1關(guān)節(jié)幾何結(jié)構(gòu)示意圖Fig.2 First joint geometry diagram

可以得到

考慮到圖2中d13是定角，因此機械臂1的轉(zhuǎn)角為

為了方便計算，機械設(shè)計時令

整理可得

其中

2.1.2 關(guān)節(jié)角θ2與電動缸2長度L2的對應(yīng)關(guān)系

對第2關(guān)節(jié)幾何關(guān)系進行分析，其幾何結(jié)構(gòu)圖如圖3所示。

圖3 第2關(guān)節(jié)幾何結(jié)構(gòu)示意圖Fig.3 Second joint geometry diagram

可以得到

考慮到d21和d22是定角，因此機械臂在OXY坐標中的轉(zhuǎn)角q2(t)為

2.1.3 關(guān)節(jié)角θ3與電動缸3長度L3的對應(yīng)關(guān)系

對第3節(jié)臂幾何關(guān)系進行分析，其幾何結(jié)構(gòu)圖如圖4所示。

可以得到

圖4 第3關(guān)節(jié)幾何結(jié)構(gòu)Fig.4 Third joint geometry diagram

2.2 柔性特征下的動力學(xué)建模

確定了機械臂關(guān)節(jié)轉(zhuǎn)角與電動缸伸長量之間的關(guān)系，就能夠得到機械臂輸入轉(zhuǎn)矩與電動缸伸縮量控制的對應(yīng)關(guān)系。下面采用有限元法對臂架系統(tǒng)進行動力學(xué)建模。如圖5所示，在機械臂i上建立旋轉(zhuǎn)坐標系原點O￠i固定于機械臂之間的驅(qū)動關(guān)節(jié)中心，￠為械臂i的初始端切線方向。

圖5 柔性機械臂坐標空間Fig.5 Flexible manipulator coordinate space

圖5中ig表示機械臂i繞驅(qū)動關(guān)節(jié)實際轉(zhuǎn)過的角度，且容易得到

2.3 修枝臂動力學(xué)模型實現(xiàn)

在確保電動缸功率能夠滿足作業(yè)要求基礎(chǔ)上，電動缸實際輸出轉(zhuǎn)矩與電動缸伸長量相關(guān)并分別由式（4）、（6）、（10）、（14）給出?？梢钥吹?，盡管式（4）、（6）、（10）中關(guān)節(jié)轉(zhuǎn)角與電動缸伸長量的幾何關(guān)系具有相同的表達形式，且式（14）明確了輸出轉(zhuǎn)矩 與電動缸控制參量之間的對應(yīng)關(guān)系，但由于幾何關(guān)系式本身是超越方程，求導(dǎo)之后計算尤為復(fù)雜。此外，有限元模型本身構(gòu)建也較為繁瑣，計算量大，這些因素都影響了對模型進行數(shù)值求解。Simulink作為MATLAB最重要的組件之一，提供了一個動態(tài)系統(tǒng)建模、仿真和綜合分析的集成環(huán)境，不需要大量編寫程序就能夠構(gòu)造出復(fù)雜系統(tǒng)，非常適合此類系統(tǒng)的建模和仿真計算[13-16]。利用 Simulink庫中提供的基本模塊，分別構(gòu)造電動缸伸長量到機械臂轉(zhuǎn)矩 的Simulink關(guān)系圖和機械臂Simulink有限元模型如圖6所示。

在圖6a中，封裝后In1輸入端為來自電動缸i的長度Li(t)，Out1輸出端為對應(yīng)臂i的輸出轉(zhuǎn)矩ti(t)。圖6b為包含30個有限元的柔性臂模型（圖中省略了大部分重復(fù)單元），每個有限元模型具有圖 6c所示的結(jié)構(gòu)，由式（13）表述的機械臂分布式參數(shù)可以根據(jù)表 1中實際參數(shù)在Solid HalfBeam單元中進行設(shè)置。

圖6 Simulink模型Fig.6 Simulink model

表1 高枝修剪機各節(jié)臂參數(shù)Table 1 Arm parameters of high-branch pruning manipulator

3 機械臂主動抑振算法及控制器設(shè)計

機械臂系統(tǒng)模型的輸入輸出分別是電動缸長度和位置、轉(zhuǎn)角，機械臂控制是給定目標位置前提下，通過檢測位置、轉(zhuǎn)角偏差反饋到基于改進粒子群算法（particle swarm optimization，PSO）的模糊PID控制器輸入端，并最終由電動缸伸縮量轉(zhuǎn)化為關(guān)節(jié)轉(zhuǎn)矩控制機械臂姿態(tài)。

本文機械臂控制算法設(shè)計采用的是一類基于改進粒子群的模糊 PID控制算法。PID控制是工程實際中應(yīng)用最為廣泛的調(diào)節(jié)器之一，具有結(jié)構(gòu)簡單、參數(shù)易整定等優(yōu)點[17-20]。但對于大干擾、高度非線性的柔性機械臂系統(tǒng)，傳統(tǒng) PID不能隨系統(tǒng)參數(shù)變化實時調(diào)節(jié)，無法達到預(yù)期的控制目標，甚至造成系統(tǒng)發(fā)散?？紤]到修枝機實際作業(yè)時姿態(tài)調(diào)整區(qū)域有限[11]，本文采用一種基于改進粒子群離線優(yōu)化算法的模糊 PID方法設(shè)計控制器，通過仿真模型和離線優(yōu)化技術(shù)，對 PID參數(shù)進行整定，并將優(yōu)化得到的控制參數(shù)應(yīng)用于實際系統(tǒng)，進而有效抑制機械臂振動，實現(xiàn)末端修枝鋸的準確定位。

3.1 基于改進粒子群的優(yōu)化算法

粒子群算法屬于進化算法的一種[21-25]，是從隨機解出發(fā)，通過迭代尋找最優(yōu)解并通過適應(yīng)度來評價解的品質(zhì)。在N維空間中，粒子i的空間位置

給定一個目標函數(shù)，每個粒子的位置對應(yīng)一個由該函數(shù)決定的適應(yīng)值fi。粒子按照式（14）來更新自己的位置和速度

Clerc[26]在研究粒子群優(yōu)化算法時，提出了收斂因子的概念

研究表明算式（17）可以達到較好的收斂性能，但由于過快收斂，有些求解過程中無法到達全局最優(yōu)。為了使粒子能夠逃出局部最優(yōu)，本文在算法具體實現(xiàn)時，在當前迭代周期內(nèi)設(shè)定一個最小速度門限值當持續(xù)小于時，則可以認為粒子陷入了局部最優(yōu)。此時應(yīng)當重啟粒子，加大粒子速度，促使粒子飛出局部最優(yōu)。很明顯，迭代即將結(jié)束時算法已經(jīng)趨近于全局最優(yōu)，此時應(yīng)當取消速度門限限制，防止粒子產(chǎn)生不必要的外逃。

此外，在適應(yīng)度函數(shù)的選擇上，本文選擇的適應(yīng)度函數(shù)為時間絕對偏差積分。為了抑制控制輸入產(chǎn)生突變，在適應(yīng)度函數(shù)中增加了輸入變化量的絕對值項，得到

3.2 機械臂控制器設(shè)計

模糊 PID已被應(yīng)用到很多領(lǐng)域，但模糊器的設(shè)計一般還是以經(jīng)驗為主，在非線性較強的系統(tǒng)中需要不斷嘗試以獲得更好的控制效果[27-30]。本文所采用的模糊 PID參數(shù)整定方法本質(zhì)上是一種基于粒子群算法的模糊隸屬函數(shù)優(yōu)化方法，通過改進粒子群優(yōu)化算法可以減少模糊PID設(shè)計過程中的工作量，并在模型不確定的情況下提高系統(tǒng)的控制性能。

控制器設(shè)計利用模糊規(guī)則建立誤差e(t)，誤差變化率(t)與比例參數(shù)kp、積分參數(shù)ki、微分參數(shù)kd之間關(guān)系。在改進粒子群算法的基礎(chǔ)上，通過將對系統(tǒng)的誤差作為粒子群優(yōu)化算法的評價函數(shù)即適應(yīng)度函數(shù)輸入，計算出適應(yīng)度函數(shù)的數(shù)值，然后根據(jù)函數(shù)的適應(yīng)度來調(diào)整模糊論域的量化范圍，進而通過模糊器調(diào)整PID的3個參數(shù)，使系統(tǒng)的控制性能達到最優(yōu)。設(shè)計控制器的系統(tǒng)結(jié)構(gòu)如圖7所示。

圖7 控制器設(shè)計結(jié)構(gòu)示意圖Fig.7 Controller design structure diagram

嚴格來講，柔性機械臂是無限自由度系統(tǒng)，考慮到控制成本和算法復(fù)雜度，現(xiàn)實中很難，也沒有必要對式（13）中所有狀態(tài)量進行監(jiān)控。通過監(jiān)測轉(zhuǎn)軸轉(zhuǎn)角和末端位置狀態(tài)信息，利用轉(zhuǎn)角及位置偏差量進行機械臂姿態(tài)控制顯然更有應(yīng)用價值。其中，系統(tǒng)的轉(zhuǎn)軸轉(zhuǎn)角可以由關(guān)節(jié)角計算得到，而末端狀態(tài)可以通過對加速度傳感器的信息積分而得。因此，軸的偏角誤差或末端位移誤差e及其變化率都可以作為有效輸入量，輸出量則為轉(zhuǎn)矩的大小。模糊控制的模糊關(guān)系可以用式（19）和式（20）計算得到，即

其中Ei為誤差集，ECj為誤差率集，Uij為輸出集，Ri為分模糊關(guān)系，Rr為總模糊。

為了建立機械臂的模糊控制規(guī)則，將輸入變量和輸出變量的語言值分成5個子集，定義為NB-負大、NS-負小、ZE-零、PS-正小、和PB-正大，即

為模糊語言變量選取相應(yīng)的隸屬度函數(shù)，本文各變量均選擇工程上常用的三角形隸屬函數(shù)，每個模糊變量在其論域內(nèi)可以分成相應(yīng)的 5個量化區(qū)間，由于加入了離子優(yōu)化算法，所以每個論域的實際量化區(qū)間為

表2 不同誤差下輸出的模糊規(guī)則Table 2 Output fuzzy rule with defferent errors

4 系統(tǒng)試驗與驗證

4.1 仿真試驗

在Simulink中搭建仿真試驗環(huán)境，構(gòu)造如圖6所示的伸長量與轉(zhuǎn)矩對應(yīng)關(guān)系，計算式（4）、（6）、（10）中的系數(shù)為

構(gòu)造30個有限元的機械臂模型如圖6b，模型輸入為轉(zhuǎn)矩 ，通過有限元模型可以獲得機械臂的中間變量，但如前說述只有轉(zhuǎn)角和末端狀態(tài)參與運算。圖8a為系統(tǒng)的控制結(jié)構(gòu)圖，其中Fuzzy System with PSO是M語言實現(xiàn)的改進粒子群模糊算法函數(shù)，反饋變量經(jīng)過與輸入?yún)⒖甲兞勘容^后得到誤差及其變化率，并作為帶粒子群優(yōu)化的模糊控制器的輸入。這里設(shè)定粒子優(yōu)化算法中迭代次數(shù)30，粒子數(shù)10，優(yōu)化范圍0～1 000。圖8b為PID控制子系統(tǒng)的內(nèi)部結(jié)構(gòu)圖，由于實際誤差有轉(zhuǎn)角和位置兩組且具有耦合性，這里通過兩個模塊對兩組變量進行解耦，分別計算其輸出值，再通過其線性組合得到整個控制器的輸出，即

式中w1，w2為加權(quán)系數(shù)，這里取w1=w2= 0.5。

經(jīng)過數(shù)值模擬仿真得到的模糊 PID控制器參數(shù)自整定曲線如圖8c所示，進而得到系統(tǒng)單位階躍響應(yīng)曲線如圖8d所示，可以看到經(jīng)過改進粒子群算法迭代優(yōu)化后系統(tǒng)的階躍響應(yīng)曲線超調(diào)量小，上升時間短，調(diào)整時間小，沒有穩(wěn)態(tài)誤差，表明控制器系統(tǒng)性能好，能夠達到較為理想的控制效果。

圖8 Simulink控制仿真Fig.8 Simulink control simulation

4.2 樣機試驗

在數(shù)值仿真試驗的基礎(chǔ)上，將優(yōu)化后的控制算法應(yīng)用于試驗樣機。樣機試驗在山東農(nóng)業(yè)大學(xué)校內(nèi)進行，將高枝修剪機由動力機械牽引至開闊區(qū)域，對高度8～10 m的樹木側(cè)枝進行剪枝作業(yè)。試驗過程首先將機械臂架展開，通過控制器調(diào)整機械臂的姿態(tài)對準待修樹枝，在鋸切定位過程中，分別測得使能、禁用算法 2種情況下末端修枝鋸的振動幅度和穩(wěn)定時間，進行結(jié)果對比分析，并檢測機械修枝完成度。

試驗主要以末端修枝鋸為測量對象，修枝鋸振幅通過在修枝鋸上固定AKE392B振動傳感器（加速度測量量程為±16g，g=9.8 m/s2），通過加速度數(shù)字積分的方式得到。控制器位于控制箱中，集成本文前述基于改進粒子群優(yōu)化后的模糊 PID控制算法。一次定位活動中，當修枝鋸振幅小于最大振幅5%時，定義為修枝鋸進入穩(wěn)態(tài)。實際臂架系統(tǒng)、控制箱和傳感器固定位置如圖9a所示。圖9b為修枝機作業(yè)試驗現(xiàn)場，圖9c為修枝鋸鋸切定位作業(yè)，圖9d為完成修枝作業(yè)后的樹枝茬口?？梢钥吹?，樣機順利完成了修枝作業(yè)，經(jīng)測量，修剪樹枝為直徑3.7 cm的側(cè)枝，修剪的樹枝切口平整，修枝效果符合要求。

圖9 樣機試驗Fig.9 Prototype experiment

將采集計算得到的末端定位數(shù)據(jù)進行濾波、擬合處理，分別繪制控制算法禁用和使能時機械臂末端修枝鋸定位誤差和誤差變化率曲線，如圖10所示。分別對比圖10a和圖10c，圖10b和圖10d，可以看到算法禁用時定位誤差及其誤差變化率曲線震蕩劇烈，且5 s后仍有小幅震蕩，不易進入穩(wěn)態(tài)，而在本文設(shè)計控制器的作用下，末端修枝鋸能夠在定位過程中較短時間內(nèi)能進入穩(wěn)態(tài)，定位過程更加平穩(wěn)。由圖10c、10d顯示，末端修枝鋸在1s左右時振幅衰減至峰值的5%以下，震蕩調(diào)整的時間小于1s，實現(xiàn)了較為有效的抑振效果，能順利將樹枝送入鋸切口，提高了作業(yè)效率，并最終實現(xiàn)了樹枝修剪工作。

圖10 控制算法禁用和使能時末端定位誤差及其變化率曲線Fig.10 End-point positioning error & change rate curves with control algorithm disabled and enable

5 結(jié) 論

高大樹木修枝是林業(yè)生產(chǎn)中一項重要工作，在林業(yè)生產(chǎn)管理中占有非常大的比例。本文在前期設(shè)計、試制高枝修剪機械基礎(chǔ)上，進一步完成了以下工作：

1）針對已經(jīng)制作的高枝修剪機械樣機，對其臂架系統(tǒng)進行了柔性分析，分析了機械臂幾何結(jié)構(gòu)，利用有限元法對機械臂進行動力學(xué)建模，并在Simulink中實現(xiàn)了其動力學(xué)模型，并進行了仿真實驗。

2）設(shè)計了基于改進粒子群的優(yōu)化算法的模糊PID控制器，對定位時末端修枝鋸振幅進行抑制，從而使修枝鋸震蕩調(diào)整時間從大于5 s優(yōu)化為小于1s，使之較快進入穩(wěn)態(tài)，較為有效的改善了末端定位產(chǎn)生的振動情況。

3）經(jīng)過以上分析和設(shè)計，提高了剪枝鋸的定位精度和速度，優(yōu)化了整個機械的動態(tài)性能，確保了對高枝修剪機械的靈活操控。通過對提出的主動控制算法進行仿真分析和樣機試驗，試驗結(jié)果驗證了算法的可靠性，為進一步發(fā)展高枝修剪機械積累了寶貴經(jīng)驗。

[1]張秀秀，曹幫華，張曉文，等. 楊樹修枝理論和技術(shù)研究進展[J]. 河北林果研究，2010，25(3)：235－239.Zhang Xiuxiu, Cao Banghua, Zhang Xiaowen, et al. Progress in research on theory and technology of poplar pruning[J].Hebei Journal of Forestry and Orchard Research, 2010, 25(3):235－239. (in Chinese with English abstract)

[2]王春勝，趙志剛，吳龍敦，等. 修枝高度對西南樺擬木蠹蛾為害的影響[J]. 西北林學(xué)院學(xué)報，2012，27(6)：120－123.Wang Chunsheng, Zhao Zhigang, Wu Longdun, et al. Effects of pruning height on trunk borer (arbela spp.) damage to betula alnoides[J]. Journal of Northwest Forestry University,2012, 27(6): 120－123. (in Chinese with English abstract)

[3]丁思一，佘濟云，楊慶朋，等. 間伐和修枝對杉木人工林土壤微生物量碳和酶活性的影響[J]. 中南林業(yè)科技大學(xué)學(xué)報，2015，35(6)：75—79.Ding Siyi, She Jiyun, Yang Qingpeng, et al. Effects of thinning and pruning on soil microbial biomass carbon and soil enzyme activities in chinese fir plantation[J]. Journal of Central South University of Forestry & Technology, 2015,35(6): 75－79. (in Chinese with English abstract)

[4]顧正平，沈瑞珍. 國內(nèi)外園林綠化機械現(xiàn)狀與發(fā)展趨勢[J].林業(yè)機械與木工設(shè)備，2004，32(2)：4－7.Gu Zhengping, Shen Ruizhen. Present status and prospect of gardening machines at home and abroad[J]. Forestry Machinery & Woodworking Equipment, 2004, 32(2): 4－7.(in Chinese with English abstract)

[5]賈啟明，馬秀娟，張大海. 關(guān)于城市高大樹木修剪機械化的探討[J]. 遼寧林業(yè)科技，2001，5(3)：43－44.Jia Qiming, Ma Xiujuan, Zhang Dahai. Discussion on the mechanization of pruning tall trees in cities[J]. Journal of Liaoning Forestry Science & Technology, 2001, 5(3): 43－44. (in Chinese with English abstract)

[6]李世葳，王述洋，王慧，等. 樹木整枝修剪機械現(xiàn)狀及發(fā)展趨勢[J]. 林業(yè)機械與木工設(shè)備，2008，36(1)：15－16.Li Shiwei, Wang Shuyang, Wang Hui, et al. Present status and prospect of tree pruning machinery[J]. Forestry Machinery & Woodworking Equipment, 2008, 36(1): 15－16.(in Chinese with English abstract)

[7]辛繼紅，湯興初，全臘珍，等. 背負式可調(diào)高枝修剪機的研制[J]. 湖南農(nóng)業(yè)大學(xué)學(xué)報：自然科學(xué)版，2003，29(1)：63－64.Xin Jihong, Tang Xingchu, Quan Lazhen, et al. On compact adjustable tree pruner[J]. Journal of Hunan Agricultural University: Natural Sciences, 2003, 29(1): 63－64. (in Chinese with English abstract)

[8]楊乾華，向北平. 電動綠籬修枝機的結(jié)構(gòu)設(shè)計與研究[J].林業(yè)科技，2010，35(1)：48－50.Yang Qianhua, Xiang Beiping. Structural design and research on electricaly operated hedgerow pruner[J]. Forestry Science& Technology, 2010, 35(1): 48－50. (in Chinese with English abstract)

[9]焦恩璋，張建紅. 車載式高枝修剪機的研制[J]. 南京林業(yè)大學(xué)學(xué)報，1990，14(1)：63－67.Jiao Enzhang, Zhang Jianhong. A study of lorry-mounted highlift pruner[J]. Journal of Nanjing Forestry University,1990, 14(1): 63－67. (in Chinese with English abstract)

[10]3SG-8型全液壓修枝整形機[J]. 農(nóng)業(yè)機械，1981(2)：10－11.3SG-8 full hydraulic pruning machine[J]. Agricultural Machinery, 1981(2): 10－11.

[11]陳延甫. 高大樹木修枝機械的設(shè)計與優(yōu)化分析[D]. 泰安：山東農(nóng)業(yè)大學(xué)，2016.Chen Yanfu. Design and Optimization Analysis of Tall Trees Pruning Machine[D]. Taian: Shandong Agricultural University, 2016. (in Chinese with English abstract)

[12]苑進，武軍，曹邦華，等. 一種楊樹自動修枝裝置：2013 103070033B[P]. 2013-12-11.

[13]李伯虎，柴旭東，朱文海，等. 現(xiàn)代建模與仿真技術(shù)發(fā)展中的幾個焦點[J]. 系統(tǒng)仿真學(xué)報，2004，16(9)：1871－1877.Li Bohu, Chai Xudong, Zhu Wenhai, et al. Some focusing points in development of modern modeling and simulation technology[J]. Journal of System Simulation, 2004, 16(9):1871－1877. (in Chinese with English abstract)

[14]王金武，張春鳳，周文琪，等. 基于 MATLAB仿真的非規(guī)則齒輪行星系扎穴機構(gòu)的優(yōu)化設(shè)計[J]. 農(nóng)業(yè)工程學(xué)報，2016，32(3)：22－28.Wang Jinwu, Zhang Chunfeng, Zhou Wenqi, et al.Optimization design of non-circular planetary gear trains pricking hole mechanism based on MATLAB[J].Transactions of the Chinese Society of Agricultural Engineering (Transactions of theCSAE), 2016, 32(3): 22－28.(in Chinese with English abstract)

[15]余強毅，吳文斌，陳羊陽，等. 農(nóng)作物空間格局變化模擬模型的 MATLAB實現(xiàn)及應(yīng)用[J]. 農(nóng)業(yè)工程學(xué)報，2014，30(12)：105－114.Yu Qiangyi, Wu Wenbin, Chen Yangyang, et al. Model application of an agent-based model for simulating crop pattern dynamics at regional scale based on MATLAB[J].Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2014, 30(12):105－114. (in Chinese with English abstract)

[16]孫韓，朱軍. MATLAB/Simulink在動態(tài)系統(tǒng)仿真中應(yīng)用研究[J]. 辦公自動化，2015(17)：42－44.Sun Han, Zhu Jun. Application of MATLAB/Simulink dynamic system simulation[J]. Office Automation, 2015(17):42－44.(in Chinese with English abstract)

[17]郭娜，胡靜濤. 基于Smith-模糊PID控制的變量噴藥系統(tǒng)設(shè)計及試驗[J]. 農(nóng)業(yè)工程學(xué)報，2014，30(8)：56－64.Guo Na, Hu Jingtao. Design and experiment of variable rate spaying system on Smith-Fuzzy PID control[J]. Transactions of the Chinese Society of Agricultural Engineering(Transactions of the CSAE), 2014, 30(8): 56－64. (in Chinese with English abstract)

[18]樊國平. 智能PID控制系統(tǒng)的設(shè)計與研究[D]. 杭州：浙江工業(yè)大學(xué)，2005.Fan Guoping. Design and Research on Intelligent PID Control System[D]. Hangzhou: Zhejiang University of Technology, 2005. (in Chinese with English abstract)

[19]仇成群，劉成林，沈法華，等. 基于Matlab和模糊PID的汽車巡航控制系統(tǒng)設(shè)計[J]. 農(nóng)業(yè)工程學(xué)報，2012，28(6)：197－202.Qiu Chengqun, Liu Chenglin, Shen Fahua, et al. Design of automobile cruise control system based on Matlab and fuzzy PID[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2012, 28(6): 197－202. (in Chinese with English abstract)

[20]寧宗夏. PID參數(shù)對控制系統(tǒng)穩(wěn)定性影響的研究[D]. 西安：西安電子科技大學(xué)，2008.Ning Zongxia. Study on Stability of PID Control System[D].Xi’an: Xidian University, 2008. (in Chinese with English abstract)

[21]董全成，馮顯英. 基于自適應(yīng)模糊免疫PID的軋花自動控制系統(tǒng)[J]. 農(nóng)業(yè)工程學(xué)報，2013，29(23)：30－37.Dong Quancheng, Feng Xianying. Cotton-gin automation by using adaptive fuzzy immune PID controller[J]. Transactions of the Chinese Society of Agricultural Engineering(Transactions of the CSAE), 2013, 29(23): 30－37. (in Chinese with English abstract)

[22]金欣磊. 基于 PSO 的多目標優(yōu)化算法研究及應(yīng)用[D]. 杭州：浙江大學(xué)，2006.Jin Xinlei. Pso-based Multi-objective Optimization Algorithm Research and its Applications[D]. Hangzhou:Zhejiang University, 2006. (in Chinese with English abstract)

[23]雷秀娟，付阿利，孫晶晶. 改進PSO算法的性能分析與研究[J]. 計算機應(yīng)用研究，2010，27(2)：453－458.Lei Xiujuan, Fu Ali, Sun Jingjing. Performance analyzing and researching of improved pso algorithm[J]. Application Research of Computers, 2010, 27(2): 453－458. (in Chinese with English abstract)

[24]陳嘯，王紅英，孔丹丹，等. 基于粒子群參數(shù)優(yōu)化和 BP神經(jīng)網(wǎng)絡(luò)的顆粒飼料質(zhì)量預(yù)測模型[J]. 農(nóng)業(yè)工程學(xué)報，2016，32(14)：306－314.Chen Xiao, Wang Hongying, Kong Dandan, et al. Quality prediction model of pellet feed basing on BP network using PSO parameters optimization method[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2016, 32(14): 306－314. (in Chinese with English abstract)

[25]胡旺，Gary G. Yen，張鑫. 基于Pareto熵的多目標粒子群優(yōu)化算法[J]. 軟件學(xué)報，2014，25(5)：1025－1050.Hu Wang, Gary G. YEN, Zhang Xin. Multiobjective particle swarm optimization based on pareto entropy[J]. Journal of Software, 2014, 25(5): 1025－1050. (in Chinese with English abstract)

[26]Clerc M. The swarm and the queen: Towards a deterministic and adaptive particle swarm optimization[C]// Proc. of the ICEC. 1999: 1951－1957.

[27]徐軍. 基于模糊控制的剪枝機器人驅(qū)動系統(tǒng)的研究[D].哈爾濱：東北林業(yè)大學(xué)，2011.Xu Jun. Study on the Fuzzy-controlled Driving System of Plantation Pruning Robot[D]. Harbin: Northeast Forestry University, 2011. (in Chinese with English abstract)

[28]王述彥，師宇，馮忠緒. 基于模糊PID控制器的控制方法研究[J]. 機械科學(xué)與技術(shù)，2011，30(1)：166－172.Wang Shuyan, Shi Yu, Feng Zhongxu. A method for controlling a loading system based on a fuzzy PID controller[J]. Mechanical Science and Technology for Aerospace Engineering, 2011, 30(1): 166－172. (in Chinese with English abstract)

[29]崔建弘，寇雪梅，楊靜宜，等. 基于模糊PID參數(shù)整定的收獲機前進速度控制優(yōu)化[J]. 農(nóng)機化研究，2016，7：75－79.Cui Jianhong, Kou Xuemei, Yang Jingyi, et al. Forward speed control optimization of the harvester based on parameter tuning of fuzzy PID[J]. Journal of Agricultural Mechanization Research, 2016, 7: 75－79. (in Chinese with English abstract)

[30]李加念，洪添勝，馮瑞玨，等. 基于模糊控制的肥液自動混合裝置設(shè)計與試驗[J]. 農(nóng)業(yè)工程學(xué)報，2013，29(16)：22－30.Li Jianian, Hong Tiansheng, Feng Ruijue, et al. Design and experiment of automatic mixing apparatus for liquid fertilizer based on fuzzy control[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2013, 29(16): 22－30. (in Chinese with English abstract)

Experiment and vibration suppression algorithm for high-branch pruning manipulator based on fuzzy PID with improved PSO

Li Yang1,2, Hou Jialin1,2※, Yuan Jin1,2, Zhao Xinxue1, Liu Xuemei1,2, Zhang Li3
(1.College of Mechanical & Electronic Engineering, Shandong Agricultural University, Tai'an271018,China;2.Shandong Provincial Key Laboratory of Horticultural Machinery and Equipment, Tai’an271018,China;3.Department of Resources and Civil Engineering, Shandong University of Science and Technology, Tai'an271019,China)

Pruning trees is an important work in forestry production, which plays an important role on the growth of trees and timber and the forest fire prevention. However, domestic and foreign high-altitude pruning machinery is still in its infancy,whose working height is generally less than 8 m and is not high flexible. It is difficult to effectively improve work efficiency in pruning high branches. In this paper, a simple, low-cost mobile tall tree pruning machine was designed, which could be easily towed to the forest area, and prune high branches within 15 m height. This machine had the working radius of 6 m and the maximum pruning diameter of 10 cm. However, in the process of sawing and positioning, due to the long arm span and high load weight ratio, there were obviously flexible features for its arms, and the end-effector (pruning saw) was easy to vibrate during its positioning. Thus, it was difficult to achieve fast and accurate positioning, as well as fix the branch to be cut. Aiming to the above problems, this paper analyzed the flexible characteristics of the boom system with the boom display and the high load weight ratio. On this basis, the vibration suppression control method of the end of pruning saws was investigated to achieve the rapid and accurate positioning of the end of pruning saws. In this paper, focusing the flexible characteristics of the manipulator and the vibration suppression of the end-point, based on the introduction of the boom structure and working principle, we analyzed the impact of flexible features on the positioning of the end of pruning saws by geometric derivation,and the FEM (finite element modeling) was used for the dynamics analysis of the boom system. And the fuzzy PID (proportion,integral, derivative) controller was designed based on an improved PSO (particle swarm optimization) algorithm, in order to realize the active vibration suppression control of the end of the actuator. In the designed fuzzy PID controller, the improved PSO algorithm was used on the numerical simulation model to optimize the fuzzy domain intelligently. The parameters of the PID controller were adjusted and the vibration of the pendulum saw was suppressed, and the simulation and experimental verification were performed in the SIMULINK environment and a prototype system, respectively. The experimental results showed that the design of the tall trees pruning manipulator control method could realize the end-point vibration suppression,and the pruning saw could be accurately positioned into the steady state during the localization process in a short period of time. The actual measured data showed that the overshoot was less than 50% under the open-loop state, the amplitude decay was less than 5% of the peak after 1 s, the vibration adjustment time was less than 1 s, and the system could achieve steady state, and achieve a more effective vibration suppression effect. Verification results showed that under the effect of the control algorithm and the controller designed in this paper, the end-effector could be stabilized in a short time after the positioning to achieve better active vibration suppression effect. The control algorithm improved the pruning saw’s positioning accuracy and speed, and optimized the dynamic performance of the entire machinery to ensure the flexible control of high branch pruning machinery. Through the simulation analysis and prototype test using the proposed active control algorithm, the results verify the reliability of the algorithm and accumulate the valuable experience for the further development of the high branch pruning machinery.

manipulators; forestery; vibration control; vibration suppression; flexible Features; improved PSO; fuzzy PID

10.11975/j.issn.1002-6819.2017.10.007

S776.27+4

A

1002-6819(2017)-10-0049-10

2016-09-13

2017-04-16

國家自然科學(xué)基金項目（51675317、51475278）；“十二五”國家科技支撐計劃資助項目（2014BAD08B01-2）；山東科技發(fā)展計劃項目（2013GNC11203、2014GNC112010）；山東省農(nóng)機裝備研發(fā)創(chuàng)新計劃項目（2015YB201）

李 揚，男，山東泰安人，主要從事嵌入式系統(tǒng)、智能農(nóng)機裝備方向研究。泰安 山東農(nóng)業(yè)大學(xué)機械與電子工程學(xué)院，271018。

Email：mtlyab@sdau.edu.cn

※通信作者：侯加林，男，山東泰安人，博士，教授，主要從事農(nóng)業(yè)電氣化與自動化方向研究。泰安 山東農(nóng)業(yè)大學(xué)機械與電子工程學(xué)院，271018。

Email：jlhou@sdau.edu.cn