一种三自由度并联结构运动学系统及其求解方法技术方案

本发明专利技术公开了一种三自由度并联结构运动学系统，包括在二自由度并联结构的末端设置推动杆r3，所述推动杆r3为可伸缩杆，所述系统还包括动平台和定平台，建立动坐标系平台o2x2y2，Dong

A three degree of freedom parallel structure kinematics system and its solution method

【技术实现步骤摘要】
一种三自由度并联结构运动学系统及其求解方法
本专利技术涉及三自由度并联结构
，特别是涉及一种三自由度并联结构运动学系统及其求解方法。
技术介绍
并联机构可以定义为动平台和定平台通过至少两个独立的运动链相连接，机构具有两个或两个以上自由度，且以并联方式驱动的一种闭环机构。目前，现有技术中产品BKT-TD系列主要用在流水线上对物品进行搬运，其属于二轴并联结构，但其局限性太大，只有水平和垂直两个方向的运动，结构如图1所示。BKT-TD系列是二自由度并联结构，其主动杆和从动杆均是固定值，所以其算法也是相对简单，通过两个主动杆上下摆动带动从动杆运动，从而使运动末端进行相应位移。在其算法中，知道动平台坐标系和静平台坐标系x和y轴各相对距离，即可知逆解。BKT-TD系列可以应用在食品装盒、药盒扫码、装箱生产线等等，其不同型号有不同的规格，TD-800和TD-1200型号规格如图2所示。目前，类似三自由度结构串联机器人应用比较多，串联机器人技术比较成熟，但其精准度不够高，刚度较差，而且不像并联结构那种速度快，所以现在并联结构发展迅速，在未来有着很大潜力。而现有的和本产品相类似的并联结构大多为二自由度，三自由度机械结构比此产品又相对复杂，现有技术的技术方法过于简单，导致其应用范围缩小，市场应用范围减小。本专利技术摆脱这些束缚，而且易改造，在此基础上进行优化改造，还可以衍生出很多新产品，应用范围扩大。其算法也是简单易懂，相比其他产品来说，得到了很大的优化。
技术实现思路
本专利技术的目的是提供一种三自由度并联结构运动学系统及其求解方法，在二自由度并联结构的基础上增加了第三自由度推杆r3，并通过逆解和正解求解算法进行求得相关参数，为结构设计提供依据，让此机械结构实现理想的运动状态。为实现上述目的，本专利技术提供了如下方案：一种三自由度并联结构运动学系统，包括二自由度并联结构，在二自由度并联结构的末端设置推动杆r3，所述推动杆r3为可伸缩杆，所述系统还包括动平台和定平台，建立动坐标系平台o2x2y2，Dongi＝[dongxi,dongyi,1]，(i＝1,2,3)，为相对于动平台的三个固定的矢量；建立定平台坐标系o1x1y1，Dingi＝[dingxi,dingyi,1]，(i＝1,2,3)，为定平台的3个铰点相对于定平台坐标系的矢量，|g3Ding3|是推动杆，是一变量；本系统的的约束条件及已知参数设定如下：约束条件：①|g1TDong1|＝L1②|g2TDong3|＝L2③|g4TDong4|＝L3④⑤r3的伸缩量是变化量，其他参数均为固定值。已知参数：在动平台坐标系下：在定平台坐标系下：本专利技术还提供了一种三自由度并联结构运动学逆解求解方法，应用于上述的三自由度并联结构运动学系统，所述方法包括：所述逆解求解方法的逆解指已知动平台变换矩阵：求解主动臂的两个摆角α1和α2，以及推动杆r3的长度，具体包括以下步骤：第一，根据角度关系得到g1和g2坐标表示为：第二，由约束关系①②得到方程：(dong1cosθ+x-a1)2+(dong1sinθ+y-b1)2＝L12(3)将(1)式中参数代数(2)式得：(dong1cosθ+x-r1cosα1-ding1)2+(dong1sinθ+y-r1sinα1)2＝L12(4)第三，令pa1＝-ding1+dong1cosθ+x(5)pb1＝dong1sinθ+y(6)化简得：第四，设求得：同理求得：第五，由约束关系②③④可得到：第六，g2、g3、g4点围城一个三角形结构，设得到方程组：第七，利用求根公式求得到g3点坐标；第八，根据两点之间的距离公式求得推动杆的伸缩量r3：本专利技术还提供了一种三自由度并联结构运动学正解求解方法，应用于上述的三自由度并联结构运动学系统，所述方法包括：所述正解求解方法的正解指已知两个主动臂的摆角α1，α2和推动杆的伸缩量r3，求解动平台转换坐标T中的变量，具体包括以下步骤：第一，得到g1和g2点的坐标：a1＝r1cosα1+ding1b1＝r1sinα1a2＝-r2cos(180-α2)+ding2b2＝r2sin(180-α2)(13)；第二，根据解出g3点，(a2-a3)2+(b2-b3)3＝r52(ding3-a3)2+(ding4-b3)2＝r32(14)；将(14)式中两方程相减并整理得：a3(2ding3-2a2)+b3(2ding4-2b2)＝r52+ding32+ding42-r32-a22-b22(15)，第三，设第四，将(17)和(18)式代入(14)式中第一个方程中得：(1+p22)a32+(2b2p2-2a2-2p1p2)a3+a22+b22+p12-2b2p1-r52＝0(19)第五，由求根公式可得知a3、b3；第六，同理，由三角形中的约束条件解出g4点；第七，由约束关系②③④解出θ的值：第八，根据约束条件①②可解出转换矩阵里面得x和y，(方法同解g3点的方法，即第二至第五步)令pp1＝dong1cosθ-a1pp2＝dong1sinθ-b1pp3＝dong3cosθ-a2pp4＝dong3sinθ-b2(21)，设(1+pp62)x2+(2pp1-2pp5×pp6-2pp2×pp6)x+pp12+pp22+pp52+2pp2×pp6-L12＝0(25)，y＝pp5-xpp6(27)。根据本专利技术提供的具体实施例，本专利技术公开了以下技术效果：本专利技术提供的三自由度并联结构运动学系统及其求解方法，增加了一个自由度r3，这就使其在很多方面能够发挥优势，不仅能够实现现有技术的特点，还能应用在其他许多方面，例如拧螺丝、掀盖子、自助加油等；此技术在现有技术基础上可以衍生许多其他产品，安装视觉或声等传感器，可以实现不同的功能，应用在诸多领域，如改造成三杆并联视觉拾取机器人，就可以与工厂里三杆并联四自由度视觉机器人相媲美；根据此结构得到其算法，结合其几何约束，我们很容易得到逆解和正解，此算法简单易懂，以最简单的算法解决了运动学问题，从而使控制程序编写上得到便利，其中推动杆r3比较关键，此结构打破了末端执行器只能在平面平移的束缚，使得其多了一个自由度，从而使发展空间得到提升。附图说明为了更清楚地说明本专利技术实施例或现有技术中的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术的一些实施例，对于本领域本文档来自技高网...

