一種用于物流快遞分揀的2-RPU/2-SPU并聯(lián)機(jī)構(gòu)設(shè)計(jì)

樊文龍，李瑞琴，王春臻，王志浩，劉建國(guó)

一種用于物流快遞分揀的2-RPU/2-SPU并聯(lián)機(jī)構(gòu)設(shè)計(jì)

樊文龍，李瑞琴，王春臻，王志浩，劉建國(guó)

（中北大學(xué) 機(jī)械工程學(xué)院，太原 030051）

針對(duì)目前大量的快遞件需要進(jìn)行分揀和搬運(yùn)，為解決人力成本問題并提高物流線上的自動(dòng)化程度，提出一種2-RPU/2-SPU并聯(lián)機(jī)構(gòu)。用螺旋理論對(duì)此機(jī)構(gòu)進(jìn)行自由度分析，求出此機(jī)構(gòu)的運(yùn)動(dòng)約束。通過閉環(huán)矢量法求出該機(jī)構(gòu)的位置逆解和各個(gè)支鏈間的相互約束條件。通過逆解和約束對(duì)該機(jī)構(gòu)的運(yùn)動(dòng)進(jìn)行仿真，求出此機(jī)構(gòu)的可達(dá)工作范圍。2-RPU/2-SPU并聯(lián)機(jī)構(gòu)具有兩轉(zhuǎn)兩移（2R2T）4個(gè)自由度，分別是沿a軸移動(dòng)，沿a軸移動(dòng)，繞a軸轉(zhuǎn)動(dòng)，繞a軸轉(zhuǎn)動(dòng)，動(dòng)作較靈活，工作空間范圍較大，并且在機(jī)構(gòu)運(yùn)動(dòng)過程中沒有出現(xiàn)奇異位形的情況。2-RPU/2-SPU并聯(lián)機(jī)構(gòu)具有較大的工作范圍，可以在物流線上進(jìn)行分揀工作，并且在分揀過程中可以實(shí)現(xiàn)快速、精準(zhǔn)控制，工作過程較靈活，運(yùn)動(dòng)性能良好，其中2R2T的運(yùn)動(dòng)性能能更好地適應(yīng)分揀機(jī)構(gòu)斜置時(shí)的分揀。

2-RPU/2-SPU；并聯(lián)機(jī)構(gòu)；逆運(yùn)動(dòng)學(xué)；工作空間；物流分揀

隨著社會(huì)的不斷發(fā)展，人們對(duì)購(gòu)物的需求不斷提升，伴隨著購(gòu)物量的上升，物流中心的物品分揀會(huì)消耗大量的人力成本，而自動(dòng)分揀機(jī)器人的出現(xiàn)打破了這個(gè)局面。并聯(lián)機(jī)構(gòu)由于具有動(dòng)態(tài)誤差小、精度高、運(yùn)動(dòng)慣性小、承載能力強(qiáng)等優(yōu)勢(shì)在物流線上有廣泛應(yīng)用。胡建等[1]設(shè)計(jì)了一種2-RPU/UPS并聯(lián)機(jī)構(gòu)用于流水線上的碼垛和搬運(yùn)。米文博等[2]分析了一種用于藥品包裝生產(chǎn)線上的2-UPR/RSPR并聯(lián)機(jī)構(gòu)，具有2R2T運(yùn)動(dòng)模式，所以此機(jī)構(gòu)中需要4個(gè)驅(qū)動(dòng)確保該機(jī)構(gòu)能夠穩(wěn)定的運(yùn)行，通過D-H法求出支鏈的運(yùn)動(dòng)參數(shù)，并求出該并聯(lián)機(jī)構(gòu)的工作空間。

