CN112632768A - 一种欠约束绳牵引并联机构稳定性分析方法 - Google Patents
一种欠约束绳牵引并联机构稳定性分析方法 Download PDFInfo
- Publication number
- CN112632768A CN112632768A CN202011515598.XA CN202011515598A CN112632768A CN 112632768 A CN112632768 A CN 112632768A CN 202011515598 A CN202011515598 A CN 202011515598A CN 112632768 A CN112632768 A CN 112632768A
- Authority
- CN
- China
- Prior art keywords
- rope
- under
- constrained
- stability
- parallel mechanism
- 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.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- 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
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F2119/00—Details relating to the type or aim of the analysis or the optimisation
- G06F2119/14—Force analysis or force optimisation, e.g. static or dynamic forces
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Computer Hardware Design (AREA)
- Evolutionary Computation (AREA)
- Geometry (AREA)
- General Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
一种欠约束绳牵引并联机构稳定性分析方法,属于机构学领域。首先建立欠约束绳牵引并联机构的运动学方程和势能方程;基于最小势能原理,构建欠约束绳牵引并联机构稳定性的Hessian矩阵;联合求解静力几何方程,得到位姿和绳拉力等参数;基于此Hessian矩阵特性,直接推导子矩阵特征值表达式并进行求解,进而判断其是否大于零;对于不稳定情况,根据推导的约束条件,进一步提出了改进欠约束绳牵引并联结构稳定性的两种措施。能够快速有效地在机构设计初期判断约束绳牵引并联机构的稳定性,保证末端执行器在受到外界扰动后能保持原有平衡状态。
Description
技术领域
本发明属于机构学领域,尤其是涉及解决柔性并联机器人实用化过程中稳定性问题的一种欠约束绳牵引并联机构稳定性分析方法。
背景技术
绳牵引并联支撑系统(wire/cable-driven parallel suspension system,WDPSS)是基于并联机器人技术的一种新型机构,具有可伸缩性,通过传动机构调整绳索的长度很容易实现较大的工作空间,同时具有结构简单、成本低、响应速度快、动态性好等优点,非常适用于机械加工、装卸运载、航空航天等领域,已成为近年来研究的热点。
绳牵引并联支撑系统可根据绳索数量m和自由度数量n之间的关系特点,将绳牵引并联支撑分为可实现受迫运动的冗余约束支撑(m≥n+1),以及可实现受迫+自由运动的欠约束支撑(m<n+1)。其中,当m=n时,绳牵引并联支撑系统依靠重力保持绳索张紧,将重力看作附加绳索,也属于完全约束类。
与发展较为成熟的冗余/完全约束绳牵引并联技术相比,欠约束并联机构约束不足、刚度低,以及运动几何与静力学存在耦合等因素限制了它的应用,所以其相关方面的研究相对较少。但约束的减少也意味着欠约束绳牵引并联机构具有高度的灵巧性与自适应性,即末端执行器上的外力矩的变化会引起末端执行器位姿的变化,从而使末端执行器重新达到静力平衡状态。在高灵巧性和自适应性的特性下,稳定性作为反映该机构回到平衡位置的难易程度的特性需要更加深入的研究(稳定性越高,机构越容易回到原来的平衡位置或保持原来的平衡状态),在设计机构的初始阶段能通过已知参数简易地对机构的稳定性进行判断对设计机构具有重要作用。
目前,在欠约束绳牵引并联机构的稳定性判断方面,虽然已有文献涉及Hessian矩阵、势能最小原理、静平衡工作空间等方面,如:国外,博罗尼亚大学的Marco Carricato近年来指出欠约束问题难点在于运动学和静力学(动力学)之间是本质上耦合的,动平台的姿态可能会受到外部干扰而改变,研究平衡稳定性是非常必要的,同时也给出利用既约Hessian矩阵来判断稳定性的方法(M.Carricato and J-P.Merlet,Stability Analysisof Underconstrained Cable-Driven Parallel Robots,IEEE Transaction onRobotics,2013,29(1):288-296.7);Surdilovic D.提出一种力学方法的动态建模和分析欠约束绳牵引并联机构的平衡稳定性研究,也运用既约Hessian矩阵来分析机构的稳定性(Surdilovic D.,Radojicic J.Practical stability of under-constrained cable-suspended parallel robots.Cable-Driven Parallel Robots,2019:85-98);国内,刘欣基于末端执行器的静力平衡方程推导并得出Hessian矩阵,得出欠约束绳牵引并联机构的静刚度,但并未用于其稳定性的判断(刘欣,仇原鹰.绳牵引并联机器人的静刚度解析.机械工程学报,2011,47(13),35-43);刘鹏从绳牵引并联机构末端执行器的位置和最小约束的索拉为两个方面分析摄像机器人的稳定性,提出力位混合的稳定性因子,在位置性能因子和索力性能因子的基础上,把两者对末端执行器运动的稳定性进行加权综合,反映末端执行器运动的稳定性(刘鹏.柔索牵引并联机器人力学分析及稳定性评价.西安电子科技大学,2014)。但以上研究中Hessian矩阵表达式或不够完整,或使用既约Hessian矩阵进行判断稳定性,或采用斜坡角度定义稳定性度等过程较为复杂,因此亟需一种快速简易判断稳定性的方法。
针对绳牵引并联机构在风洞试验支撑系统、移动装载平台等应用情况下,不仅需要综合考虑系统稳定性,还要能够结合实际物理意义直观有效的判断。因此,本发明作为一种快速有效用于工程指导的稳定性分析方法,对欠约束绳牵引并联机构在设计过程中判断及改善稳定性具有重要意义。
发明内容
本发明的目的是为了克服现有技术存在的上述不足,提供可用来解决绳牵引并联机构现有稳定性判断方法过程复杂等问题的一种欠约束绳牵引并联机构稳定性分析方法。
本发明包括以下步骤:
1)建立欠约束绳牵引并联机构的运动学方程和势能方程,建立不同坐标系向量转换关系;
2)基于最小势能原理,构建欠约束绳牵引并联机构稳定性的Hessian矩阵;
3)联合求解静力几何方程,得到位姿和绳拉力等参数;
4)基于此Hessian矩阵特性,推导子矩阵特征值表达式并进行求解,进而判断其是否大于零;
5)对于不稳定情况,根据推导的约束条件,进一步提出改进欠约束绳牵引并联结构稳定性措施。
在步骤2)中,所述构建欠约束绳牵引并联机构稳定性的Hessian矩阵具体步骤如下:
H=H1+H2
其中,H1和H2分别为:
式中,I为3阶单位阵,ui为第i根绳的方向矢量,ri为第i根绳末端执行器质心到绳索连接点在静坐标系下的矢量,ui×、ri×分别为ui、ri的反对称矩阵,Ti为第i根绳的实时拉力,li为第i根绳由末端执行器到定滑轮铰点的绳长,km绳的实时刚度,m表示绳索数量,()T表示矩阵的转置,为求和公式。
在步骤4)中,所述子矩阵特征值表达式如下:
式中,ui为第i根绳的方向矢量,ri为第i根绳末端执行器质心到绳索连接点在静坐标系下的矢量,ui×、ri×分别为ui、ri的反对称矩阵,li为第i根绳由末端执行器连接点到定滑轮铰点的绳长,m表示绳索数量,·表示两个向量之间的点乘。
在步骤5)中,所述对于不稳定情况,根据推导的约束条件,进一步提出改进欠约束绳牵引并联结构稳定性措施具体方法可为:提出改进稳定性的措施,使得ui和ri夹角αi小于90度,或调整Li/Ai小于1,ui与ri夹角处于两者之间,的策略体现在第i根绳ui与ri的夹角αi,如下式:
式中,ui为第i根绳的方向矢量,ri为第i根绳末端执行器质心到绳索连接点在静坐标系下的矢量,αi为第i根绳ui与ri的夹角,本方法提出的优化策略在于减小ui和ri夹角,使其小于90度,或调整Li/Ai小于1,其中Ai为第i根绳ri的模,Li为第i根绳的长度,arccos()为反三角函数,ui和ri夹角处于上述两者之间。
与现有技术相比,本发明具有以下优点:
本发明可解决柔性并联机器人实用化过程中稳定性问题,本发明不仅综合考虑系统稳定性,还能够结合实际物理意义直观有效的判断,是一种快速有效用于工程指导的稳定性分析方法,对欠约束绳牵引并联机构在设计过程中判断及改善稳定性具有重要意义。
附图说明
图1为一种典型的四绳牵引六自由度欠约束并联机构。
图2为一种绳牵引并联机构传统运动学模型。
图3为稳定性分析判断流程图。
具体实施方式
以下实施例将结合附图对本发明作进一步说明。
图1给出一种典型的四绳牵引六自由度欠约束并联机构。图2给出一种绳牵引并联机构传统运动学模型。图3给出稳定性分析判断流程图。本发明首先建立欠约束绳牵引并联机构的运动学方程和势能方程,建立不同坐标系向量转换关系;基于最小势能原理,构建欠约束绳牵引并联机构稳定性的Hessian矩阵;联合求解静力几何方程,得到位姿和绳拉力等参数;基于此Hessian矩阵特性,直接推导子矩阵特征值表达式并进行求解,进而判断其是否大于零;对于不稳定情况,根据推导的约束条件,进一步提出改进欠约束绳牵引并联结构稳定性的两种措施。具体步骤如下:
1、建立欠约束绳牵引并联机构的运动学方程,建立不同坐标系向量转换关系。根据欠约束绳牵引并联机构的重力势能和弹性势能表达式,表达式如下:
运动学方程:Li=Bi-XP-ri
机构势能表达式:式中,Li为第i根绳的矢量表达式,Bi为第i根绳定滑轮铰点在静坐标系下的位置向量,XP为末端执行器质心在静坐标系下的位置向量,ri为第i根绳末端执行器质心到绳索连接点在静坐标系下的矢量;U为机构能量变化,X为飞机的位移姿态角变化矩阵,W为动平台模型所受外部载荷,l为绳索向量,T为绳系拉力矢量,()T表示矩阵的转置,·表示两个向量之间的点乘。
2、基于最小势能原理,即对机构势能表达式二阶偏导可得表征欠约束绳牵引并联机构稳定性的Hessian矩阵,表达式如下所示:
H=H1+H2
其中,H1和H2分别为:
式中,I为3阶单位阵,ui为第i根绳的方向矢量,ri为第i根绳末端执行器质心到绳索连接点在静坐标系下的矢量,ui×、ri×分别为ui、ri的反对称矩阵,Ti为第i根绳的实时拉力,li为第i根绳由末端执行器连接点到定滑轮铰点的绳长,km为绳索的实时刚度,m表示绳索数量,()T表示矩阵的转置,为求和公式。
3、联合运动学方程与静力平衡方程,即可得到位姿和绳拉力等参数。静力平衡方程如下所示:
JTT+W=0
式中,J为系统结构Jacobian矩阵,T为绳系拉力矢量,()T表示矩阵的转置,W为动平台模型所受外部载荷。此外,由于绳索只能受拉而不能受压的特性,T中的每一个元素应当满足以下约束:
Tmax>Ti>Tmin,i=1,2,...,m.
其中,Tmax和Tmin分别为绳拉力的最大值和最小值。
4、求得子矩阵特征值表达式如下:
子矩阵特征值:式中,ui为第i根绳的方向矢量,ri为第i根绳末端执行器质心到绳索连接点在静坐标系下的矢量,ui×、ri×分别为ui、ri的反对称矩阵,li为第i根绳由末端执行器连接点到定滑轮铰点的绳长,为求和公式,其中m为绳索的数量,·表示两个向量之间的点乘。
本发明的上述方法中,提高稳定性的策略体现在下式:
式中ui为第i根绳的方向矢量,ri为第i根绳末端执行器质心到绳索连接点在静坐标系下的矢量,αi为第i根绳ui与ri的夹角,本方法提出的优化策略在于减小ui和ri夹角,使其小于90度,或调整Li/Ai小于1,其中Ai是ri的模,Li为第i根绳的长度,arccos()为反余弦函数,ui和ri夹角处于上述两者之间。
以四绳牵引为例,采用本稳定性判断方法实例的结果如表1所示。表1中质心坐标是末端执行器质心在静坐标系中的坐标,角度是末端执行器的姿态角分别为滚转角、俯仰角、偏航角,子矩阵特征值是按照步骤4)中的表达形式进行求解,最后通过结果来判断是否稳定。
表1 一般构型下稳定性判定
表1中质心坐标与姿态角是根据欠约束绳牵引并联机构运动学逆解所得,第三组为不稳定情况,其四根绳索ui和ri夹角分别为81.2°、92.5°、83.2°、105.5°。根据步骤5)提出的改善稳定性的方法,改变ui和ri,使第2根和第4根夹角小于90°,可以改善该情况下机构的稳定性。
Claims (4)
1.一种欠约束绳牵引并联机构稳定性分析方法,其特征在于包括以下步骤:
1)建立欠约束绳牵引并联机构的运动学方程和势能方程,建立不同坐标系向量转换关系;
2)基于最小势能原理,构建欠约束绳牵引并联机构稳定性的Hessian矩阵;
3)联合求解静力几何方程,得到位姿和绳拉力参数;
4)基于此Hessian矩阵特性,推导子矩阵特征值表达式并进行求解,进而判断其是否大于零;
5)对于不稳定情况,根据推导的约束条件,进一步提出改进欠约束绳牵引并联结构稳定性措施。
4.如权利要求1所述一种欠约束绳牵引并联机构稳定性分析方法,其特征在于在步骤5)中,所述对于不稳定情况,根据推导的约束条件,进一步提出改进欠约束绳牵引并联结构稳定性措施具体方法为:提出改进稳定性的措施,使得ui和ri夹角αi小于90度,或调整Li/Ai小于1,ui与ri夹角处于两者之间,的策略体现在第i根绳ui与ri的夹角αi,如下式:
式中,ui为第i根绳的方向矢量,ri为第i根绳末端执行器质心到绳索连接点在静坐标系下的矢量,αi为第i根绳ui与ri的夹角,提出的优化策略在于减小ui和ri夹角,使其小于90度,或调整Li/Ai小于1,其中Ai为第i根绳ri的模,Li为第i根绳的长度,arccos()为反三角函数,ui和ri夹角处于上述两者之间。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011515598.XA CN112632768B (zh) | 2020-12-21 | 2020-12-21 | 一种欠约束绳牵引并联机构稳定性分析方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011515598.XA CN112632768B (zh) | 2020-12-21 | 2020-12-21 | 一种欠约束绳牵引并联机构稳定性分析方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112632768A true CN112632768A (zh) | 2021-04-09 |
CN112632768B CN112632768B (zh) | 2022-05-03 |
Family
ID=75318011
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011515598.XA Active CN112632768B (zh) | 2020-12-21 | 2020-12-21 | 一种欠约束绳牵引并联机构稳定性分析方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112632768B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113624400A (zh) * | 2021-08-20 | 2021-11-09 | 哈尔滨工业大学 | 一种应用于大空间绳驱装配过程中物体质心的测量方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105974797A (zh) * | 2016-07-01 | 2016-09-28 | 厦门大学 | 考虑弹性影响与补偿的绳牵引并联机器人运动控制方法 |
CN107813342A (zh) * | 2017-10-31 | 2018-03-20 | 西安科技大学 | 一种绳牵引并联机器人三位一体结构稳定性评价方法 |
CN110948481A (zh) * | 2019-11-05 | 2020-04-03 | 佛山科学技术学院 | 基于位姿索力刚度的绳牵引并联机器人的稳定性评价方法 |
-
2020
- 2020-12-21 CN CN202011515598.XA patent/CN112632768B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105974797A (zh) * | 2016-07-01 | 2016-09-28 | 厦门大学 | 考虑弹性影响与补偿的绳牵引并联机器人运动控制方法 |
CN107813342A (zh) * | 2017-10-31 | 2018-03-20 | 西安科技大学 | 一种绳牵引并联机器人三位一体结构稳定性评价方法 |
CN110948481A (zh) * | 2019-11-05 | 2020-04-03 | 佛山科学技术学院 | 基于位姿索力刚度的绳牵引并联机器人的稳定性评价方法 |
Non-Patent Citations (1)
Title |
---|
PENG LIU,HONGWEI MA: ""On the Stability for a Cable-driven Parallel Robot While Considering the Cable Sag Effects"", 《 2016 13TH INTERNATIONAL CONFERENCE ON UBIQUITOUS ROBOTS AND AMBIENT INTELLIGENCE》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113624400A (zh) * | 2021-08-20 | 2021-11-09 | 哈尔滨工业大学 | 一种应用于大空间绳驱装配过程中物体质心的测量方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112632768B (zh) | 2022-05-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Pott et al. | Cable-driven parallel robots | |
CN110076775B (zh) | 一种绳驱动连续型机械臂的三维静力学建模方法 | |
Kurazume et al. | A new index of serial-link manipulator performance combining dynamic manipulability and manipulating force ellipsoids | |
CN105974797A (zh) | 考虑弹性影响与补偿的绳牵引并联机器人运动控制方法 | |
Horoub et al. | Workspace analysis of a Gough-Stewart type cable marine platform subjected to harmonic water waves | |
CN112632768B (zh) | 一种欠约束绳牵引并联机构稳定性分析方法 | |
Wang et al. | Design and analysis of a configuration-based lengthwise morphing structure | |
Zhang et al. | Workspace analysis and optimal design of a translational cable-driven parallel robot with passive springs | |
CN110549340A (zh) | 重载码垛机器人频响特性分析方法及系统 | |
Wu et al. | A comparison study of two planar 2-DOF parallel mechanisms: one with 2-RRR and the other with 3-RRR structures | |
Nasr et al. | Multi-criteria design of 6-dof fully-constrained cable driven redundant parallel manipulator | |
Björkenstam et al. | Enhancing digital human motion planning of assembly tasks through dynamics and optimal control | |
Zhou et al. | Multi-objective optimal design of a cable-driven parallel robot based on an adaptive adjustment inertia weight particle swarm optimization algorithm | |
Li et al. | Prescribed flexible orientation workspace and performance comparison of non-redundant 3-DOF planar parallel mechanisms | |
CN114654450A (zh) | 柔性并联微动机构尺度参数优化设计方法、系统及机构 | |
CN116968057A (zh) | 一种并联绳驱平衡控制系统 | |
CN109571484B (zh) | 一种用于自组装任务的空间机械臂柔顺装配控制方法 | |
Handojo et al. | Cable driven parallel robot with big interference-free workspace | |
CN117234078A (zh) | 基于滑模控制的张拉整体无人机滚动控制方法 | |
Khodadadi et al. | Kinematic analysis of planar cable-driven robots with parallelogram links | |
Nagai et al. | Development of parallel manipulator" NINJA" with ultra-high-acceleration | |
CN115096496A (zh) | 一种采用索驱机构进行空间六维力解耦测量的方法 | |
Ma et al. | Optimal design of a parallel assembling robot with large payload-to-mass ratio | |
Nguyen | Gravity compensation of articulated robots using spring four-bar mechanisms | |
Jin et al. | Zero-free-length elastic system for gravity compensation of parallel mechanisms with Delta and Delta-like architectures |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |