李峰平　張正亞　周斯加

溫州大學(xué)浙江省激光加工機器人重點實驗室，溫州，325035

修邊機器人的夾緊機構(gòu)優(yōu)化設(shè)計及運動分析

李峰平張正亞周斯加

溫州大學(xué)浙江省激光加工機器人重點實驗室，溫州，325035

摘要：針對修邊機器人夾緊機構(gòu)的優(yōu)化設(shè)計開展研究。通過分析夾緊機構(gòu)的機構(gòu)組成原理，建立了以夾緊機構(gòu)工作半徑最大化為優(yōu)化目標(biāo)，以各轉(zhuǎn)動副位置、支撐底座質(zhì)量、極限位置、工作半徑范圍、壓桿運動穩(wěn)定性和驅(qū)動桿推程為約束條件的機構(gòu)優(yōu)化設(shè)計數(shù)學(xué)模型。模型驗證實驗中，以夾持直徑d=40 cm的圓形塑料制品為例，得到了壓桿位移、壓桿與驅(qū)動桿速率比隨驅(qū)動桿位移變化的曲線，并對驅(qū)動桿的運動速度曲線進行了規(guī)劃。仿真結(jié)果顯示，優(yōu)化及運動分析結(jié)果滿足設(shè)計要求，從而為修邊機器人的優(yōu)化設(shè)計與自動控制提供了設(shè)計參考。

關(guān)鍵詞：修邊機器人；夾緊機構(gòu)；優(yōu)化設(shè)計；運動分析

0引言

目前，絕大多數(shù)注塑制品企業(yè)塑料制品的修邊工序仍采用人工手動修邊的方式，該種作業(yè)方式人工勞動量大，生產(chǎn)效率低下。本課題組設(shè)計的一種塑料制品自動修邊機器人[1]，不僅適用于日常使用的大多數(shù)圓形塑料制品的修邊，而且對提高塑料制品生產(chǎn)企業(yè)的生產(chǎn)效率，降低工人勞動強度具有重要的現(xiàn)實意義。其中，機械結(jié)構(gòu)中夾緊機構(gòu)的優(yōu)化設(shè)計是修邊機器人設(shè)計的重要一環(huán)，也是本文研究的重點。文獻[2-5]指出，通過對機構(gòu)功能要求作出分析，建立優(yōu)化設(shè)計模型，優(yōu)化設(shè)計的結(jié)果將直接影響機構(gòu)設(shè)計的關(guān)鍵性能指標(biāo)?；诖?，本文針對修邊機器人的夾緊機構(gòu)的優(yōu)化設(shè)計展開研究。

1夾緊機構(gòu)的機構(gòu)組成原理

圖1　修邊機器人夾緊機構(gòu)工作原理

修邊機器人夾緊機構(gòu)工作原理如圖1所示。其中，運動控制卡作為控制核心單元，夾緊機構(gòu)作為末端執(zhí)行單元，整個機電系統(tǒng)實現(xiàn)閉環(huán)控制。為實現(xiàn)高精度的伺服控制和運動規(guī)劃，本文以夾緊機構(gòu)工作半徑最大化為設(shè)計目標(biāo)，通過運動仿真實驗,分析得到最終的優(yōu)化結(jié)果。修邊機器人的夾緊機構(gòu)工作原理如圖2所示。夾緊機構(gòu)三搖桿底端與支撐底座均通過鉸鏈連接，頂端與壓桿通過移動副連接，連桿的兩端分別與支撐頂座及搖臂連接。三搖臂的運動規(guī)律完全一樣，故取其中一個搖臂為研究對象，作出其運動簡圖，見圖3，圖中，OF=l1，DE=l2，DC=l3，EF=l4，EG=l5，F(xiàn)G=l6。

1.壓桿頭　2.導(dǎo)塊　3.壓桿　4.支撐底座　5.工作臺6.支撐頂座　7.連桿　8.搖臂　9.驅(qū)動桿圖2　修邊機器人夾緊機構(gòu)

圖3　夾緊機構(gòu)單個搖臂運動簡圖

1.1確定設(shè)計變量，建立目標(biāo)函數(shù)

修邊機器人夾緊機構(gòu)是一單自由度六桿機構(gòu)，優(yōu)化設(shè)計變量為夾緊機構(gòu)的各桿的尺寸參數(shù)li(i=1,2,…,6)，即

X=(l1,l2,…,l6)

(1)

為盡可能地適用于更大直徑的圓形塑料制品的修邊，拓展修邊機的適用范圍，故要求優(yōu)化后夾緊機構(gòu)最大工作半徑RB越大越好，即定義修邊機器人夾緊機構(gòu)優(yōu)化設(shè)計的目標(biāo)函數(shù)為