Muralidharan等[3]提出了一種并聯(lián)機(jī)器人的設(shè)計(jì)方法，使并聯(lián)機(jī)器人在給定安全工作區(qū)域內(nèi)動(dòng)態(tài)性能達(dá)到最優(yōu)的尺寸設(shè)計(jì)。Peng等[4]設(shè)計(jì)了一組三自由度并聯(lián)機(jī)構(gòu)的運(yùn)動(dòng)學(xué)和定向能力，分析了Delta機(jī)構(gòu)與等效的3-PRS并聯(lián)機(jī)構(gòu)的運(yùn)動(dòng)學(xué)特性，求出機(jī)構(gòu)與輸出參數(shù)的耦合關(guān)系，并非奇異性。賈竣臣等[5]設(shè)計(jì)了一種2T2R并聯(lián)機(jī)構(gòu)并且求出了其位置逆解和工作空間，用以代替人工操作，從而提高工作效率。Guo等[6]提出了一種基于螺旋理論的4-RRCR并聯(lián)機(jī)構(gòu)，證明了機(jī)構(gòu)擁有正運(yùn)動(dòng)學(xué)簡(jiǎn)單，無平臺(tái)奇異的優(yōu)點(diǎn)。Sangveraphunsiri等[7]提出了一種基于H-4族并聯(lián)機(jī)構(gòu)的混合五自由度機(jī)械臂的設(shè)計(jì)，對(duì)運(yùn)動(dòng)學(xué)、逆運(yùn)動(dòng)學(xué)和動(dòng)力學(xué)模型進(jìn)行了數(shù)值分析。

目前用于分揀的并聯(lián)機(jī)構(gòu)大部分都具有工作空間較小。工作途徑單一，只能實(shí)現(xiàn)極少數(shù)的工作點(diǎn)傳送。其中使用最廣泛的并聯(lián)分揀機(jī)器人是Delta機(jī)器人[8-9]，通過閉環(huán)平行四邊形結(jié)構(gòu)增加力臂，但由于拓?fù)錂C(jī)構(gòu)使得整體結(jié)構(gòu)較為復(fù)雜，驅(qū)動(dòng)角受到的約束較大，由于只有三自由度，限制了其繞著水平線的轉(zhuǎn)動(dòng)，故在裝配分揀時(shí)機(jī)構(gòu)始終垂直于流水線。文中提出2-RPU/2-SPU并聯(lián)機(jī)構(gòu)則會(huì)實(shí)現(xiàn)單對(duì)多的工作點(diǎn)傳輸，極大地提高工作效率，并且此機(jī)構(gòu)具有結(jié)構(gòu)簡(jiǎn)單，受到的約束力少，機(jī)構(gòu)斜置時(shí)也可以正常工作等優(yōu)點(diǎn)，在物品分揀方面可以說是非常適用。

1 2-RPU/2-SPU并聯(lián)機(jī)構(gòu)構(gòu)型以及坐標(biāo)系的建立

2-RPU/2-SPU并聯(lián)機(jī)構(gòu)由1個(gè)靜平臺(tái)、1個(gè)動(dòng)平臺(tái)和4條支鏈（2條RPU支鏈和2條SPU支鏈）組成。支鏈中的R代表轉(zhuǎn)動(dòng)副，P代表移動(dòng)副，U代表萬向鉸，S代表球面副。2條RPU支鏈的R副與靜平臺(tái)相連，U副與動(dòng)平臺(tái)相連，2條SPU支鏈的S副與靜平臺(tái)相連，U副與動(dòng)平臺(tái)相連。靜平臺(tái)和動(dòng)平臺(tái)均為正四邊形，其邊長(zhǎng)分別為、。

建立固連于靜平臺(tái)的靜坐標(biāo)系bbb，其坐標(biāo)原點(diǎn)位于靜平臺(tái)的幾何中心，b軸通過14的中點(diǎn)，與轉(zhuǎn)動(dòng)副的軸線平行，b軸通過13的中點(diǎn)，b軸垂直于靜平臺(tái)豎直向上；建立固連于動(dòng)平臺(tái)上的動(dòng)坐標(biāo)系-aaa，其坐標(biāo)原點(diǎn)位于動(dòng)平臺(tái)的幾何中心，a軸通過14的中點(diǎn)，a軸通過13的中點(diǎn)，a軸垂直于動(dòng)平臺(tái)向外。

2 2-RPU/2-SPU并聯(lián)機(jī)構(gòu)的運(yùn)動(dòng)性能分析

對(duì)桿33求反螺旋，可得：

