专利名称: |
一种基于滤波平滑的闭环控制系统姿态引入修正方法 |
摘要: |
本发明涉及一种基于滤波平滑的闭环控制系统姿态引入修正方法,属于卫星姿态控制技术领域。本发明提出的基于机动能力约束的任务规划系统设计方法,是一种全新的针对实现多点目标、匀地速主动推扫和匀角速度扫描等多种模式成像任务规划的解决方法,很好地解决了由于主动推扫和被动推扫成像任务混合且主动推扫任务复杂多样导致的星上统一成像任务指令实现困难以及各成像任务在姿态机动能力约束下的最短机动时间计算问题。 |
专利类型: |
发明专利 |
国家地区组织代码: |
北京;11 |
申请人: |
北京控制工程研究所 |
发明人: |
陆栋宁;齐天翼;徐李佳;孙鲲;王淑一;关新;张万利;谢晓兵;谌颖;张晋;李艳;吴倩 |
专利状态: |
有效 |
申请日期: |
2019-07-15T00:00:00+0800 |
发布日期: |
2019-10-15T00:00:00+0800 |
申请号: |
CN201910636017.9 |
公开号: |
CN110329545A |
代理机构: |
中国航天科技专利中心 |
代理人: |
张丽娜 |
分类号: |
B64G1/24(2006.01);B;B64;B64G;B64G1 |
申请人地址: |
100080 北京市海淀区北京2729信箱 |
主权项: |
1.一种基于滤波平滑的闭环控制系统姿态引入修正方法,其特征在于该方法包括:比例控制和微分控制,其中,比例控制步骤包括: (1)根据卫星的轨道位置,计算卫星在轨道坐标系下的导引角αx、αy和αz; (2)根据步骤(1)得到的卫星的导引角计算卫星期望姿态矩阵CTPo; (3)根据步骤(2)得到的卫星期望姿态矩阵CTPo计算期望目标姿态角φ、θ和ψ; (4)将当前目标姿态角转换为步骤(3)得到的期望目标姿态角φ、θ和ψ。 2.根据权利要求1所述的一种基于滤波平滑的闭环控制系统姿态引入修正方法,其特征在于:该方法根据成像模式需求的姿态导引修正方式计算所需引入闭环控制系统的目标姿态修正量,将每周期新计算的姿态修正量与上一周期引入系统的姿态修正量作滤波平滑处理,所得结果作为每周期实时引入系统的姿态修正量。 3.根据权利要求1所述的一种基于滤波平滑的闭环控制系统姿态引入修正方法,其特征在于:所述的步骤(1)中,αx=0; 其中,e为卫星所在轨道的偏心率,f为卫星的近地点幅角,u为卫星所在轨道的幅角,i为卫星所在轨道的倾角,ω0为卫星所在轨道的角速度,ωe为地球的自转角速度。 4.根据权利要求1所述的一种基于滤波平滑的闭环控制系统姿态引入修正方法,其特征在于:所述的步骤(3)中,根据卫星期望姿态矩阵CTPo计算期望目标姿态角φ、θ和ψ的方法为:将卫星期望姿态矩阵CTPo转序改为 5.根据权利要求1所述的一种基于滤波平滑的闭环控制系统姿态引入修正方法,其特征在于:所述的步骤(4)中,将当前目标姿态角转换为期望目标姿态角φ、θ和ψ的方法为: 第一步,计算当前目标姿态角转换为期望目标姿态角的平滑系数kf; 其中,kf0为一设定值,其取值范围为0
|
所属类别: |
发明专利 |