F(X)=RB(X)

(2)

1.2確定約束條件

應(yīng)用機械原理等相關(guān)知識對機構(gòu)的約束進行分析。

(1)搖臂各轉(zhuǎn)動副位置約束。由圖3可知，l4、l5、l6構(gòu)成三角形且長度依次增大，并且所構(gòu)成的三角形不能太窄，需要在E處留出鉸孔位置。故有約束條件：

(3)

(4)

(2)支撐頂座質(zhì)量約束。由于整個機構(gòu)由小功率伺服電機驅(qū)動，所以支撐頂座不宜太重，即設(shè)計l3較l1小。但同時要求RB不受l3制約，故設(shè)計l2與l3之和大于l1，有約束條件：

(5)

(3)極限位置約束。如圖4所示，當(dāng)壓桿處于極限位置A○處時，夾緊機構(gòu)最小工作半徑一定大于l1，所以有約束條件：

(6)

(7)

圖4　極限位置簡圖

此時可以得到夾緊機構(gòu)工作的最小工作半徑RA為

(8)

(9)

當(dāng)壓桿處于極限位置B○處時，根據(jù)圖4所示位置幾何關(guān)系，有

(10)

根據(jù)圖3和圖4，可分別得到導(dǎo)塊垂直移動距離H0和驅(qū)動桿推程xh的解析式：

(11)

此時可以得到夾緊機構(gòu)工作的最大工作半徑RB，進一步得到夾緊機構(gòu)工作行程L：

(12)

(4)工作半徑范圍約束。日常所使用的圓形塑料制品夾持直徑一般在30～50 cm(本文所述夾持直徑指的是壓頭與圓形塑料制品接觸點所在高度處塑料制品的直徑)。塑料制品受力后有彈性壓縮量，考慮到被修邊塑料制品的夾持直徑為最小時也能被有效地夾緊定位，故要求夾緊機構(gòu)的最小工作半徑不大于14.5 cm，同時被修邊塑料制品的夾持直徑為最大時也能被放入夾緊區(qū)域，故要求夾緊機構(gòu)的最大工作半徑大于25 cm，即

(13)

(5)壓桿運動穩(wěn)定性約束。若導(dǎo)塊垂直移動距離H0太大，則可能造成壓桿在移動過程中翻轉(zhuǎn)而導(dǎo)致壓桿卡死，導(dǎo)塊垂直移動距離H0越小，壓桿的水平運動越平穩(wěn)。為保證壓桿運動的平穩(wěn)，導(dǎo)塊垂直移動距離H0應(yīng)盡量小，有：

g10(l)=H0-5 cm≤0

(14)

(6)驅(qū)動桿推程約束。本文采用的驅(qū)動模塊由伺服電機、絲杠、移動滑塊等組成(文獻[1]采用的是氣缸驅(qū)動)，可實現(xiàn)機構(gòu)動作的精細控制。由于驅(qū)動模塊垂直安裝于夾緊機構(gòu)下方，驅(qū)動桿推程xh過大會導(dǎo)致修邊機器人的體積增大，整體結(jié)構(gòu)不夠緊湊，故限定驅(qū)動桿推程xh的上限值，有：

g11(l)=xh-5 cm≤0

(15)

2夾緊機構(gòu)優(yōu)化設(shè)計數(shù)學(xué)模型的建立

在最優(yōu)化設(shè)計的問題中，建立正確的數(shù)學(xué)模型尤為重要。由于F(X)恒大于零，故求解目標(biāo)函數(shù)F(X)最大值可轉(zhuǎn)化為求解-F(X)的最小值。綜上所述，建立夾緊機構(gòu)非線性約束最優(yōu)問題的數(shù)學(xué)模型[6-7]:

min(-F(X))s.t. gi(l)<0 i=1,2,…,11 X∈Ω}

(16)

其中，Ω為可行域空間，由變量l1,l2,…,l6的范圍區(qū)間組成，各變量上下限值在表1中列出。

表1　優(yōu)化后的結(jié)果　cm

本文采用MATLAB優(yōu)化函數(shù)庫提供的求解有約束的多維非線性規(guī)劃問題函數(shù)fimincon求解未知向量X。根據(jù)實際經(jīng)驗和相應(yīng)的預(yù)計算，最終選定初始設(shè)計向量X0=(7.0000 cm,5.0000 cm,4.0000 cm,11.0000 cm,25.0000 cm,35.0000 cm)，線性約束條件和非線性約束條件上文均已給出。編輯完程序后運行求解，經(jīng)過6次迭代后優(yōu)化求解結(jié)束。迭代過程中夾緊機構(gòu)最大工作半徑RB值的變化曲線如圖5所示。從表1中的優(yōu)化結(jié)果可以看出，RB值最大時l1、l6的取值均達到上限值。優(yōu)化組RB值較初始設(shè)計組增長了8.90%，所得的優(yōu)化結(jié)果能夠更好地滿足夾緊機構(gòu)的工作要求。