由此機(jī)構(gòu)的運(yùn)動(dòng)螺旋可知此機(jī)構(gòu)可沿a軸移動(dòng)，沿a軸移動(dòng)，沿a軸方向轉(zhuǎn)動(dòng)，沿a軸方 向轉(zhuǎn)動(dòng)。約束螺旋限制了沿a軸的移動(dòng)和繞a軸的轉(zhuǎn)動(dòng)。

3 基于歐拉角轉(zhuǎn)換和四元數(shù)法求2- RPU/2-SPU并聯(lián)機(jī)構(gòu)的運(yùn)動(dòng)逆解

求并聯(lián)機(jī)構(gòu)的逆解就是根據(jù)動(dòng)平臺(tái)的位置和姿態(tài)來反求出各個(gè)驅(qū)動(dòng)的運(yùn)動(dòng)參數(shù)[10-12]。常用的求逆解

方法有閉環(huán)矢量法和D-H法，當(dāng)驅(qū)動(dòng)加在R副上時(shí)使用D-H法，因本機(jī)構(gòu)的4個(gè)驅(qū)動(dòng)添加在P副上，故只需用閉環(huán)矢量法進(jìn)行分析即可。

靜平臺(tái)上各點(diǎn)的坐標(biāo)表示為：

動(dòng)平臺(tái)上各點(diǎn)的坐標(biāo)表示為：

根據(jù)閉環(huán)矢量法求得各桿在靜坐標(biāo)系下的矢量表達(dá)式為：

設(shè)動(dòng)平臺(tái)參考點(diǎn)的位置矢量為：

通過變換公式求得動(dòng)平臺(tái)上的各點(diǎn)在靜坐標(biāo)系下的矢量為：

四元數(shù)法[14-15]在表達(dá)三維空間的旋轉(zhuǎn)信息時(shí)，具有很好的解釋作用，其表達(dá)式為：

在四元乘法運(yùn)算中，運(yùn)算關(guān)系為：

將并聯(lián)機(jī)構(gòu)轉(zhuǎn)動(dòng)的四元數(shù)轉(zhuǎn)化為規(guī)范化四元數(shù)，即可變?yōu)槭剑?5）所示的矩陣形式。

根據(jù)空間幾何關(guān)系可知：

式中：的表達(dá)式為式（9）。

即可求出如下的對(duì)應(yīng)關(guān)系：

4 2-RPU/2-SPU并聯(lián)機(jī)構(gòu)工作空間分析

可以發(fā)現(xiàn)，此機(jī)構(gòu)的工作范圍比較大，并且工作空間在各個(gè)坐標(biāo)平面上的投影形狀基本對(duì)稱，而且工作空間連續(xù)，沒有空洞，說明此機(jī)構(gòu)能夠在工作空間范圍內(nèi)平穩(wěn)運(yùn)行，無奇異性[16]，運(yùn)動(dòng)性能良好。

5 2-RPU/2-SPU并聯(lián)機(jī)構(gòu)的運(yùn)動(dòng)學(xué)分析

建立2-RPU/2-SPU并聯(lián)機(jī)構(gòu)的虛擬樣機(jī)模型，將建立好的SolidWorks模型轉(zhuǎn)換格式，代入Adams軟件中，設(shè)置其約束及驅(qū)動(dòng)力，將驅(qū)動(dòng)力施加到支鏈的4個(gè)移動(dòng)副中，見圖3。觀察動(dòng)平臺(tái)質(zhì)心運(yùn)動(dòng)參數(shù)的變化規(guī)律，見圖4。

從圖4可以看出，2-RPU/2-SPU并聯(lián)機(jī)構(gòu)動(dòng)平臺(tái)質(zhì)心的位移、速度、加速度曲線變化較平穩(wěn)，無斷點(diǎn)，適用于自動(dòng)分揀裝置。

6 2-RPU/2-SPU自動(dòng)分揀機(jī)構(gòu)

