CN111300424A - 一种三自由度并联结构运动学系统及其求解方法 - Google Patents
一种三自由度并联结构运动学系统及其求解方法 Download PDFInfo
- Publication number
- CN111300424A CN111300424A CN202010190975.0A CN202010190975A CN111300424A CN 111300424 A CN111300424 A CN 111300424A CN 202010190975 A CN202010190975 A CN 202010190975A CN 111300424 A CN111300424 A CN 111300424A
- Authority
- CN
- China
- Prior art keywords
- degree
- platform
- parallel structure
- freedom parallel
- push rod
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/003—Programme-controlled manipulators having parallel kinematics
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Transmission Devices (AREA)
Abstract
本发明公开了一种三自由度并联结构运动学系统,包括在二自由度并联结构的末端设置推动杆r3,所述推动杆r3为可伸缩杆,所述系统还包括动平台和定平台,建立动坐标系平台o2x2y2,Dongi=[dongxi,dongyi,1],(i=1,2,3),为相对于动平台的三个固定的矢量;建立定平台坐标系o1x1y1,Dingi=[dingxi,dingyi,1],(i=1,2,3),为定平台的3个铰点相对于定平台坐标系的矢量,|g3Ding3|是推动杆,是一变量。本发明提供的三自由度并联结构运动学系统及其求解方法,在二自由度并联结构的基础上增加了第三自由度推杆r3,并通过逆解和正解求解算法进行求得相关参数,为结构设计提供依据,让此机械结构实现理想的运动状态。
Description
技术领域
本发明涉及三自由度并联结构技术领域,特别是涉及一种三自由度并联结 构运动学系统及其求解方法。
背景技术
并联机构可以定义为动平台和定平台通过至少两个独立的运动链相连接, 机构具有两个或两个以上自由度,且以并联方式驱动的一种闭环机构。目前, 现有技术中产品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的伸缩量是变化量,其他参数均为固定值。
已知参数:
本发明还提供了一种三自由度并联结构运动学逆解求解方法,应用于上述 的三自由度并联结构运动学系统,所述方法包括:
第一,根据角度关系得到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)
化简得:
同理求得:
第五,由约束关系②③④可得到:
第七,利用求根公式求得到g3点坐标;
第八,根据两点之间的距离公式求得推动杆的伸缩量r3:
本发明还提供了一种三自由度并联结构运动学正解求解方法,应用于上述 的三自由度并联结构运动学系统,所述方法包括:
所述正解求解方法的正解指已知两个主动臂的摆角α1,α2和推动杆的 伸缩量r3,求解动平台转换坐标T中的变量,具体包括以下步骤:
第一,得到g1和g2点的坐标:
a1=r1cosα1+ding1
b1=r1sinα1
a2=-r2cos(180-α2)+ding2
b2=r2sin(180-α2) (13);
(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;
第七,由约束关系②③④解出θ的值:
第八,根据约束条件①②可解出转换矩阵里面得x和y,(方法同解g3 点的方法,即第二至第五步)
令
pp1=dong1cosθ-a1
pp2=dong1sinθ-b1
pp3=dong3cosθ-a2
pp4=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是现有技术二自由度并联结构的系统结构示意图;
图2是本发明实施例三自由度并联结构运动学系统的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清 楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是 全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造 性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明的目的是提供一种三自由度并联结构运动学系统及其求解方法,在 二自由度并联结构的基础上增加了第三自由度推杆r3,并通过逆解和正解求 解算法进行求得相关参数,为结构设计提供依据,让此机械结构实现理想的运 动状态。
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和 具体实施方式对本发明作进一步详细的说明。
如图1-图2所示,本发明提供的三自由度并联结构运动学系统,包括二自 由度并联结构,在二自由度并联结构的末端设置推动杆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的伸缩量是变化量,其他参数均为固定值。
已知参数:
本发明还提供了一种三自由度并联结构运动学逆解求解方法,应用于上述 的三自由度并联结构运动学系统,所述方法包括:
第一,根据角度关系得到g1和g2坐标表示为:
第二,由约束关系①②得到方程(根据三角函数在90—270角度内的正负 性,可得到第二条主动臂的运动角度为180-α2):
(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)
化简得:
同理求得:
第五,由约束关系②③④可得到:
第七,利用求根公式求得到g3点坐标;
第八,根据两点之间的距离公式求得推动杆的伸缩量r3:
本发明还提供了一种三自由度并联结构运动学正解求解方法,应用于上述 的三自由度并联结构运动学系统,所述方法包括:
所述正解求解方法的正解指已知两个主动臂的摆角α1,α2和推动杆的 伸缩量r3,求解动平台转换坐标T中的变量,具体包括以下步骤:
第一,得到g1和g2点的坐标:
(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;
第七,由约束关系②③④解出θ的值:
第八,根据约束条件①②可解出转换矩阵里面得x和y,(方法同解g3 点的方法,即第二至第五步),
令
pp1=dong1cosθ-a1
pp2=dong1sinθ-b1
pp3=dong3cosθ-a2
pp4=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比较关键,此结 构打破了末端执行器只能在平面平移的束缚,使得其多了一个自由度,从而使 发展空间得到提升。
本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施 例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的 一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变 之处。综上所述,本说明书内容不应理解为对本发明的限制。
Claims (3)
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所述的三自由度并联结构运动学系统,其特征在于,所述方法包括:
第一,根据角度关系得到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)
化简得:
同理求得:
第五,由约束关系②③④可得到:
第七,利用求根公式求得到g3点坐标;
第八,根据两点之间的距离公式求得推动杆的伸缩量r3:
3.一种三自由度并联结构运动学正解求解方法,应用于权利要求1所述的三自由度并联结构运动学系统,其特征在于,所述方法包括:
所述正解的求解方法指已知两个主动臂的摆角α1,α2和推动杆的伸缩量r3,求解动平台转换坐标T中的变量,具体包括以下步骤:
第一,得到g1和g2点的坐标:
a1=r1cosα1+ding1
b1=r1sinα1
a2=-r2cos(180-α2)+ding2
b2=r2sin(180-α2) (13);
(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;
第七,由约束关系②③④解出θ的值:
第八,根据约束条件①②可解出转换矩阵里面得x和y,
令
pp1=dong1cosθ-a1
pp2=dong1sinθ-b1
pp3=dong3cosθ-a2
pp4=dong3sinθ-b2 (21),
设
(1+pp62)x2+(2pp1-2pp5×pp6-2pp2×pp6)x+pp12+pp22+pp52+2pp2×pp6-L12=0(25),
y=pp5-xpp6 (27)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010190975.0A CN111300424A (zh) | 2020-03-18 | 2020-03-18 | 一种三自由度并联结构运动学系统及其求解方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010190975.0A CN111300424A (zh) | 2020-03-18 | 2020-03-18 | 一种三自由度并联结构运动学系统及其求解方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111300424A true CN111300424A (zh) | 2020-06-19 |
Family
ID=71160632
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010190975.0A Pending CN111300424A (zh) | 2020-03-18 | 2020-03-18 | 一种三自由度并联结构运动学系统及其求解方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111300424A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116166052A (zh) * | 2022-12-20 | 2023-05-26 | 奥莱特汽车科技有限公司 | 一种两平动一转动三自由度平台的控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN201275760Y (zh) * | 2008-10-30 | 2009-07-22 | 杜宏图 | 二自由度平面并联机器人机构 |
KR20130042282A (ko) * | 2011-10-18 | 2013-04-26 | 양국진 | 물체 및 공간을 삼차원 모델링을 할 수 있는 시스템을 지닌 병렬형 머니퓰레이터 |
CN104742114A (zh) * | 2013-12-30 | 2015-07-01 | 上海沃迪自动化装备股份有限公司 | 一种带摆动机构的单边两轴并联机器人 |
CN110524513A (zh) * | 2019-08-28 | 2019-12-03 | 勃肯特(镇江)机器人技术有限公司 | 一种两轴并联翻转抓取机器人 |
-
2020
- 2020-03-18 CN CN202010190975.0A patent/CN111300424A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN201275760Y (zh) * | 2008-10-30 | 2009-07-22 | 杜宏图 | 二自由度平面并联机器人机构 |
KR20130042282A (ko) * | 2011-10-18 | 2013-04-26 | 양국진 | 물체 및 공간을 삼차원 모델링을 할 수 있는 시스템을 지닌 병렬형 머니퓰레이터 |
CN104742114A (zh) * | 2013-12-30 | 2015-07-01 | 上海沃迪自动化装备股份有限公司 | 一种带摆动机构的单边两轴并联机器人 |
CN110524513A (zh) * | 2019-08-28 | 2019-12-03 | 勃肯特(镇江)机器人技术有限公司 | 一种两轴并联翻转抓取机器人 |
Non-Patent Citations (2)
Title |
---|
张之仪主编: "《机械化运输设计手册》", 31 May 1997, 北京:机械工业出版社 * |
熊有伦等: "《机器人学 建模、控制与视觉》", 31 March 2018, 华中科技大学出版社 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116166052A (zh) * | 2022-12-20 | 2023-05-26 | 奥莱特汽车科技有限公司 | 一种两平动一转动三自由度平台的控制方法 |
CN116166052B (zh) * | 2022-12-20 | 2023-10-31 | 奥莱特汽车科技有限公司 | 一种两平动一转动三自由度平台的控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108621158B (zh) | 一种关于机械臂的时间最优轨迹规划控制方法及装置 | |
CN113305843A (zh) | 一种机械臂零力控制方法 | |
CN102962838A (zh) | 具有封闭式运动学正解的六自由度并联机构及解析方法 | |
CN110744547B (zh) | 一种基于分段常曲率的连续体机械臂逆运动学建模方法 | |
CN110842913B (zh) | 一种单关节机械臂的自适应滑模迭代学习控制方法 | |
CN108897220B (zh) | 一种自适应稳定平衡控制方法和系统以及双足仿人机器人 | |
CN110253574A (zh) | 一种多任务机械臂位姿检测和误差补偿方法 | |
CN112936287B (zh) | 一种基于动力学迭代学习的柔性机器人控制方法及装置 | |
CN111300424A (zh) | 一种三自由度并联结构运动学系统及其求解方法 | |
CN109434838B (zh) | 线驱动连续机器人内窥操作的协同运动规划方法及系统 | |
CN112276940A (zh) | 一种六自由度非球型手腕机器人逆运动学求解方法 | |
CN111496783A (zh) | 一种6r工业机器人逆运动学求解方法 | |
CN110909438B (zh) | 一种基于动力学模型的轻载关节型并联机器人控制方法 | |
CN114714327A (zh) | 一种机械臂与灵巧手的融合系统及运动控制方法 | |
CN104772755A (zh) | 3-prs并联机构速度优化方法 | |
Zhang et al. | Design optimization of a cable-driven two-DOF joint module with a flexible backbone | |
CN113334381A (zh) | 一种可运动解耦的连续体机器人控制方法 | |
CN106055519B (zh) | 一种Stewart并联机构的奇异性分析方法 | |
Ma et al. | 6R serial manipulator space path planning based on RRT | |
CN114536348B (zh) | 一种高欠驱动空间机械臂运动灵巧性评估方法 | |
CN104589321B (zh) | 带传动式可摆动平行连杆同步伸缩机构 | |
CN116300445A (zh) | 一种汽车电泳涂装输送混联机构的任务空间新型综合误差快速连续滑模控制方法 | |
CN112276945B (zh) | 机器人外部主动重力补偿系统及仿真验证方法 | |
Qu et al. | A new method for isotropic analysis of limited DOF parallel manipulators with terminal constraints | |
CN115383793A (zh) | 一种多段连续体机械臂形态预测方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20200619 |
|
RJ01 | Rejection of invention patent application after publication |