圖5　迭代過程曲線

3夾緊機構(gòu)運動學(xué)實例分析

3.1驅(qū)動桿與壓桿之間位移關(guān)系

(17)

圖6　收緊過程運動簡圖

由式(17)易推出

(18)

采用表1中優(yōu)化后的各桿長度數(shù)據(jù)，代入式(17)、式(18)，得出壓桿位移yl隨驅(qū)動桿位移xh變化的曲線，如圖7所示?？梢钥闯?，當(dāng)驅(qū)動桿行程為0～3.4350 cm時，壓桿收緊位移量小于驅(qū)動桿的位移量，壓桿收緊位移量增幅緩慢。當(dāng)驅(qū)動桿行程大于3.4350 cm時，壓桿收緊位移量大于驅(qū)動桿的位移量，壓桿收緊位移量迅速增大。

圖7　驅(qū)動桿與壓桿位移關(guān)系曲線

3.2驅(qū)動桿速度規(guī)劃

當(dāng)圓形塑料制品夾持直徑較小時，壓桿收縮壓緊過程的位移yl較大，為提高修邊機器人的工作效率，需對驅(qū)動桿的速度進行規(guī)劃以保證壓桿收縮壓緊過程的時間適當(dāng)。以夾持直徑d=40 cm的圓形塑料制品為例，對驅(qū)動桿速度曲線進行規(guī)劃。由圖8所示的驅(qū)動桿與壓桿速率比值隨驅(qū)動桿運動位移變化曲線可以看出，當(dāng)驅(qū)動桿位移小于4.5386 cm時，壓桿與驅(qū)動桿速率比值增幅緩慢，而當(dāng)驅(qū)動桿位移大于4.5386 cm時壓桿與驅(qū)動桿速率比值增幅迅速增大。所以，當(dāng)圓形塑料制品產(chǎn)品的夾持直徑較小時，驅(qū)動桿規(guī)劃速度應(yīng)該先大后小。

圖8　驅(qū)動桿與壓桿速率比隨驅(qū)動桿運動位移變化圖

為使壓桿接觸到圓形塑料制品時的沖擊力較小，限制壓桿的接觸速度為1 cm/s左右。另外，壓桿頭裝有壓力傳感器，可實現(xiàn)壓緊力的閉環(huán)控制[8]，實現(xiàn)對加工對象圓形塑料制品產(chǎn)品的雙重保護。

由式(18)可求出驅(qū)動桿行程xh=f-1(RB-d/2)=4.5386 cm，根據(jù)圖8所示的速率比值曲線，可知f′(xh=4.5386)=5.4777，也即驅(qū)動桿運動到位移4.5386 cm處時，壓桿運動速率約為驅(qū)動桿運動速率的5.5倍，故驅(qū)動桿的末速度大小設(shè)計為0.2 cm/s。依此，對驅(qū)動桿速度vin規(guī)劃的曲線如圖9所示。

圖9　驅(qū)動桿速度規(guī)劃曲線

壓桿跟隨速度vout隨時間變化曲線如圖10所示，從圖10中可以看出，壓桿的接觸速度約為1.1cm/s，達到了設(shè)計要求。

圖10　壓桿跟隨速度曲線

4結(jié)語

本文對修邊機器人夾緊機構(gòu)的優(yōu)化設(shè)計進行了研究，建立了該機構(gòu)優(yōu)化設(shè)計的數(shù)學(xué)模型。以設(shè)計的夾持直徑在30～50cm的圓形零件夾緊機構(gòu)為例，分析并得到了壓桿位移、兩桿速率比隨驅(qū)動桿位移變化的曲線圖，并據(jù)此以夾持直徑d=40cm的圓形塑料制品修邊為例，對驅(qū)動桿的輸入速度進行了規(guī)劃，所得的壓桿輸出速度很好地滿足了夾持機構(gòu)壓桿的運動設(shè)計要求。仿真分析結(jié)果表明，本文所建立的修邊機器人夾緊機構(gòu)優(yōu)化設(shè)計模型是可行的，優(yōu)化結(jié)果是有效的，其優(yōu)化設(shè)計方法對修邊機器人的設(shè)計具有一定的參考價值，具有較好的現(xiàn)實意義。