由于快遞物流線上的快遞件大小不同，其在流水線上的擺放規(guī)律更是雜亂無章。針對(duì)適用的快遞物流線上的分揀機(jī)，有精度、速度以及穩(wěn)定性等方面的要求。通過對(duì)2-RPU/2-SPU并聯(lián)機(jī)構(gòu)進(jìn)行分析，可觀察其工作空間較大、控制較靈活、動(dòng)態(tài)性偏差小。由于采用并聯(lián)機(jī)構(gòu)形式，此機(jī)構(gòu)無累積偏差，并且并聯(lián)機(jī)構(gòu)剛度大、結(jié)構(gòu)穩(wěn)定、承載能力大。

圖2 2-RPU/2-SPU并聯(lián)機(jī)構(gòu)的可達(dá)工作空間

圖3 2-RPU/2-SPU并聯(lián)機(jī)構(gòu)的虛擬樣機(jī)

基于2-RPU/2-SPU并聯(lián)機(jī)構(gòu)的自動(dòng)分揀裝置，可配置于快遞物流線上用于物品的分揀。將此機(jī)構(gòu)與視覺傳感技術(shù)相結(jié)合即可實(shí)現(xiàn)流水線上物品的分揀，可以實(shí)現(xiàn)精準(zhǔn)度高、響應(yīng)速度快的分揀，節(jié)約了人工成本。通過SolidWorks建模后，根據(jù)其不受a軸移動(dòng)的約束力，將此機(jī)構(gòu)配置在快遞流水線上，接著對(duì)此機(jī)構(gòu)進(jìn)行仿真處理，仿真過程發(fā)現(xiàn)此機(jī)構(gòu)能夠?qū)⑽锲分糜诜謷鋬?nèi)，見圖5a。

鑒于此機(jī)構(gòu)在水平面內(nèi)沿a軸方向的投影較大，故可實(shí)現(xiàn)單機(jī)構(gòu)對(duì)多條流水線上的同時(shí)分揀，見圖5b。當(dāng)分揀箱垂直于流水線時(shí)，只需要將機(jī)構(gòu)斜置在流水線和分揀箱之間即可實(shí)現(xiàn)抓取與擺放的動(dòng)作，見圖5c。

2-RPU/2-SPU自動(dòng)分揀機(jī)構(gòu)與經(jīng)典的Delta分揀機(jī)構(gòu)相比，當(dāng)Delta分揀機(jī)構(gòu)與2-RPU/2-SPU分揀機(jī)構(gòu)所給定的桿長(zhǎng)參數(shù)相等時(shí)，位移變化曲線平穩(wěn)且范圍較大，速度可調(diào)節(jié)范圍較大，因此，2-RPU/2-SPU自動(dòng)分揀機(jī)構(gòu)更適用于物流線貨物較多，需要快速、精準(zhǔn)分揀的情形。

圖4 動(dòng)平臺(tái)質(zhì)心參數(shù)

1.傳送帶；2.并聯(lián)機(jī)構(gòu)；3.機(jī)架；4.分揀集裝箱；5.分揀貨物；6.機(jī)械爪。

7 結(jié)語(yǔ)

2-RPU/2-SPU并聯(lián)機(jī)構(gòu)具有沿a軸移動(dòng)，沿a軸移動(dòng)，繞a軸轉(zhuǎn)動(dòng)，繞a軸轉(zhuǎn)動(dòng)4個(gè)自由度。利用閉環(huán)矢量法求得該機(jī)構(gòu)的位置逆解及各支鏈間的相互約束關(guān)系。利用極限位置探索法求出該機(jī)構(gòu)的工作空間，通過對(duì)工作空間的分析發(fā)現(xiàn)，工作空間基本呈現(xiàn)對(duì)稱情況，空間性能良好。相較于傳統(tǒng)的并聯(lián)機(jī)構(gòu)分揀機(jī)，此機(jī)構(gòu)具有工作范圍較大，驅(qū)動(dòng)力容易添加等優(yōu)點(diǎn)，只需要給各條支鏈移動(dòng)副添加用移動(dòng)驅(qū)動(dòng)即可達(dá)到各個(gè)位置和姿態(tài)，實(shí)現(xiàn)了貨物大批量的快速、精準(zhǔn)分揀。

