第六届华中地区大学生数学建模邀请赛问题1.飞行器空间坐标修正

第六届华中地区大学生数学建模邀请赛

题目：飞行器空间坐标修正

【摘要】

飞行器的导航问题越来越受到人们的重视，它对精度的要求非常之高，我国通过激光引导和北斗导航系统来提高导弹等的定位导航精度然而由于噪声干扰和仪器精度问题使得飞行器的坐标观测值存在一定误差，随着时间的推移，误差逐渐积累会变得越来越大，这会严重影响飞行器的导航精度，因此修正坐标误差非常必要。

本文在分析了各物理量的关系的基础上，经过严密地推导，得出各个轴方向上的位移与其对应速度的修正之后的函数关系，据此建立了相关的数学模型并通过评价说明了模型的合理性和科学性。

对于问题一：噪声信号的干扰对飞行器空间坐标的观测值造成误差，通常采用联邦卡尔曼滤波的方法或者通过坐标变换用雅各比行列式来修正噪声干扰带来的误差。

对于问题二：另外观测数据的仪器误差可以均值法或者迭代均值法来消减。

关键词：联邦卡尔曼，坐标变换，雅各比行列式，迭代均值

目录

一问题重述 (3)

1.1问题背景 (3)

1.2问题提出 (3)

二模型假设 (4)

三符号说明与名词解释 (4)

四问题分析 (4)

4.1问题一分析 (4)

4.2问题二分析 (6)

五模型建立与求解 (7)

5.1问题一模型 (7)

5.2问题二模型 (11)

六模型评价 (13)

七模型的改进 (13)

参考文献 (14)

一问题重述

1.1问题背景

飞行器的导航精度问题一直是航空航天领域研究的重要课题，惯性导航系统是一种不依赖于任何外部信息的自主式导航系统，在航空航天领域起着越来越重要的作用。由于其系统结构误差、惯性测量部件误差、标度系数误差等因素的影响，惯性导航系统的积累误差随着时间的推移而逐渐增大，这一问题严重影响到航空航天技术的发展。目前关于定位精度的研究成果主要是从物理技术(例如红外测距)方面来提高定位的精度，近年来，围绕定位坐标精度问题的相关研究也渐渐展开。因此进一步研究飞行器空间坐标修正方法有重要的理论意义和应用价值。本题的目标是利用数学的方法对飞行器的误差进行修正，并利用结果进行飞行器的仿真。

1.2问题提出

某一观测站测得飞行器空间位置(假设观测站为坐标原点)X(x、y、z)，飞行器的飞行速度V(x轴、y轴、z轴),飞行器与观测站之间的偏向角α，俯仰角θ以及观测数据的时间间隔t。所给的各项数据均含有一定的误差，其中观测站的坐标 (0,0,0)不含误差，飞行器的坐标（观测值）可能含有较大误差。请根据所给数据进行如下工作：问题一：飞行器坐标的数据为观测值，由于电子仪器的精度和噪声干扰等，含有一定的误差波动，建立数学模型对飞行器坐标观测值的随机波动误差进行修正。

问题二：由于观测数据的仪器误差，飞行器坐标在长时间的飞行中，坐标数据的观测值由于误差的累积发生漂移，建立数学模型，对飞行器的坐标的这种误差进行修正。(提示：在短时间内，可以视为飞行器坐标含有一定的常量误差，或者飞行器的这种误差是线性变化的)。

问题三：结合具体的飞行器给出误差修正方案。

二模型假设

假设1.假设噪声的干扰造成的误差可以通过卡尔曼滤波器或者其他方法完全消除。

假设2.观测站的坐标与机体的的坐标系存在有相对运动，而且是球面作用（后边有解释page.11）。

假设3.不考虑在传输过程中的时间延迟效应。

假设4.在使用速度拟合位移曲线的时候假设中间时间间隔做匀速运动。

三符号说明与名词解释

符号解释说明

x,y,h 飞行器空间位置坐标

vx,vy,vh 飞行器沿各个轴方向上的速度

t 观测数据的时间间隔

alpha 飞行器与观测站之间的偏向角

.theta 飞行器与观测站之间的俯仰角

x’,y’，h’坐标变换后飞行器的空间位置坐标

i,j,k 机体采用的坐标系的三个基向量

I’,j’,k’观测站采用的坐标系的三个基向量

四问题分析

4.1问题一分析

首先，惯性导航系统是不依赖于任何外部信息的自主导航系统，明确了数据

vx,vy,vh均是由机体导航系统提供，而x，y，z，以及偏向角（alpha），俯仰角（theta）均由观测站测的

对于问题一：电子仪器精度和噪声的干扰：

2

4

6

800

1000

1200

1400

t

x

x - t 图像

02

46

800

1000

1200

1400

t

y

y - t 图像

1

2

34

5

6

510

510.1510.2510.3

510.4

510.5t

h

h - t 图像

在绘制的x-t ，y-t ，h-t 图像中可以很明显的看出噪声信号对x 和y 的值基本上没

有什么影响，不需要对x,y 进行噪音修正。而h 的值随着t 的变化呈现出上下波动的情况，说明噪声对h 的值影响较大，需要进行修正。消除噪声的干扰可以采用联邦卡尔曼滤波的方法或者使用坐标变换的方法来修正。

4.2问题二分析

观测仪器误差的积累：

246500

1000

1500t x

x - t 图像

2

46

6565.5

66t v x

vx - t 图像

246500

1000

1500t y

y - t 图像

2

46

7070.5

71t v y

vy - t 图像

02

46510

510.5

t

h

h - t 图像

2

46

-1-0.5

0t

v z

vz - t 图像

题设：飞行器的坐标（观测值）可能有较大的误差。

从x-t ，vx-t 图象和y-t ，vy-t 图象中可以看出在x 轴和y 轴方向上都是做类似匀速的运动，速度v 都为正值，不过都有小幅度的波动，说明可能测量过程中存在很小的误差，x ，y 的值都有一定的偏差。

从vz-t 图像中可以看出vz 一直为负值，而且也有小幅度的变化，理论上h 应随着t 时间的推移而呈现出递增趋势，然而根据数据绘制的h-t 图象确实在上下波动的，说明数据中存在偏差，更大可能是所选坐标系不同，导致测量结果的符号不同，需要进行修正。