一种风洞试验模型姿态测量方法与流程

1.本发明涉及风洞测控技术领域，尤其是涉及一种风洞试验模型姿态测量方法。


背景技术：

2.随着空天领域的发展、飞行器设计精细和复杂程度的不断增加，对风洞试验相关配套测控系统的测量和控制精度也提出了更高要求。其中，飞行器表面风载荷、表面气动力分析均需依托风洞试验模型的三维姿态数据，反之，风洞试验模型的姿态测量精度也直接影响着飞行器后续迭代设计。
3.目前，常用的风洞试验模型姿态测量手段包括模型支撑装置、攻角传感器、视觉和惯导等。不同测量方式各有其优缺点：1）支撑装置，支撑装置通过转盘编码器确定模型姿态，静态测量精度高，但在动态环境下，风载荷会导致弹性变形，引入动态误差；2）攻角传感器，攻角传感器利用加速度计测量模型攻角，无法测量模型侧滑，此外模型振动会产生有害加速度，其动态测量精度较差；3）视觉方式具有非接触三维测量的优势，对流场干扰小，但当安装受限、遮挡、模型运动等导致相机有效视场较小时，图像帧间匹配误差较大，可能导致姿态数据质量较差甚至无效；4）惯导采用航迹推算的方式计算模型姿态，受初始对准和惯性器件误差的影响，系统姿态测量误差随时间累积。因此，如何充分发挥各种测量方法的各自优势，提高风洞试验模型三维姿态的测量精度，是本发明所要解决的问题。


技术实现要素：

