[发明专利]航天器避障轨迹快速规划方法、装置和计算机设备有效
申请号: | 202010069901.1 | 申请日: | 2020-01-21 |
公开(公告)号: | CN111310312B | 公开(公告)日: | 2022-08-23 |
发明(设计)人: | 蔡伟伟;张润德;杨乐平;黄涣;朱彦伟 | 申请(专利权)人: | 中国人民解放军国防科技大学 |
主分类号: | G06F30/20 | 分类号: | G06F30/20;G06F30/15 |
代理公司: | 长沙国科天河知识产权代理有限公司 43225 | 代理人: | 邱轶 |
地址: | 410073 湖*** | 国省代码: | 湖南;43 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 航天器 轨迹 快速 规划 方法 装置 计算机 设备 | ||
1.一种航天器避障轨迹快速规划方法,所述方法包括:
获取服务航天器与目标航天器间的相对运动模型;
获取障碍物的非线性碰撞避免约束模型;
根据障碍物在服务航天器轨迹起点和轨迹终点连线上的投影位置,确定旋转时间窗口的中心位置;
根据障碍物的最大尺寸以及预先设置的调节参数,确定所述旋转时间窗口的长度;
根据所述非线性碰撞避免约束模型以及障碍物在所述旋转时间窗口内的旋转超平面,得到避障约束;
根据所述避障约束以及所述相对运动模型,进行服务航天器避障轨迹快速规划。
2.根据权利要求1所述的方法,其特征在于,所述获取服务航天器与目标航天器间的相对运动模型,包括:
获取服务航天器与目标航天器以采样周期T进行离散得到的离散形式相对运动动力学方程;
对所述动力学方程中的状态向量和控制输入向量进行叠加重组,得到相对运动模型为:
X=Ψx(0)+ΩU
其中,X表示状态列向量,U表示控制输入列向量,Ψ和Ω表示状态转移矩阵。
3.根据权利要求1所述的方法,其特征在于,所述获取障碍物的非线性碰撞避免约束模型,包括:
根据障碍物的测量信息对应的协方差矩阵,构建空间椭球禁飞区域;
根据所述空间椭球禁飞区域、服务航天器的位置矢量以及障碍物中心的位置矢量确定障碍物的非线性碰撞避免约束模型。
4.根据权利要求1所述的方法,其特征在于,根据障碍物在服务航天器轨迹起点和轨迹终点连线上的投影位置,确定旋转时间窗口的中心位置,包括:
根据障碍物在服务航天器轨迹起点和轨迹终点连线上的投影位置,确定旋转时间窗口的中心位置为:
其中,twindow表示中心位置,dcp表示投影位置到轨迹起点的距离,dct表示轨迹终点到轨迹起点的距离,Tentire表示服务航天器轨迹机动的时间,[·]表示向下取整。
5.根据权利要求4所述的方法,其特征在于,所述根据障碍物的最大尺寸以及预先设置的调节参数,确定所述旋转时间窗口的长度,包括:
根据障碍物的最大尺寸以及预先设置的调节参数,确定所述旋转时间窗口的长度为:
其中,Lwindow表示旋转时间窗口的长度,ζ表示用于调节超平面约束旋转速率的调节系数,表示障碍物的最大尺寸。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国人民解放军国防科技大学,未经中国人民解放军国防科技大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010069901.1/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种架体系统安全装置
- 下一篇:基于边缘云的高性能智能路侧系统