分揀并聯(lián)機(jī)器人自適應(yīng)滑?？刂?/h1>
2024-02-21 06:00:02高國(guó)琴
軟件導(dǎo)刊 2024年1期
劉 濤，高國(guó)琴
（江蘇大學(xué) 電氣信息工程學(xué)院，江蘇 鎮(zhèn)江 212013）
0 引言
近年來(lái)，我國(guó)水果產(chǎn)量逐年增長(zhǎng)，傳統(tǒng)人工分揀方法效率低下，不利于現(xiàn)代農(nóng)業(yè)的發(fā)展。實(shí)現(xiàn)機(jī)器人水果自動(dòng)分揀以提高水果分揀效率、降低勞動(dòng)強(qiáng)度、提高經(jīng)濟(jì)效益是現(xiàn)代農(nóng)業(yè)發(fā)展的趨勢(shì)。水果分揀工作可采用機(jī)械手完成［1］，目前多采用Delta 機(jī)械手［2］添加UPU 支鏈［3］的方式實(shí)現(xiàn)SCARA（Selective Compliance Assembly Robot Arm）運(yùn)動(dòng)的分揀操作。然而，UPU 支鏈長(zhǎng)時(shí)間處于工作空間邊緣時(shí)損壞程度較大，會(huì)導(dǎo)致機(jī)械手控制精度降低。因此設(shè)計(jì)一款剛度大、精度高、承載能力強(qiáng)的串類水果分揀并聯(lián)機(jī)器人十分必要［4］。
1 相關(guān)研究
針對(duì)串類水果分揀并聯(lián)機(jī)器人末端負(fù)載變化強(qiáng)烈干擾、難以穩(wěn)定運(yùn)行的問(wèn)題，國(guó)內(nèi)外學(xué)者進(jìn)行了諸多研究。例如，文獻(xiàn)［5］針對(duì)并聯(lián)機(jī)器人系統(tǒng)負(fù)載變化的問(wèn)題，采用擴(kuò)張狀態(tài)觀測(cè)器進(jìn)行觀測(cè)與補(bǔ)償，根據(jù)狀態(tài)估測(cè)設(shè)計(jì)了控制器，提高了并聯(lián)機(jī)器人的抗干擾能力；文獻(xiàn)［6］分析了機(jī)器人系統(tǒng)額定負(fù)載和空載兩種狀態(tài)下的伺服系統(tǒng)損耗情況；文獻(xiàn)［7］針對(duì)末端執(zhí)行器負(fù)載變化的并聯(lián)機(jī)器人軌跡跟蹤控制問(wèn)題，在末端執(zhí)行器中安裝力傳感器以測(cè)量負(fù)載變化，并提出一種超螺旋滑模控制方法，仿真結(jié)果證實(shí)了其有效性。然而，以上控制方法均未能在末端負(fù)載大范圍變化的情況下確保串類水果分揀并聯(lián)機(jī)器人良好的軌跡跟蹤性能。為此，本文通過(guò)解決系統(tǒng)負(fù)載轉(zhuǎn)動(dòng)慣量在線辨識(shí)和末端執(zhí)行器負(fù)載變化的自適應(yīng)滑模控制兩個(gè)關(guān)鍵問(wèn)題，以此達(dá)到對(duì)串類水果分揀并聯(lián)機(jī)器人的高性能控制。
并聯(lián)機(jī)器人在分揀不同種類的串類水果時(shí)質(zhì)量會(huì)發(fā)生變化，即使拾取同種類的水果也難免會(huì)發(fā)生纏繞等情況，負(fù)載變化具有不確定性，直接影響單通道系統(tǒng)的負(fù)載轉(zhuǎn)動(dòng)慣量［8］，給機(jī)器人控制帶來(lái)困難。如何實(shí)現(xiàn)系統(tǒng)負(fù)載轉(zhuǎn)動(dòng)慣量的在線辨識(shí)是關(guān)鍵難題，為此國(guó)內(nèi)外學(xué)者們嘗試了各種方法，例如文獻(xiàn)［9］提出的卡爾曼濾波器對(duì)時(shí)變數(shù)據(jù)和系統(tǒng)狀態(tài)的估測(cè)具有很好效果，其是一種隨機(jī)狀態(tài)估計(jì)器，但卡爾曼濾波算法需要設(shè)計(jì)各種假設(shè)條件，計(jì)算量大且復(fù)雜，影響了其在日?？刂葡到y(tǒng)中的普及；文獻(xiàn)［10］采用的最小二乘法及其衍生算法相對(duì)簡(jiǎn)單，但僅能保障系統(tǒng)估計(jì)量誤差和處于最小水平，無(wú)法實(shí)現(xiàn)誤差的最優(yōu)分布，因此無(wú)法用于精度控制；文獻(xiàn)［11-12］中的狀態(tài)觀測(cè)器法可以估測(cè)電機(jī)的瞬時(shí)狀態(tài)，但沒(méi)有較強(qiáng)的抗干擾能力，在復(fù)雜操作環(huán)境中位置檢測(cè)可能會(huì)出錯(cuò)；文獻(xiàn)［13-15］中的梯度校正參數(shù)辨識(shí)算法對(duì)于同步電機(jī)這種存在較多變量的設(shè)備可進(jìn)行參數(shù)變換，在每次計(jì)算與收斂時(shí)耗時(shí)較短、速度較快，擁有優(yōu)良的性能。
為提高串類水果分揀并聯(lián)機(jī)器人的抗負(fù)載能力，必須選擇合適的控制方法。模糊邏輯控制方法雖然具有抗負(fù)載變化的能力，但在應(yīng)用中很難消除系統(tǒng)穩(wěn)態(tài)誤差，控制精度不高［16-17］；人工神經(jīng)網(wǎng)絡(luò)具有自適應(yīng)、自組織、自學(xué)習(xí)能力，然而算法復(fù)雜程度高［18-19］；魯棒控制通過(guò)將末端執(zhí)行器的負(fù)載變化作為干擾進(jìn)行抑制或補(bǔ)償，但難以有效應(yīng)對(duì)負(fù)載變化［20-21］；滑?？刂剖且环N設(shè)計(jì)非線性不確定系統(tǒng)魯棒控制器的有效方法，其對(duì)控制通道中的參數(shù)變化具有魯棒性和動(dòng)態(tài)性能好的優(yōu)點(diǎn)［22-23］。
為此，本文針對(duì)串類水果分揀并聯(lián)機(jī)器人存在負(fù)載變化及支路不確定性等問(wèn)題運(yùn)用滑?？刂品椒ǎ⒏鶕?jù)滑模變量設(shè)計(jì)對(duì)于不確定性變化具備較強(qiáng)適應(yīng)能力的自適應(yīng)規(guī)則，以克服負(fù)載變化的影響；同時(shí)有效抑制滑?？刂魄袚Q增益過(guò)估計(jì)帶來(lái)的抖振，以期增強(qiáng)系統(tǒng)對(duì)于負(fù)載變化的魯棒性。
2 串類水果分揀并聯(lián)機(jī)器人
2.1 機(jī)構(gòu)簡(jiǎn)述
串類水果分揀并聯(lián)機(jī)器人實(shí)物如圖1 所示，包括動(dòng)靜平臺(tái)和4 組正交布置的R-（2-SS）（R 為旋轉(zhuǎn)副，S 為球副）支鏈。為減輕運(yùn)動(dòng)部件質(zhì)量，主動(dòng)臂和從動(dòng)臂的主要制作材料為碳纖維，動(dòng)平臺(tái)的主要制作材料為鋁合金。動(dòng)平臺(tái)由主、輔兩個(gè)平臺(tái)構(gòu)成，通過(guò)轉(zhuǎn)動(dòng)機(jī)構(gòu)連接主平臺(tái)和輔平臺(tái)，轉(zhuǎn)動(dòng)機(jī)構(gòu)由通過(guò)軸承轉(zhuǎn)動(dòng)連接在主平臺(tái)上的絲杠和固接于輔平臺(tái)上的螺母兩部分構(gòu)成。
Fig.1 Physical entity of string fruit sorting parallel robot圖1 串類水果分揀并聯(lián)機(jī)器人實(shí)物
2.2 運(yùn)動(dòng)學(xué)分析
為了更好地實(shí)施運(yùn)動(dòng)學(xué)分析，進(jìn)一步簡(jiǎn)化串類水果分揀并聯(lián)機(jī)器人的設(shè)計(jì)，使之成為如圖2所示的等效機(jī)構(gòu)。
Fig.2 Kinematic equivalent mechanism of string fruit sorting parallel robot圖2 串類水果分揀并聯(lián)機(jī)器人運(yùn)動(dòng)學(xué)等效機(jī)構(gòu)
基于靜平臺(tái)的中點(diǎn)創(chuàng)建參考坐標(biāo)系O-xyz，將該坐標(biāo)系下的主平臺(tái)和輔平臺(tái)分別作為質(zhì)點(diǎn)P1和P2，因此P1(P2)的矢量r可表示為：
式中：s為P1點(diǎn)到P2點(diǎn)的長(zhǎng)度；e為主動(dòng)臂轉(zhuǎn)軸到靜平臺(tái)中心的長(zhǎng)度；l1、l2分別表示支路i主、從動(dòng)臂的桿長(zhǎng)度；ui、wi分別表示主動(dòng)臂和從動(dòng)臂的單位矢量。其中ui表示為：
式中：θi為主動(dòng)臂i的轉(zhuǎn)角。根據(jù)機(jī)構(gòu)的裝配方式便能列出運(yùn)動(dòng)學(xué)逆解方程：
式中：分別表示為坐標(biāo)系O-xyz各坐標(biāo)軸上的單位矢量。
由式（2）和式（3）可求出wi：
將式（1）左右兩端分別對(duì)時(shí)間求導(dǎo)，整理可得：
將式（5）兩端點(diǎn)乘wiT并寫成矩陣形式，可得速度模型為：
式中：J、Jθ與Jx分別表示雅克比矩陣、直接與間接雅克比矩陣；。
通過(guò)式（5）對(duì)于時(shí)間的求導(dǎo)，可求出加速度模型的計(jì)算公式：
2.3 動(dòng)力學(xué)分析
為構(gòu)建串類水果分揀并聯(lián)機(jī)器人的動(dòng)力學(xué)模型，本文作出如下假設(shè)：①各運(yùn)動(dòng)副之間工作過(guò)程中產(chǎn)生的摩擦無(wú)能量損失；②從動(dòng)臂質(zhì)量較小，轉(zhuǎn)動(dòng)慣量也較小，可按照1∶2的比例將質(zhì)量分配給動(dòng)平臺(tái)與主動(dòng)臂。
基于虛功原理，可作如下計(jì)算：
式中：τ表示主動(dòng)關(guān)節(jié)的驅(qū)動(dòng)轉(zhuǎn)矩；τAg表示主動(dòng)臂對(duì)其轉(zhuǎn)軸的重力矩；IA表示主動(dòng)臂傳遞給轉(zhuǎn)軸的轉(zhuǎn)動(dòng)慣量等效值；表示動(dòng)平臺(tái)轉(zhuǎn)動(dòng)絲杠的角加速度；Is表示絲杠與負(fù)載轉(zhuǎn)軸的轉(zhuǎn)動(dòng)慣量。
代入δθ=Jδr與δθs=(2π/p)δs，經(jīng)過(guò)計(jì)算可以得到關(guān)節(jié)空間的動(dòng)力學(xué)模型：
M(θ)為4 × 4 的對(duì)稱正定矩陣，稱為慣量矩陣。末端執(zhí)行器負(fù)載的變化會(huì)引起M(θ)的改變。
驅(qū)動(dòng)關(guān)節(jié)的等效慣量為：
施加在電機(jī)軸上的等效負(fù)載慣量為：
交流伺服電機(jī)的數(shù)學(xué)模型可表示為驅(qū)動(dòng)軸的角位移θout與輸入轉(zhuǎn)速ωd的傳遞函數(shù)：
式中：Rph、LD分別表示定子繞阻和電樞電感；Kpi、Kpv分別表示電流環(huán)和速度環(huán)增益；KE為感應(yīng)電動(dòng)勢(shì)常數(shù)；Kii、KT、αT分別表示電流反饋系數(shù)、轉(zhuǎn)矩系數(shù)以及測(cè)速反饋系數(shù)；J(t)=J+J'，J表示負(fù)載轉(zhuǎn)動(dòng)慣量，J'表示電機(jī)轉(zhuǎn)子轉(zhuǎn)動(dòng)慣量。
2.4 梯度校正參數(shù)辨識(shí)算法
梯度校正參數(shù)辨識(shí)算法建立在梯度函數(shù)理論的基礎(chǔ)上，校正原則為基于準(zhǔn)則函數(shù)的負(fù)梯度方向進(jìn)行搜索，修正模型參數(shù)的估計(jì)值，保障準(zhǔn)則函數(shù)最小化［22］。
永磁同步電機(jī)主要包括轉(zhuǎn)子與負(fù)載兩部分［23］，機(jī)械運(yùn)動(dòng)可用公式表示為：
式中：wm表示轉(zhuǎn)子機(jī)械角速度，Tem表示電機(jī)電磁轉(zhuǎn)矩，TL表示負(fù)載轉(zhuǎn)矩，J表示負(fù)載施加于電機(jī)軸上的總轉(zhuǎn)動(dòng)慣量，B表示粘性阻尼系數(shù)。
將式（10）離散化為：
式（11）可進(jìn)一步轉(zhuǎn)化為：
則式（11）可表示為：
Ts為運(yùn)用梯度校正慣量辨識(shí)算法進(jìn)行采樣時(shí)轉(zhuǎn)速與電磁轉(zhuǎn)矩所需的采樣周期。由于慣量辨識(shí)所需的周期較短，采樣頻率必須足夠高，離散化不易造成失真，無(wú)需考慮，得出公式（18）：
由文獻(xiàn)［6］可知梯度校正參數(shù)辨識(shí)的實(shí)用公式為：
式中：(k-1)=[(k-1)(k-1)(k-1)]T；α、β分別表示兩個(gè)修正參數(shù)與待辨識(shí)參數(shù)，根據(jù)即可求出負(fù)載的轉(zhuǎn)動(dòng)慣量J。
3 控制器設(shè)計(jì)
3.1 自適應(yīng)律設(shè)計(jì)
不確定非線性系統(tǒng)表示為：
式中：x∈χ表示系統(tǒng)狀態(tài)向量，χ?Rn表示存在原點(diǎn)的領(lǐng)域，u∈R表示控制輸入，f(x)表示存在不確定性參數(shù)的光滑函數(shù)，g(x)表示易為外界擾動(dòng)影響的光滑函數(shù)。函數(shù)f(x) 與g(x) 無(wú)明確的界，g(x) ≠0 可以控制全部的(x，t) ∈χ系統(tǒng)，使得滑模變量s于短期內(nèi)接近零的領(lǐng)域。假設(shè)S與控制輸入u將相對(duì)階保持為1，則：
為方便起見(jiàn)，下文將簡(jiǎn)化這些函數(shù)的表達(dá)（S、ψ、Γ 中x與t將省略）。假設(shè)函數(shù)ψ和Γ 有界，但該界未知，不失一般性地有：
非線性不確定系統(tǒng)中，滑模變量可通過(guò)式（20）來(lái)計(jì)算。反饋控制律u(t)可表示為：
將式（22）代入式（20）中，得到：
式中：sgn表示符號(hào)函數(shù)，K表示切換增益。
為彌補(bǔ)現(xiàn)有自適應(yīng)律的不足之處，本文還制定出一種新的自適應(yīng)率，即積分指數(shù)自適應(yīng)律，表示為：
式中：α＞0，ε＞0，β＞0，μ＞0，γ為正整數(shù)。當(dāng)β=0時(shí)，自適應(yīng)律經(jīng)過(guò)簡(jiǎn)化變?yōu)榉e分自適應(yīng)律［6］。
3.2 自適應(yīng)滑?？刂破髟O(shè)計(jì)
本文設(shè)計(jì)的串類水果分揀并聯(lián)機(jī)器人轉(zhuǎn)動(dòng)慣量自適應(yīng)滑?？刂圃砣鐖D3 所示。該控制器主要由自適應(yīng)切換增益和轉(zhuǎn)動(dòng)慣量在線辨識(shí)兩個(gè)模塊構(gòu)成。自適應(yīng)切換增益基于滑模變量設(shè)計(jì)而成，主要作用是克服串類水果分揀并聯(lián)機(jī)器人因末端負(fù)載變化問(wèn)題引起的支路間不確定影響。由于滑模控制需要高切換增益，設(shè)計(jì)的自適應(yīng)律需有效抑制抖振。轉(zhuǎn)動(dòng)慣量在線辨識(shí)的主要作用是克服串類水果分揀并聯(lián)機(jī)器人受到的外部負(fù)載擾動(dòng)影響。伺服系統(tǒng)的轉(zhuǎn)動(dòng)慣量變化范圍大，采用梯度校正算法實(shí)時(shí)辨識(shí)負(fù)載轉(zhuǎn)動(dòng)慣量的大小，并在控制器當(dāng)中形成補(bǔ)償，可提高系統(tǒng)的魯棒性和抗干擾能力。
Fig.3 Motion control principle block diagram of series fruit sorting parallel robot mechanism圖3 串類水果分揀并聯(lián)機(jī)器人轉(zhuǎn)動(dòng)慣量自適應(yīng)滑?？刂圃砜驁D
為更有效地控制不同支路的交流伺服驅(qū)動(dòng)電機(jī)及相關(guān)驅(qū)動(dòng)器，為支路搭建相應(yīng)的數(shù)學(xué)模型。表示為：
在單支路控制系統(tǒng)中，滑模變量s為：
可得：
式中：ρ(t)表示集總不確定項(xiàng)。
滑模變量動(dòng)態(tài)方程為：
控制律u表示為：
當(dāng)=0時(shí)可推導(dǎo)出：
將式（31）代入式（28）可得：
綜上，總的控制律為：
3.3 穩(wěn)定性證明
此次設(shè)計(jì)的積分指數(shù)自適應(yīng)滑?？刂疲↖ntegral Exponential Adaptive Sliding Mode Control，IEG-ASMC）分為兩個(gè)階段，即補(bǔ)償與趨近階段。在補(bǔ)償階段，當(dāng)切換增益K小于ψsgn(s)/Γ時(shí)有：
由式（23）和式（34）可得：
因此，|s|非減。根據(jù)式（24）和Γ＞0，有：
由于|s|非減，由式（24）可知(t)將會(huì)補(bǔ)償式（36）右側(cè)的上界，K最終會(huì)于有限時(shí)間t*內(nèi)對(duì)ψsgn(s)/Γ 進(jìn)行補(bǔ)償。任何|s|＞ε皆會(huì)產(chǎn)生最終時(shí)刻t*≥0，因此：
對(duì)于任何t≥t*，如果發(fā)生了ψsgn(s)/Γ 比切換增益K更大的情況，K將會(huì)對(duì)ψsgn(s)/Γ 作進(jìn)一步補(bǔ)償。因此，t*≥0 會(huì)一直存在，滑模變量s符合|s|＞ε要求，(t)仍會(huì)持續(xù)增加，保持一般性，存在κ＞0 和δt＞0，對(duì) 于t≥t*+δt，則有：
補(bǔ)償階段結(jié)束后，系統(tǒng)軌跡進(jìn)入趨近階段。Lyapunov函數(shù)的構(gòu)建公式為：
基于所有t≥t*+δt，有：
式中：在t*+δt和t≥t*+δt間采用積分，以便使|s|于限定時(shí)間內(nèi)向領(lǐng)域|s|≤ε收斂。
4 仿真試驗(yàn)結(jié)果分析
為保證系統(tǒng)轉(zhuǎn)動(dòng)慣量能準(zhǔn)確有效地完成在線識(shí)別，需嚴(yán)格校驗(yàn)IEG-ASMC 算法的準(zhǔn)確性率和有效性。在設(shè)計(jì)和開(kāi)發(fā)串類水果分揀并聯(lián)機(jī)器人時(shí)需要為工作空間設(shè)計(jì)出門字形運(yùn)動(dòng)軌跡，根據(jù)動(dòng)力學(xué)模型分別計(jì)算出在線和非在線識(shí)別到的電機(jī)慣量參數(shù)J與J'，根據(jù)平均值和進(jìn)行自適應(yīng)滑模控制器設(shè)計(jì)。具體過(guò)程如下：分別對(duì)本文提出的IEG-ASMC 方法與文獻(xiàn)［6］中的自適應(yīng)滑模控制（IGASMC）方法、切換增益恒定的滑模控制（SMC）方法在如圖4 給定的期望軌跡下，以J作為電機(jī)慣量參數(shù)、Jˉ為自適應(yīng)滑模控制設(shè)計(jì)參數(shù)進(jìn)行仿真。根據(jù)電機(jī)模型參數(shù)和伺服驅(qū)動(dòng)器設(shè)置公式（25）中參數(shù)為Rph=18Ω，Kpi=15，Kii=1，LD=0.052 5H，KT=1.25N·m/A，aT=0.1，Kpv=0.08，KE=1.215；自適應(yīng)滑?？刂破鲄?shù)為c1=2 500，c2=50，α=0.01，ε=2g(x)KTe，Te=0.001，β=1.5，μ=0.01，γ=1。仿真結(jié)果如圖5 所示?？梢钥闯?，本文方法在保證良 好跟蹤性能的前提下可有效削弱滑?？刂频亩墩駟?wèn)題。
Fig.4 The desired trajectory of the end effector圖4 末端執(zhí)行器位姿各分量期望軌跡
Fig.5 Simulation results圖5 仿真結(jié)果
比較辨識(shí)與不辨識(shí)兩種狀態(tài)下電機(jī)的跟蹤誤差，結(jié)果 見(jiàn)圖6?？梢钥闯?，本文方法有效提高了系統(tǒng)跟蹤精度。
Fig.6 Verification of online identification of load moment圖6 在線辨識(shí)負(fù)載轉(zhuǎn)動(dòng)慣量驗(yàn)證
5 驗(yàn)證實(shí)驗(yàn)
本文采用分布式結(jié)構(gòu)建成串類水果分揀并聯(lián)機(jī)器人控制平臺(tái)。上位機(jī)（Personal Computer，PC）主要負(fù)責(zé)系統(tǒng)初始化、代碼編譯和人機(jī)交互以及狀態(tài)的監(jiān)控等功能；下位機(jī)（Universal Motion and Automation Controller，UMAC）主要負(fù)責(zé)數(shù)據(jù)的整理、數(shù)模之間的轉(zhuǎn)換和運(yùn)動(dòng)控制等指令。PC 與UMAC 通過(guò)以太網(wǎng)（Ethernet）進(jìn)行通訊。所搭建的串類水果分揀并聯(lián)機(jī)器人的整個(gè)程序流程是：在上位機(jī)當(dāng)中編寫相關(guān)程序，整理所需參數(shù)的設(shè)定，將指令發(fā)送給下位機(jī)；下位機(jī)接收指令，并對(duì)數(shù)據(jù)進(jìn)行計(jì)算和處理，利用板卡把指令發(fā)送給驅(qū)動(dòng)系統(tǒng)，串類水果分揀并聯(lián)機(jī)器人的伺服電機(jī)在接收指令后完成相關(guān)運(yùn)動(dòng)；上位機(jī)接收力傳感器檢測(cè)的壓力結(jié)果，整理編碼器采集到的電機(jī)信息；下位機(jī)控制完成后把結(jié)果送回上位機(jī)。
在以往的滑?？刂飘?dāng)中，為了滿足機(jī)器人系統(tǒng)的高性能控制，經(jīng)常設(shè)計(jì)定值增益或無(wú)指數(shù)項(xiàng)的自適應(yīng)律。在選用切換增益的同時(shí)必須滿足其高于不確定性的上邊緣，進(jìn)而可以對(duì)負(fù)載擾動(dòng)實(shí)時(shí)補(bǔ)償，但在生產(chǎn)應(yīng)用中此信息不容易得到，導(dǎo)致機(jī)器人系統(tǒng)的性能不佳。本文設(shè)計(jì)的自適應(yīng)律可以降低系統(tǒng)的不確定性，同時(shí)也能很好抑制抖振。實(shí)驗(yàn)結(jié)果表明，本文方法的電機(jī)最大誤差為1.19 × 10-2rad，其他方法的電機(jī)最大誤差為 3.26 × 10-2rad、1.38 × 10-2rad、1.56 × 10-2rad，誤差均較大。說(shuō)明本文方法能夠克服負(fù)載變化和系統(tǒng)不確定性作用，提高串類水果分揀并聯(lián)機(jī)器人的控制性能。
6 結(jié)語(yǔ)
串類水果分揀并聯(lián)機(jī)器人分揀不同種類的串類水果時(shí)質(zhì)量會(huì)發(fā)生變化，從而導(dǎo)致負(fù)載變化具有不確定性，直接影響單通道系統(tǒng)的轉(zhuǎn)動(dòng)慣量，進(jìn)而影響機(jī)器人系統(tǒng)的控制精度。針對(duì)該問(wèn)題，本文在分析電機(jī)機(jī)械運(yùn)動(dòng)方程的基礎(chǔ)上采用梯度校正參數(shù)辨識(shí)算法，沿著準(zhǔn)則函數(shù)的負(fù)梯度方向不斷進(jìn)行搜索，并修正參數(shù)的估計(jì)值，保障準(zhǔn)則函數(shù)最小化，以此在線辨識(shí)系統(tǒng)轉(zhuǎn)動(dòng)慣量的大小，增強(qiáng)系統(tǒng)對(duì)于負(fù)載擾動(dòng)的魯棒性。為解決其不確定性上界難以獲取的問(wèn)題，基于在線辨識(shí)系統(tǒng)轉(zhuǎn)動(dòng)慣量的支鏈電機(jī)模型，引入滑模控制方法并設(shè)計(jì)積分指數(shù)自適應(yīng)律，使其在近滑模面迅速有效調(diào)整滑模切換增益，提升了系統(tǒng)魯棒性，并抑制了滑模控制抖振，提升了串類水果分揀并聯(lián)機(jī)器人的水果分揀效率。由于串類水果分揀并聯(lián)機(jī)器人存在耦合問(wèn)題，會(huì)在一定程度影響其運(yùn)行效率，后續(xù)可對(duì)該方面進(jìn)行重點(diǎn)研究。
猜你喜歡
識(shí)別串、并聯(lián)電路的方法中學(xué)生數(shù)理化·中考版(2021年10期)2021-11-22 07:26:40 差值法巧求剛體轉(zhuǎn)動(dòng)慣量高師理科學(xué)刊(2020年2期)2020-11-26 06:01:32 三線擺測(cè)剛體轉(zhuǎn)動(dòng)慣量誤差分析及改進(jìn)四川工商學(xué)院學(xué)術(shù)新視野(2020年2期)2020-08-13 03:18:34 基于組合滑?？刂频慕^對(duì)重力儀兩級(jí)主動(dòng)減振設(shè)計(jì)中國(guó)慣性技術(shù)學(xué)報(bào)(2019年6期)2019-03-04 09:50:06 測(cè)控技術(shù)(2018年4期)2018-11-25 09:47:26 并網(wǎng)逆變器逆系統(tǒng)自學(xué)習(xí)滑?？箶_控制測(cè)控技術(shù)(2018年3期)2018-11-25 09:45:40 審批由“串聯(lián)”改“并聯(lián)”好在哪里?中國(guó)環(huán)境監(jiān)察(2016年7期)2016-10-23 05:36:30 并聯(lián)型APF中SVPWM的零矢量分配通信電源技術(shù)(2016年1期)2016-04-16 04:57:26 一種軟開(kāi)關(guān)的交錯(cuò)并聯(lián)Buck/Boost雙向DC/DC變換器通信電源技術(shù)(2016年5期)2016-03-22 01:09:37 基于扭擺振動(dòng)的轉(zhuǎn)動(dòng)慣量識(shí)別方法振動(dòng)、測(cè)試與診斷(2014年4期)2014-03-01 01:14:01
劉 濤，高國(guó)琴
（江蘇大學(xué) 電氣信息工程學(xué)院，江蘇 鎮(zhèn)江 212013）
0 引言
近年來(lái)，我國(guó)水果產(chǎn)量逐年增長(zhǎng)，傳統(tǒng)人工分揀方法效率低下，不利于現(xiàn)代農(nóng)業(yè)的發(fā)展。實(shí)現(xiàn)機(jī)器人水果自動(dòng)分揀以提高水果分揀效率、降低勞動(dòng)強(qiáng)度、提高經(jīng)濟(jì)效益是現(xiàn)代農(nóng)業(yè)發(fā)展的趨勢(shì)。水果分揀工作可采用機(jī)械手完成［1］，目前多采用Delta 機(jī)械手［2］添加UPU 支鏈［3］的方式實(shí)現(xiàn)SCARA（Selective Compliance Assembly Robot Arm）運(yùn)動(dòng)的分揀操作。然而，UPU 支鏈長(zhǎng)時(shí)間處于工作空間邊緣時(shí)損壞程度較大，會(huì)導(dǎo)致機(jī)械手控制精度降低。因此設(shè)計(jì)一款剛度大、精度高、承載能力強(qiáng)的串類水果分揀并聯(lián)機(jī)器人十分必要［4］。
1 相關(guān)研究
針對(duì)串類水果分揀并聯(lián)機(jī)器人末端負(fù)載變化強(qiáng)烈干擾、難以穩(wěn)定運(yùn)行的問(wèn)題，國(guó)內(nèi)外學(xué)者進(jìn)行了諸多研究。例如，文獻(xiàn)［5］針對(duì)并聯(lián)機(jī)器人系統(tǒng)負(fù)載變化的問(wèn)題，采用擴(kuò)張狀態(tài)觀測(cè)器進(jìn)行觀測(cè)與補(bǔ)償，根據(jù)狀態(tài)估測(cè)設(shè)計(jì)了控制器，提高了并聯(lián)機(jī)器人的抗干擾能力；文獻(xiàn)［6］分析了機(jī)器人系統(tǒng)額定負(fù)載和空載兩種狀態(tài)下的伺服系統(tǒng)損耗情況；文獻(xiàn)［7］針對(duì)末端執(zhí)行器負(fù)載變化的并聯(lián)機(jī)器人軌跡跟蹤控制問(wèn)題，在末端執(zhí)行器中安裝力傳感器以測(cè)量負(fù)載變化，并提出一種超螺旋滑模控制方法，仿真結(jié)果證實(shí)了其有效性。然而，以上控制方法均未能在末端負(fù)載大范圍變化的情況下確保串類水果分揀并聯(lián)機(jī)器人良好的軌跡跟蹤性能。為此，本文通過(guò)解決系統(tǒng)負(fù)載轉(zhuǎn)動(dòng)慣量在線辨識(shí)和末端執(zhí)行器負(fù)載變化的自適應(yīng)滑模控制兩個(gè)關(guān)鍵問(wèn)題，以此達(dá)到對(duì)串類水果分揀并聯(lián)機(jī)器人的高性能控制。
并聯(lián)機(jī)器人在分揀不同種類的串類水果時(shí)質(zhì)量會(huì)發(fā)生變化，即使拾取同種類的水果也難免會(huì)發(fā)生纏繞等情況，負(fù)載變化具有不確定性，直接影響單通道系統(tǒng)的負(fù)載轉(zhuǎn)動(dòng)慣量［8］，給機(jī)器人控制帶來(lái)困難。如何實(shí)現(xiàn)系統(tǒng)負(fù)載轉(zhuǎn)動(dòng)慣量的在線辨識(shí)是關(guān)鍵難題，為此國(guó)內(nèi)外學(xué)者們嘗試了各種方法，例如文獻(xiàn)［9］提出的卡爾曼濾波器對(duì)時(shí)變數(shù)據(jù)和系統(tǒng)狀態(tài)的估測(cè)具有很好效果，其是一種隨機(jī)狀態(tài)估計(jì)器，但卡爾曼濾波算法需要設(shè)計(jì)各種假設(shè)條件，計(jì)算量大且復(fù)雜，影響了其在日?？刂葡到y(tǒng)中的普及；文獻(xiàn)［10］采用的最小二乘法及其衍生算法相對(duì)簡(jiǎn)單，但僅能保障系統(tǒng)估計(jì)量誤差和處于最小水平，無(wú)法實(shí)現(xiàn)誤差的最優(yōu)分布，因此無(wú)法用于精度控制；文獻(xiàn)［11-12］中的狀態(tài)觀測(cè)器法可以估測(cè)電機(jī)的瞬時(shí)狀態(tài)，但沒(méi)有較強(qiáng)的抗干擾能力，在復(fù)雜操作環(huán)境中位置檢測(cè)可能會(huì)出錯(cuò)；文獻(xiàn)［13-15］中的梯度校正參數(shù)辨識(shí)算法對(duì)于同步電機(jī)這種存在較多變量的設(shè)備可進(jìn)行參數(shù)變換，在每次計(jì)算與收斂時(shí)耗時(shí)較短、速度較快，擁有優(yōu)良的性能。
為提高串類水果分揀并聯(lián)機(jī)器人的抗負(fù)載能力，必須選擇合適的控制方法。模糊邏輯控制方法雖然具有抗負(fù)載變化的能力，但在應(yīng)用中很難消除系統(tǒng)穩(wěn)態(tài)誤差，控制精度不高［16-17］；人工神經(jīng)網(wǎng)絡(luò)具有自適應(yīng)、自組織、自學(xué)習(xí)能力，然而算法復(fù)雜程度高［18-19］；魯棒控制通過(guò)將末端執(zhí)行器的負(fù)載變化作為干擾進(jìn)行抑制或補(bǔ)償，但難以有效應(yīng)對(duì)負(fù)載變化［20-21］；滑?？刂剖且环N設(shè)計(jì)非線性不確定系統(tǒng)魯棒控制器的有效方法，其對(duì)控制通道中的參數(shù)變化具有魯棒性和動(dòng)態(tài)性能好的優(yōu)點(diǎn)［22-23］。
為此，本文針對(duì)串類水果分揀并聯(lián)機(jī)器人存在負(fù)載變化及支路不確定性等問(wèn)題運(yùn)用滑?？刂品椒ǎ⒏鶕?jù)滑模變量設(shè)計(jì)對(duì)于不確定性變化具備較強(qiáng)適應(yīng)能力的自適應(yīng)規(guī)則，以克服負(fù)載變化的影響；同時(shí)有效抑制滑?？刂魄袚Q增益過(guò)估計(jì)帶來(lái)的抖振，以期增強(qiáng)系統(tǒng)對(duì)于負(fù)載變化的魯棒性。
2 串類水果分揀并聯(lián)機(jī)器人
2.1 機(jī)構(gòu)簡(jiǎn)述
串類水果分揀并聯(lián)機(jī)器人實(shí)物如圖1 所示，包括動(dòng)靜平臺(tái)和4 組正交布置的R-（2-SS）（R 為旋轉(zhuǎn)副，S 為球副）支鏈。為減輕運(yùn)動(dòng)部件質(zhì)量，主動(dòng)臂和從動(dòng)臂的主要制作材料為碳纖維，動(dòng)平臺(tái)的主要制作材料為鋁合金。動(dòng)平臺(tái)由主、輔兩個(gè)平臺(tái)構(gòu)成，通過(guò)轉(zhuǎn)動(dòng)機(jī)構(gòu)連接主平臺(tái)和輔平臺(tái)，轉(zhuǎn)動(dòng)機(jī)構(gòu)由通過(guò)軸承轉(zhuǎn)動(dòng)連接在主平臺(tái)上的絲杠和固接于輔平臺(tái)上的螺母兩部分構(gòu)成。
Fig.1 Physical entity of string fruit sorting parallel robot圖1 串類水果分揀并聯(lián)機(jī)器人實(shí)物
2.2 運(yùn)動(dòng)學(xué)分析
為了更好地實(shí)施運(yùn)動(dòng)學(xué)分析，進(jìn)一步簡(jiǎn)化串類水果分揀并聯(lián)機(jī)器人的設(shè)計(jì)，使之成為如圖2所示的等效機(jī)構(gòu)。
Fig.2 Kinematic equivalent mechanism of string fruit sorting parallel robot圖2 串類水果分揀并聯(lián)機(jī)器人運(yùn)動(dòng)學(xué)等效機(jī)構(gòu)
基于靜平臺(tái)的中點(diǎn)創(chuàng)建參考坐標(biāo)系O-xyz，將該坐標(biāo)系下的主平臺(tái)和輔平臺(tái)分別作為質(zhì)點(diǎn)P1和P2，因此P1(P2)的矢量r可表示為：
式中：s為P1點(diǎn)到P2點(diǎn)的長(zhǎng)度；e為主動(dòng)臂轉(zhuǎn)軸到靜平臺(tái)中心的長(zhǎng)度；l1、l2分別表示支路i主、從動(dòng)臂的桿長(zhǎng)度；ui、wi分別表示主動(dòng)臂和從動(dòng)臂的單位矢量。其中ui表示為：
式中：θi為主動(dòng)臂i的轉(zhuǎn)角。根據(jù)機(jī)構(gòu)的裝配方式便能列出運(yùn)動(dòng)學(xué)逆解方程：
式中：分別表示為坐標(biāo)系O-xyz各坐標(biāo)軸上的單位矢量。
由式（2）和式（3）可求出wi：
將式（1）左右兩端分別對(duì)時(shí)間求導(dǎo)，整理可得：
將式（5）兩端點(diǎn)乘wiT并寫成矩陣形式，可得速度模型為：
式中：J、Jθ與Jx分別表示雅克比矩陣、直接與間接雅克比矩陣；。
通過(guò)式（5）對(duì)于時(shí)間的求導(dǎo)，可求出加速度模型的計(jì)算公式：
2.3 動(dòng)力學(xué)分析
為構(gòu)建串類水果分揀并聯(lián)機(jī)器人的動(dòng)力學(xué)模型，本文作出如下假設(shè)：①各運(yùn)動(dòng)副之間工作過(guò)程中產(chǎn)生的摩擦無(wú)能量損失；②從動(dòng)臂質(zhì)量較小，轉(zhuǎn)動(dòng)慣量也較小，可按照1∶2的比例將質(zhì)量分配給動(dòng)平臺(tái)與主動(dòng)臂。
基于虛功原理，可作如下計(jì)算：
式中：τ表示主動(dòng)關(guān)節(jié)的驅(qū)動(dòng)轉(zhuǎn)矩；τAg表示主動(dòng)臂對(duì)其轉(zhuǎn)軸的重力矩；IA表示主動(dòng)臂傳遞給轉(zhuǎn)軸的轉(zhuǎn)動(dòng)慣量等效值；表示動(dòng)平臺(tái)轉(zhuǎn)動(dòng)絲杠的角加速度；Is表示絲杠與負(fù)載轉(zhuǎn)軸的轉(zhuǎn)動(dòng)慣量。
代入δθ=Jδr與δθs=(2π/p)δs，經(jīng)過(guò)計(jì)算可以得到關(guān)節(jié)空間的動(dòng)力學(xué)模型：
M(θ)為4 × 4 的對(duì)稱正定矩陣，稱為慣量矩陣。末端執(zhí)行器負(fù)載的變化會(huì)引起M(θ)的改變。
驅(qū)動(dòng)關(guān)節(jié)的等效慣量為：
施加在電機(jī)軸上的等效負(fù)載慣量為：
交流伺服電機(jī)的數(shù)學(xué)模型可表示為驅(qū)動(dòng)軸的角位移θout與輸入轉(zhuǎn)速ωd的傳遞函數(shù)：
式中：Rph、LD分別表示定子繞阻和電樞電感；Kpi、Kpv分別表示電流環(huán)和速度環(huán)增益；KE為感應(yīng)電動(dòng)勢(shì)常數(shù)；Kii、KT、αT分別表示電流反饋系數(shù)、轉(zhuǎn)矩系數(shù)以及測(cè)速反饋系數(shù)；J(t)=J+J'，J表示負(fù)載轉(zhuǎn)動(dòng)慣量，J'表示電機(jī)轉(zhuǎn)子轉(zhuǎn)動(dòng)慣量。
2.4 梯度校正參數(shù)辨識(shí)算法
梯度校正參數(shù)辨識(shí)算法建立在梯度函數(shù)理論的基礎(chǔ)上，校正原則為基于準(zhǔn)則函數(shù)的負(fù)梯度方向進(jìn)行搜索，修正模型參數(shù)的估計(jì)值，保障準(zhǔn)則函數(shù)最小化［22］。
永磁同步電機(jī)主要包括轉(zhuǎn)子與負(fù)載兩部分［23］，機(jī)械運(yùn)動(dòng)可用公式表示為：
式中：wm表示轉(zhuǎn)子機(jī)械角速度，Tem表示電機(jī)電磁轉(zhuǎn)矩，TL表示負(fù)載轉(zhuǎn)矩，J表示負(fù)載施加于電機(jī)軸上的總轉(zhuǎn)動(dòng)慣量，B表示粘性阻尼系數(shù)。
將式（10）離散化為：
式（11）可進(jìn)一步轉(zhuǎn)化為：
則式（11）可表示為：
Ts為運(yùn)用梯度校正慣量辨識(shí)算法進(jìn)行采樣時(shí)轉(zhuǎn)速與電磁轉(zhuǎn)矩所需的采樣周期。由于慣量辨識(shí)所需的周期較短，采樣頻率必須足夠高，離散化不易造成失真，無(wú)需考慮，得出公式（18）：
由文獻(xiàn)［6］可知梯度校正參數(shù)辨識(shí)的實(shí)用公式為：
式中：(k-1)=[(k-1)(k-1)(k-1)]T；α、β分別表示兩個(gè)修正參數(shù)與待辨識(shí)參數(shù)，根據(jù)即可求出負(fù)載的轉(zhuǎn)動(dòng)慣量J。
3 控制器設(shè)計(jì)
3.1 自適應(yīng)律設(shè)計(jì)
不確定非線性系統(tǒng)表示為：
式中：x∈χ表示系統(tǒng)狀態(tài)向量，χ?Rn表示存在原點(diǎn)的領(lǐng)域，u∈R表示控制輸入，f(x)表示存在不確定性參數(shù)的光滑函數(shù)，g(x)表示易為外界擾動(dòng)影響的光滑函數(shù)。函數(shù)f(x) 與g(x) 無(wú)明確的界，g(x) ≠0 可以控制全部的(x，t) ∈χ系統(tǒng)，使得滑模變量s于短期內(nèi)接近零的領(lǐng)域。假設(shè)S與控制輸入u將相對(duì)階保持為1，則：
為方便起見(jiàn)，下文將簡(jiǎn)化這些函數(shù)的表達(dá)（S、ψ、Γ 中x與t將省略）。假設(shè)函數(shù)ψ和Γ 有界，但該界未知，不失一般性地有：
非線性不確定系統(tǒng)中，滑模變量可通過(guò)式（20）來(lái)計(jì)算。反饋控制律u(t)可表示為：
將式（22）代入式（20）中，得到：
式中：sgn表示符號(hào)函數(shù)，K表示切換增益。
為彌補(bǔ)現(xiàn)有自適應(yīng)律的不足之處，本文還制定出一種新的自適應(yīng)率，即積分指數(shù)自適應(yīng)律，表示為：
式中：α＞0，ε＞0，β＞0，μ＞0，γ為正整數(shù)。當(dāng)β=0時(shí)，自適應(yīng)律經(jīng)過(guò)簡(jiǎn)化變?yōu)榉e分自適應(yīng)律［6］。
3.2 自適應(yīng)滑?？刂破髟O(shè)計(jì)
本文設(shè)計(jì)的串類水果分揀并聯(lián)機(jī)器人轉(zhuǎn)動(dòng)慣量自適應(yīng)滑?？刂圃砣鐖D3 所示。該控制器主要由自適應(yīng)切換增益和轉(zhuǎn)動(dòng)慣量在線辨識(shí)兩個(gè)模塊構(gòu)成。自適應(yīng)切換增益基于滑模變量設(shè)計(jì)而成，主要作用是克服串類水果分揀并聯(lián)機(jī)器人因末端負(fù)載變化問(wèn)題引起的支路間不確定影響。由于滑模控制需要高切換增益，設(shè)計(jì)的自適應(yīng)律需有效抑制抖振。轉(zhuǎn)動(dòng)慣量在線辨識(shí)的主要作用是克服串類水果分揀并聯(lián)機(jī)器人受到的外部負(fù)載擾動(dòng)影響。伺服系統(tǒng)的轉(zhuǎn)動(dòng)慣量變化范圍大，采用梯度校正算法實(shí)時(shí)辨識(shí)負(fù)載轉(zhuǎn)動(dòng)慣量的大小，并在控制器當(dāng)中形成補(bǔ)償，可提高系統(tǒng)的魯棒性和抗干擾能力。
Fig.3 Motion control principle block diagram of series fruit sorting parallel robot mechanism圖3 串類水果分揀并聯(lián)機(jī)器人轉(zhuǎn)動(dòng)慣量自適應(yīng)滑?？刂圃砜驁D
為更有效地控制不同支路的交流伺服驅(qū)動(dòng)電機(jī)及相關(guān)驅(qū)動(dòng)器，為支路搭建相應(yīng)的數(shù)學(xué)模型。表示為：
在單支路控制系統(tǒng)中，滑模變量s為：
可得：
式中：ρ(t)表示集總不確定項(xiàng)。
滑模變量動(dòng)態(tài)方程為：
控制律u表示為：
當(dāng)=0時(shí)可推導(dǎo)出：
將式（31）代入式（28）可得：
綜上，總的控制律為：
3.3 穩(wěn)定性證明
此次設(shè)計(jì)的積分指數(shù)自適應(yīng)滑?？刂疲↖ntegral Exponential Adaptive Sliding Mode Control，IEG-ASMC）分為兩個(gè)階段，即補(bǔ)償與趨近階段。在補(bǔ)償階段，當(dāng)切換增益K小于ψsgn(s)/Γ時(shí)有：
由式（23）和式（34）可得：
因此，|s|非減。根據(jù)式（24）和Γ＞0，有：
由于|s|非減，由式（24）可知(t)將會(huì)補(bǔ)償式（36）右側(cè)的上界，K最終會(huì)于有限時(shí)間t*內(nèi)對(duì)ψsgn(s)/Γ 進(jìn)行補(bǔ)償。任何|s|＞ε皆會(huì)產(chǎn)生最終時(shí)刻t*≥0，因此：
對(duì)于任何t≥t*，如果發(fā)生了ψsgn(s)/Γ 比切換增益K更大的情況，K將會(huì)對(duì)ψsgn(s)/Γ 作進(jìn)一步補(bǔ)償。因此，t*≥0 會(huì)一直存在，滑模變量s符合|s|＞ε要求，(t)仍會(huì)持續(xù)增加，保持一般性，存在κ＞0 和δt＞0，對(duì) 于t≥t*+δt，則有：
補(bǔ)償階段結(jié)束后，系統(tǒng)軌跡進(jìn)入趨近階段。Lyapunov函數(shù)的構(gòu)建公式為：
基于所有t≥t*+δt，有：
式中：在t*+δt和t≥t*+δt間采用積分，以便使|s|于限定時(shí)間內(nèi)向領(lǐng)域|s|≤ε收斂。
4 仿真試驗(yàn)結(jié)果分析
為保證系統(tǒng)轉(zhuǎn)動(dòng)慣量能準(zhǔn)確有效地完成在線識(shí)別，需嚴(yán)格校驗(yàn)IEG-ASMC 算法的準(zhǔn)確性率和有效性。在設(shè)計(jì)和開(kāi)發(fā)串類水果分揀并聯(lián)機(jī)器人時(shí)需要為工作空間設(shè)計(jì)出門字形運(yùn)動(dòng)軌跡，根據(jù)動(dòng)力學(xué)模型分別計(jì)算出在線和非在線識(shí)別到的電機(jī)慣量參數(shù)J與J'，根據(jù)平均值和進(jìn)行自適應(yīng)滑模控制器設(shè)計(jì)。具體過(guò)程如下：分別對(duì)本文提出的IEG-ASMC 方法與文獻(xiàn)［6］中的自適應(yīng)滑模控制（IGASMC）方法、切換增益恒定的滑模控制（SMC）方法在如圖4 給定的期望軌跡下，以J作為電機(jī)慣量參數(shù)、Jˉ為自適應(yīng)滑模控制設(shè)計(jì)參數(shù)進(jìn)行仿真。根據(jù)電機(jī)模型參數(shù)和伺服驅(qū)動(dòng)器設(shè)置公式（25）中參數(shù)為Rph=18Ω，Kpi=15，Kii=1，LD=0.052 5H，KT=1.25N·m/A，aT=0.1，Kpv=0.08，KE=1.215；自適應(yīng)滑?？刂破鲄?shù)為c1=2 500，c2=50，α=0.01，ε=2g(x)KTe，Te=0.001，β=1.5，μ=0.01，γ=1。仿真結(jié)果如圖5 所示?？梢钥闯?，本文方法在保證良 好跟蹤性能的前提下可有效削弱滑?？刂频亩墩駟?wèn)題。
Fig.4 The desired trajectory of the end effector圖4 末端執(zhí)行器位姿各分量期望軌跡
Fig.5 Simulation results圖5 仿真結(jié)果
比較辨識(shí)與不辨識(shí)兩種狀態(tài)下電機(jī)的跟蹤誤差，結(jié)果 見(jiàn)圖6?？梢钥闯?，本文方法有效提高了系統(tǒng)跟蹤精度。
Fig.6 Verification of online identification of load moment圖6 在線辨識(shí)負(fù)載轉(zhuǎn)動(dòng)慣量驗(yàn)證
5 驗(yàn)證實(shí)驗(yàn)
本文采用分布式結(jié)構(gòu)建成串類水果分揀并聯(lián)機(jī)器人控制平臺(tái)。上位機(jī)（Personal Computer，PC）主要負(fù)責(zé)系統(tǒng)初始化、代碼編譯和人機(jī)交互以及狀態(tài)的監(jiān)控等功能；下位機(jī)（Universal Motion and Automation Controller，UMAC）主要負(fù)責(zé)數(shù)據(jù)的整理、數(shù)模之間的轉(zhuǎn)換和運(yùn)動(dòng)控制等指令。PC 與UMAC 通過(guò)以太網(wǎng)（Ethernet）進(jìn)行通訊。所搭建的串類水果分揀并聯(lián)機(jī)器人的整個(gè)程序流程是：在上位機(jī)當(dāng)中編寫相關(guān)程序，整理所需參數(shù)的設(shè)定，將指令發(fā)送給下位機(jī)；下位機(jī)接收指令，并對(duì)數(shù)據(jù)進(jìn)行計(jì)算和處理，利用板卡把指令發(fā)送給驅(qū)動(dòng)系統(tǒng)，串類水果分揀并聯(lián)機(jī)器人的伺服電機(jī)在接收指令后完成相關(guān)運(yùn)動(dòng)；上位機(jī)接收力傳感器檢測(cè)的壓力結(jié)果，整理編碼器采集到的電機(jī)信息；下位機(jī)控制完成后把結(jié)果送回上位機(jī)。
在以往的滑?？刂飘?dāng)中，為了滿足機(jī)器人系統(tǒng)的高性能控制，經(jīng)常設(shè)計(jì)定值增益或無(wú)指數(shù)項(xiàng)的自適應(yīng)律。在選用切換增益的同時(shí)必須滿足其高于不確定性的上邊緣，進(jìn)而可以對(duì)負(fù)載擾動(dòng)實(shí)時(shí)補(bǔ)償，但在生產(chǎn)應(yīng)用中此信息不容易得到，導(dǎo)致機(jī)器人系統(tǒng)的性能不佳。本文設(shè)計(jì)的自適應(yīng)律可以降低系統(tǒng)的不確定性，同時(shí)也能很好抑制抖振。實(shí)驗(yàn)結(jié)果表明，本文方法的電機(jī)最大誤差為1.19 × 10-2rad，其他方法的電機(jī)最大誤差為 3.26 × 10-2rad、1.38 × 10-2rad、1.56 × 10-2rad，誤差均較大。說(shuō)明本文方法能夠克服負(fù)載變化和系統(tǒng)不確定性作用，提高串類水果分揀并聯(lián)機(jī)器人的控制性能。
6 結(jié)語(yǔ)
串類水果分揀并聯(lián)機(jī)器人分揀不同種類的串類水果時(shí)質(zhì)量會(huì)發(fā)生變化，從而導(dǎo)致負(fù)載變化具有不確定性，直接影響單通道系統(tǒng)的轉(zhuǎn)動(dòng)慣量，進(jìn)而影響機(jī)器人系統(tǒng)的控制精度。針對(duì)該問(wèn)題，本文在分析電機(jī)機(jī)械運(yùn)動(dòng)方程的基礎(chǔ)上采用梯度校正參數(shù)辨識(shí)算法，沿著準(zhǔn)則函數(shù)的負(fù)梯度方向不斷進(jìn)行搜索，并修正參數(shù)的估計(jì)值，保障準(zhǔn)則函數(shù)最小化，以此在線辨識(shí)系統(tǒng)轉(zhuǎn)動(dòng)慣量的大小，增強(qiáng)系統(tǒng)對(duì)于負(fù)載擾動(dòng)的魯棒性。為解決其不確定性上界難以獲取的問(wèn)題，基于在線辨識(shí)系統(tǒng)轉(zhuǎn)動(dòng)慣量的支鏈電機(jī)模型，引入滑模控制方法并設(shè)計(jì)積分指數(shù)自適應(yīng)律，使其在近滑模面迅速有效調(diào)整滑模切換增益，提升了系統(tǒng)魯棒性，并抑制了滑模控制抖振，提升了串類水果分揀并聯(lián)機(jī)器人的水果分揀效率。由于串類水果分揀并聯(lián)機(jī)器人存在耦合問(wèn)題，會(huì)在一定程度影響其運(yùn)行效率，后續(xù)可對(duì)該方面進(jìn)行重點(diǎn)研究。
猜你喜歡
中學(xué)生數(shù)理化·中考版(2021年10期)2021-11-22 07:26:40
高師理科學(xué)刊(2020年2期)2020-11-26 06:01:32
四川工商學(xué)院學(xué)術(shù)新視野(2020年2期)2020-08-13 03:18:34
中國(guó)慣性技術(shù)學(xué)報(bào)(2019年6期)2019-03-04 09:50:06
測(cè)控技術(shù)(2018年3期)2018-11-25 09:45:40
中國(guó)環(huán)境監(jiān)察(2016年7期)2016-10-23 05:36:30
通信電源技術(shù)(2016年1期)2016-04-16 04:57:26
通信電源技術(shù)(2016年5期)2016-03-22 01:09:37
振動(dòng)、測(cè)試與診斷(2014年4期)2014-03-01 01:14:01