[1] 胡健, 宋勝濤, 李瑞琴, 等. 2-RPU/UPS并聯(lián)機(jī)構(gòu)自由度和位置分析[J]. 包裝工程, 2021, 42(7): 214-219.

HU Jian, SONG Sheng-tao, LI Rui-qin, et al. Degree of Freedom and Position Analysis of 2-RPU/UPS Parallel Mechanism[J]. Packaging Engineering, 2021, 42(7): 214-219.

[2] 米文博, 馬春生, 李瑞琴, 等. 應(yīng)用于藥品包裝生產(chǎn)線的2-UPR/RSPR并聯(lián)機(jī)構(gòu)的工作空間分析[J]. 包裝工程, 2021, 42(3): 171-176.

MI Wen-bo, MA Chun-sheng, LI Rui-qin, et al. Workspace Analysis of 2-UPR/RSPR Parallel Mechanism Applied to Pharmaceutical Packaging Production Line[J]. Packaging Engineering, 2021, 42(3): 171-176.

[3] MURALIDHARAN V, BOSE A, CHATRA K, et al. Methods for Dimensional Design of Parallel Manipulators for Optimal Dynamic Performance Over a Given Safe Working Zone[J]. Mechanism and Machine Theory, 2020, 147(C): 1-33.

[4] PENG Bin-bin, ZHU Shuai, KHAJEPOUR A, et al. Kinematics and Orientation Capability of a Family of 3-DOF Parallel Mechanisms[J]. Mechanism and Machine Theory, 2019, 142: 1-20.

[5] 賈竣臣, 薄瑞峰, 郭鑫鑫, 等. 一種2T2R并聯(lián)機(jī)構(gòu)的位置逆解和工作空間分析[J]. 機(jī)械傳動(dòng), 2021, 45(6): 22-27.

JIA Jun-chen, BO Rui-feng, GUO Xin-xin, et al. Inverse Position Solution and Workspace Analysis of a 2T2R Parallel Mechanism[J]. Journal of Mechanical Transmission, 2021, 45(6): 22-27.

[6] GUO Sheng, WANG Cong-zhe, QU Hai-bo, et al. A Novel 4-RRCR Parallel Mechanism Based on Screw Theory and Its Kinematics Analysis[J]. Proceedings of the Institution of Mechanical Engineers, Part C: Journal of Mechanical Engineering Science, 2013, 227(9): 2039-2048.

[7] SANGVERAPHUNSIRI V, CHOOPRASIRD K. Dynamics and Control of a 5-DOF Manipulator Based on an H-4 Parallel Mechanism[J]. The International Journal of Advanced Manufacturing Technology, 2011, 52(1-4): 343-364.

[8] 李家宇, 沈惠平, 孟慶梅, 等. 一種Delta變形機(jī)構(gòu)及其基于工作空間分析的尺度設(shè)計(jì)[J]. 機(jī)械設(shè)計(jì), 2018, 35(7): 92-98.

LI Jia-yu, SHEN Hui-ping, MENG Qing-mei, et al. A Delta-Derived Mechanism and Its Scale Design Based on Working Space Analysis[J]. Journal of Machine Design, 2018, 35(7): 92-98.

[9] 喬文剛, 王磊, 秦天碧. 三自由度Delta機(jī)器人的奇異性分析及空間研究[J]. 機(jī)床與液壓, 2018, 46(9): 61-64.

QIAO Wen-gang, WANG Lei, QIN Tian-bi. Singularity Analysis and Space Research of 3-DOF Delta Robot [J]. Machine Tool & Hydraulics, 2018, 46(9): 61-64.

[10] 石志新, 葉梅燕, 羅玉峰, 等. 3T1R并聯(lián)機(jī)構(gòu)結(jié)構(gòu)設(shè)計(jì)與位置分析[J]. 農(nóng)業(yè)機(jī)械學(xué)報(bào), 2016, 47(8): 364-369.

SHI Zhi-xin, YE Mei-yan, LUO Yu-feng, et al. Structure Design and Displacement Analysis of 3T1R Parallel Mechanism[J]. Transactions of the Chinese Society for Agricultural Machinery, 2016, 47(8): 364-369.

