CN109977433B - 一种曲面约束下机器人线缆建模方法 - Google Patents
一种曲面约束下机器人线缆建模方法 Download PDFInfo
- Publication number
- CN109977433B CN109977433B CN201711445237.0A CN201711445237A CN109977433B CN 109977433 B CN109977433 B CN 109977433B CN 201711445237 A CN201711445237 A CN 201711445237A CN 109977433 B CN109977433 B CN 109977433B
- Authority
- CN
- China
- Prior art keywords
- cable
- robot
- curved surface
- coordinate system
- constraint
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 31
- 238000013178 mathematical model Methods 0.000 claims abstract description 11
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 8
- 230000003068 static effect Effects 0.000 claims abstract description 4
- 230000005484 gravity Effects 0.000 claims description 5
- 238000005452 bending Methods 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 3
- 238000012897 Levenberg–Marquardt algorithm Methods 0.000 claims description 2
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
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
- G06F30/23—Design optimisation, verification or simulation using finite element methods [FEM] or finite difference methods [FDM]
-
- 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/06—Power analysis or power optimisation
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)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明涉及一种曲面约束下机器人线缆建模方法,将操作机器人约束线缆的截面简化成圆截面;对简化后的线缆进行静力学分析,得到线缆非线性力学模型;采用有限差分法进行离散化,得到离散化数学模型;添加操作机器人空间中的线缆曲面约束、定长条件约束和边界条件约束;基于信赖域策略调整的非线性最小二乘算法对约束后的离散化数学模型进行求解,得到包含线所有线缆离散点的欧拉参数和力学特性。本发明根据求解结果验证了该发明的正确性和合理性,利用求解得到的欧拉参数拟合高精度操作机器人线缆的形态,验证了本发明的有效性和正确性,得到了机器人线缆离散点的力学特性,为柔弱高精度操作机器人关节的稳定性分型提供了重要支持。
Description
技术领域
本发明涉及高精度操作机器人技术领域,具体地说是一种曲面约束下机器人线缆建模方法。
背景技术
在多维物理场耦合下,受到机器人有限操作空间的约束,高精度操作电机的动力输出往往比较小,机器人关节一般相比普通机器人关节显得比较柔弱。在超低温等极端环境下,受到安全屏蔽层包覆而显粗重的特殊强力线缆会对柔弱高精度操作机器人关节造成强力非线性干扰。目前,对柔性线缆的力学建模方法仅仅存在于线缆的两端约束下,无法用于高精度操作多维物理场耦合下受空间约束的特殊线缆建模,对柔弱高精度操作机器人关节的稳定性分析有着很大的制约。现有的方法没有涉及到特殊高精度操作机器人线缆与曲面接触时的线缆方法研究。
发明内容
针对现有技术的不足,本发明提供一种曲面约束下机器人线缆建模方法。
本发明为实现上述目的所采用的技术方案是:
一种曲面约束下机器人线缆建模方法,包括以下步骤:
步骤1:将操作机器人约束线缆的截面简化成圆截面;
步骤2:对简化后的操作机器人约束线缆进行静力学分析,得到线缆非线性力学模型;
步骤3:采用有限差分法对线缆非线性力学模型进行离散化,得到离散化数学模型;
步骤4:对离散化数学模型添加操作机器人空间中的线缆曲面约束、定长条件约束和边界条件约束;
步骤5:基于信赖域策略调整的非线性最小二乘算法对约束后的离散化数学模型进行求解,得到包含线所有线缆离散点的欧拉参数和力学特性。
所述线缆非线性力学模型为:
线缆无原始的曲率和扭率,得到线缆的本构关系为:
其中,q1、q2、q3和q4是线缆截面的欧拉参数,它们相对于机器人线缆弧坐标s的导数分别为Q1、Q2、Q3和Q4;A、B分别为机器人线缆截面绕x轴和y轴的抗弯刚度,C为线缆截面绕z轴的抗扭刚度;根据线缆截面为圆截面,得到:其中d为线缆的截面的直径;将线缆理想化为均匀各向同性,其中E、G为线缆的杨氏模量和剪切模量;(Fx,Fy,Fz)是机器人线缆内力F在线缆截面主轴坐标系中的投影;(Mx,My,Mz)表示机器人线缆内力矩M在线缆截面主轴坐标系中的投影;(fx,fy,fz)是机器人线缆分布力f在线缆截面主轴坐标系中的投影,包括线缆的重力分布力fg和接触面对线缆的接触力分布力。
所述线缆曲面约束为:
其中,fsp,i+1是高精度操作机器人线缆的第i+1个离散点与曲面发生的接触分布力;曲面表面方程为(X0,Y0,Z0)是曲面在世界坐标系中圆心坐标,R0是其半径大小,r是在世界坐标系O-XYZ下任意一点的坐标,r=(X,Y,Z);为操作机器人线缆与可能与曲面发生接触的离散点,即第i+1个离散点在世界坐标系中的坐标,当该离散点在曲面上时,有成立。
所述定长条件约束为:
其中,(rX,i,rY,i,rZ,i)和(rX,i+1,rY,i+1,rZ,i+1)是离散点i和离散点i+1的坐标在世界坐标系中坐标值;操作机器人线缆每个离散点在世界坐标系中的坐标通过线缆中心线切线方向矢量积分得到。
所述边界条件约束通过线缆首末两个端点欧拉参数和首末两个端点在世界坐标系下的相对坐标共同约束。
所述线缆首末两个端点欧拉参数为:
其中,(q1,1,q2,1,q3,1,q4,1)是操作机器人线缆的第1个离散点的欧拉参数,(q1,n+1,q2,n+1,q3,n+1,q4,n+1)是操作机器人线缆的第n+1个离散点的欧拉参数;(a1,a2,a3,a4)和(b1,b2,b3,b4)是给定的已知量,满足和
所述首末两个端点在世界坐标系下的相对坐标为:
其中,(rX,n+1,rY,n+1,rZ,n+1)表示操作机器人线缆第n+1个离散点在世界坐标系中的坐标,操作机器人线缆第1个离散点与世界坐标系的原点重合,(rX,rY,rZ)是给出的线缆第n+1个离散点在世界坐标系中的已知坐标。
所述基于信赖域策略调整的非线性最小二乘算法为通过信赖域策略对Levenberg-Marquardt算法的迭代步长因子进行调整。
本发明具有以下有益效果及优点:
1.本发明建立了曲面接触下的高精度操作机器人线缆建模方法,弥补了该方面的技术空白;
2.本发明考虑到线缆的重力分布力、曲面的接触力和线缆与曲面之间的摩擦力,线缆的力学模型更为合理;
3.本发明基于信赖域策略改进的求解算法对上述高精度操作线缆力学模型进行求解,保证了计算过程的全局收敛性和求解精确性。
附图说明
图1为高精度操作机器人线缆的受力分析图;
图2为本发明建模方法得到的高精度操作机器人线缆形态在世界坐标系XOZ平面的投影;
图3为本发明建模方法得到的高精度操作机器人线缆形态在世界坐标系YOZ平面的投影;
图4为本发明建模方法得到的高精度操作机器人线缆形态在世界坐标系XOY平面的投影;
图5为在跟随高精度操作机器人关节运动时线缆的末端点力曲线图。
具体实施方式
下面结合附图及实施例对本发明做进一步的详细说明。
如图1所示为高精度操作机器人线缆的受力分析图。
本发明包括以下步骤:
步骤一:将高精度操作机器人线缆截面简化为圆截面。
包括如下内容:
1.机器人线缆截面为刚性的圆形截面;
2.忽略机器人线缆截面的剪切应变;
3.机器人线缆的长度远大于线缆的直径,同时忽略机器人线缆的直径;
4.机器人线缆的中心线为2阶以上的光滑曲线。
步骤二:高精度操作机器人线缆的起点与世界坐标系的圆心O重合。选取高精度操作机器人线缆中的“微弧段”进行力学分析,“微弧段”处于静力平衡状态。式(1)-式(2)中:基于Kirchhoff力学模型,建立曲面约束下的高精度操作机器人线缆非线性力学模型。(Fx,Fy,Fz)是机器人线缆内力F在线缆截面主轴坐标系中投影,(fx,fy,fz)是机器人线缆分布力f在线缆截面主轴坐标系中投影,包括线缆的重力分布力、曲面对线缆的接触力分布力和曲面与线缆之间的摩擦力分布力。(Mx,My,Mz)表示机器人线缆内力矩M在线缆截面主轴坐标系中投影。q1、q2、q3和q4是线缆截面的欧拉参数,它们相对于线缆弧坐标s的导数分别为Q1、Q2、Q3和Q4。A、B分别为机器人线缆截面绕截面主轴坐标系x轴和y轴的抗弯刚度,C为线缆截面绕截面主轴坐标系z轴的抗扭刚度;根据线缆截面为圆截面,得到:其中d为线缆的截面的直径;将线缆理想化为均匀各向同性,其中E、G为线缆的杨氏模量和剪切模量;
假设线缆无原始的曲率和扭率,得到线缆的本构关系为:
步骤三:基于有限差分法对线缆的力学模型进行离散化,得到离散化数学模型。
步骤四:添加非光滑曲面约束下高精度操作机器人线缆的边界条件、定长条件和曲面条件。
边界条件:式(3)中:给出线缆首末两个端点欧拉参数的具体值。(q1,1,q2,1,q3,1,q4,1)是离散点1的欧拉参数,(q1,n+1,q2,n+1,q3,n+1,q4,n+1)是离散点n+1的欧拉参数。(a1,a2,a3,a4)和(b1,b2,b3,b4)是给定的已知量,满足和
式(4)中:(rX,n+1,rY,n+1,rZ,n+1)表示线缆末端点在世界坐标系中的坐标,(rX,rY,rZ)是给出的线缆末端点已知值。
定长条件:式(5)中:(rX,i,rY,i,rZ,i)和(rX,i+1,rY,i+1,rZ,i+1)是离散点i和离散点i+1的坐标在世界坐标系中坐标值,它们通过线缆中心线切线方向矢量积分得到。
曲面条件:首先添加高精度操作机器人线缆重力分布力、线缆与曲面的接触力分布力和线缆与曲面之间的摩擦力分布力,用以修正式(1)中的高精度操作机器人线缆分布力项。用球面作为特例代表高精度操作机器人线缆与曲面接触的特殊工况。
式(6)中:给出的曲面在世界坐标系中的表面方程。(X0,Y0,Z0)是曲面在世界坐标系中圆心坐标,R0是其半径大小。fsp,i+1是高精度操作机器人线缆的i+1个离散点与曲面发生的接触分布力,是需要求解的未知量。r是在世界坐标系O-XYZ下任意一点的坐标,r=(X,Y,Z);为操作机器人线缆与可能与曲面发生接触的离散点(第i+1个离散点)在世界坐标系中的坐标,当该离散点在曲面上时,有成立;当高精度操作机器人线缆不与曲面发生接触时,有fsp,i+1=0、和接触点处的半径矢量p1和切线矢量p2不垂直。半径矢量p1和切线矢量p2的数量积不为零,有p1·p2≠0;当高精度操作机器人线缆与曲面发生接触时,有fsp,i+1≠0、以及接触点处的半径矢量p1和切线矢量p2垂直。半径矢量p1和切线矢量p2的数量积为零,有p1·p2=0。机器人线缆摩擦力的方向垂直于半径矢量p1和切线矢量p2,由半径矢量p1和切线矢量p2的方向可以确定线缆摩擦力的方向。根据该曲面约束条件,添加约束方程,完善高精度操作机器人线缆非线性力学模型的约束条件。
步骤五:通过基于信赖域策略调整的Levenberg-Marquardt求解算法对上述高精度操作机器人线缆的非线性力学模型进行求解,主要是采用信赖域策略对高精度操作机器人线缆模型的迭代步长因子进行调节,保证算法的全局收敛性,从而得到线缆各个离散点的参数。
步骤六:将线缆的欧拉参数用于拟合线缆的几何形态,使用三次样条曲线拟合线缆形态。而高精度操作机器人线缆的力学特性可以用于分析机器人关节稳定性分析问题。图2是利用基于曲面接触的高精度操作机器人线缆模型的求解结果中的欧拉参数拟合而成的线缆形态在世界坐标系XOZ平面中的投影(单位:mm);图3是利用基于曲面接触的高精度操作机器人线缆模型的求解结果中的欧拉参数拟合而成的线缆形态在世界坐标系YOZ平面中的投影(单位:mm);图4是利用基于曲面接触的高精度操作机器人线缆模型的求解结果中的欧拉参数拟合而成的线缆形态在世界坐标系XOY平面中的投影(单位:mm)。上述求解结果验证了本发明的有效性和正确性。图5是随着高精度操作机器人方位关节运动而俯仰关节不发生运动时,线缆末端点力的理论值,γ是高精度操作机器人方位关节的方位角,(Fx,Fy,Fz)是高精度操作机器人线缆末端点力F在线缆截面主轴坐标系中投影。本发明为高精度操作机器人关节的稳定性分析提供了重要的支撑。
Claims (7)
1.一种曲面约束下机器人线缆建模方法,其特征在于:包括以下步骤:
步骤1:将操作机器人约束线缆的截面简化成圆截面;
步骤2:对简化后的操作机器人约束线缆进行静力学分析,得到线缆非线性力学模型;所述线缆非线性力学模型为:
线缆无原始的曲率和扭率,得到线缆的本构关系为:
其中,q1、q2、q3和q4是线缆截面的欧拉参数,它们相对于机器人线缆弧坐标s的导数分别为Q1、Q2、Q3和Q4;A、B分别为机器人线缆截面绕x轴和y轴的抗弯刚度,C为线缆截面绕z轴的抗扭刚度;根据线缆截面为圆截面,得到:其中d为线缆的截面的直径;将线缆理想化为均匀各向同性,其中E、G为线缆的杨氏模量和剪切模量;(Fx,Fy,Fz)是机器人线缆内力F在线缆截面主轴坐标系中的投影;(Mx,My,Mz)表示机器人线缆内力矩M在线缆截面主轴坐标系中的投影;(fx,fy,fz)是机器人线缆分布力f在线缆截面主轴坐标系中的投影,包括线缆的重力分布力fg和接触面对线缆的接触力分布力;
步骤3:采用有限差分法对线缆非线性力学模型进行离散化,得到离散化数学模型;
步骤4:对离散化数学模型添加操作机器人空间中的线缆曲面约束、定长条件约束和边界条件约束;
步骤5:基于信赖域策略调整的非线性最小二乘算法对约束后的离散化数学模型进行求解,得到包含线所有线缆离散点的欧拉参数和力学特性;
所述基于信赖域策略调整的非线性最小二乘算法为通过信赖域策略对Levenberg-Marquardt算法的迭代步长因子进行调整。
3.根据权利要求1所述的曲面约束下机器人线缆建模方法,其特征在于:所述线缆曲面约束为:
5.根据权利要求1所述的曲面约束下机器人线缆建模方法,其特征在于:所述边界条件约束通过线缆首末两个端点欧拉参数和首末两个端点在世界坐标系下的相对坐标共同约束。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711445237.0A CN109977433B (zh) | 2017-12-27 | 2017-12-27 | 一种曲面约束下机器人线缆建模方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711445237.0A CN109977433B (zh) | 2017-12-27 | 2017-12-27 | 一种曲面约束下机器人线缆建模方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109977433A CN109977433A (zh) | 2019-07-05 |
CN109977433B true CN109977433B (zh) | 2021-07-27 |
Family
ID=67072422
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711445237.0A Active CN109977433B (zh) | 2017-12-27 | 2017-12-27 | 一种曲面约束下机器人线缆建模方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109977433B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111310401B (zh) * | 2020-01-17 | 2022-09-06 | 大连海事大学 | 一种数字化柔性电缆设计方法 |
CN112818481B (zh) * | 2021-01-19 | 2023-11-07 | 中国科学院沈阳自动化研究所 | 弹性平面约束的细长软体机器人的建模与控制方法 |
CN112818482B (zh) * | 2021-01-19 | 2023-07-21 | 中国科学院沈阳自动化研究所 | 弹性光滑曲面约束的细长软体机器人的建模与控制方法 |
CN114562950B (zh) * | 2022-02-28 | 2023-08-15 | 中国船舶科学研究中心 | 一种用于水下协同作业的脐带缆缆形监测系统及装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6144696A (en) * | 1997-12-31 | 2000-11-07 | At&T Corp. | Spread spectrum bit allocation algorithm |
CN101727523A (zh) * | 2009-12-17 | 2010-06-09 | 北京理工大学 | 基于物理特性的活动线缆的建模、运动仿真的方法及装置 |
WO2014110502A1 (en) * | 2013-01-11 | 2014-07-17 | The Regents Of The University Of Michigan | Monitoring proximity of objects at construction jobsites via three-dimensional virtuality in real-time |
CN105492943A (zh) * | 2013-03-06 | 2016-04-13 | Ipg光子公司 | 具有非均匀配置的光纤-光纤棒多模放大器的超大功率单模光纤激光器系统 |
-
2017
- 2017-12-27 CN CN201711445237.0A patent/CN109977433B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6144696A (en) * | 1997-12-31 | 2000-11-07 | At&T Corp. | Spread spectrum bit allocation algorithm |
CN101727523A (zh) * | 2009-12-17 | 2010-06-09 | 北京理工大学 | 基于物理特性的活动线缆的建模、运动仿真的方法及装置 |
WO2014110502A1 (en) * | 2013-01-11 | 2014-07-17 | The Regents Of The University Of Michigan | Monitoring proximity of objects at construction jobsites via three-dimensional virtuality in real-time |
CN105492943A (zh) * | 2013-03-06 | 2016-04-13 | Ipg光子公司 | 具有非均匀配置的光纤-光纤棒多模放大器的超大功率单模光纤激光器系统 |
Non-Patent Citations (3)
Title |
---|
刘检华等.虚拟环境下的活动线缆物理特性建模与运动仿真技术.《机器工程学报》.2011,第47卷(第9期), * |
含空间约束航天器线缆力学建模方法;游斌弟等;《振动与冲击》;20150828;第34卷(第16期);第3.1-3.3节 * |
虚拟环境下的活动线缆物理特性建模与运动仿真技术;刘检华等;《机器工程学报》;20110505;第47卷(第9期);第0-2节 * |
Also Published As
Publication number | Publication date |
---|---|
CN109977433A (zh) | 2019-07-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109977433B (zh) | 一种曲面约束下机器人线缆建模方法 | |
CN109977434B (zh) | 一种卡箍约束下机器人线缆建模方法 | |
CN106406277B (zh) | 机器人运动学参数误差优化补偿方法及装置 | |
Fattah et al. | On the design of cable-suspended planar parallel robots | |
Shafei et al. | Theoretical and experimental study of dynamic load‐carrying capacity for flexible robotic arms in point‐to‐point motion | |
WO2018090323A1 (zh) | 一种坐标系标定方法、系统及装置 | |
Arsenault et al. | Synthesis of planar parallel mechanisms while considering workspace, dexterity, stiffness and singularity avoidance | |
Li et al. | A novel three-loop parallel robot with full mobility: kinematics, singularity, workspace, and dexterity analysis | |
CN104866722B (zh) | 一种七轴工业机械臂的逆运动学求解方法 | |
CN107038275B (zh) | 一种机械臂误差分析方法 | |
CN107160401B (zh) | 一种解决冗余度机械臂关节角偏移问题的方法 | |
CN106844951B (zh) | 基于分段几何法求解超冗余机器人逆运动学的方法及系统 | |
Andersson | Discretization of a continuous curve | |
He et al. | Kinematic calibration of a three degrees-of-freedom parallel manipulator with a laser tracker | |
Wang et al. | A Novel Analytical Inverse Kinematics Method for SSRMS‐Type Space Manipulators Based on the POE Formula and the Paden‐Kahan Subproblem | |
Yuan et al. | Error modeling and accuracy evaluation of parallel manipulators with mixed DoFs based on motion/force transmissibility and constrainability | |
Ni et al. | A trajectory planning approach for Delta robots considering both motion smoothness and dynamic stress | |
Kulakov | Active force-torque robot control without using wrist force-torque sensors | |
CN112818481A (zh) | 弹性平面约束的细长软体机器人的建模与控制方法 | |
Zhao et al. | An approach for computing the transmission index of full mobility planar multiloop mechanisms | |
Xue et al. | The posture optimization method based on deformation index in robotic milling process | |
JP5513146B2 (ja) | ロボットシミュレータ | |
Gu et al. | Theoretical and experimental study on active stiffness control of a two-degrees-of-freedom rope-driven parallel mechanism | |
CN113434982B (zh) | 一种电力智能仿生攀爬机器人的运动学逆解方法 | |
Zhang et al. | High‐Efficiency Dynamic Modeling of a Helical Spring Element Based on the Geometrically Exact Beam Theory |
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 |