一种航天器小角度姿态机动控制参数优化方法.pdf

(19)中华人民共和国国家知识产权局*CN102411304A*(12)发明专利申请(10)申请公布号CN102411304A(43)申请公布日2012.04.11(21)申请号201110420875.3(22)申请日2011.12.15(71)申请人北京航空航天大学地址100191北京市海淀区学院路37号(72)发明人房建成彭聪崔培玲(74)专利代理机构北京科迪生专利代理有限责任公司11251代理人成金玉(51)Int.Cl.G05B13/02(2006.01)权利要求书3页说明书9页附图3页(54)发明名称一种航天器小角度姿态机动控制参数优化方法(57)摘要本发明涉及一种航天器小角度姿态机动控制参数优化方法。在航天器姿态参考坐标系下建立含有飞轮或控制力矩陀螺的航天器动力学和运动学模型，基于非线性输入受限反馈控制方法设计小角度姿态机动控制器，用改进的模拟退火优化方法对所设计的姿态控制器进行控制参数优化选取。本发明可以适用于各类航天器姿态控制器设计中。本发明属于航天控制技术领域，不仅可以提高航天器姿态控制精度，而且可以大大提高控制器设计效率。CN10243ACCNN110241130402411313A权利要求书1/3页1.一种航天器小角度姿态机动控制参数优化方法，其特征在于：在航天器姿态参考坐标系下建立其姿态动力学和运动学模型，进一步建立飞轮或控制力矩陀螺的动力学模型，并基于飞轮或控制力矩陀螺输入受限的非线性反馈控制方法设计小角度姿态机动控制器，最后用改进的模拟退火优化方法进行控制器参数优化；具体包括以下步骤：①在航天器姿态参考坐标系下建立航天器姿态运动学模型；T其中，q＝(q0，q1，q2，q3)为航天器姿态四元数，为姿态四元数的微分，ωθ和ωψ分别表示航天器三轴姿态角速度；②建立航天器姿态动力学模型；其中，I为航天器转动惯量矩阵，包含飞轮或控制力矩陀螺的转动惯量，h为飞轮或控制力矩陀螺的角动量，为航天器姿态角速度，为姿态角速度的微分，Td为作用于航天器的外部干扰力矩，Tw为飞轮或控制力矩陀螺作用于航天器的力矩，ω×定义为向量叉积的运算，ω×用反对称矩阵表示为：③建立步骤②中航天器姿态动力学方程中的外部干扰力矩Td模型；其中，Tdθ和Tdψ分别表示航天器三轴外部干扰力矩，t为时间，ωo表示轨道角速度，a、b、c表示不同的干扰常系数；④建立步骤②中航天器姿态动力学方程中Tw模型；+Tw＝QTc(3)+其中Tc为控制器输出的指令控制力矩，Q是飞轮或控制力矩陀螺的安装矩阵，Q为安装矩阵Q的广义逆；⑤基于步骤②-步骤④中所建立的含有飞轮或控制力矩陀螺的航天器姿态动力学和运动学方程，设计三轴姿态非线性输入受限反馈控制器为：其中，表示航天器姿态控制器输出的三轴姿态指令力矩；为三轴姿态角误差；m为增益系数，进一步定义kp＝K，ki＝K/m，kd＝C，2CCNN110241130402411313A权利要求书2/3页表示航天器三轴姿态控制器比例环节增益，表示航天器三轴姿态控制器积分环节增益，表示航天器三轴姿态控制器微分环节增益；饱和受限函数定义为：其中，x为饱和受限函数变量，S＝U，L为实际要求中受限力矩和姿态误差决定的饱和受限函数幅值；⑥对步骤⑤中所设计的控制器采用改进的模拟退火算法对三轴姿态控制参数同时进行优化。2.根据权利要求1所述的一种航天器小角度姿态机动控制参数优化方法，其特征在于：所述步骤⑥中采用改进的模拟退火算法，具体步骤为：(i)利用步骤①-步骤④所建立的航天器姿态动力学和运动学模型设计三轴姿态优化目标函数：其中，为横滚姿态角目标函数，表示横滚姿态角误差的绝对值，表示横滚轴控制器输出力矩的绝对值，表示当前时刻横滚姿态角与前一时刻横滚姿态角之差，为横滚姿态角上升时间；Jθ为俯仰姿态角目标函数，|eθ|表示俯仰姿态角误差的绝对值，|uθ|表示俯仰轴控制器输出力矩的绝对值，|erθ|表示当前时刻俯仰姿态角与前一时刻俯仰姿态角之差，trθ为俯仰姿态角上升时间；Jψ为偏航姿态角目标函数，|eψ|表示偏航姿态角误差的绝对值，|uψ|表示偏航轴控制器输出力矩的绝对值，|erψ|表示当前时刻偏航姿态角与前一时刻偏航姿态角之差，trψ为偏航姿态角上升时间；w1，w2，w3，w4分别表示权重系数；(ii)初始化模拟退火算法中初始温度T，马尔科夫链La，步长scale，冷却速率λ，增长速率α，内循环总次数n1，外循环总次数n2；(iii)初始化控制器参数并用此控制器参数值求得步骤(i)中目标函数的值J1θ，J1ψ；(iv)对步骤(iii)中控制器参数进行更新：x′＝x+scale×rand其中，rand为与x具有相同维数的随机向量，其元素为[-1，1]之间具有高斯分布的随机数；并用更新后的控制器参数值求得目标函数值J2θ，J2ψ；(v)用改进