【技术保护点】
1.一种三自由度并联结构运动学系统，包括二自由度并联结构，其特征在于：在二自由度并联结构的末端设置推动杆r3，所述推动杆r3为可伸缩杆，所述系统还包括动平台和定平台，建立动坐标系平台o2x2y2，Dong

【技术特征摘要】
1.一种三自由度并联结构运动学系统，包括二自由度并联结构，其特征在于：在二自由度并联结构的末端设置推动杆r3，所述推动杆r3为可伸缩杆，所述系统还包括动平台和定平台，建立动坐标系平台o2x2y2，Dongi＝[dongxi,dongyi,1]，(i＝1,2,3)，为相对于动平台的三个固定的矢量；建立定平台坐标系o1x1y1，Dingi＝[dingxi,dingyi,1]，(i＝1,2,3)，为定平台的3个铰点相对于定平台坐标系的矢量，|g3Ding3|是推动杆，是一变量；
本系统的的约束条件及已知参数设定如下：
约束条件：
①|g1TDong1|＝L1
②|g2TDong3|＝L2
③|g4TDong4|＝L3
④
⑤r3的伸缩量是变化量，其他参数均为固定值。
已知参数：
在动平台坐标系下：



在定平台坐标系下：








2.一种三自由度并联结构运动学逆解求解方法，应用于权利要求1所述的三自由度并联结构运动学系统，其特征在于，所述方法包括：
所述逆解求解方法的逆解指已知动平台变换矩阵：求解主动臂的两个摆角α1和α2，以及推动杆r3的长度，具体包括以下步骤：
第一，根据角度关系得到g1和g2坐标表示为：






第二，由约束关系①②得到方程：
(dong1cosθ+x-a1)2+(dong1sinθ+y-b1)2＝L12(3)
将(1)式中参数代入(3)式得：
(dong1cosθ+x-r1cosα1-ding1)2+(dong1sinθ+y-r1sinα1)2＝L12(4)
第三，令pa1＝-ding1+dong1cosθ+x(5)
pb1＝dong1sinθ+y(6)
化简得：



第四，设求得：



同理求得：



第五，由约束关系②③④可得到：



第六，g2、g3、g4点围城一个三角形结构，设得到方程组：


<...

【专利技术属性】
技术研发人员：吴少华，周万勇，汪杰，单博文，高博文，王兆涵，
申请(专利权)人：北华航天工业学院，
类型：发明
国别省市：河北;13