CN107422739B - 一种空间机器人基座姿态的鲁棒控制方法 - Google Patents
一种空间机器人基座姿态的鲁棒控制方法 Download PDFInfo
- Publication number
- CN107422739B CN107422739B CN201710466005.7A CN201710466005A CN107422739B CN 107422739 B CN107422739 B CN 107422739B CN 201710466005 A CN201710466005 A CN 201710466005A CN 107422739 B CN107422739 B CN 107422739B
- Authority
- CN
- China
- Prior art keywords
- base
- attitude
- space robot
- robust
- control method
- 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 33
- 238000006243 chemical reaction Methods 0.000 claims description 7
- 239000011159 matrix material Substances 0.000 claims description 7
- 238000013507 mapping Methods 0.000 claims description 4
- 230000001808 coupling effect Effects 0.000 abstract description 6
- 238000004088 simulation Methods 0.000 description 9
- 238000010586 diagram Methods 0.000 description 4
- 230000001052 transient effect Effects 0.000 description 3
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 239000012636 effector Substances 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000013470 microfluidic resistive pulse sensing Methods 0.000 description 1
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/244—Spacecraft control systems
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Feedback Control In General (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种空间机器人基座姿态的鲁棒控制方法,包括基于拉格朗日方程建立空间机器人基座姿态的动力学方程;设置调节空间机器人的基座姿态的鲁棒控制器;调整鲁棒控制器的稳定性。该方法基于预设性能控制和滑模控制,针对空间机器人基座姿态调整的鲁棒控制方法,实现了动力学耦合效应下基座姿态调整的鲁棒控制。
Description
技术领域
本属于空间机器人技术领域;涉及一种空间机器人基座姿态控制方法,具体的涉及一种空 间机器人基座姿态的鲁棒控制方法。
背景技术
随着空间维修、在轨装配和碎片清理等任务需求不断增加,机器人用于空间任务中的数量 和能力将不断增加。空间机器人由基座与连接在基座上的机械臂构成。由于基座自由运动,空 间机械臂与基座之间存在很强的动力学耦合效应。这种耦合效应使得空间机器人相比于固定基 座机器人具有一些特殊的特性。当机械臂运动时,空间机器人基座的姿态也会受到影响。因此, 需要研究动力学耦合问题下的姿态控制技术。
Yoshida等[1]使用反作用零空间(RNS)的概念,设计零反作用机械臂来消除机械臂的时 间损失和速度限制,可用于冗余和非冗余机械臂。然而,零作用只能用于特别的机器人,不可 避免的限制了机械臂的工作空间。对空间机器人基座的主动控制是必要的,特别是当机械手执 行操作时。Xu等[2]提出了一种自适应控制方案用于带有姿态控制基座的空间机器人系统,同 时考虑了动态不确定性。近来,Shi等[3]设计了一种光滑的滑模控制器(SMC),用于空间机 械臂保持期望的姿态,同时机械臂跟随期望轨迹。
实际中,由于参数的不确定性和额外的扰动,对于基座姿态调整来确保高保真瞬态和稳态 跟踪性能是很有挑战的。一种称为预设形能控制(PPC)的控制方法在[4]中提出,保证系统的 输出收敛到预定义的任意小的残差集与预先设定的速度和超调量。
发明内容
本发明提供了一种空间机器人基座姿态的鲁棒控制方法,基于预设性能控制和滑模控制, 针对空间机器人基座姿态调整的鲁棒控制方法,实现了动力学耦合效应下基座姿态调整的鲁棒 控制。
本发明的技术方案是:一种空间机器人基座姿态的鲁棒控制方法,包括以下步骤:
步骤1,基于拉格朗日方程建立空间机器人基座姿态的动力学方程;
步骤2,设置调节空间机器人的基座姿态的鲁棒控制器;具体的包括:
步骤2.1,设置鲁棒控制器的性能函数,
步骤2.2,设置鲁棒控制器的性能边界,
步骤2.3,设置鲁棒控制器的PPC策略;
步骤3,调整鲁棒控制器的稳定性。
更进一步的,本发明的特点还在于:
其中步骤1中在空间机器人在主动力不为0的情况下,建立其动力学方程。
其中步骤2中将空间机器人的机械臂引起的反作用力和力矩作为空间机器人的主动力。
其中步骤2.3中PPC策略的具体过程为其中R=diag(ζ1,ζ2,ζ3), 是一个设计的正定常数,Q=diag(η1,η2,η3)是正定的对角矩阵选择满足ξT(0)Qξ(0)<1、 G=(R-1Qξ)TgTλ(R-1Qξ)。
其中步骤3中包括构造Lyapunov函数为ξ为映射状态的稳定性。
与现有技术相比,本发明的有益效果是:对于空间机器人的基座姿态调整,提出了一种鲁 棒预设性能控制方法,尤其是考虑了机械臂与基座之间的动力学耦合效应。所提出控制策略的 优势是:无模型和性能保证。由于未知的动力学和扰动的不需要,控制方案是带有低复杂度的。 这种控制方案可以保证性能的同时调整基座的姿态,即使空间机器人执行操作时会对基座产生 很大的扰动。
附图说明
图1为本发明实施例中的空间机器人示意图;
图2为本发明无主动控制情况下的基座姿态MRPs仿真结果图;
图3为无主动控制情况下的基座姿态MRPs仿真结果图;
图4为无主动控制情况下的仿真结果图;
图5为无主动控制情况下的仿真结果图;
图6为本发明实施例中PPC策略基座姿态的仿真结果图;
图7为本发明实施例中PPC策略基座姿态的仿真结果图;
图8为本发明实施例中PPC策略基座姿态的仿真结果图;
图9为本发明实施例中PPC策略基座姿态的仿真结果图。
具体实施方式
下面结合附图和具体实施例对本发明的技术方案进一步说明。
本发明提供了一种空间机器人基座姿态的鲁棒控制方法,包括以下步骤:
步骤1,基于拉格朗日方程建立空间机器人基座姿态的动力学方程;具体的在空间机器人 的主动力为非0的情况下,空间机器人的动力学方程;
步骤2,将空间机器人的机械臂引起的反作用力和力矩作为空间机器人的主动力,设置调 节空间机器人的基座姿态的鲁棒控制器;具体的包括:
步骤2.3,设置鲁棒控制器的PPC策略,具体过程为其中 R=diag(ζ1,ζ2,ζ3),是一个设计的正定常数,Q=diag(η1,η2,η3)是正定的对角矩阵选择满足ξT(0)Qξ(0)<1、G=(R-1Qξ)TgTλ(R-1Qξ)。
步骤3,调整鲁棒控制器的稳定性,其中包括构造Lyapunov函数为ξ为 映射状态的稳定性。
下面结合具体实施例,对本发明的技术方案做进一步说明:
针对具有6自由度的基座和7自由度运动学冗余机械臂的空间机器人,设计其鲁棒控制器, 具体过程是:
步骤1,基于拉格朗日方程建立空间机器人的动力学方程为:在没有外力作用于末端执行器时,fe=0,没有主动力作用于基座,即fb=0,系统则为自由漂浮空间机器人。在本实施例中,需要对基座进行主动控制,因此fb≠0,基座的速度矢量可以记为对公式(1)展开并消去可以得到基座的动力学方程:其中和 代表由于空间机器人操作对基座的反作用力和力矩。当基座位置 自由时,关于基座姿态的动力学方程可以描述如下:其中是 整个系统的惯性矩阵;基座速度的非线性项。
空间机器人基座姿态动力学和运动学方程可以描述为:和 其中是体坐标系相对于惯性参考坐标系的绝对姿态,使用修正 Rodrigues参数(MRPS);雅克比矩阵为:对于姿态表达的MRPs和欧拉参数的关系为:其中μ和p分别为欧拉特征轴和特征角。
步骤2,设计调节空间机器人基座姿态的鲁棒控制器,当空间机器人执行操作时,将空间 机械臂引起的反作用力和力矩视为基座的外部扰动;在保证基座姿态的瞬态和稳态性能,通过 设计具体函数而非重新调整控制器参数;设计鲁棒控制器的具体过程是:
步骤2.1,预设性能函数;定义姿态跟踪偏差为e(t)=q-qd,导数为在收敛 过程中的暂态和稳态性能都应得到保证,扩展状态基于这些状态偏差建立:其中λ=diag(λ1,λ2,λ3)应满足0<λiβi<1,i=1,2,3。
步骤2.2,预设性能边界其中应满足 很明显,预设性能函数的收敛速度为exp(-βit),严格正衰减函数满足控制目标是实现以下条件:其中 δi∈[0,1]是设计的常数用于阻止超调。上式也可以表达如下:Liαi(t)<zi(t)<Uiαi(t)(11), 其中
步骤2.3,设计鲁棒控制器的PPC策略;定义zi(t)=αi(t)Pi(ξi(t))其中ξi(t)是转换误差, 可以得到其中函数Pi为可以得到函数ξi(t)的一阶局部李普希兹微分满足单调性需求, ρi(t)∈(Li,Ui),ξi(t)∈(-∞,+∞)。对ξi(t)进行时间求导得到: 其中 将误差方程、动力学方程带入得到:其中
考虑到原始的非线性系统,对于基座姿态调整的鲁棒PPC策略为 其中R=diag(ζ1,ζ2,ζ3),是一个设计的正定常数。Q=diag(η1,η2,η3)是正定的 对角矩阵选择满足:ξT(0)Qξ(0)<1和G=(R-1Qξ)TgTλ(R-1Qξ)。
未知的非线性项f(x)和集中的外部扰动d有界,因此存在一个常数γ1≥0使得: fT(x)+dT≤||f(x)||+||d||≤γ1(20)成立;由于ρi(t)∈(-1,1),考虑αi(t)的定义,存在常数γ2≥0 使得成立。此外由于和的有界性假设, 因此也存在一个常数γ3≥0使得:κT≤||κ||≤γ3(22)成立;利用ζ(t)的定义和αi(t)的有界性, 可以得到存在常数γ4≥0使得:λR-1Qξ≤||λR-1Qξ||≤γ4(23)成立。
将所提出的控制器带入(24)式中,定义二次型可以得到由G的定义可以确保, 保持为正,得到其中gmin是中g(x)的最小奇异值,λmin=min(λ1,λ2,λ3),ηmin=min(η1,η2,η3)和ζmax=max(ζ1,max,ζ2,max,ζ3,max),其中ζi,max是ζi(t)的上界。
图2-5表明没有主动控制的基座姿态仿真结果。可以看出z-y-x初始欧拉角为 χ°=[-15°,15°,30°],对应的MRPs是q°=[-0.081,0.047,0.139]。由于没有主动力加于基座,整 个空间机器人系统的角动量保持守恒。机械臂的运动使基座姿态发生改变。20s展开以后,基 座的姿态变化为χ=[-17.333°,36.881°,24.359°],角速度减少为零。很明显由于动力学耦合效 应,基座的姿态受到机械臂运动的影响。
Claims (6)
2.根据权利要求1所述的空间机器人基座姿态的鲁棒控制方法,其特征在于,所述步骤1中在空间机器人在主动力不为0的情况下,建立其动力学方程。
3.根据权利要求1所述的空间机器人基座姿态的鲁棒控制方法,其特征在于,所述步骤2中将空间机器人的机械臂引起的反作用力和力矩作为空间机器人的主动力。
4.根据权利要求1或3任意一项所述的空间机器人基座姿态的鲁棒控制方法,其特征在于,所述步骤2.1中设置鲁棒控制器的性能函数的具体过程包括:基座姿态跟踪偏差为e(t)=q-qd,导数为e(t)=q-qd,基于该状态偏差建立扩展状态z(t)=e(t)+λe(t),其中λ=diag(λ1,λ2,λ3)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710466005.7A CN107422739B (zh) | 2017-06-19 | 2017-06-19 | 一种空间机器人基座姿态的鲁棒控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710466005.7A CN107422739B (zh) | 2017-06-19 | 2017-06-19 | 一种空间机器人基座姿态的鲁棒控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107422739A CN107422739A (zh) | 2017-12-01 |
CN107422739B true CN107422739B (zh) | 2020-02-18 |
Family
ID=60428283
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710466005.7A Active CN107422739B (zh) | 2017-06-19 | 2017-06-19 | 一种空间机器人基座姿态的鲁棒控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107422739B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108132601B (zh) * | 2017-12-06 | 2020-04-28 | 西北工业大学 | 一种利用机械臂抑制航天器基座姿态干扰的方法 |
CN108247631B (zh) * | 2017-12-06 | 2020-04-07 | 西北工业大学 | 一种提高路径跟踪性能的机械臂自主鲁棒避奇异方法 |
CN109591017B (zh) * | 2019-01-07 | 2021-11-09 | 西北工业大学 | 空间机器人捕获翻滚目标后的轨迹规划方法 |
CN110844121B (zh) * | 2019-10-22 | 2022-07-12 | 西北工业大学深圳研究院 | 一种在轨装配航天器协同运输的合作博弈控制方法 |
CN111590561B (zh) * | 2020-04-27 | 2021-11-16 | 江苏建筑职业技术学院 | 一种分布式机械臂系统鲁棒预设性能控制方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101726296B (zh) * | 2009-12-22 | 2013-10-09 | 哈尔滨工业大学 | 空间机器人视觉测量、路径规划、gnc一体化仿真系统 |
CN105005195B (zh) * | 2014-04-18 | 2019-03-29 | 东北大学 | 一种上肢康复机器人康复训练运动控制方法 |
WO2015170361A1 (ja) * | 2014-05-07 | 2015-11-12 | 野村ユニソン株式会社 | ケーブルロボットのキャリブレーション方法 |
-
2017
- 2017-06-19 CN CN201710466005.7A patent/CN107422739B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN107422739A (zh) | 2017-12-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107422739B (zh) | 一种空间机器人基座姿态的鲁棒控制方法 | |
Chen et al. | Adaptive sliding-mode disturbance observer-based finite-time control for unmanned aerial manipulator with prescribed performance | |
CN109564406B (zh) | 一种自适应终端滑模控制方法 | |
Adhikary et al. | Integral backstepping sliding mode control for underactuated systems: Swing-up and stabilization of the Cart–Pendulum System | |
Zhao et al. | Robust adaptive terminal sliding mode-based synchronised position control for multiple motion axes systems | |
CN108508749A (zh) | 一种用于抓捕非合作目标的空间机械臂系统抗干扰迭代学习控制方法 | |
CN109676634A (zh) | 自抗扰控制器及工业机器人 | |
Ghaf-Ghanbari et al. | Active fault-tolerant control of a schonflies parallel manipulator based on time delay estimation | |
CN107450326A (zh) | 反步有限时间双边遥操作控制方法及计算机可读存储介质 | |
CN110142766B (zh) | 带性能和状态约束的关节型机器人末端轨迹控制方法 | |
CN107450317A (zh) | 一种空间机械臂自适应动力学协调控制方法 | |
Ulrich et al. | Modified simple adaptive control for a two-link space robot | |
CN110434858A (zh) | 一种基于命令滤波的多机械臂系统的力/位混合控制方法 | |
WO2019139133A1 (ja) | モデル予測制御のための制御パラメータの設定方法 | |
Sun et al. | Research on the trajectory tracking control of a 6-DOF manipulator based on fully-actuated system models | |
Bao et al. | Finite-time synchronization control for bilateral teleoperation systems with asymmetric time-varying delay and input dead zone | |
Shi et al. | Coordinated control of a dual-arm space robot: Novel models and simulations for robotic control methods | |
Kim et al. | Adaptive impedance control of a cleaning unit for a novel wall-climbing mobile robotic platform (ROPE RIDE) | |
CN113219825A (zh) | 一种四足机器人单腿轨迹跟踪控制方法及系统 | |
JP2015195009A (ja) | スライディングモード制御方法及びスライディングモード制御装置 | |
CN111590561A (zh) | 一种分布式机械臂系统鲁棒预设性能控制方法 | |
Huang et al. | PD plus error-dependent integral nonlinear controllers for robot manipulators with an uncertain Jacobian matrix | |
Kamath et al. | Vision Augmented 3 DoF Quadrotor Control using a Non-singular Fast-terminal Sliding Mode Modified Super-twisting Controller | |
Pitakwatchara | Control of time-varying delayed teleoperation system using corrective wave variables | |
Mendes et al. | Variable structure position control of an industrial robotic manipulator |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |