CN116661342A - 一种面向目标抓取的空间机器人固定时间阻抗控制方法 - Google Patents
一种面向目标抓取的空间机器人固定时间阻抗控制方法 Download PDFInfo
- Publication number
- CN116661342A CN116661342A CN202310360361.6A CN202310360361A CN116661342A CN 116661342 A CN116661342 A CN 116661342A CN 202310360361 A CN202310360361 A CN 202310360361A CN 116661342 A CN116661342 A CN 116661342A
- Authority
- CN
- China
- Prior art keywords
- space robot
- space
- model
- constructing
- robot
- 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
- 238000000034 method Methods 0.000 title claims abstract description 39
- 239000012636 effector Substances 0.000 claims abstract description 33
- 239000013598 vector Substances 0.000 claims description 49
- 239000011159 matrix material Substances 0.000 claims description 29
- 238000013016 damping Methods 0.000 claims description 9
- 230000008569 process Effects 0.000 claims description 6
- 230000003068 static effect Effects 0.000 claims description 6
- 230000009471 action Effects 0.000 claims description 5
- 238000004590 computer program Methods 0.000 claims description 5
- 230000003190 augmentative effect Effects 0.000 claims description 3
- 230000009545 invasion Effects 0.000 claims 1
- 230000009975 flexible effect Effects 0.000 abstract description 7
- 230000000694 effects Effects 0.000 abstract description 2
- 230000001133 acceleration Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 238000011160 research Methods 0.000 description 4
- 238000004088 simulation Methods 0.000 description 4
- 230000008859 change Effects 0.000 description 3
- 230000006870 function Effects 0.000 description 2
- 238000005381 potential energy Methods 0.000 description 2
- 241000208340 Araliaceae Species 0.000 description 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 1
- 235000003140 Panax quinquefolius Nutrition 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 238000004141 dimensional analysis Methods 0.000 description 1
- 239000000446 fuel Substances 0.000 description 1
- 235000008434 ginseng Nutrition 0.000 description 1
- 230000005486 microgravity Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000035515 penetration Effects 0.000 description 1
- 230000005855 radiation Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
- G05B19/0423—Input/output
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/20—Pc systems
- G05B2219/25—Pc structure of the system
- G05B2219/25257—Microcontroller
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种面向目标抓取的空间机器人固定时间阻抗控制方法,首先依次构建空间机器人的接触运动学模型与动力学模型以及目标卫星的动力学模型与运动学模型,之后构建空间机器人的末端执行器与目标卫星的接触力模型,包含法向压力和切向摩擦力,最后基于固定时间理论构建阻抗控制器,以保证在与目标接触时,能够快速实现空间机器人***的柔顺控制,实现空间机器人的固定时间阻抗控制。本发明构建的空间机器人的运动学模型考虑了接触力对空间机器人***产生的平移效应,更准确地描述了发生接触之后空间机器人的运动状态,同时在设计阻抗控制器时将阻抗关系转化为一阶滤波器的形式,能够快速地实现期望阻抗关系,实现柔顺控制。
Description
技术领域
本发明属于空间机器人控制领域,具体涉及一种面向目标抓取的空间机器人固定时间阻抗控制方法。
背景技术
随着人类对太空探索的不断深入,每年都会有大量人造卫星被发射到太空。这些卫星大部分都会由于自然失效或意外事故成为空间垃圾,一旦不能得到很好地处理,就会严重威胁到在轨卫星与空间站的安全运行。考虑到经济效益,失效卫星不可能都进行销毁处理,可对部分燃料耗尽或可修复的故障卫星进行回收。在外太空微重力、高真空、强辐射和大温差的恶劣条件下,仅依靠宇航员完成卫星抓捕任务,风险很大。因此,开展安全捕获空间机器人控制的研究具有重要的理论意义和工程应用价值。
针对空间机器人抓捕控制问题,国内外学者已经进行了部分研究。然而,这些研究普遍集中于抓捕过程中乃至抓捕后对空间机器人或组合航天器的机体姿态控制,而对于空间机器人同目标卫星接触的柔顺控制研究常常被忽视。倘若抓捕时空间机器人不具备柔顺能力,则碰撞很可能产生超出设备的承受范围的接触力,从而导致设备损坏,因此,对空间机器人的柔顺控制是保证抓捕过程顺利完成的必要策略。目前,柔顺控制大多应用于地面机器人,而相关研究中的控制策略还普遍存在着收敛速度慢的问题。另外,在现有的空间机器人接触研究中,对接触力的分析大多只考虑法向压力而无视切向摩擦,这难免存在失真。此外,学者们通常忽略了接触力冲量对空间机器人***的运动学模型产生的影响,这也是不合理的。
当前迫切需要建立目标抓捕时空间机器人完备的接触运动学模型和接触动力学模型,并需要一种抓捕控制方法,使得空间机器人在与目标的碰撞中能快速实现柔顺控制。但是现有技术中尚无相关描述。
发明内容
针对上述问题,本发明的目的在于提供一种面向目标抓取的空间机器人固定时间阻抗控制方法,以保证在与目标接触时,能够快速实现空间机器人***的柔顺控制。
实现本发明目的的具体技术方案为:
一种面向目标抓取的空间机器人固定时间阻抗控制方法,包括以下步骤:
步骤1、构建空间机器人的接触运动学模型与动力学模型;
步骤2、构建目标卫星的动力学模型与运动学模型;
步骤3、构建空间机器人的末端执行器与目标卫星的接触力模型;
步骤4、基于固定时间理论构建阻抗控制器,实现空间机器人的固定时间阻抗控制。
与现有技术相比,本发明的有益效果在于:
(1)本发明构建了目标抓捕时一类刚性自由飞行空间机器人的接触运动学和接触动力学模型,并构建了目标卫星的动力学模型与运动学模型,从而构建基于固定时间理论的抓捕控制的阻抗控制器,以保证在与目标接触时,能够快速实现空间机器人***的柔顺控制;
(2)本发明构建的空间机器人的运动学模型考虑了接触力对空间机器人***产生的平移效应,更准确地描述了发生接触之后空间机器人的运动状态;
(3)本发明对抓捕过程的分析考虑了末端执行器的具体形态,构建的接触力学模型包含了法向压力,也考虑了执行器与目标之间的切向运动趋势引入摩擦力,更具真实性;
(4)本发明将阻抗关系转化为一阶滤波器的形式,基于此所设计的固定时间阻抗控制器能够快速地实现期望阻抗关系,实现柔顺控制,且收敛时间与***的初始状态无关。
附图说明
图1为本发明的面向目标抓取的空间机器人固定时间阻抗控制方法步骤流程图。
图2为本发明的空间机器人结构示意图。
图3为本发明中的目标卫星结构示意图。
图4为本发明实施例中的空间机器人抓捕目标卫星把手时的三维场景与二维分析示意图。
图5为本发明实施例中的空间机器人结构示意图。
图6为本发明实施例中的空间机器人末端执行器所受的接触力仿真结果示意图。
图7为本发明实施例中的阻抗误差中间向量变化曲线图。
图8为本发明实施例中的空间机器人基座和关节角度变化曲线图。
具体实施方式
结合图1和图2,一种面向目标抓取的空间机器人固定时间阻抗控制方法,包括以下步骤:
步骤1、构建一类空间机器人的接触运动学模型与动力学模型,具体为:
步骤1-1、构建空间机器人的接触运动学模型:
空间机器人的末端执行器在惯性坐标系中的位置矢量为:
其中,n表示空间机器人连杆数目,r0表示空间机器人基座质心在惯性坐标系中的位置矢量,l0为基座质心到关节1的长度,li(i=1,2,...n)代表连杆i的长度,变量ei表示空间机器人各部分本体坐标轴yi上的单位矢量:
q0表示空间机器人基座转角,qi(i=1,2,...n)表示空间机器人关节i的转角;
对位置矢量公式关于时间求导,则末端执行器在惯性坐标系中的速度表示为:
根据动量定理,在抓捕初始时刻0到时间t,空间机器人满足以下方程:
其中,m0表示空间机器人基座质量,mi(i=1,2,...n)表示空间机器人连杆i的质量,ri(i=1,2,…n)表示连杆i的质心在惯性坐标系中的位置矢量,P0为空间机器人***的初始线动量,fe表示空间机器人末端执行器所受的接触力;
考虑到连杆i的质心速度满足以下关系:
其中,ai表示连杆i质心到关节i的距离;
则,整理可得:
其中,表示空间机器人总质量;
则末端执行器在惯性坐标系中的速度可以表示为:
其中,q=[q0,q1,...,qn]T∈Rn表示空间机器人基座与关节转角向量,J(q)∈R2×n为空间机器人从关节空间到笛卡尔空间的雅可比矩阵,矩阵中各个元素表示为:
步骤1-2、基于拉格朗日能量建模方法,构建空间机器人的动力学模型:
空间机器人***总动能为:
其中,I0表示基座关于其自身质心的转动惯量,Ii(i=1,2…n)表示连杆i关于其自身质心的转动惯量,忽略势能,根据拉格朗日方程:
其中,L=T表示拉格朗日能量函数,Q表示广义力;
基于此求取空间机器人动力学方程为:
其中M(q)∈Rn×n为该刚性自由飞行空间机器人***惯量矩阵,为科氏力和向心力矩阵,τ∈Rn为输入控制力矩,τe∈Rn为执行器末端所受接触力在关节空间的等效力矩,满足:
τe=J(q)Tfe
其中M(q)∈Rn×n为该刚性自由飞行空间机器人***惯量矩阵,为科氏力和向心力矩阵,τ∈Rn为输入控制力矩,τe∈Rn为执行器末端所受接触力在关节空间的等效力矩,q=[q0,q1,...,qn]T∈Rn表示空间机器人基座与关节转角向量,J(q)为空间机器人从关节空间到笛卡尔空间的雅可比矩阵,fe表示空间机器人末端执行器所受的接触力。
步骤2、结合图3,构建一类带圆柱体把手的目标卫星的动力学模型与运动学模型,具体为:
步骤2-1、构建一类带圆柱体把手的目标卫星的动力学模型:
目标卫星为空间中的自由漂浮刚体,基于牛顿-欧拉方法,构建目标卫星的动力学模型:
其中mt表示目标卫星的质量,rt为目标卫星质心在惯性坐标系中的位置矢量,It为目标卫星在其惯性主轴坐标系中的惯量矩阵,为目标卫星的角速度,ρ表示惯性坐标系中接触点相对目标卫星质心的位置矢量,考虑到圆柱体把手的半径Rh远远小于|ρ|,所以目标卫星的所受的接触力可以近似认为作用于把手圆心Ch处,即:
ρ=rh-rt
其中rh为Ch在惯性坐标系中的位置矢量;
步骤2-2、构建目标卫星的运动学模型:
步骤3、结合图4,构建空间机器人的末端执行器与目标卫星的接触力模型,具体为:
步骤3-1、根据具体的抓捕方式,即空间机器人的末端执行器采用夹爪抓捕,夹爪所围成的区域可以看成一个半径为R(t),匀速收缩的抓捕圆域,圆域的圆心为Ce,其在惯性坐标系中的位置矢量为:
rc=re+R(t)e2
在抓捕开始之前,假设把手已经在圆域内,即被夹爪包围,当夹爪开始闭合后,圆域半径减小,会同把手发生碰撞,产生接触力,当抓捕圆域半径收缩到把手半径Rh时,默认空间机器人和目标卫星固连,即不再存在接触力,完成抓捕;
步骤3-2、构建末端执行器和目标卫星的法向压力模型:
其中,δ表示平面内把手和夹爪的局部侵入量,n为沿接触点公法线方向的单位向量,Fn为夹爪所受的法向压力,Kc和Cc分别为刚度系数和阻尼系数;
步骤3-3、构建末端执行器和目标卫星的切向摩擦力模型:
vt=Δv-(ΔvTn)n
其中,Δv表示在接触点处夹爪相对于把手的速度,vt为在接触点处夹爪相对于把手的切向速度,s(t)和smax(t)分别表示t时刻的平均刚毛偏置向量和最大刚毛偏置量,t0为碰撞初始时刻,μk和μs分别表示滑动摩擦系数和静摩擦系数,vd为区分滑动摩擦和静摩擦情况的临界速度,Ff为夹爪所受的摩擦力,kb和cb分别表示刚毛刚度系数和刚毛阻尼系数;
步骤3-4、构建包含法向压力和切向摩擦力的接触力模型:
Fr=Fn+Ff
Ft=-Fr
式中,Fr和Ft分别表示空间机器人和目标卫星所受的接触力。
步骤4、基于固定时间理论构建阻抗控制器,以保证在与目标碰撞时空间机器人能够快速实现期望阻抗关系,实现空间机器人的固定时间阻抗控制,具体为:
步骤4-1、构建抓捕过程中的空间机器人关节空间的期望阻抗模型:
其中,Md=diag(Md0,Md1,...,Mdn),Cd=diag(Cd0,Cd1,...,Cdn)和Kd=diag(Kd0,Kd1,...,Kdn)分别为环境的期望惯量矩阵,期望阻尼矩阵和期望刚度矩阵,q=[q0,q1,...,qn]T∈Rn表示空间机器人基座与关节转角向量,qd=[q0d,q1d,...,qnd]T表示基座与关节的期望转角向量,τe∈Rn为执行器末端所受接触力在关节空间的等效力矩;
为简化阻抗控制器设计,将阻抗关系转化为一阶滤波器形式:
定义增广阻抗误差:
其中,e=q-qd,Λ和Γ均为对角矩阵,且满足
定义阻抗误差中间向量:
构建一阶滤波器形式的阻抗模型:
步骤4-2、基于固定时间理论构建阻抗控制器,实现空间机器人的柔顺动作:
定义参考转角的角速度与角加速度:
固定时间阻抗控制律为:
其中,α>1,0<β<1,sigγ(z)=[|z0|γsign(z0),|z1|γsign(z1),...,|zn|γsign(zn)]T(γ=α,β),K1=diag(K10,K11,...,K1n),K2=diag(K20,K21,...,K2n)且满足zTK1=k1sigα(zT),zTK2=k2sigβ(zT),k1>0,e=q-qd,Λ和Γ均为对角矩阵,且满足/>
一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现以下步骤:
步骤1、构建空间机器人的接触运动学模型与动力学模型;
步骤2、构建目标卫星的动力学模型与运动学模型;
步骤3、构建空间机器人的末端执行器与目标卫星的接触力模型;
步骤4、基于固定时间理论构建阻抗控制器,实现空间机器人的固定时间阻抗控制。
一种储存有计算机程序的计算机可存储介质,其特征在于,在该计算机程序上由处理器来实现以下步骤:
步骤1、构建空间机器人的接触运动学模型与动力学模型;
步骤2、构建目标卫星的动力学模型与运动学模型;
步骤3、构建空间机器人的末端执行器与目标卫星的接触力模型;
步骤4、基于固定时间理论构建阻抗控制器,实现空间机器人的固定时间阻抗控制。
实施例
结合图5,本实施例中以两连杆的自由飞行空间机器人为例,说明本发明的面向目标抓取的空间机器人固定时间阻抗控制方法,包括以下步骤:
步骤1、构建一类空间机器人的接触运动学模型与动力学模型,具体为:
步骤1-1、构建空间机器人的接触运动学模型:
空间机器人的末端执行器在惯性坐标系中的位置矢量为:
re=r0+l0e0+l1e1+l2e2
其中,r0表示空间机器人基座质心在惯性坐标系中的位置矢量,l0为基座质心到关节1的长度,l1和l2分别代表连杆1和连杆2的长度。变量e0,e1和e2分别表示轴y0,y1和y0上的单位矢量:
e0=[sin(q0),cos(q0)]T
e1=[sin(q0+q1),cos(q0+q1)]T
e2=[sin(q0+q1+q2),cos(q0+q1+q2)]T
q0,q1和q2分别表示基座转角,关节1转角和关节2转角;
对位置矢量公式关于时间求导,则末端执行器在惯性坐标系中的速度表示为:
根据动量定理,在抓捕初始时刻0到时间t,空间机器人满足以下方程:
其中,m0,m1和m2分别为空间机器人基座、连杆1、连杆2的质量,r1和r2分别表示连杆1和连杆2的质心在惯性坐标系中的位置矢量,P0为空间机器人的初始线动量,fe表示空间机器人末端执行器所受的接触力;
考虑到连杆1与连杆2质心速度满足以下关系:
其中,a1和a2分别表示连杆1质心到关节1的距离和连杆2质心到关节2的距离;
则,整理可得:
其中,M=m0+m1+m2表示空间机器人总质量;
则末端执行器在惯性坐标系中的速度可以表示为:
其中,q=[q0,q1,q2]T∈R3表示空间机器人基座与关节转角向量,J(q)∈R2×3为空间机器人从关节空间到笛卡尔空间的雅可比矩阵,矩阵中各个元素表示为:
步骤1-2、基于拉格朗日能量建模方法,构建空间机器人的动力学模型:
空间机器人***总动能为:
其中,I0表示基座关于其自身质心的转动惯量,Ii(i=1,2...n)表示连杆i关于其自身质心的转动惯量,忽略势能,根据拉格朗日方程:
其中,L=T表示拉格朗日能量函数,Q表示广义力;
基于此求取空间机器人动力学方程为:
其中M(q)∈R3×3为该刚性自由飞行空间机器人***惯量矩阵,为科氏力和向心力矩阵,τ∈R3为输入控制力矩,τe∈R3为执行器末端所受接触力在关节空间的等效力矩,满足:
τe=J(q)Tfe
为方便表示,记以下中间量:
L4=m0G0G1+m1(G0+l0)(G1+a1)+m2(G0+l0)(G1+l1)
L5=m0G0G2+m1(G0+l0)G2+m2(G0+l0)(G2+a2)
L6=m0G1G2+m1(G1+a1)G2+m2(G1+l1)(G2+a2)
其中I0,I1和I2分别表示空间机器人基座、连杆1、连杆2关于其自身质心的转动惯量。则惯量矩阵M(q)中各元素可以表示为:
M11=2(L1+L2+L3+L4cos(q1)+L5cos(q1+q2)+L6cos(q2))
M12=M21=2(L2+L3+L6cos(q2))+L4cos(q1)+L5cos(q1+q2)
M13=M31=2L3+L5cos(q1+q2)+L6cos(q2)
M22=2(L2+L3+L6cos(q2))
M23=M32=2L3+L6cos(q2)
M33=2L3
科氏力和向心力矩阵中各元素可以表示为:
C33=0
在本实施例中,空间机器人参数如下所示:
m0=200kg,m1=8kg,m2=16kg,I0=100kg·m2,I1=4.2kg·m2,I2=42kg·m2,a1=1m,a2=0.95m,l0=1m,,l1=2m,l2=1m,基座质心在惯性坐标系中的初始位置矢量与速度矢量分别为r0=[0,0]T和基座和关节的初始角度,初始角速度,初始角加速度分别为q0=[0,0.0655,2.024]T(rad/s),/>
步骤2、构建一类带圆柱体把手的目标卫星的动力学模型与运动学模型,具体为:
步骤2-1、构建一类带圆柱体把手的目标卫星的动力学模型:
目标卫星为空间中的自由漂浮刚体,基于牛顿-欧拉方法,构建目标卫星的动力学模型:
其中mt表示目标卫星的质量,rt为目标卫星质心在惯性坐标系中的位置矢量,It为目标卫星在其惯性主轴坐标系中的惯量矩阵,为目标卫星的角速度,ρ表示惯性坐标系中接触点相对目标卫星质心的位置矢量,考虑到圆柱体把手的半径Rh远远小于|ρ|,所以目标卫星的所受的接触力可以近似认为作用于把手圆心Ch处,即:
ρ=rh-rt
其中rh为Ch在惯性坐标系中的位置矢量;
步骤2-2、构建目标卫星的运动学模型:
在本实施例中,目标卫星参数如下所示:
mt=20kg,It=10kg·m2,卫星质心在惯性坐标系中的初始位置矢量和初始速度矢量分别为rt0=[2.087,2.450]Tm,卫星在二维平面内的初始姿态角和角速度分别为qt0=0和/>(垂直平面向外为正),Rh=0.02m,|ρ|=1,Ch在惯性坐标系中的初始位置矢量为rh0=rt0-|ρ|=[1.087,2.450]Tm。
步骤3、构建空间机器人的末端执行器与目标卫星的接触力模型,具体为:
步骤3-1、根据具体的抓捕方式,即空间机器人的末端执行器采用夹爪抓捕,夹爪所围成的区域可以看成一个半径为R(t),匀速收缩的抓捕圆域,圆域的圆心为Ce,其在惯性坐标系中的位置矢量为:
rc=re+R(t)e2
在抓捕开始之前,假设把手已经在圆域内,即被夹爪包围,当夹爪开始闭合后,圆域半径减小,会同把手发生碰撞,产生接触力,当抓捕圆域半径收缩到把手半径Rh时,默认空间机器人和目标卫星固连,即不再存在接触力,完成抓捕;
在本实施例中,抓捕开始后圆域半径R(t)=(0.1-0.01t)m。
步骤3-2、构建末端执行器和目标卫星的法向压力模型:
其中,δ表示平面内把手和夹爪的局部侵入量,n为沿接触点公法线方向的单位向量,Fn为夹爪所受的法向压力,Kc和Cc分别为刚度系数和阻尼系数;
在本实施例中,法向压力模型参数如下所示:
Kc=5×106N/m,Cc=0Nm/s
步骤3-3、构建末端执行器和目标卫星的切向摩擦力模型:
vt=Δv-(ΔvTn)n
其中,Δv表示在接触点处夹爪相对于把手的速度,vt为在接触点处夹爪相对于把手的切向速度,s(t)和smax(t)分别表示t时刻的平均刚毛偏置向量和最大刚毛偏置量,t0为碰撞初始时刻,μk和μs分别表示滑动摩擦系数和静摩擦系数,vd为区分滑动摩擦和静摩擦情况的临界速度,Ff为夹爪所受的摩擦力,kb和cb分别表示刚毛刚度系数和刚毛阻尼系数;
在本实施例中,切向摩擦力模型参数如下所示:
kb=5×104N/m,cb=0Nm/s,μk=0.25,μs=0.3,vd=10-2m/s
步骤3-4、构建包含法向压力和切向摩擦力的接触力模型:
Fr=Fn+Ff
Ft=-Fr
式中,Fr和Ft分别表示空间机器人和目标卫星所受的接触力。
步骤4、基于固定时间理论构建阻抗控制器,以保证在与目标碰撞时空间机器人能够快速实现期望阻抗关系,实现空间机器人的固定时间阻抗控制,具体为:
步骤4-1、构建抓捕过程中的空间机器人关节空间的期望阻抗模型:
其中qd,和/>分别表示基座与关节的期望转角,期望角速度,期望角加速度。Md=diag(Md1,Md2,Md3),Cd=diag(Cd1,Cd2,Cd3)和Kd=diag(Kd1,Kd2,Kd3)分别为环境的期望惯量矩阵,期望阻尼矩阵和期望刚度矩阵;
在本实施例中,期望转角和期望阻抗模型参数如下所示:
qd=[0.06,0.1355,1.974]T(rad/s),Md=diag(1,1,1),Cd=diag(10,10,10),Kd=diag(25,25,25);
为简化阻抗控制器设计,将阻抗关系转化为一阶滤波器形式:
定义增广阻抗误差:
其中,e=q-qd,Λ和Γ均为对角矩阵,且满足
定义阻抗误差中间向量:
构建一阶滤波器形式的阻抗模型:
步骤4-2、基于固定时间理论构建阻抗控制器,实现空间机器人的柔顺动作:
定义参考转角的角速度与角加速度:
固定时间阻抗控制律为:
其中,α>1,0<β<1,sigγ(z)=[|z1|γsign(z1),|z2|γsign(z2),|z3|γsign(z3)]T(γ=α,β),K1=diag(K11,K12,K13),K2=diag(K21,K22,K23)且满足zTK1=k1sigα(zT),zTK2=k2sigβ(zT),k1>0,k2>0。
在本实施例中,固定时间阻抗控制器参数如下所示:
α=1.5,β=0.833,k1=1,k2=1.
基于MATLAB进行仿真,得到的仿真结果如图6-图8所示;
从仿真结果可以看出,本发明所设计的控制算法可以保证空间机器人在抓捕过程中与目标碰撞时能够快速实现期望阻抗关系,实现空间机器人的柔顺动作;具体地,图6描述的是抓捕目标过程中末端执行器所受的接触力;从图7可以看出,在开始抓捕后,固定时间阻抗控制器能够使得阻抗误差在2.5s左右收敛于0,实现了期望阻抗关系;另外,图8表明当空间机器人末端无接触力时,会趋于期望轨迹运动,如果末端存在接触力,能够主动偏离期望轨迹以在顺应环境的变化,以此实现空间机器人的柔顺动作。
本实施例采用了面向目标抓取的空间机器人柔顺控制方法。首先针对一类自由飞行空间机器人和目标卫星,分别建立了二者的接触运动学和动力学模型;再根据具体的抓取方式,构建了包含法向压力和切向摩擦力的接触力模型,以描述空间机器人与目标之间的接触行为;针对空间目标安全捕获任务对机械臂柔顺动作的要求,所设计的固定时间阻抗控制器能够快速地实现期望阻抗关系,实施例验证了本发明的有效性。
以上实施例显示和描述了本发明的基本原理、主要特征。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是说明本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明范围内。
Claims (11)
1.一种面向目标抓取的空间机器人固定时间阻抗控制方法,其特征在于,包括以下步骤:
步骤1、构建空间机器人的接触运动学模型与动力学模型;
步骤2、构建目标卫星的动力学模型与运动学模型;
步骤3、构建空间机器人的末端执行器与目标卫星的接触力模型;
步骤4、基于固定时间理论构建阻抗控制器,实现空间机器人的固定时间阻抗控制。
2.根据权利要求1所述的面向目标抓取的空间机器人固定时间阻抗控制方法,其特征在于,所述步骤1中的构建空间机器人的接触运动学模型与动力学模型,具体为:
步骤1-1、构建空间机器人的接触运动学模型;
步骤1-2、构建空间机器人的动力学模型。
3.根据权利要求2所述的面向目标抓取的空间机器人固定时间阻抗控制方法,其特征在于,所述步骤1-1中的构建空间机器人的接触运动学模型,具体为:
J(q)∈R2×n
其中,表示空间机器人的末端执行器在惯性坐标系中的位置矢量,n表示空间机器人连杆数目,r0表示空间机器人基座质心在惯性坐标系中的位置矢量,l0为基座质心到关节1的长度,li(i=1,2,...n)代表连杆i的长度;ei表示空间机器人各部分本体坐标轴yi上的单位矢量,q0表示空间机器人基座转角,qi(i=1,2,...n)表示空间机器人关节i的转角;q=[q0,q1,...,qn]T∈Rn表示空间机器人基座与关节转角向量,J(q)为空间机器人从关节空间到笛卡尔空间的雅可比矩阵,fe表示空间机器人末端执行器所受的接触力。
4.根据权利要求2所述的面向目标抓取的空间机器人固定时间阻抗控制方法,其特征在于,所述步骤1-2中的构建空间机器人的动力学模型,具体为:
τe=J(q)Tfe
其中M(q)∈Rn×n为该刚性自由飞行空间机器人***惯量矩阵,为科氏力和向心力矩阵,τ∈Rn为输入控制力矩,τe∈Rn为执行器末端所受接触力在关节空间的等效力矩,q=[q0,q1,...,qn]T∈Rn表示空间机器人基座与关节转角向量,J(q)为空间机器人从关节空间到笛卡尔空间的雅可比矩阵,fe表示空间机器人末端执行器所受的接触力。
5.根据权利要求1所述的面向目标抓取的空间机器人固定时间阻抗控制方法,其特征在于,所述步骤2中的构建目标卫星的动力学模型与运动学模型,具体为:
步骤2-1、构建一类带圆柱体把手的目标卫星的动力学模型:
目标卫星为空间中的自由漂浮刚体,基于牛顿-欧拉方法,构建目标卫星的动力学模型:
其中mt表示目标卫星的质量,rt为目标卫星质心在惯性坐标系中的位置矢量,It为目标卫星在其惯性主轴坐标系中的惯量矩阵,为目标卫星的角速度,ρ表示惯性坐标系中接触点相对目标卫星质心的位置矢量,圆柱体把手的半径Rh远远小于|ρ|,目标卫星的所受的接触力认为作用于把手圆心Ch处,即:
ρ=rh-rt
其中rh为Ch在惯性坐标系中的位置矢量;
步骤2-2、构建目标卫星的运动学模型:
6.根据权利要求1所述的面向目标抓取的空间机器人固定时间阻抗控制方法,其特征在于,所述步骤3中的构建空间机器人的末端执行器与目标卫星的接触力模型,具体为:
步骤3-1、空间机器人的末端执行器采用夹爪抓捕,夹爪所围成的区域可以看成一个半径为R(t),匀速收缩的抓捕圆域,圆域的圆心为Ce,其在惯性坐标系中的位置矢量为:
rc=re+R(t)e2
在抓捕开始之前,假设把手已经在圆域内,即被夹爪包围,当夹爪开始闭合后,圆域半径减小,会同把手发生碰撞,产生接触力,当抓捕圆域半径收缩到把手半径Rh时,默认空间机器人和目标卫星固连,即不再存在接触力,完成抓捕;
步骤3-2、构建末端执行器和目标卫星的法向压力模型:
其中,δ表示平面内把手和夹爪的局部侵入量,n为沿接触点公法线方向的单位向量,Fn为夹爪所受的法向压力,Kc和Cc分别为刚度系数和阻尼系数;
步骤3-3、构建末端执行器和目标卫星的切向摩擦力模型:
vt=Δv-(ΔvTn)n
其中,Δv表示在接触点处夹爪相对于把手的速度,vt为在接触点处夹爪相对于把手的切向速度,s(t)和smax(t)分别表示t时刻的平均刚毛偏置向量和最大刚毛偏置量,t0为碰撞初始时刻,μk和μs分别表示滑动摩擦系数和静摩擦系数,vd为区分滑动摩擦和静摩擦情况的临界速度,Ff为夹爪所受的摩擦力,kb和cb分别表示刚毛刚度系数和刚毛阻尼系数;
步骤3-4、构建包含法向压力和切向摩擦力的接触力模型:
Fr=Fn+Ff
Ft=-Fr
式中,Fr和Ft分别表示空间机器人和目标卫星所受的接触力。
7.根据权利要求1所述的面向目标抓取的空间机器人固定时间阻抗控制方法,其特征在于,所述步骤4中的构建阻抗控制器,实现空间机器人的固定时间阻抗控制,具体为:
步骤4-1、构建抓捕过程中的空间机器人关节空间的期望阻抗模型:
步骤4-2、基于固定时间理论构建阻抗控制器,实现空间机器人的柔顺动作。
8.根据权利要求7所述的面向目标抓取的空间机器人固定时间阻抗控制方法,其特征在于,所述步骤4-1中的期望阻抗模型具体为:
其中,Md=diag(Md0,Md1,...,Mdn),Cd=diag(Cd0,Cd1,...,Cdn)和Kd=diag(Kd0,Kd1,...,Kdn)分别为环境的期望惯量矩阵,期望阻尼矩阵和期望刚度矩阵,q=[q0,q1,...,qn]T∈Rn表示空间机器人基座与关节转角向量,qd=[q0d,q1d,...,qnd]T表示基座与关节的期望转角向量,τe∈Rn为执行器末端所受接触力在关节空间的等效力矩;
定义增广阻抗误差:
其中,e=q-qd,Λ和Γ均为对角矩阵,且满足
定义阻抗误差中间向量:
构建一阶滤波器形式的阻抗模型:
9.根据权利要求7所述的面向目标抓取的空间机器人固定时间阻抗控制方法,其特征在于,所述步骤4-2中的阻抗控制器,具体为:
其中,α>1,0<β<1,sigγ(z)=[|z0|γsign(z0),|z1|γsign(z1),...,|zn|γsign(zn)]T(γ=α,β),K1=diag(K10,K11,...,K1n),K2=diag(K20,K21,...,K2n)且满足zTK1=k1sigα(zT),zTK2=k2sigβ(zT),k1>0,e=q-qd,Λ和Γ均为对角矩阵,且满足
10.一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现权利要求1至8之任一所规定的方法步骤。
11.一种储存有计算机程序的计算机可存储介质,其特征在于,在该计算机程序上由处理器来实现如上述1至8之任一所规定的方法步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310360361.6A CN116661342A (zh) | 2023-04-06 | 2023-04-06 | 一种面向目标抓取的空间机器人固定时间阻抗控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310360361.6A CN116661342A (zh) | 2023-04-06 | 2023-04-06 | 一种面向目标抓取的空间机器人固定时间阻抗控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN116661342A true CN116661342A (zh) | 2023-08-29 |
Family
ID=87714242
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310360361.6A Pending CN116661342A (zh) | 2023-04-06 | 2023-04-06 | 一种面向目标抓取的空间机器人固定时间阻抗控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116661342A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117406667A (zh) * | 2023-11-20 | 2024-01-16 | 南京工程学院 | 一种基于数字孪生模型的拉弯机运动控制方法 |
-
2023
- 2023-04-06 CN CN202310360361.6A patent/CN116661342A/zh active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117406667A (zh) * | 2023-11-20 | 2024-01-16 | 南京工程学院 | 一种基于数字孪生模型的拉弯机运动控制方法 |
CN117406667B (zh) * | 2023-11-20 | 2024-05-10 | 南京工程学院 | 一种基于数字孪生模型的拉弯机运动控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106625671B (zh) | 一种空间机器人抓捕翻滚目标的最优轨迹规划方法 | |
Zhang et al. | Grasp a moving target from the air: System & control of an aerial manipulator | |
Korpela et al. | Dynamic stability of a mobile manipulating unmanned aerial vehicle | |
CN104142687B (zh) | 一种空间绳系机械臂目标抓捕后复合体姿态稳定控制方法 | |
Wenfu et al. | Area-oriented coordinated trajectory planning of dual-arm space robot for capturing a tumbling target | |
CN109426147B (zh) | 捕获卫星后组合航天器的自适应增益调整控制方法 | |
CN105773617A (zh) | 空间机器人的三指式抓持器碰撞预测方法 | |
Cyril et al. | Postcapture dynamics of a spacecraft-manipulator-payload system | |
Ma et al. | Hand-eye servo and impedance control for manipulator arm to capture target satellite safely | |
Dongming et al. | Impedance control of multi-arm space robot for the capture of non-cooperative targets | |
Hirano et al. | Caging-based grasp with flexible manipulation for robust capture of a free-floating target | |
CN116661342A (zh) | 一种面向目标抓取的空间机器人固定时间阻抗控制方法 | |
Xu et al. | Modeling and planning of a space robot for capturing tumbling target by approaching the dynamic closest point | |
CN110641738B (zh) | 一种空间五自由度自由飞行机械臂的轨迹跟踪控制方法 | |
Estrada et al. | Force and moment constraints of a curved surface gripper and wrist for assistive free flyers | |
Shi et al. | Modeling and simulation of space robot visual servoing for autonomous target capturing | |
Carignan et al. | Hardware-in-the-loop simulation of satellite capture on a ground-based robotic testbed | |
Huang et al. | Contact and impact dynamics of space manipulator and free-flying target | |
Nishida et al. | Dynamical simulations for space debris capture | |
Jin et al. | A motion planning method based vision servo for free-flying space robot capturing a tumbling satellite | |
CN112904875B (zh) | 一种刚柔可变机构对空间目标的抵近接触方法 | |
Yan et al. | Kinodynamic Trajectory Optimization of Dual‐Arm Space Robot for Stabilizing a Tumbling Target | |
Liu et al. | Hybrid control scheme for grasping a non-cooperative tumbling satellite | |
CN109987258B (zh) | 一种空间机器人捕获非合作目标后的消旋方法 | |
Zhang et al. | Pre-impact Trajectory Planning of Nonredundant Free-Floating Space Manipulator |
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 |