CN109015658B - 一种用于捕获翻滚目标的空间双臂机器人控制方法 - Google Patents
一种用于捕获翻滚目标的空间双臂机器人控制方法 Download PDFInfo
- Publication number
- CN109015658B CN109015658B CN201811099190.1A CN201811099190A CN109015658B CN 109015658 B CN109015658 B CN 109015658B CN 201811099190 A CN201811099190 A CN 201811099190A CN 109015658 B CN109015658 B CN 109015658B
- Authority
- CN
- China
- Prior art keywords
- target
- space
- arm robot
- force
- double
- 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
- 238000005096 rolling process Methods 0.000 title claims abstract description 46
- 238000000034 method Methods 0.000 title claims abstract description 40
- 239000011159 matrix material Substances 0.000 claims description 47
- 239000013598 vector Substances 0.000 claims description 42
- 230000001133 acceleration Effects 0.000 claims description 33
- 238000013016 damping Methods 0.000 claims description 16
- 230000007613 environmental effect Effects 0.000 claims description 10
- 230000008569 process Effects 0.000 claims description 9
- 230000009466 transformation Effects 0.000 claims description 4
- 238000006243 chemical reaction Methods 0.000 claims description 2
- 230000002238 attenuated effect Effects 0.000 abstract 1
- 238000000418 atomic force spectrum Methods 0.000 description 6
- 230000003068 static effect Effects 0.000 description 6
- 230000000694 effects Effects 0.000 description 5
- 238000013507 mapping Methods 0.000 description 4
- 230000006340 racemization Effects 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 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
- 230000007246 mechanism Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000006399 behavior Effects 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000007667 floating Methods 0.000 description 1
- 239000012530 fluid Substances 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
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/1679—Programme controls characterised by the tasks executed
- B25J9/1682—Dual arm manipulator; Coordination of several manipulators
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明实施例提供了一种用于捕获翻滚目标的空间双臂机器人控制方法,包括:获得空间双臂机器人动力学模型及摩擦接触模型;依据所述空间双臂机器人动力学模型及摩擦接触模型,获得空间双臂机器人协调操作***的统一动力学模型;依据所述空间双臂机器人协调操作***的统一动力学模型,获得空间双臂机器人捕获翻滚目标的控制器。根据本发明实施例提供的技术方案,可实现夹紧翻滚目标的同时完成其角速度的有效衰减,保证对目标期望运动的稳定跟踪及双臂末端与目标之间的柔顺性,从而实现空间双臂机器人稳定可靠捕获的翻滚目标。
Description
【技术领域】
本发明涉及空间机器人柔顺控制技术,尤其涉及一种用于捕获翻滚目标的空间双臂机器人控制方法。
【背景技术】
目前,近地轨道中故障和失效卫星的数量逐渐增加,为了最大限度的降低损失,各国正在积极研究以卫星维护、轨道垃圾处理为目的的在轨捕获技术。在利用空间双臂机器人完成翻滚目标在轨捕获任务时,最重要的阶段之一是接触碰撞阶段。捕获过程中,末端执行机构不可避免的会与待捕获目标发生接触碰撞甚至激振等行为,不利于捕获操作任务稳定可靠的进行,严重时甚至可能损坏机器人或捕获机构。同时,为防止目标逃逸,空间双臂机器人需要输出必要的操作力,以抑制末端与目标之间的相对运动,实现对目标的可靠抓捕。如何将空间双臂机器人末端与目标之间的接触力控制在期望范围内,对保证捕获过程平稳安全、提高目标捕获成功率具有十分重要的意义。
现有目标捕获过程的空间机器人柔顺控制算法,一般适用于静态目标的抓捕,要求目标与空间机器人之间保持相对静止,以实现抓捕点跟踪,其控制器设计难度较低。考虑在空间摄动力的作用下,自由漂浮状态下的目标旋转速度通常可以达到6°/s,而对于携带推进***的目标来说,在控制***失效的情况下,其旋转速度可能在短期内增加到几十甚至上百°/s。此时,若仍采用静态目标抓捕的算法,为实现抓捕点的快速跟踪,空间机器人可能存在跟踪困难,或跟踪运动幅度过大导致***失稳、碰撞风险加大等问题。因此现有算法并不适用翻滚目标的抓捕。
【发明内容】
有鉴于此,本发明实施例提供了一种用于捕获翻滚目标的空间双臂机器人控制方法,通过控制末端接触力在夹紧翻滚目标的同时完成其角速度的有效衰减,以实现空间双臂机器人稳定可靠捕获翻滚目标。
本发明实施例提供了一种用于捕获翻滚目标的空间双臂机器人控制方法,包括:
获得空间双臂机器人动力学方程及摩擦接触方程;
依据所述空间双臂机器人动力学方程及摩擦接触方程,获得空间双臂机器人协调操作***的统一动力学方程;
依据所述空间双臂机器人协调操作***的统一动力学方程,获得空间双臂机器人捕获翻滚目标的控制器。
上述方法中,所述依据所述空间双臂机器人动力学方程及摩擦接触方程,获得空间双臂机器人协调操作***的统一动力学方程为:
利用如下空间双臂机器人末端与目标接触表面的力约束关系公式,获得空间双臂机器人末端输出力Fe:
Fe=Fext+Fi
其中,目标的外力矢量Fext,用以平衡目标的动力学Fo及作用于目标的外界环境力Fenv,目标的内力矢量Fi,用以提供夹紧内力。
上述方法中,利用如下翻滚目标动力学方程公式:
依据上式,并采用零空间理论,获得目标的外力矢量Fext及目标的内力矢量Fi:
其中,E12为12×12单位阵。
上述方法中,所述依据所述空间双臂机器人协调操作***的统一动力学方程,获得空间双臂机器人捕获翻滚目标的控制器,包括:
获得目标操作空间阻抗控制方程:
采用混合控制理论,获得空间双臂机器人笛卡尔空间混合阻抗控制方程:
其中,He为空间双臂机器人末端期望惯量,Be为空间双臂机器人末端期望阻尼,Ke为空间双臂机器人末端期望刚度,Kif为空间双臂机器人内力控制增益,cXoed、和表示空间双臂机器人末端与目标之间的期望相对运动位姿、期望相对运动速度和期望相对运动加速度,cXoe、和表示空间双臂机器人末端与目标之间的实际相对运动位姿、实际相对运动速度和实际相对运动加速度,Fid为期望内力,{C}为接触坐标系,S为阻抗控制模式选择矩阵,为力控制模式选择矩阵;
其中,Rs为接触坐标系与惯性系的转换矩阵;
依据空间双臂机器人捕获翻滚目标的多空间混合阻抗控制器和空间双臂机器人协调操作***的统一动力学方程,获得空间双臂机器人广义驱动力F:
由以上技术方案可以看出,本发明实施例具有以下有益效果:
本发明实施例的技术方案中,依据空间双臂机器人动力学方程及摩擦接触方程,获得空间双臂机器人协调操作***的统一动力学方程,进而依据统一动力学方程,获得空间双臂机器人捕获翻滚目标的控制器,通过控制机器人末端输出力,在夹紧翻滚目标的同时完成其角速度的有效衰减,保证对目标期望运动的稳定跟踪及双臂末端与目标之间的柔顺性,从而实现空间双臂机器人稳定可靠的捕获翻滚目标。
【附图说明】
为了更清楚地说明本发明实施例的技术方案,下面将对实施例中所需要使用的附图作简单的介绍,显而易见的,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性和劳动性的前提下,还可以根据这些附图获得其它附图。
图1是本发明实施例所提供的用于捕获翻滚目标的空间双臂机器人控制方法的流程示意图;
图2是本发明实施例所提供的空间双臂机器人运动学模型示意图;
图3是利用本发明实施例所提供的方法对初始旋转速度ω0=0°/s的目标进行控制的多空间混合阻抗控制曲线图;
图4是利用本发明实施例所提供的方法对初始旋转速度ω0=5°/s的目标进行控制的多空间混合阻抗控制曲线图;
图5是利用本发明实施例所提供的方法对初始旋转速度ω0=20°/s的目标进行控制的多空间混合阻抗控制曲线图。
【具体实施方式】
为了更好的理解本发明的技术方案,下面结合附图对本发明实施例进行详细描述。
应当明确,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
本发明实施例给出一种用于捕获翻滚目标的空间双臂机器人控制方法,请参考图1,其本发明实施例所提供的用于捕获翻滚目标的空间双臂机器人控制方法的流程示意图,如图1所示,该方法包括以下步骤:
步骤101,获得空间双臂机器人动力学方程及摩擦接触方程。
具体的,首先,获得空间双臂机器人动力学方程。
针对带耦合分支的空间双臂机器人,获得如下运动学方程,用以描述空间双臂机器人末端运动与关节运动的映射关系:
其中,为空间双臂机器人末端速度矢量,分别为左臂和右臂末端速度矢量,为关节角速度矢量,J为空间双臂机器人雅克比矩阵,Jl=[Jl1 Jl2]、Jr=[Jr1 Jr3]分别为与左臂、右臂运动相关的雅克比矩阵。
利用拉格朗日方程,获得如下空间双臂机器人关节空间动力学方程,用以描述空间双臂机器人关节运动与关节驱动力矩的映射关系:
将运动学方程(1)微分后代入关节空间动力学方程(2)中,获得如下空间双臂机器人操作空间动力学方程,用以描述空间双臂机器人末端运动与广义驱动力的映射关系:
然后,获得摩擦接触方程。
考虑空间双臂机器人与翻滚目标的接触情况,获得机械臂末端输出力:
Fe=Fn+Ff (4)
其中,Fn为法向正压力,Ff为切向摩擦力。
采用弹簧-阻尼模型,获得接触情况中的法向正压力Fn:
采用LuGre模型,获得接触情况中的切向摩擦力Ff:
其中,σ0为接触表面的刚度系数,σ1为阻尼系数,σ2为粘性阻尼系数,z为接触表面的形变量,为接触表面的形变率,v为末端与目标表面的相对速度,||Ff||为切向摩擦力Ff的模值,Ff的方向为相对运动方向的反方向。
其中
g(v)=Fc+(Fs-Fc)exp(-|v/vs|2)
g(v)为库仑摩擦和Stribeck(粘滞力)效应,Fc、Fs分别为接触面之间的库伦摩擦力及粘滞力,vs为***的Stribeck速度。
当接触摩擦为干摩擦时,反映流体的内摩擦力的粘滞力Fs=0,vs=0,σ2=0,有g(v)=Fc,获得接触表面的形变率为:
获得接触情况中的切向摩擦力Ff为:
步骤102,依据所述空间双臂机器人动力学方程及摩擦接触方程,获得空间双臂机器人协调操作***的统一动力学方程。
具体的,考虑翻滚目标捕获过程中目标的动态特性,准确建立空间双臂机器人末端与目标接触表面的运动约束关系及力约束关系,代入空间双臂机器人动力学方程及摩擦接触方程中,获得空间双臂机器人协调操作***的统一动力学方程,用以描述空间双臂机器人广义驱动力与目标运动、目标外力矢量、目标内力矢量之间的映射关系。
首先,获得空间双臂机器人末端与目标接触表面的运动约束关系。
根据翻滚目标捕获过程中目标的动态特性,获得如下空间双臂机器人末端与目标接触表面的速度约束方程:
其中,
ωo为惯性系下翻滚目标质心角速度矢量,OPOA、OPOB分别为翻滚目标质心系下目标质心到左右臂末端位置矢量,对任意向量r=[x,y,z],其反对称矩阵S(r)为
将速度约束方程(10)两边对时间进行求导,获得如下空间双臂机器人末端与目标接触表面的加速度约束方程:
其中,
αo为惯性系下翻滚目标质心角加速度矢量。
然后,获得空间双臂机器人末端与目标接触表面的力约束关系。
利用如下翻滚目标动力学方程公式:
其中,Mo为目标惯性矩阵,Co为科氏力/离心力系数矩阵,Fo为目标所受合外力,Fenv为目标所受外界环境力,Jo和Jp分别为空间双臂机器人抓持矩阵和外界环境力接触矩阵。
其中,
其中,mo、Io分别为目标质量和目标惯性张量,Jol、Jor分别为空间双臂机器人左右臂抓持矩阵,IPOA、IPOB、IPOP分别为惯性系下目标质心到左右臂末端及环境接触点的位置矢量。
依据翻滚目标动力学方程公式(12),并采用零空间理论,获得空间双臂机器人末端输出力Fe:
其中,Fext目标的外力矢量,用以平衡目标的动力学Fo及作用于目标的外界环境力Fenv,Fi目标的内力矢量,用以提供夹紧内力;表示抓持矩阵的零空间矩阵,因此无论内力作用与否,目标的运动都不受影响,从而实现空间双臂机器人协调操作***的内力、外力分解。
最后,依据空间双臂机器人末端与目标接触表面的运动约束关系和力约束关系,代入空间双臂机器人动力学方程中,获得空间双臂机器人协调操作***的统一动力学方程。
将空间双臂机器人末端与目标接触表面的运动约束关系(11)和力约束关系(13),代入空间双臂机器人操作空间动力学方程(3)中,获得空间双臂机器人协调操作***的统一动力学方程:
步骤103,依据所述空间双臂机器人协调操作***的统一动力学模型,获得空间双臂机器人捕获翻滚目标的控制器。
具体的,将目标操作空间阻抗作为控制外环,获得目标运动及环境作用力间的阻抗关系;将空间双臂机器人笛卡尔空间混合阻抗作为控制内环,获得接触表面相对运动及目标内力间的阻抗关系;结合目标操作空间阻抗控制器和空间双臂机器人笛卡尔空间混合阻抗控制器,获得空间双臂机器人捕获翻滚目标的控制器。
本发明实施例中,依据所述空间双臂机器人协调操作***的统一动力学模型,获得空间双臂机器人捕获翻滚目标的控制器,包括:
1)获得目标操作空间阻抗控制方程。
目标的阻抗方程为:
考虑环境作用力难以直接获得,将翻滚目标动力学方程(12)代入目标阻抗方程(15)中,获得:
由式(16)可获得目标操作空间阻抗控制器的控制输入为:
2)获得空间双臂机器人笛卡尔空间混合阻抗控制方程。
采用混合控制理论,将任务空间分解成阻抗控制子空间和力控制子空间。在阻抗控制子空间对空间双臂机器人***位置-力之间的阻抗关系进行调整,在力控制子空间则进行期望的力跟踪。空间双臂机器人笛卡尔空间混合阻抗控制方程为:
其中,He为空间双臂机器人末端期望惯量,Be为空间双臂机器人末端期望阻尼,Ke为空间双臂机器人末端期望刚度,Kif为空间双臂机器人内力控制增益,cXoed、和表示空间双臂机器人末端与目标之间的期望相对运动位姿、期望相对运动速度和期望相对运动加速度,cXoe、和表示空间双臂机器人末端与目标之间的实际相对运动位姿、实际相对运动速度和实际相对运动加速度,Fid为期望内力,{C}为接触坐标系,S为阻抗控制模式选择矩阵,为力控制模式选择矩阵。
式(18)中控制子空间的选取通过调整选择矩阵S和实现:当S对应元素为1时,在接触坐标系{C}的对应方向上采用阻抗控制模式,当对应元素为1时,在对应方向上采用力控制模式。特别的,由于可操作维度的限制,某些方向不进行任何控制,S和对应元素均为0。
当不考虑外界环境干扰的情况下,根据式(12)和式(13)获得期望摩擦力Ffd为:
其中,期望摩擦力Ffd=[Ffld Ffrd]T,Ffld为左臂期望摩擦力,Ffrd为右臂期望摩擦力,摩擦矩阵Jof=[S(IPOA)S(IPOB)]T,惯性矩阵MI=Io,科氏力/离心力系数矩阵CI=-S(Ioωo),αod为惯性系下翻滚目标质心期望角加速度矢量,ωod为惯性系下翻滚目标质心期望角速度矢量。
对式(8)经Laplace变换可计算获得变形量z,代入式(9),可获得接触情况中的切向摩擦力Ff:
||Ff||=(Fc-σ1|v|)exp(-σ0|x|/Fc)+σ1v (20)
由式(19)和式(20)可得期望运动vd为:
将式(21)代入式(18)中,即可实现通过摩擦力的换算,建立期望相对运动与期望目标运动、期望法向正压力间的关系。
由式(18)可获得空间双臂机器人笛卡尔空间混合阻抗控制器的控制输入为:
其中,Rs为接触坐标系与惯性系的转换矩阵。
3)获得空间双臂机器人捕获翻滚目标的多空间混合阻抗控制器。
依据所述目标操作空间阻抗控制方程及空间双臂机器人笛卡尔空间混合阻抗控制方程,代入加速度约束方程(11)中,获得空间双臂机器人捕获翻滚目标的多空间混合阻抗控制器的控制输入为:
上式(23)代入空间双臂机器人操作空间动力学方程中,即可获得空间双臂机器人关节驱动力矩。
依据本发明实施例提供的上述方法,对空间双臂机器人的控制进行了仿真,分别针对静止、低速、中速3种不同旋转状态的翻滚目标的夹紧消旋过程中的柔顺控制开展仿真实验研究。
请参考图2,其为空间双臂机器人的运动学模型,其中,tk、lk、rk分别表示耦合分支、左臂、右臂上第k个关节,有Zr1为∑r1的Z轴单位向量(即空间双臂机器人右臂第1关节轴线方向的单位向量),Xr1为∑r1的X轴单位向量,Yr1为∑r1的Y轴单位向量,其余符号类似。其对应的D-H参数如表1所示。
表1空间双臂机器人D-H参数表
设置目标初始旋转速度分别为ω0=0°/s、ω0=5°/s、ω0=20°/s,使用本发明
实施例的技术方案对上述任务进行仿真,仿真结果如图3~图5所示。
请参考图3,其为目标初始旋转速度为ω0=0°/s的控制效果图。设置目期望内力为Fi=[0,10,0]N,目标操作空间的阻抗参数分别为Ho=100E6,Bo=10E6,Ko=0.5E6,空间双臂机器人笛卡尔空间的阻抗参数分别为He=20E12,Be=250E12,Ke=0.8E12,Kif=0.4E12。请参考图(a),其为目标角速度控制曲线,实线为目标实际角速度曲线,虚线为目标期望角速度曲线,如图(a)所示,目标运动状态始终维持初始状态。请参考图(b),其为目标内力控制曲线,实线为目标实际内力曲线,虚线为目标期望内力曲线,如图(b)所示,目标内力在t=2.6s时即完成了对期望值内力的跟踪(内力误差为0.1N),最终维持在10-12N的数量级。使用本发明实施例提供的上述方法实现对静止目标的快速精确夹持。
请参考图4,其为目标初始旋转速度为ω0=5°/s的控制效果图。设置目标期望内力为Fi=[0,10,0],N目标操作空间的阻抗参数分别为Ho=100E6,Bo=10E6,Ko=0.5E6,空间双臂机器人笛卡尔空间的阻抗参数分别为He=60E12,Be=300E12,Ke=0.8E12,Kif=0.4E12,库伦摩擦力系数μ=0.1,接触表面的刚度系数σ0=1000N/m,阻尼系数为σ1=1N/(m/s),混合阻抗控制中阻抗控制子空间选择矩阵为S=diag{[0,0,1,0,0,0,0,0,1,0,0,0]},力控制子空间选择矩阵为请参考图(a),其为目标角速度控制曲线,实线为目标实际角速度曲线,虚线为目标期望角速度曲线,如图(a)所示,目标角速度能完成较好跟踪,跟踪误差维持在10-6°/s的数量级。请参考图(b),其为目标内力控制曲线,实线为目标实际内力曲线,虚线为目标期望内力曲线,如图(b)所示,目标的内力在t=12.9s时即完成了对期望值内力的跟踪(内力误差为0.1N),内力误差最终维持在10-6N的数量级。使用本发明实施例提供的上述方法实现对目标的有效夹紧消旋操作。
请参考图5,其为目标初始旋转速度为ω0=20°/s的控制效果图。设置目标期望内力为Fi=[0,0.5,0]N,目标操作空间的阻抗参数分别为Ho=100E6,Bo=10E6,Ko=0.5E6,空间双臂机器人笛卡尔空间的阻抗参数分别为He=20E12,Be=diag{[100,200,100,100,100,100,100,200,100,100,100,100]},Ke=0.8E12,Kif=diag{[0.8,6,0.8,0.8,0.8,0.8,0.8,6,0.8,0.8,0.8,0.8]},库伦摩擦力系数μ=0.1,接触表面的刚度系数σ0=1000N/m,阻尼系数为σ1=1N/(m/s),混合阻抗控制中阻抗控制子空间选择矩阵为S=diag{[0,0,1,0,0,0,0,0,1,0,0,0]},力控制子空间选择矩阵为请参考图(a),其为目标角速度控制曲线,实线为目标实际角速度曲线,虚线为目标期望角速度曲线,如图(a)所示,目标角速度的跟踪误差维持在10-4°/s的数量级。请参考图(b),其为目标内力控制曲线,实线为目标实际内力曲线,虚线为目标期望内力曲线,如图(b)所示,内力误差最终维持在10-6N的数量级。使用本发明实施例提供的上述方法实现对目标的有效夹紧消旋操作。
表2三组实验结果对比
由表2中的数据可以看出,当要求在相同时间内完成翻滚目标角速度的衰减时,随着目标旋转速度的提高,最终角速度跟踪误差和力跟踪误差数量级逐渐增大。当初始旋转速度较小时(需求的加速度较小),静摩擦力足以实现目标预期的角速度衰减,此时机械臂末端与翻滚目标表面无相对滑动,可以实现对抓捕点的实时稳定的跟踪;当初始旋转速度较大时,如ω0=20°/s,若仍采取上述策略,机械臂将跟随目标转动达300.5°,此时双臂运动范围过大,可能直接导致双臂之间发生干涉,或是基座侧翻。采用相对运动产生的滑动摩擦力实现目标角速度衰减时,机械臂末端仅需运动0.17m,运动范围大幅下降,大大保障了抓捕过程的稳定性与可靠性。
无论机械臂末端与目标表面是否存在相对滑动,均可采用统一的多空间混合阻抗控制算法进行规划求解,最终速度误差均控制在10-4°/s量级内,内力误差均控制在10-6N量级内,能够较好满足目标捕获过程中的柔顺控制需求,证明了本发明实施例提供的多空间混合阻抗控制算法鲁棒性和普适性较强。
本发明实施例的技术方案具有以下有益效果:
建立的空间双臂机器人协调操作模型,综合考虑了末端与目标间的相对运动以及摩擦接触情况,能更加真实的反映实际情况;提出的多空间混合阻抗控制算法,可实现不同旋转状态的翻滚目标稳定可靠的消旋及夹紧,为故障卫星回收方法提供了新思路;提出的控制方法可进一步应用于其他在轨操作任务及研究领域中。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明保护的范围之内。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。
Claims (4)
1.一种用于捕获翻滚目标的空间双臂机器人控制方法,其特征在于,所述方法包括:
(1)获得空间双臂机器人动力学方程及摩擦接触方程;
所述的空间双臂机器人动力学方程如(1)所示
其中,M=J+TA(q)J+为空间双臂机器人操作空间惯性矩阵,J为空间双臂机器人雅克比矩阵,J+表示J的广义逆,q为关节角矢量,A(q)为空间双臂机器人关节空间惯性矩阵,为空间双臂机器人操作空间科氏力项和离心力项之和,B(q)为空间双臂机器人关节空间科氏力系数,C(q)为空间双臂机器人关节空间离心力系数,分别为左右臂关节角速度,为关节角速度,为空间双臂机器人末端加速度矢量,F为空间双臂机器人广义驱动力,Fe为末端输出力;
所述的摩擦接触方程如(2)所示
Fe=Fn+Ff (2)
其中,Fn为法向正压力,Ff为切向摩擦力;
采用弹簧-阻尼模型,获得接触情况中的法向正压力Fn:
采用LuGre模型,获得接触情况中的切向摩擦力Ff:
其中,σ0为接触表面的刚度系数,σ1为阻尼系数,σ2为粘性阻尼系数,z为接触表面的形变量,为接触表面的形变率,v为末端与目标表面的相对速度,||Ff||为切向摩擦力Ff的模值,Ff的方向为相对运动方向的反方向;
(2)考虑翻滚目标捕获过程中目标的动态特性,建立空间双臂机器人末端与目标接触表面的运动约束关系及力约束关系,代入空间双臂机器人动力学方程(1)中,获得空间双臂机器人协调操作***的统一动力学方程(5)
(3)依据所述空间双臂机器人协调操作***的统一动力学方程,获得空间双臂机器人捕获翻滚目标的控制器。
4.根据权利要求1所述的方法,其特征在于,依据所述空间双臂机器人协调操作***的统一动力学方程,获得空间双臂机器人捕获翻滚目标的控制器,包括:
(1)获得目标操作空间阻抗控制方程:
(2)采用混合控制理论,获得空间双臂机器人笛卡尔空间混合阻抗控制方程:
其中,He为空间双臂机器人末端期望惯量,Be为空间双臂机器人末端期望阻尼,Ke为空间双臂机器人末端期望刚度,Kif为空间双臂机器人内力控制增益,cXoed、和表示空间双臂机器人末端与目标之间的期望相对运动位姿、期望相对运动速度和期望相对运动加速度,cXoe、和表示空间双臂机器人末端与目标之间的实际相对运动位姿、实际相对运动速度和实际相对运动加速度,Fi为实际内力,Fid为期望内力,{C}为接触坐标系,S为阻抗控制模式选择矩阵,为力控制模式选择矩阵;
(3)依据所述目标操作空间阻抗控制方程及空间双臂机器人笛卡尔空间混合阻抗控制方程,获得空间双臂机器人捕获翻滚目标的多空间混合阻抗控制器:
其中,Rs为接触坐标系与惯性系的转换矩阵;
依据空间双臂机器人捕获翻滚目标的多空间混合阻抗控制器和空间双臂机器人协调操作***的统一动力学方程,获得空间双臂机器人广义驱动力F,如式(16):
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811099190.1A CN109015658B (zh) | 2018-09-20 | 2018-09-20 | 一种用于捕获翻滚目标的空间双臂机器人控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811099190.1A CN109015658B (zh) | 2018-09-20 | 2018-09-20 | 一种用于捕获翻滚目标的空间双臂机器人控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109015658A CN109015658A (zh) | 2018-12-18 |
CN109015658B true CN109015658B (zh) | 2021-10-08 |
Family
ID=64617108
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811099190.1A Active CN109015658B (zh) | 2018-09-20 | 2018-09-20 | 一种用于捕获翻滚目标的空间双臂机器人控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109015658B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109760046A (zh) * | 2018-12-27 | 2019-05-17 | 西北工业大学 | 基于强化学习的空间机器人捕获翻滚目标运动规划方法 |
CN109987258B (zh) * | 2019-01-28 | 2022-10-21 | 西北工业大学深圳研究院 | 一种空间机器人捕获非合作目标后的消旋方法 |
CN110842925A (zh) * | 2019-11-24 | 2020-02-28 | 深圳华数机器人有限公司 | 一种协作化机器人的力矩前馈补偿方法 |
CN114161399B (zh) * | 2021-12-20 | 2023-08-18 | 大连理工大学 | 一种六自由度机械臂笛卡尔空间运动目标实时跟踪控制方法 |
CN114670197B (zh) * | 2022-03-28 | 2024-07-23 | 北京精密机电控制设备研究所 | 多轮臂机器人操作目标消旋的多接触点力分配方法和*** |
CN115625711B (zh) * | 2022-11-08 | 2024-04-30 | 沈阳工业大学 | 一种考虑末端力的双臂机器人协同控制方法 |
CN118143954B (zh) * | 2024-05-09 | 2024-07-05 | 中国人民解放军国防科技大学 | 一种人形机器人上肢双机械臂的柔顺控制方法及装置 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012129251A2 (en) * | 2011-03-23 | 2012-09-27 | Sri International | Dexterous telemanipulator system |
CN103213129A (zh) * | 2013-04-17 | 2013-07-24 | 北京空间飞行器总体设计部 | 一种空间机械臂位置力混合控制方法 |
CN106695797A (zh) * | 2017-02-22 | 2017-05-24 | 哈尔滨工业大学深圳研究生院 | 基于双臂机器人协同操作的柔顺控制方法及*** |
CN106891335A (zh) * | 2017-03-23 | 2017-06-27 | 北京空间飞行器总体设计部 | 一种空间机器人在轨抓捕过程的柔顺与协调控制方法 |
CN106892137A (zh) * | 2017-02-21 | 2017-06-27 | 哈尔滨工业大学深圳研究生院 | 一种空间非合作翻滚目标的大容差捕获方法及*** |
CN106945020A (zh) * | 2017-05-18 | 2017-07-14 | 哈尔滨工业大学 | 一种空间双机械臂***运动协调控制方法 |
-
2018
- 2018-09-20 CN CN201811099190.1A patent/CN109015658B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012129251A2 (en) * | 2011-03-23 | 2012-09-27 | Sri International | Dexterous telemanipulator system |
CN103213129A (zh) * | 2013-04-17 | 2013-07-24 | 北京空间飞行器总体设计部 | 一种空间机械臂位置力混合控制方法 |
CN106892137A (zh) * | 2017-02-21 | 2017-06-27 | 哈尔滨工业大学深圳研究生院 | 一种空间非合作翻滚目标的大容差捕获方法及*** |
CN106695797A (zh) * | 2017-02-22 | 2017-05-24 | 哈尔滨工业大学深圳研究生院 | 基于双臂机器人协同操作的柔顺控制方法及*** |
CN106891335A (zh) * | 2017-03-23 | 2017-06-27 | 北京空间飞行器总体设计部 | 一种空间机器人在轨抓捕过程的柔顺与协调控制方法 |
CN106945020A (zh) * | 2017-05-18 | 2017-07-14 | 哈尔滨工业大学 | 一种空间双机械臂***运动协调控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109015658A (zh) | 2018-12-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109015658B (zh) | 一种用于捕获翻滚目标的空间双臂机器人控制方法 | |
CN108466289B (zh) | 一种考虑关节摩擦的并联机器人的动力学建模方法 | |
Gang et al. | Detumbling strategy based on friction control of dual-arm space robot for capturing tumbling target | |
CN111268182B (zh) | 空间双臂机器人约束柔顺稳定控制方法 | |
Cui et al. | Friction compensation based on time-delay control and internal model control for a gimbal system in magnetically suspended CMG | |
CN105773617B (zh) | 空间机器人的三指式抓持器碰撞预测方法 | |
CN111290269B (zh) | 一种空间机器人的自适应柔顺稳定控制方法 | |
CN109606753A (zh) | 一种空间双臂机器人协同抓捕目标的控制方法 | |
CN109426147B (zh) | 捕获卫星后组合航天器的自适应增益调整控制方法 | |
CN114179089B (zh) | 一种机械臂的鲁棒区域跟踪控制方法 | |
CN110641738B (zh) | 一种空间五自由度自由飞行机械臂的轨迹跟踪控制方法 | |
CN108445778B (zh) | 一种针对空间非合作目标非完全约束组合体的动力学建模方法 | |
CN117301064A (zh) | 一种基于固定时间收敛的双臂机器人安全协同控制方法 | |
Nishida et al. | Dynamical simulations for space debris capture | |
Wu et al. | Contact dynamics and control of a space manipulator capturing a rotating object | |
CN116661342A (zh) | 一种面向目标抓取的空间机器人固定时间阻抗控制方法 | |
CN113848958B (zh) | 基于四元数的全驱动抗退绕水下机器人有限时间容错轨迹跟踪控制方法 | |
Siciliano et al. | Six-degree-of-freedom impedance robot control | |
Zhang et al. | Varying inertial parameters model based robust control for an aerial manipulator | |
CN106292678B (zh) | 一种针对目标操作的空间机器人基座解耦控制方法 | |
CN116766181B (zh) | 一种基于全驱***理论的机械臂主动柔顺控制方法 | |
Yang et al. | An adaptive force control method for 7-dof space manipulator repairing malfunctioning satellite | |
Zeng et al. | Space end effector cpaturing hybrid simulation system | |
Hu et al. | Impedance Control for Stabilizing the Coupled System During Tumbling Target Capturing | |
Chen et al. | Impact dynamic modeling of space flexible manipulators based on continuous approach |
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 |