一种 Delta并联机器人及其运动学正反解法

一种 Delta并联机器人及其运动学正反解法

李小辉

佛山市顺德区美的电热电器制造有限公司 广东省佛山市 528311

【摘要】随着人口老龄化问题的日益突出，青壮年比例不断降低，我国一些地方出现了不同程度的用工荒，单纯的依靠传统的劳动力已经适应不了企业和社会发展的需要。基于此，社会和企业对于利用机器人代替人工的渴求越来越强烈，机器人的运动控制复杂，计算量大，基于此本文探讨一种Delta并联机器人的运动学正反解方法。

【关键词】Delta并联机器人；运动学；正反解

【引言】传统的手工作业不仅效率低下，而且难以保证食品的卫生安全性，容易造成质量问题，目前国内在机器人研究方面取得了一定的成绩。随着中国制造2025规划的提出，机器人跟踪作业作为工业自动化、智能化的一个重要方向，将会迎来一个高速的发展时期。

本文设计的Delta并联机器人的空间结构如图1所示，其整体结构主要包括静平台、动平台、主动臂和从动臂这四个主要模块。Delta并联机器人从动臂的两平行杆经过平行度调整，将其等效成一个连杆；而静平台和动平台都经过水平仪调整水平。本文的模型中认为静平台和动平台为水平的平面。其简化的结构模型如图2所示。

静平台

主动臂

从动臂

动平台

图1 Delta并联机器人结构图

在2所示的图中，以静平台的中心为坐标原点建立坐标系。根据右手准则建立如图所示的空间坐标系O-XYZ。其中A_i(i=1,2,3)为Delta并联机器人静平台上第i轴主动臂(A_iB_i)与静平台(A₁A₂A₃)的交点，同理，B_i为第i轴主动臂(A_iB_i)与等效从动臂(B_iC_i)之间的交点，C_i为动平台(C₁C₂C₃)与第i轴等效从动臂(B_iC_i)的交点，η_i为OA_i与X正方向的夹角，δ_i为O´C_i与X正方向的夹角，θ_i为主动臂(A_iB_i)与XY平面(静平台)之间的夹角，β_i为主动臂(A_iB_i)初始位置与XY平面(静平台)之间的夹角。以上所有夹角按照右手定则规定正方向。

图2 Delta并联机器人的简化模型

则由图2，对第i轴所在的传动链，设OA_i的长度为L_oi，A_iB_i的长度为L_ai，B_iC_i的长度为L_bi，O’C_i的长度为L_ci，且设末端O´的位置坐标为(x,y,z)。则根据空间的坐标表达关系可知：

OO´= (3-1)

OA_i= (3-2)

A_iB_i= (3-3)

O´C_i= (3-4)

根据以上向量，分别求解出B_iC_i的向量表达式，如式3-5：

B_iC_i=OC_i-OB_i=(0A_i +A_iB_i)-( OO´+ O´C_i) i=1,2,3 (3-5)

再分别利用3-6所示的等式关系，列出三个等式方程如式3-7，3-8，3-9。

|B_iC_i|=L_bi i=1,2,3 (3-6)

(3-7)

(3-8)

(3-9)

在式子3-7，3-8，3-9中，对于Delta机器人的正解，其各个轴的旋转角度(θ₁，θ₂，θ₃)是已知的，其值可以根据机器人的各个轴的编码值计算得到，而末端位置坐标(x，y，z)则是未知的。联立式3-7，3-8，3-9三个方程式来求解未知数x、y、z，得到x、y、z的解的表达式为：

(3-10)

其中：

同样的，在式子3-7，3-8，3-9中，对于Delta并联机器人的逆解，其末端位置坐标(x，y，z)是已知的，而各个轴的旋转角度θ₁、θ₂、θ₃是未知的。联立3-7，3-8，3-9三

个方程式来求解θ₁、θ₂、θ₃，θ_i的解析式如式3-11所示。

(3-11)

本文的Delta机器人初始加工要求和装配要求为：(η_i，β_i，δ_i，L_oi，L_ai，L_bi，L_ci) = (- 0,0,130,300,570,65)，i=1,2,3。针对上面的正逆解，本文对其进行正逆解的正确性予以判定。表3-2对表3-1得到的3组正解方向求出其对应的逆解。从结果可以看出，3组数据正解和逆解相互吻合。由此可得出，本文的正逆解求解公式是正确的。

表3-1 运动学正解结果

表3-2 运动学逆解结果

【参考文献】

[1] Pierrot F., Nabat V., Company O., et al. Optimal design of a 4-DOF parallel manipulator: From academia to industry[J]. IEEE Transactions on Robotics, 2009, 25(2): 213-224.

[2] Choi H.B., Konno A., Uchiyama M.. Design, implementation, and performance evalua-

tion of a 4-DOF parallel robot[J]. Robotica,2010, 28(1): 107-118.

[3] 艾青林，祖顺江，胥芳．并联机构运动学与奇异性研究进展[J]．浙江大学学报：工学版，2012，46(8)：1345-1359.

[4] 赵杰, 朱延河, 蔡鹤皋. Delta 型并联机器人运动学正解几何解法[J]．哈尔滨工业大学学报，2003，35(1)：25-27.

[5] Rachedi M., Bouri M., Hemici B.. Application of an H∞ control Strategy to the parallel Delta[C]. IEEE International Conference on Communications, Computing and Control Applications. Piscataway,USA: IEEE, 2012.