[发明专利]复杂约束条件下的航天器编队姿态有限时间协同控制方法有效
申请号: | 201710742009.3 | 申请日: | 2017-08-25 |
公开(公告)号: | CN107422641B | 公开(公告)日: | 2019-06-25 |
发明(设计)人: | 孙向东;马肸;刘刚;徐军;郑宗贵;吴亮;何兵;秦伟伟;赵欣;安喜彬 | 申请(专利权)人: | 中国人民解放军火箭军研究院;中国人民解放军火箭军工程大学 |
主分类号: | G05B13/04 | 分类号: | G05B13/04;G05D1/08 |
代理公司: | 北京润泽恒知识产权代理有限公司 11319 | 代理人: | 苏培华 |
地址: | 100094 *** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 复杂 约束 条件下 航天器 编队 姿态 有限 时间 协同 控制 方法 | ||
1.一种复杂约束条件下的航天器编队姿态有限时间协同控制方法,其特征在于,所述方法包括:
确定编队拓扑结构,获取航天器编队的当前姿态值;
将航天器姿态控制方程转化成系统追踪误差方程;
调用系统状态观测器对各航天器编队成员的角速度和姿态值进行估计,得到角速度估计值以及姿态估计值;
对邻近编队成员的角速度估计值以及所述姿态估计值进行耦合得到控制滑模变量;
将所述控制滑模变量发送至控制器,以使所述控制器按照预设滑模控制算法将所述控制滑模变量转化为控制信号;
所述滑模变量为:
si=δαi1+αi2
其中,为耦合姿态追踪误差,δ为给定常数,lij和bi是指通信拓扑链接不同权重,ej1,ej2是指航天器姿态和角速度追踪误差;其中,ei1=qi-q0,ei2=vi-v0,qi∈R3为第i个航天器修正罗德里格斯参数,vi∈R3为第i个航天器的角速度,q0表示航天器编队期望姿态,v0表示航天器编队期望角速度;
所述滑模控制算法为:
其中,表示非线性项fi的估计值;表示航天器角速度vi的估计值,表示航天器系统扰动估计值;0<α<1表示奇异项系数;ki1,ki2表示滑模反馈项增益,σ为控制项增益;gi表示控制增益系数,ψ=[ψ1,ψ2,ψ3]T为双曲线正切函数定义如下:
其中,ku=0.2785,κi为正数,ε为给定的小量,用来表示扰动估计精度。
2.根据权利要求1所述的方法,其特征在于,所述将航天器姿态控制方程转化成系统追踪误差方程的步骤包括:
将第一航天器姿态控制方程转化成第二航天器姿态控制方程,将所述第二航天器姿态控制方程转化成所述系统追踪误差方程;
其中,第一航天器姿态控制方程如下:
其中,J为系统的转动惯量;Ji∈R3×3为第i个航天器的转动惯量矩阵;ui∈R3为第i个航天器的控制输入;di∈R3为第i个航天器的外部扰动力矩;ωi∈R3为第i个航天器在刚体本体坐标系下的角速度;qi∈R3表示第i个航天器修正罗德里格斯参数;Ei为航天器的姿态速度与角速度的转换矩阵;
第二航天器姿态控制方程如下:
其中,Ti=Ei-1,gi=EiJi-1,vi∈R3为第i个航天器的角速度。
3.根据权利要求2所述的方法,其特征在于,所述系统追踪误差方程为:
其中,ei1=qi-q0,ei2=vi-v0,q0表示航天器编队期望姿态,v0表示航天器编队期望角速度。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国人民解放军火箭军研究院;中国人民解放军火箭军工程大学,未经中国人民解放军火箭军研究院;中国人民解放军火箭军工程大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201710742009.3/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种夹紧工装
- 下一篇:一种可调节式焊接平台