[11] OLARU A, OLARU S, NICULAE M. Proper Assisted Research Method Solving of the Robots Inverse Kinematics Problem[J]. Applied Mechanics and Materials, 2014, 555: 134-146.

[12] FANG Hai-rong, LIU Peng-fei, YANG Hui, et al. Design and Analysis of a Novel 2T2R Parallel Mechanism with the Closed-Loop Limbs[J]. International Journal of Automation and Computing, 2021, 18(4): 654-666.

[13] 黃真, 李艷文, 高峰. 空間運(yùn)動(dòng)構(gòu)件姿態(tài)的歐拉角表示[J]. 燕山大學(xué)學(xué)報(bào), 2002, 26(3): 189-192.

HUANG Zhen, LI Yan-wen, GAO Feng. The Expression of the Orientation of a Spatial Moving Unit by Euler Angle[J]. Journal of Yanshan University, 2002, 26(3): 189-192.

[14] 閆鑫, 馬麗萍, 王曉華, 等. 基于倍四元數(shù)的縫紉機(jī)器人運(yùn)動(dòng)學(xué)分析[J]. 機(jī)械傳動(dòng), 2020, 44(10): 68-73.

YAN Xin, MA Li-ping, WANG Xiao-hua, et al. Kinematics Analysis of Sewing Robot Based on Double Quaternion[J]. Journal of Mechanical Transmission, 2020, 44(10): 68-73.

[15] 趙德勝, 吳榮軍, 張雪. 基于四元數(shù)的6-UPS機(jī)構(gòu)奇異性分析[J]. 機(jī)械傳動(dòng), 2015, 39(2): 72-76.

ZHAO De-sheng, WU Rong-jun, ZHANG Xue. Singularity Analysis of 6-UPS Mechanism Based on Quaternion[J]. Journal of Mechanical Transmission, 2015, 39(2): 72-76.

[16] REZAEI A, AKBARZADEH A. Study on Jacobian, Singularity and Kinematics Sensitivity of the FUM 3-PSP Parallel Manipulator[J]. Mechanism and Machine Theory, 2015, 86: 211-234.

Design of a 2-RPU/2-SPU Parallel Mechanism for Logistics and Express Sorting

FAN Wen-long, LI Rui-qin, WANG Chun-zhen, WANG Zhi-hao, LIU Jian-guo

(School of Mechanical Engineering, North University of China, Taiyuan 030051, China)

The work aims to propose a 2-RPU/2-SPU parallel mechanism to solve the problem of labor cost and improve the degree of automation on the logistics line, in view of the need for sorting and handling of a large number of express items. Firstly, the degree of freedom of 2-RPU/2-SPU mechanism was analyzed with screw theory to obtain the motion constraints of the mechanism. The position inverse solution of the mechanism and the mutual constraints between limbs were obtained with closed-loop vector method. Through inverse solution and constraint, the motion of the mechanism was simulated, and the reachable working range of the mechanism was obtained. The 2-RPU/2-SPU parallel mechanism had four degrees of freedom (2R2T), namely, two rotations alongaandarespectively and two translations alongaandarespectively, which made the mechanism more flexible and had a large range of workspace, and there was no singularity in the process of mechanism motion. The 2-RPU/2-SPU parallel mechanism has large working range. It can perform the sorting work on the logistics line. In addition, it can realize fast and accurate control in the sorting process. It has relatively flexible working process and good motion performance, among which the motion performance of 2R2T can better adapt to the sorting when the sorting mechanism is placed in an incline position.

2-RPU/2-SPU; parallel mechanism; inverse kinematics; workspace; logistics sorting

TB486; TH112

A

1001-3563(2022)07-0178-06

10.19554/j.cnki.1001-3563.2022.07.022

2021-08-03

山西省重點(diǎn)研發(fā)計(jì)劃（201803D421028，201903D421051）

樊文龍（1997—），男，中北大學(xué)碩士生，主攻機(jī)構(gòu)理論與機(jī)器人技術(shù)。

李瑞琴（1964—），女，中北大學(xué)教授，主要研究方向?yàn)闄C(jī)構(gòu)理論與機(jī)器人技術(shù)。

責(zé)任編輯：曾鈺嬋