CN113093547A - 一种基于自适应滑模和差分进化的空间机器人控制方法 - Google Patents
一种基于自适应滑模和差分进化的空间机器人控制方法 Download PDFInfo
- Publication number
- CN113093547A CN113093547A CN202110366861.1A CN202110366861A CN113093547A CN 113093547 A CN113093547 A CN 113093547A CN 202110366861 A CN202110366861 A CN 202110366861A CN 113093547 A CN113093547 A CN 113093547A
- Authority
- CN
- China
- Prior art keywords
- control
- sliding mode
- representing
- follows
- max
- 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
- 238000000034 method Methods 0.000 title claims abstract description 35
- 238000005457 optimization Methods 0.000 claims abstract description 19
- 239000013598 vector Substances 0.000 claims description 11
- 230000003044 adaptive effect Effects 0.000 claims description 10
- 239000011159 matrix material Substances 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 6
- 230000006978 adaptation Effects 0.000 claims description 2
- 238000013459 approach Methods 0.000 claims description 2
- 230000035772 mutation Effects 0.000 claims description 2
- 238000005070 sampling Methods 0.000 claims description 2
- 238000012360 testing method Methods 0.000 claims description 2
- 230000007704 transition Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process 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
- 230000009471 action Effects 0.000 description 1
- 230000008859 change Effects 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
- 230000001419 dependent effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 235000008434 ginseng Nutrition 0.000 description 1
- 230000005486 microgravity Effects 0.000 description 1
- 238000010587 phase diagram Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Images
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
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于自适应滑模和差分进化的空间机器人控制方法,属于空间机器人控制技术领域。在建立空间机器人动力学模型的基础上,提出了自适应滑模控制算法,通过实时调整增益以匹配外部干扰和***的不确定参数变化,以实现基座和空间机械臂的快速协同运动控制,并结合改进的高斯骨架差分优化算法对关键控制参数进行优化。本发明提出的控制算法消除了传统滑模方法导致的抖动问题,提高了收敛速度和控制精度。
Description
技术领域
本发明具体涉及一种基于自适应滑模和差分进化的空间机器人控制方法,属于空间机器人控制技术领域。
背景技术
随着空间技术和机器人技术的发展,空间机器人成为实现在轨服务的关键技术途径。空间机器人在轨捕获目标是实现在轨服务的基本环节,在接近目标的过程中,空间机器人的运动控制精度决定了其能否成功捕获目标,同时其运动控制速度也决定了在轨任务的执行效率。由于微重力环境下空间机器人基座和机械臂之间存在着动力学耦合,且太空中存在各种干扰力/力矩的作用,使得空间机器人***的控制问题变得十分复杂。
目前针对空间机器人的控制方法多基于准确的空间机器人动力学模型,而实际上空间机器人的动力学参数很难准确给出。滑模控制被应用于考虑***参数不确定性和外界干扰的空间机器人控制中,但传统的滑模控制是通过使***误差沿一特定滑模平面进行收敛,会导致***产生抖振甚至结构破坏。边界层滑模控制可以解决上述问题,但牺牲了控制精度。本发明基于滑模控制思想,引入可变增益,根据空间机器人的不确定度和运动状态对其进行实时调整,并通过差分进化方法对控制器的关键参数进行优化,消除了传统滑模方法导致的抖动问题,提高了运动的控制精度和误差的收敛速度,实现了对空间机器人基座姿态和机械臂运动的快速、精确协同控制。
发明内容
本发明的目的在于提供一种基于自适应滑模和差分进化的空间机器人控制方法,该方法可以在保持控制***良好鲁棒性的基础上,消除传统滑模控制的抖振问题,提高误差收敛速度和运动控制精度。
一种基于自适应滑模和差分进化的空间机器人控制方法,包括以下步骤:
步骤1:采用拉格朗日方法建立空间机器人的动力学模型,在此基础上,以运动误差为状态向量,将考虑***不确定性的动力学模型在状态空间进行表述(见式(3)和(5));
步骤2:基于步骤1建立的动力学模型,设计自适应变结构滑模控制方法,得到控制方法的过渡阶段、收敛阶段和约束阶段的控制律(见式(7),(8)和(12)),实现对空间机器人基座和机械臂的协同控制;
步骤3:基于改进的高斯骨架差分优化算法对自适应增益参数Mmax进行优化,优化区间的确定和参数优化过程如图2所示,最终实现对空间机器人运动的快速、精确控制。
发明优点:
本发明主要涉及一种基于自适应滑模和差分进化的空间机器人控制方法,结合自适应增益滑模控制理论和改进的高斯骨架差分优化算法,实现了对空间机器人基座和机械臂运动的协同控制。其优点在于:第一,自适应滑模控制器通过实时调整增益以匹配外部干扰和***的不确定参数变化,从而使误差相平面在收敛阶段沿抛物线路径接近原点,消除了传统滑模方法导致的抖动问题,提高了误差的收敛速度;第二,通过改进的高斯骨架差分优化算法对滑模控制的关键增益参数进行优化,提高了运动控制精度。
附图说明
图1为自适应变结构滑模控制算法三个阶段的误差相平面图;
图2为控制参数的优化流程图;
图3为实施例中的空间机器人的三维模型及坐标系定义;
图4为实施例中的控制效果图;
图5为实施例中的不同控制参数对应的目标函数值。
具体实施方式
参见图1-图5,本发明所采用的技术方案包括以下内容。
1空间机器人动力学方程的建立
根据拉格朗日算法建立的***动力学模型为:
其中,Φ=[ΦS T,ΦM T]T代表广义坐标,Φs=[α,β,γ]T代表基座的姿态,ΦM=[Φ1,Φ2…Φn]T代表n个机械臂关节的角度,τ=[τx,τy,τz,τ1,τ2,…,τn]T代表基座姿态调整力矩和关节力矩。H∈R(n+3)×(n+3)正定且对称,代表空间机器人的惯量矩阵;表示非线性项。
将状态方程(2)写成如下形式
2控制器设计
2-1)自适应变结构滑模控制器
自适应变结构滑模控制算法分为三个阶段:过渡阶段、收敛阶段和约束阶段。误差相平面图如图1所示。在过渡阶段,***在控制输入的作用下快速于误差相平面内与一抛物线σ(e)=0相交,从而进入收敛阶段,抛物线方程定义如下:
其中,κi的值取决于控制参数和***的不确定性。过渡阶段控制律的表达式为:
其中,Mi(t)是自适应因子。令收敛阶段开始时t=0,Mi(0)为:
Mi(t)的更新方式为:
Mi(t)=κci(t)-κmi(t)+Mi(t-T) (10)
其中,T是采样周期。κci(t)和κmi(t)的表达式为:
当误差值始终小于限定阈值时,约束阶段开始,约束阶段采用传统的边界层滑模控制算法,使运动误差始终控制在设定的阈值范围内。控制律的表达式为:
ε为边界层厚度。
2-2)自适应增益参数优化。
将改进的高斯骨架差分进化算法应用于控制器中自适应增益参数Mmax的优化,以获得最优的空间机器人点位运动控制精度。首先需要确定参数优化区间,然后再进行参数优化。参数优化区间[infMmax,supMmax]的确定过程为:设定infMmax的值为0,supMmax的获取方式是:设Mmax=0.02[k1,k2,…,kN+3],ki的初值为1。然后基于单一变量的思想,保持其他的ki值不变,分别以1为步长增大ki的值,若运动误差收敛,则继续增大ki的值,否则输出supMmax。
Mmax的优化步骤如图2所示,其中xi=Mmax。首先进行初始化操作,在搜索区间内随机生成个体数量为Np的种群。设种群中的个体为:xi=(xi,1,xi,2,…,xi,d),其中,i=1,2,…,Np,d为待优化参数的维数。然后进行变异操作。变异过程中,个体适应度函数或目标函数设为控制结束时关节角误差的绝对值之和,为
优化时的变异策略为:
交叉方式为二项式交叉,但交叉概率值不是固定值,而是采用一种简单的自适应策略动态地更新交叉概率:
其中ui,G为试验向量,由vi,G进行交叉操作得到。最后进行选择操作。根据ui,G和vi,G的适应度函数f,从两者中选择较优的个体,即
其中,xi,G+1为得到的下一代的个体。使用上述的选择方案,下一代种群中的所有个体都要优于当代种群中个体,实现了优胜劣汰,并不断向最优值逼近,最终获得使***控制精度最优的自适应增益Mbest。
由此,实现空间机器人基座姿态和机械臂运动的快速、精确协同控制。
实施例
根据本发明所提供的一种基于自适应滑模和差分进化的空间机器人控制方法,以图3所示的空间机器人为对象展开验证,其参数如表1所示。空间机器人的初始角度为Φ(0)=[0,0,0,0,0,0]T,期望终止角度为Φ(tf)=[2°,2°,-4°,5°,5°,5°]T。
表1空间机器人参数
分别利用本发明提出的控制方法和边界层滑模控制方法对其进行运动控制,其点位控制效果如图4所示。结果表明,本发明提出的控制方法提高了姿态角和关节角3的运动误差收敛速度,在控制精度方面,通过仿真实验,边界层滑模控制的精度等级为10-8,而本发明提出的控制方法的精度较高,为10-14数量级。
此外,通过设定不同的Mmax值,进行运动控制效果的比较。具体实验参数选取如表2所示。其中,ΔM=Mmax-Mbest,ΔMi表示Mmax与Mbest差值向量的第i个元素。参数a分别设为0.02、0.04、0.06、0.08和0.10,相同的a值记为一组,共5组,每组中的第8个Mmax值为基准值,为Mbest。分别对各组中的15个Mmax值对应的目标函数,即最终运动位姿误差之和f进行记录,共75组数据。结果如图5所示。从图中可以看出基于Mbest进行空间机器人运动控制的误差最小,说明应用改进的高斯骨架差分进化算法对自适应变结构滑模控制器进行了全局最优参数的优化搜索,证明了优化算法的有效性。
表2参数选取列表
Claims (1)
1.一种基于自适应滑模和差分进化的空间机器人控制方法,其特征在于:具体步骤如下:
步骤1:采用拉格朗日方法建立空间机器人的动力学模型,在此基础上,以运动误差为状态向量,将考虑***不确定性的动力学模型在状态空间进行表述。包括以下子步骤:
步骤1.1:根据拉格朗日算法建立的***动力学模型为:
其中,Φ=[ΦS T,ΦM T]T代表广义坐标,ΦS=[α,β,γ]T代表基座的姿态,ΦM=[Φ1,Φ2…Φn]T代表n个机械臂关节的角度,τ=[τx,τy,τz,τ1,τ2,…,τn]T代表基座姿态调整力矩和关节力矩。H∈R(n+3)×(n+3)正定且对称,代表空间机器人的惯量矩阵;表示非线性项。
步骤2:设计自适应变结构滑模控制方法,实现对空间机器人基座和机械臂的协同控制。自适应变结构滑模控制包括三个阶段:接近阶段、收敛阶段和约束阶段,各阶段控制律的建立分别如下子步骤:
步骤2.1:接近阶段的控制律表达式为:
步骤2.2:收敛阶段的控制律表达式为:
其中,Mi(t)是自适应因子。令收敛阶段开始时t=0,Mi(0)为:
Mi(t)的更新方式为:
Mi(t)=κci(t)-κmi(t)+Mi(t-T) (9)
式中,T是采样周期。κci(t)和κmi(t)的表达式为:
步骤2.3:约束阶段采用传统的边界层滑模控制算法,控制律的表达式为:
步骤3:以提高运动控制精度为目标,基于改进的高斯骨架差分优化算法对自适应增益参数Mmax进行优化。首先需要确定参数优化区间,然后再进行参数优化,优化过程主要包括初始化、变异、交叉及选择操作。主要包括如下子步骤:
步骤3.1:确定参数优化区间[infMmax,supMmax]。设定infMmax的值为0,supMmax的获取方式是:设Mmax=0.02[k1,k2,…,kN+3],ki的初值为1。然后基于单一变量的思想,保持其他的ki值不变,分别以1为步长增大ki的值,若运动误差收敛,则继续增大ki的值,否则输出supMmax。
步骤3.2:参数优化。首先进行初始化操作,在搜索区间内随机生成个体数量为Np的种群。设种群中的个体为:xi=(xi,1,xi,2,…,xi,d),其中,i=1,2,…,Np,d为待优化参数的维数。然后进行变异操作。变异过程中,个体适应度函数或目标函数设为控制结束时关节角误差的绝对值之和,为
优化时的变异策略为:
交叉方式为二项式交叉,但交叉概率值不是固定值,而是采用一种简单的自适应策略动态地更新交叉概率:
其中ui,G为试验向量,由vi,G进行交叉操作得到。最后进行选择操作。根据ui,G和vi,G的适应度函数f,从两者中选择较优的个体,即
其中,xi,G+1为得到的下一代的个体。使用上述的选择方案,下一代种群中的所有个体都要优于当代种群中个体,实现了优胜劣汰,并不断向最优值逼近,最终获得使得***控制精度最优的自适应增益Mbest。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110366861.1A CN113093547B (zh) | 2021-04-06 | 2021-04-06 | 一种基于自适应滑模和差分进化的空间机器人控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110366861.1A CN113093547B (zh) | 2021-04-06 | 2021-04-06 | 一种基于自适应滑模和差分进化的空间机器人控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113093547A true CN113093547A (zh) | 2021-07-09 |
CN113093547B CN113093547B (zh) | 2022-03-01 |
Family
ID=76674228
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110366861.1A Active CN113093547B (zh) | 2021-04-06 | 2021-04-06 | 一种基于自适应滑模和差分进化的空间机器人控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113093547B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115446844A (zh) * | 2022-11-09 | 2022-12-09 | 深圳鹏行智能研究有限公司 | 机器人的控制方法、机器人及控制终端 |
CN117325176A (zh) * | 2023-11-02 | 2024-01-02 | 北京长木谷医疗科技股份有限公司 | 一种机械臂量化滑模控制方法、装置及电子设备 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102010052396A1 (de) * | 2010-11-24 | 2012-05-24 | Kuka Roboter Gmbh | Verfahren und Vorrichtung zum Steuern einer Peripheriekomponente eines Robotersystems |
CN105511266A (zh) * | 2016-01-07 | 2016-04-20 | 无锡信捷电气股份有限公司 | 基于引力搜索粒子群算法的Delta机器人轨迹规划方法 |
CN108970014A (zh) * | 2018-09-10 | 2018-12-11 | 武汉理工大学 | 一种适用于多个关节的进阶式康复机器人及其康复训练方法 |
CN109766597A (zh) * | 2018-12-26 | 2019-05-17 | 北京理工大学 | 一种考虑几何误差的装配位姿高精度线性化求解方法 |
CN111062147A (zh) * | 2019-12-31 | 2020-04-24 | 北京理工大学 | 四电机联动***固定时间控制与结构联合优化方法和*** |
CN111224593A (zh) * | 2020-02-20 | 2020-06-02 | 浙江理工大学 | 基于差分进化算法优化的模糊自适应滑模控制方法及*** |
CN111708279A (zh) * | 2020-06-29 | 2020-09-25 | 重庆大学 | 一种面向节能的数控机床进给***设计优化方法 |
-
2021
- 2021-04-06 CN CN202110366861.1A patent/CN113093547B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102010052396A1 (de) * | 2010-11-24 | 2012-05-24 | Kuka Roboter Gmbh | Verfahren und Vorrichtung zum Steuern einer Peripheriekomponente eines Robotersystems |
CN105511266A (zh) * | 2016-01-07 | 2016-04-20 | 无锡信捷电气股份有限公司 | 基于引力搜索粒子群算法的Delta机器人轨迹规划方法 |
CN108970014A (zh) * | 2018-09-10 | 2018-12-11 | 武汉理工大学 | 一种适用于多个关节的进阶式康复机器人及其康复训练方法 |
CN109766597A (zh) * | 2018-12-26 | 2019-05-17 | 北京理工大学 | 一种考虑几何误差的装配位姿高精度线性化求解方法 |
CN111062147A (zh) * | 2019-12-31 | 2020-04-24 | 北京理工大学 | 四电机联动***固定时间控制与结构联合优化方法和*** |
CN111224593A (zh) * | 2020-02-20 | 2020-06-02 | 浙江理工大学 | 基于差分进化算法优化的模糊自适应滑模控制方法及*** |
CN111708279A (zh) * | 2020-06-29 | 2020-09-25 | 重庆大学 | 一种面向节能的数控机床进给***设计优化方法 |
Non-Patent Citations (1)
Title |
---|
艾海平: "空间机器人双臂捕获航天器操作的力 /位置控制", 《哈尔滨工程大学学报》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115446844A (zh) * | 2022-11-09 | 2022-12-09 | 深圳鹏行智能研究有限公司 | 机器人的控制方法、机器人及控制终端 |
CN117325176A (zh) * | 2023-11-02 | 2024-01-02 | 北京长木谷医疗科技股份有限公司 | 一种机械臂量化滑模控制方法、装置及电子设备 |
Also Published As
Publication number | Publication date |
---|---|
CN113093547B (zh) | 2022-03-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112904728B (zh) | 一种基于改进型趋近律的机械臂滑模控制轨迹跟踪方法 | |
CN113093547B (zh) | 一种基于自适应滑模和差分进化的空间机器人控制方法 | |
CN112394645B (zh) | 一种航天器姿态跟踪的神经网络反步滑模控制方法和*** | |
Zhang et al. | Stepsize range and optimal value for Taylor–Zhang discretization formula applied to zeroing neurodynamics illustrated via future equality-constrained quadratic programming | |
CN106502100B (zh) | 多移动机器人的分布式单时滞控制器设计方法 | |
CN109143846A (zh) | 一种考虑执行器受限问题的刚性飞行器自适应神经网络跟踪控制方法 | |
CN109164823A (zh) | 一种考虑执行器受限问题的刚体飞行器非奇异固定时间姿态跟踪控制方法 | |
Fanger et al. | Gaussian processes for dynamic movement primitives with application in knowledge-based cooperation | |
Liang et al. | Multitarget tracking for multiple Lagrangian plants with input-to-output redundancy and sampled-data interactions | |
CN113219825B (zh) | 一种四足机器人单腿轨迹跟踪控制方法及*** | |
CN109108964B (zh) | 一种基于自适应动态规划Nash博弈的空间机械臂协调控制方法 | |
Xia et al. | Extremum seeking-based indirect adaptive control for nonlinear systems with time-varying uncertainties | |
CN111590561A (zh) | 一种分布式机械臂***鲁棒预设性能控制方法 | |
CN112987770B (zh) | 两栖仿蟹多足机器人步行足抗饱和有限时间运动控制方法 | |
Chen et al. | Decentralised collaborative iterative learning control for MIMO multi-agent systems | |
Yan et al. | Time-varying disturbance-observer-based tracking control of uncertain flexible-joint manipulator | |
Dutta et al. | An adaptive feedback linearized model predictive controller design for a nonlinear multi‐input multi‐output system | |
Benosman et al. | Learning-based modular indirect adaptive control for a class of nonlinear systems | |
CN117963168B (zh) | 基于全驱***理论的挠性航天器姿态控制方法 | |
CN116079730B (zh) | 一种提升机器人手臂操作精度的控制方法及*** | |
CN114609915B (zh) | 一种未知控制方向的时变多智能体协同控制方法 | |
Jia et al. | Adaptive backstepping control for longitudinal dynamics of hypersonic vehicle subject to actuator saturation and disturbance | |
Chen et al. | Model free sliding mode control for inspection robot based on pigeon-inspired optimization | |
Shi et al. | Adaptive Vector Nonsingular Terminal Sliding Mode Control for a Class of n‐Order Nonlinear Dynamical Systems with Uncertainty | |
Pandey et al. | Multiple models with two level adaptation control for a class of nonlinearly parameterized nonlinear system |
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 |