[发明专利]一种角速度输入条件下的姿态解耦方法

说明书

本发明公开了一种角速度输入条件下的姿态解耦方法，能够把目前主要通过改变自旋刚体自身结构来降低转速以削弱姿态耦合的方法转换为通过建立中间坐标系进行数学解旋从而克服姿态耦合的方法。该方法包含：(1)构建一个能够实时跟踪载体旋转角速度的动坐标系，将其作为中间坐标系；(2)将姿态解算过程由载体坐标系转换到中间坐标系；(3)待解算完成后再转换到导航坐标系，实现导航坐标系下的姿态解耦。本发明能够解决制导弹药姿态稳定、油气藏钻井的钻杆姿态控制等自旋刚体姿态的实时精确测量，对航空航天、武器弹药、油气勘探等领域的发展具有现实的应用价值。

技术领域

本发明属于导航制导与控制领域，具体是一种一种角速度输入条件下的姿态解耦方法。

背景技术

刚体是指在外力作用下，其形状、大小及内部各点相对位置不变的物体。在导航、制导与控制领域，刚体姿态的精确测量对其自身的姿态稳定、运动控制具有重要意义。刚体在旋转时，常表现出俯仰和偏航通道之间的耦合效应(如马格努斯效应、陀螺效应等)，使其具有特殊的运动学和动力学特性，具体表现为锥运动及其它附加运动。这些复杂运动导致刚体姿态角相互耦合，出现诱导误差，将加剧导航系统的姿态误差发散，从而严重影响自旋刚体后续的导航、制导与控制。

例如制导弹药飞行过程中姿态参数的测量对弹药的气动参数辨识、外弹道特性研究、制导系统设计等都有重要的意义，而自旋弹丸的姿态测量一直存在很多困难。身管发射弹药的转速通常在30～100转/秒，以现有的导航手段难以得到满足制导控制要求的姿态参数。又比如在油气田勘探开发中，钻井的钻杆姿态控制问题一直是深层油气藏钻井施工中面临的主要难题和急需解决的技术，这一问题在我国塔里木、准噶尔和南方海相地区这尤为明显。对于高陡构造、大倾角底层等复合底层，常规的满眼钻具、偏心钻具等姿态防斜纠斜技术可以在一定程度上抑制井斜增加，但只能采用轻压吊打来控制井斜，导致机械钻速极低，直接影响着该地区油气藏的勘探开发速度，而造成这种情况的主要原因在于无法实现对井斜角的实时动态测量。

总之，目前缺少能够解决角速度输入条件下的自旋刚体姿态解耦问题的有效方法。

发明内容

本发明公开了一种角速度输入条件下的姿态解耦方法，其主要目的在于利用数学的方法建立中间坐标系，并使其作为媒介，克服刚体自转的姿态耦合影响，提高姿态测量精度。

为了实现上述目的，本发明采用如下技术方案：

一种自旋刚体的姿态解耦方法，包括以下步骤：

步骤1，构建一个能够实时跟踪载体旋转角速度的动坐标系，将其作为中间坐标系；

步骤2，将姿态解算过程由载体坐标系转换到中间坐标系；

步骤3，待解算完成后再转换到导航坐标系，实现导航坐标系下的姿态解耦。

进一步的，所述步骤1中的中间坐标系能够使得下式中：

中Φ和ω的方向一致，其中Φ是t_k时刻至t_k+1时刻角位置变化所对应的等效旋转矢量，是Φ的导数，Φ是Φ的绝对值Φ＝|Φ|，ω是t_k时刻至t_k+1时刻的载体角速度。即Φ×ω＝0。

进一步的，所述步骤2中，由载体坐标系B系到中间坐标系S系的转换可表示为：

R_S＝T^-1(Ω·Δt)＝T(-Ω·Δt)R_B

其中R_S表示中间坐标系下的矢量，R_B表示载体坐标系下的矢量，T为方向余弦矩阵，T¹为T的逆矩阵，Ω为圆锥运动角速度，Δt为时刻差Δt＝t_k+1-t_k。