參考文獻：

[1]張正亞,李峰平,陳雨豪,等.一種自動定位塑料盆修邊機:中國,201520175322.X[P].2015-02-26.

[2]李燁健,孫宇,胡峰峰.多桿高速機械壓力機機構(gòu)優(yōu)化設(shè)計[J].中國機械工程,2015, 26(1): 31-36.

Li Yejian, Sun Yu, Hu Fengfeng. Optimization Design for Multi-linkage of High-speed Mechanical Press[J].China Mechanical Engineering, 2015, 26(1): 31-36.

[3]馬世平.基于MATLAB的六連桿打緯機構(gòu)優(yōu)化設(shè)計及仿真[J].紡織學(xué)報, 2006, 27(3): 40-42.

Ma Shiping.Optimal Design and Simulation on 6-link Beating Construction Base on MATLAB[J]. Journal of Textile Research, 2006, 27(3): 40-42.

[4]羅中華,楊雨.揉面機四桿機構(gòu)的優(yōu)化設(shè)計[J].機械設(shè)計,2013,30(6):44-47.

Luo Zhonghua, Yang Yu. Optimization Design for Four-link Mechanism of Dough Mixer[J]. Journal of Machine Design, 2013, 30(6): 44-47.

[5]宋清玉,李 建,殷文齊.基于多目標(biāo)的機械壓力機六連桿機構(gòu)設(shè)計[J].農(nóng)業(yè)機械學(xué)報,2012,43(4): 225-229.

Song Qingyu, Li Jian, Yin Wenqi. Mechanical Press Six-link Mechanism Design Based on Multi-objective[J].Transactions of the Chinese Society for Agricultural Machinery, 2012,43(4): 225-229.

[6]蔣錚.垃圾轉(zhuǎn)運設(shè)備翻轉(zhuǎn)機構(gòu)仿真及優(yōu)化[D].揚州:揚州大學(xué),2014.

[7]楊春峰,張盛,李云鵬，等. 機械壓力機六連桿機構(gòu)優(yōu)化設(shè)計[J].大連理工大學(xué)學(xué)報,2013,53(1): 64-70.

Yang Chunfeng, Zhang Sheng, Li Yunpeng, et al. Optimization Design for Six-bar Linkage of Mechanical Press[J].Journal of Dalian University of Technology,2013,53(1): 64-70.

[8]陳奇福,吳敏,安劍奇.模糊PID控制在高爐爐頂壓力控制系統(tǒng)中的應(yīng)用[J].冶金自動化,2010,33(3): 152-158.

Chen Qifu, Wu Min, An Jianqi. Application of a Hybrid fuzzy-PID Scheme to Top Pressure Control of Blast Furnace[J].Metallurgical Industry Automation, 2010, 33(3): 152-158.

(編輯蘇衛(wèi)國)

Optimized Design and Kinematic Analysis of Clamping Mechanism for Trimming Robot

Li FengpingZhang ZhengyaZhou Sijia

Zhejiang Provincial Key Laboratory of Laser Processing Robot,Wenzhou University,Wenzhou,Zhejiang,325035

Abstract：The optimum design of clamping mechanism for a trimming robot was conducted herein.The optimized design model of clamping mechanism was established by analyzing its composition principles, maximizing its working radius as the optimization target and considering the position of each revolute pair, weight of support base, extreme positions, range of working radius, kinematic stability of pressure rod, stroke of drive rod as the constraints. In the model validation experiments, a round plastic product with clamping diameter of 40 cm was choosed as the processed sample, the results of kinematic analysis of clamping mechanism show the curves of the displacement change of pressure rod, the ratio change between the pressure rod speed and driving rod speed caused by the displacement changes of drive rod. Finally, the velocity curve of driving rod was planned. Simulation experiments indicate that the results of optimization and kinematic analysis meet the design requirements, and this paper provides an important reference value to the optimized design and automatic control of trimming robot.

Key words:trimming robot;clamping mechanism; optimized design; kinematic analysis

收稿日期：2015-09-24

基金項目：國家國際科技合作專項(0S2012ZR0038)；國家自然科學(xué)基金資助項目 (71101112)

中圖分類號：TH112

DOI：10.3969/j.issn.1004-132X.2016.03.019

作者簡介：李峰平，男，1978年生。溫州大學(xué)機電工程學(xué)院副教授。主要研究方向為制造系統(tǒng)與自動化工程。張正亞，男，1988年生。溫州大學(xué)機電工程學(xué)院碩士研究生。周斯加，男，1981年生。溫州大學(xué)機電工程學(xué)院講師、博士。