[发明专利]一种航空遥感惯性稳定平台耦合力矩估计与补偿方法

权利要求书

1.一种航空遥感惯性稳定平台耦合力矩估计与补偿方法，其特征在于:基于建立的三轴动力学方程，根据POS、陀螺、码盘测量值估算耦合力矩值，进一步计算补偿电流值，具体包括以下步骤：

（1）针对航空遥感三轴惯性稳定平台建立动基座下简化动力学模型，如下：

①方位框绕方位轴的动力学方程为：

Jaz(ω·ifzf+θ··a)=Mz]]>

②俯仰框组件绕俯仰轴的动力学方程简化为：

[(Jax+Jfx)ωifxf]′+(Jaz+Jfz-Jay-Jfy)ωifyfωibzb-Jazθ·aωifyf=Mx]]>

③横滚框组件绕横滚轴方向动力学方程简化为：

[(Jry+Jay+Jfy)ωifyf]′+(Jrx-Jrz)ωibxbωibzb+(Jax+Jfx)ωifxfωibzb]]>

-(Jaz+Jfz)ωibzbωibxb+Jazθ·aωibxb=My]]>

其中定义：J_ax、J_ay、J_az分别为方位框架在x、y、z轴的转动惯量；J_fx、J_fy、J_fz分别为俯仰框架在x、y、z轴的转动惯量；J_rx、J_ry、J_rz分别为横滚框架在x、y、z轴的转动惯量；为基座相对惯性空间的角速度在基座坐标系的表达，其在x、y、z轴上的投影分别记为为俯仰框架相对惯性空间的角速度在俯仰框坐标系的表达，其在x、y、z轴上的投影分别记为为俯仰框架相对惯性空间的角加速度在俯仰框坐标系的表达在z轴的投影；θ_a为方位框架相对俯仰框架转角，为方位框架相对俯仰框架转角角速度；为方位框架相对俯仰框架转角角加速度；M_x为俯仰框组件沿x轴受到的综合力矩，M_y为横滚框组件沿y轴受到的综合力矩，M_z为方位框架沿z轴受到的综合力矩；

（2）利用安装于基座的POS测量和利用安装于俯仰框架的横滚和俯仰陀螺测量和利用安装于方位框架的码盘测量θ_a，间接计算

（3）根据步骤（2）中直接测量值或间接计算值θ_a和计算横滚框耦合力矩值M_{couple_y}和俯仰框耦合力矩值M_{couple_x}；

（4）根据步骤（3）中计算得到的横滚框耦合力矩值M_{couple_y}和俯仰框耦合力矩值M_{couple_x}，进一步计算出抵消横滚框耦合力矩M_{couple_y}所需的力矩电机电流值I_{com_y}，抵消俯仰框耦合力矩M_{couple_x}所需的力矩电机电流值I_{com_x}，并将计算出的电流值补偿到电流环的电流给定输入值中，电机输出与耦合力矩大小相等、方向相反的力矩，补偿惯性平台耦合干扰力矩。