4.本发明的目的是提供一种风洞试验模型姿态测量方法，可以融合现有多种测量方法，充分发挥各测量方法的优势，从而提高风洞试验模型三维姿态的精度测量。
5.本发明实施例提供一种风洞试验模型姿态测量方法，包括：s1、坐标取齐：将固联安装有惯导的风洞试验模型设置于风洞支撑装置上，根据风洞现场条件布置至少两个相机构成相机阵列，并将所述风洞试验模型和所述相机阵列组成的惯性/视觉姿态测量系统进行坐标取齐；s2、姿态解算：在所述惯性/视觉姿态测量系统时间同步的基础上，分别进行惯导姿态解算和相机阵列姿态解算，对应得到同一时空下的惯导解算姿态信息和视觉测量姿态信息；s3、惯导/视觉姿态信息融合：通过卡尔曼滤波器对所述惯导解算姿态信息和视觉测量姿态信息进行信息融合，建立所述惯性/视觉姿态测量系统的滤波方程，并根据信息融合结果更新所述滤波方程，得到所述惯性/视觉姿态测量系统的状态估计误差；s4、最优姿态估计：根据所述惯性/视觉姿态测量系统的状态估计误差提取得到系统的姿态估计误差，并依此校正惯导的姿态，得到风洞试验模型的最优姿态。
6.进一步的，所述惯导解算姿态信息通过传统单子样算法进行惯导姿态解算得到；所述视觉测量姿态信息利用所述相机阵列拍摄所述风洞试验模型，获得设置在所述风洞试验模型上的多个标志点的像素点位置并进行视觉姿态解算后得到。
7.进一步的，所述步骤s3具体包括：根据风洞实验的准静态过程，简化卡尔曼滤波器状态量；所述惯性/视觉姿态测量系统的滤波方程包括系统状态方程和系统观测方程；根据惯导广义误差理论，所述惯导解算姿态信息和视觉测量姿态信息进行信息融合得到的融合结果包括误差矩阵，并基于所述误差矩阵获得系统观测量；结合所述误差矩阵和所述系统观测量通过卡尔曼滤波更新方程更新所述系统状态方程和所述系统观测方程，并获得所述姿态测量系统的一步转移矩阵；基于所述一步转移矩阵得到所述姿态测量系统的状态估计误差。
8.进一步的，所述方法还包括：对所述一步转移矩阵进行离散化。
9.进一步的，所述基于系统的姿态估计误差校正惯导的姿态，得到风洞试验模型的最优姿态的步骤具体包括：通过所述系统的姿态估计误差对融合后的惯导解算姿态矩阵进行修正，得到校正后的惯导姿态矩阵；将所述校正后的惯导姿态矩阵进行坐标系转换，得到所述风洞试验模型的三维姿态矩阵；对所述三维姿态矩阵进行欧拉角解算，得到惯性和视觉融合后的风洞试验模型姿态的最优估计值。
10.进一步的，所述姿态测量系统时间同步采用gnss提供的秒脉冲，结合卫星导航数据包，获得所述相机阵列和所述惯导的真实物理时间，在此基础上进行所述相机阵列和所述惯导的时间同步。
11.与现有技术相比，本发明实施例主要有以下有益效果：通过将固联安装有惯导的风洞试验模型设置于风洞支撑装置上，并布置至少两个相机构成下相机阵列与惯导组成惯性/视觉姿态测量系统，在姿态测量系统坐标取齐和时间同步的基础上进行惯导姿态解算和相机阵列姿态解算，然后通过卡尔曼滤波器对解算得到的惯导解算姿态和视觉测量姿态进行信息融合，将融合结果更新卡尔曼滤波器建立的系统滤波方程，得到姿态测量系统的状态估计误差后提取系统的姿态估计误差并依此校正惯导的姿态，即可获得风洞试验模型姿态的最优估计结果，从而可以在风洞实验中融合支撑装置、视觉测量和惯导测量等多种姿态测量方法，充分发挥各测量方法的优势，弥补各测量方法的不足，最终提高风洞试验模型三维姿态测量的精度。
附图说明
12.为了更清楚地说明本发明实施例的技术方案，下面将对本发明实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面所描述的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
13.图1是本发明的一种风洞试验模型姿态测量方法的一个实施例的流程图；图2是本发明的惯性/视觉姿态测量系统坐标系示意图；图3是本发明的惯导初始对准策略。
具体实施方式
14.以下的说明提供了许多不同的实施例、或是例子，用来实施本发明的不同特征。以下特定例子所描述的元件和排列方式，仅用来精简的表达本发明，其仅作为例子，而并非用以限制本发明。
15.为了使本技术领域的人员更好地理解本技术方案，下面将结合附图，对本技术实施例中的技术方案进行清楚、完整地描述。
16.如图1所示，图1是本发明的一种风洞试验模型姿态测量方法的一个实施例的流程图，上述风洞试验模型姿态测量方法包括以下步骤：s1、坐标取齐：将固联安装有惯导的风洞试验模型设置于风洞支撑装置上，根据风洞现场条件布置至少两个相机构成相机阵列，并将所述风洞试验模型和所述相机阵列组成的惯性/视觉姿态测量系统进行坐标取齐。
17.本发明实施例中，在坐标取齐之前，先将惯导固联安装于风洞试验模型内部，并在风洞试验模型表面布置一定数量标记点来构建视觉坐标系，然后将风洞试验模型安装于风洞支撑装置上。标记点布置时，距离需相等或近似相等，且尽量覆盖模型中轴线，确保构建的视觉坐标系零点位于风洞试验模型质心，也便于后续视觉姿态解算。进一步根据风洞现场条件，在风洞试验模型周围布置至少两个相机构成相机阵列，如图2中所示6个相机构成的相机阵列，从而将惯导和相机阵列组成惯性/视觉姿态测量系统；而后，对各个相机进行单独标定，获取其主点、焦距和主点等内参数；在此基础上，采用相机阵列拍摄处于支撑装置零位的风洞试验模型，进行支撑装置和风洞试验模型零位姿态的标定。
18.其中，本发明实施例的由风洞试验模型和相机阵列组成的惯性/视觉姿态测量系统至少涉及以下坐标系，具体如图2所示：1）模型体坐标系（p系）：该坐标系相对风洞固定，根据支撑装置处于零位时试验模型几何关系构建而成，不随待测模型姿态发生变化。其中，坐标原点为模型质心，与模型纵轴重合，与模型横轴重合，朝地、与模型竖轴重合；2）当地地理坐标系（n系）：坐标系原点为模型质心，轴朝东，轴朝北，轴朝天；3）视觉坐标系（v系）：随体坐标系，依托各相机拍摄试验模型表面的标志点构建而成，坐标系原点为模型质心，朝上，为其处于支撑装置零位时坐标系；4）世界坐标系（系）：坐标系原点为i相机的光学中心，与相机光轴重合，平面与相机成像面平行；5）惯导坐标系（b系）：随体坐标系，其坐标轴与惯导内部惯性器件敏感轴重合，坐标系原点为模型质心，为其处于支撑装置零位时的坐标
系。
19.具体地，上述惯性/视觉姿态测量系统坐标取齐包括以下步骤：步骤1：模型体坐标系（p系）与当地地理坐标系（n系）取齐。其中，体坐标系为固定坐标系，根据支撑装置处于零位时的风洞试验模型几何关系构建而成。p系和n系水平姿态（俯仰和滚转）由电子水平仪或攻角传感器获取，记其为和，侧滑可采用gnss双天线测姿确定。考虑到支撑装置处于零位时模型纵轴通常与风洞中轴线共线，可将gnss天线安装于中轴线（或延长线）上，通过载波相位双差定位求解天线基线矢量，并投影至n系，进一步通过矢量分解获得侧滑，记其为，则体坐标系与当地地理坐标系的传递矩阵可表示为：步骤2：模型体坐标系（p系）与视觉坐标系（v系）取齐。与体坐标系不同，视觉坐标系为随动坐标系，随着模型运动而发生改变，因此，该步骤中取齐主要是指体坐标系与零位视觉坐标系（v0系）取齐。取齐时，先对各个相机阵列进行单独标定，获取主点、焦距和主点等内参数；而后，采用相机阵列拍摄处于零位的风洞试验模型，获取标志点在各相机世界坐标系的图像像素位置；进一步，构建以模型质心为原点的视觉坐标系，由于标志点粘贴时覆盖了模型中轴线，因此，可根据标志点图像提取出模型水平轴信息，而垂直轴可根据右手法则确定；最后，根据视觉姿态输出（可以通过现有的视觉姿态解算方法获得），可实现体坐标系与视觉坐标系的取齐。记视觉方式输出姿态为，则传递矩阵为：步骤3：惯导初始对准，实现惯导坐标系（b系）与当地地理坐标系（n系）的取齐。其中，惯导坐标系同样为随动坐标系。由于初始误差的存在，取齐前惯导需进行初始对准。考虑到纯静态条件下惯导可观测性较差，对准时可根据如图3所示的惯导初始对准策略以提高其观测性并可以消除初始误差，通过支撑装置控制模型进行2～3次的往复侧滑机动，单次机动完成后模型静置10min，全部机动完成后将支撑装置静置30min左右。静置过程中，惯导利用模型先验位置（由gnss测量得到）和速度（模型静置，速度为零）开展组合导航，实现模型最优估计，进而完成b系与n系取齐。记支撑装置零位时惯导姿态为，则传递矩阵为：步骤4：视觉坐标系、惯导坐标系和体坐标系的相互取齐。结合步骤1和步骤3，可实
现惯导坐标系与体坐标系取齐，记传递矩阵；结合步骤1、步骤2和步骤3，可实现视觉坐标系与惯导坐标系取齐，记传递矩阵。根据姿态矩阵链式法则可得：s2、姿态解算：在所述惯性/视觉姿态测量系统时间同步的基础上，分别进行惯导姿态解算和相机阵列姿态解算，对应得到同一时空下的惯导解算姿态信息和视觉测量姿态信息。
20.在本发明实施例中，风洞试验模型试验主要表现为10hz以下的准静态低频振动，上述惯导解算姿态信息可以通过传统单子样算法进行惯导姿态解算得到，微分形式下惯导姿态、速度和位置更新方程如下：其中，为b系相对n系转动角速度在b系下的投影，与设置于惯导内的陀螺输出相关；为惯导速度，、和分别为其东向、北向和天向分量；为惯导比力，与加速度计相关；为地球自转角速度在n系下投影，为n系相对地心地固坐标系（e系，轴指向格林尼治子午线与赤道交点，与地球平均自转轴重合、指向北极）；为当地地球重力；、和为惯导纬度、经度和高度；和为当地子午圈和卯酉圈半径。根据上式进行姿态更新，可获得任意时刻风洞试验模型姿态。
21.上述视觉测量姿态信息利用所述相机阵列拍摄风洞试验模型，获得设置在风洞试验模型上的多个标志点的像素点位置并进行视觉姿态解算后得到，具体地，可以通过上述多个相机阵列采集多组图像，对采集到的图像进行校正、增强和滤波处理后从图像中提取出风洞试验模型，处理后得到模型轮廓以及模型在图像中的位置信息；然后从图像中分割出包含模型的图片，从分割出的图片中利用sift算法或surf算法提取特征点，并通过模型的位置信息对特征点进行修正，获得特征点在视觉坐标系下的坐标；进而匹配相邻
系统观测量z可以理解为视觉测量姿态与惯导解算姿态之差，即将两者进行融合，且满足。由于惯导获得的是惯导坐标系b系到当地地理坐标系n系的姿态，视觉测量获得的是体坐标系p系到视觉坐标系v系的姿态，在视觉测量姿态与惯导解算姿态作差融合前需进行坐标系转换，具体如下：记通过视觉方式获得的惯导姿态为，结合坐标取齐结果，根据链式法则有，其中对应滤波时刻视觉测量姿态；为固定值，已经在坐标取齐步骤中获取；为滤波时刻惯导坐标系b系到视觉坐标系v系的变换矩阵。由于惯导与风洞试验模型刚性连接，而视觉测量姿态通过拍摄和解算粘贴在模型上的标志点获取，因此对于任意时刻为固定值，均满足，又已经在坐标取齐中获取，则有：进一步的，根据惯导广义误差理论，所述惯导解算姿态和视觉测量姿态进行信息融合得到的融合结果包括误差矩阵，其中和在步骤s1坐标取齐中得到，然后基于上述误差矩阵m获得系统观测量，所述系统观测量可具体表示为。
27.根据建立的系统状态方程和系统观测方程进行离散化，并结合所述误差矩阵m得到的系统观测量z，并通过卡尔曼滤波更新方程更新所述系统状态方程和所述系统观测方程，卡尔曼滤波更新方程具体如下：
其中，为系统观测矩阵，为卡尔曼滤波器对所述姿态测量系统的第k-1步到k步的一步转移矩阵，在实际滤波中，所述一步转移矩阵采用下式离散化获取，即：其中为惯导更新周期，n为滤波离散化时离散点数，满足，t为kalman卡尔曼滤波更新周期；、分别为第k步系统滤波误差协方差矩阵和滤波增益矩阵；和为第k-1步系统状态噪声和第k步观测噪声矩阵，可根据系统状态噪声w和系统观测噪声v计算得到；、分别为所述姿态测量系统的第k-1步状态误差、第k-1到k步状态误差预测值，则可以基于一步转移矩阵和得到，再基于得到所述姿态测量系统的第k步状态估计误差，即：s4、最优姿态估计：根据所述惯性/视觉姿态测量系统的状态估计误差提取得到系统的姿态估计误差，并依此校正惯导的姿态，得到风洞试验模型的最优姿态。
28.在本发明实施例中，可以根据姿态测量系统第k步的状态估计误差计算得到系统第k步的姿态估计误差，具体如下：然后基于系统的姿态估计误差校正纯惯导解算的姿态，得到风洞试验模型姿态的最优估计值，具体包括：通过所述系统的姿态估计误差对融合后的惯导解算姿态矩阵进行修正，得到校正后的惯导姿态矩阵，从而可以通过视觉测量姿态校正惯导解算姿态，与单独利用视觉测量姿态或惯导解算姿态相比，提高了风洞实验模型姿态测量的准确度；具体的计算公式如下：
其中，为对应的姿态校正矩阵，当为小角度时，可简化为：对所述校正后的惯导姿态矩阵进行坐标系转换，将惯性/视觉姿态信息融合后得到的惯导姿态矩阵变换至体坐标系，得到所述风洞试验模型的三维姿态矩阵，即：最后对所述三维姿态矩阵进行欧拉角解算：得到的、和即为惯性和视觉信息融合后最优的风洞试验模型的俯仰、滚转和侧滑角估计值。
29.综上所述，在本发明实施例中，通过将固联安装有惯导的风洞试验模型设置于风洞支撑装置上，并布置至少两个相机构成下相机阵列与惯导组成惯性/视觉姿态测量系统，在姿态测量系统坐标取齐和时间同步的基础上进行惯导姿态解算和相机阵列姿态解算，然后通过卡尔曼滤波器对解算得到的惯导解算姿态和视觉测量姿态进行信息融合，将融合结果更新卡尔曼滤波器建立的系统滤波方程，得到姿态测量系统的状态估计误差后提取系统的姿态估计误差并依此校正惯导的姿态，即可获得风洞试验模型姿态的最优估计结果，从而可以在风洞实验中融合支撑装置、视觉测量和惯导测量等多种姿态测量方法，充分发挥
各测量方法的优势，弥补各测量方法的不足，最终提高风洞试验模型三维姿态测量的精度。
30.以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。