数学建模社区-数学中国

标题: 飞行机的精确定位问题 [打印本页]

作者: 浅夏110    时间: 2020-6-17 09:25
标题: 飞行机的精确定位问题
问题描述:飞机在飞行过程中,能够收到地面上各个监控台发来的关于飞机当前位置的 信息,根据这些信息可以比较精确地确定飞机的位置。如图3所示,VOR 是高频多向导航设备的英文缩写,它能够得到飞机与该设备连线的角度信息;DME 是距离测量装 置的英文缩写,它能够得到飞机与该设备的举例信息。图中飞机接收到来自 3 个 VOR 给出的角度和 1 个 DME 给出的距离(括号内是测量误差限),并已知这 4 种设备的  x, y 坐标(假设飞机和这些设备在同一平面上)。如何根据这些信息精确地确定当前飞机的 位置? 6 ]. Q8 k& d) y
. z$ d& A! z4 g; g2 H

/ G  N2 t+ R) b/ ^" u- _2 j9 y. ?& B  D- O! \* G. n! }" d

. r: V, B( m+ g1 q& M# w& ?  (1)问题分析
: t( n& Z, W( F8 c' d& z
& {  {3 P" q7 A2 y0 m 记 4 种设备 VOR1、VOR2、VOR3、DME 的坐标为  (以 km 为单位),i=1,2,3,4 ;VOR1、VOR2、VOR3 测量得到的角度为 (从图中可以看出,按照航空飞行管理的惯例,该角度是从北开始,沿顺时针方向的角度,取值在  之间),角度的误差限为;DME 测量得到的距离为 (单位:km),距离的误差限为 4 σ。设飞机当前位置的坐标为 ,则问题就是在表 9 的已知数据下计算  6 a( n8 c1 w3 t

; P8 o. w4 U$ |# T3 i- R/ f: B$ J2 @. O
' v& I; C9 B9 K; u6 |5 u
(2)模型 1 及求解 . f( F# ^& a- Q. ?. C/ Z  m
- L- z) L( x* Y. v) X& T4 D
图中角度  是点   和点 的连线与 y 轴的夹角(以 y 轴正向为基准,顺时针方向夹角为正,而不考虑逆时针方向的夹角),于是角度 的正切     ( 1 )! v2 B+ q. M5 P, F9 L
8 N" X: X. |% F; r, C, q" s. B( G
对 DME 测量得到的距离,显然有      ( 2 )" ]3 u1 }8 s3 c2 V$ Q6 n3 W4 Q0 e+ \

8 j% B# m! `. F. W直接利用上面得到的 4 个等式确定飞机的坐标 y x, ,这是一个求解超定(非线性) 方程组的问题,在最小二乘准则下使计算值与测量值的误差平方和最小(越接近 0 越 好),则需要求解
( a* x) ?6 v0 J4 F: P& c. l
9 m; ~" l* Q! G) E( x ( 3 )" m1 X7 K5 O1 t+ u
式(3)是一个非线性(无约束)最小二乘拟合问题。很容易写出其 LINGO 程序 如下:5 w4 b6 q+ ?& o3 a) e1 C
- W* i8 R2 e9 _- v2 ?2 r  M
MODEL: ; Q7 d/ e$ L$ S5 o
TITLE 飞机定位模型1;
! [6 |  p, u  rSETS:
& b5 Y- p3 p' v% Y2 N" c- q7 |VOR/1..3/:x0,y0,cita,sigma;
( b- u, W- V0 P, r$ \, CENDSETS
' D- q% O# d/ L  G) k0 N: gDATA: ! l$ i3 L5 ?" X& {- n
x0, y0, cita, sigma = % B% T0 w0 x! ?9 o. b7 H
746  1393 161.2   0.8 . |9 Q" ?- y6 h7 y
629  375 45.1     0.6 1 k! O) v  T8 \3 C5 `- g
1571 259 309.0    1.3; 4 p% N) x. @0 v7 `& b' c% q
x4 y4 d4 sigma4=155,987,864.3,2.0; - d/ N* y* @, ?2 ~, e6 s
ENDDATA - @0 a! f) g$ X4 b
calc:
( |0 E( M4 e7 k( J  k6 T! _@for(VOR:cita=cita*3.14159/180;sigma=sigma*3.14159/180);
* }6 g: V9 v, Y, V8 tendcalc
( W% O+ d7 f7 t) c  Smin=@sum(VOR:@sqr((x-x0)/(y-y0)-@tan(cita)))+@sqr(d4-@sqrt(@sqr(x -x4)+@sqr(y-y4))); ' }& ^# v* U# ]0 \
END' W' X  g# Y  Y; x$ C
上述程序必须使用全局求解器进行求解,否则求得的是一个局部最优解。用 “LINGO|OPTIONS”菜单命令启动“Global Solver”选项卡上的“Use Global Solver”选项,然后求解,可以得到全局最优解 x=1019.306 ,y= 987.2909  ,对应的目标函! q0 n6 I( H8 Q
数值为 0.4729562,这里的解受π 的取值影响很大。 3 d4 k6 L) n2 h: k3 |. l2 _# H
6 o* {7 c; x. H4 o
(3)模型 2 及求解
, c) ^5 C" b1 M( v+ M8 x7 C  I6 N4 u) B: h
注意到这个问题中角度和距离的单位是不一致的(角度为弧度,距离为公里),因 此将这 4 个误差平方和同等对待(相加)不是很合适。并且,4 种设备测量的精度(误差限)不同,而上面的方法根本没有考虑测量误差问题。如何利用测量设备的精度信息? 这就需要看对例中给出的设备精度如何理解。 一种可能的理解是:设备的测量误差是均匀分布的。以 VOR1 为例,目前测得的角度为  ,测量精度为 ,所以实际的角度应该位于区间   内。对其它设备也可以类似理解。由于 很少,即测量精度很高,所以在相应区间内正切函数 tan 的单调性成立。于是可以得到一组不等式:8 e7 B/ i, u4 e) Q$ ]# [
) \, Z% R- v6 W3 o7 i# W* `
, K7 i5 r% W- Q1 E/ L

- k" _  K6 K# q8 ]4 k0 y! J/ V$ E7 C  也就是说,飞机坐标应该位于上述不等式组成的区域内。 由于这里假设设备的测量误差是均匀分布的,所以飞机坐标在这个区域内的每个 点上的可能性应该也是一样的,我们最好应该给出这个区域的 x和 y 坐标的最大值和最小值。于是我们可以分别以 min x ,  max x ,  min y,  max y为目标,以上面的区域限制条件为约束,求出x 和 y 坐标的最大值和最小值。
7 U; S' z' B% }9 f" ^3 M3 W* A' Q 以 min x 为例,相应的 LINGO 程序为:  
) ?2 e4 L' I5 m" W) ?1 _8 J5 J' g! p) z4 r1 ?+ X* V9 b7 D
MODEL:
! R8 k& r# [+ ATITLE 飞机定位模型2; " w( a, M: }5 v3 W) B% l. m7 ~6 ?
SETS: VOR/1..3/:x0,y0,cita,sigma; 7 N. w* ]: R* O
ENDSETS , f' o) O* h; Z
INIT:
+ x' H5 p  s9 ix=1000; y=900; # z. c, a9 H' D
ENDINIT
2 |6 J- |; ?& j' n5 W# FDATA:
- Y2 Q7 A8 `6 j) S' G/ N2 cx0, y0, cita, sigma =
* |7 B# y; [# p( M$ T/ c746  1393 161.2   0.8
$ I9 x* Y: K6 i! ~629  375 45.1     0.6
  l  u8 f9 k( b3 k. c" s1 Q1571 259 309.0    1.3; & K9 Y% }2 F* I! h& ~" V
x4 y4 d4 sigma4=155,987,864.3,2.0; / Q& g& g3 N$ b1 l2 j4 ^
ENDDATA ' n1 L) j, H0 I; t' C5 A" A4 @
calc:
! Y8 S" u2 _$ c@for(VOR:cita=cita*3.14159/180;sigma=sigma*3.14159/180); 1 _- e. d% V( Y. V, N0 y( G
endcalc
# u' e" T6 i2 f0 \' x- U0 z5 V. Lmin=x; % D% i4 y# s! j3 Q5 |; j- t: P
@for(VOR:(x-x0)/(y-y0)>@tan(cita-sigma));
) G# z9 y+ {$ [' Y' K- g@for(VOR:(x-x0)/(y-y0)<@tan(cita+sigma)); ) ^$ n* Y' g6 k% k! L/ v
d4-sigma4 <((x-x4)^2+(y-y4)^2)^.5 ;
  Z! z, n! D, j; ?! x& Nd4+sigma4 >((x-x4)^2+(y-y4)^2)^.5 ;
5 s: D7 r# n  k" z! |" `1 ~6 y" OEND $ W5 j. n% \/ ~& A
注意:用 LINGO9 求解非线性问题,必须对决策变量进行初始化,否则 LINGO 可 能找不到可行解。决策变量的初值也有范围限制,取的不合适也可能找不到可行解。 求得的 x的最小值为 974. 8433。类似地(只需要换目标函数就可以了),可得 到 x的最大值为 982.2005, y 的最小值为 717.1614, y 的最大值为 733.1582。 因此,最后得到的解是一个比较大的矩形区域,大致为 . 0 G$ Y. y" ~! k* ~/ T

8 \5 ]+ S1 _! F) Z/ ?  (4)模型 3 及求解
4 Q  b1 F, B( s6 t; `6 q' _  W0 A# }3 r& h. b8 P
模型 2 得到的只是一个很大的矩形区域,仍不能令人满意。实际上,模型 2 假设 设备的测量误差是均匀分布的,这是很不合理的。一般来说,在多次测量中,应该假设设备的测量误差是正态分布的,而且均值为 0。本例中给出的精度 可以认为是测量
. K4 k' R( D4 u( }9 o2 R误差的标准差。
; L( `, e/ j, v  I2 J0 Z" `& A0 L$ N( M0 o4 {
在这种理解下,用各自的误差限   对测量误差进行无量纲化(也可以看成是一种加权法)处理是合理的,即求解如下的无约束优化问题更合理。 4 ^* z' v" ~  r# ^

( M1 U$ y( [# k/ E8 z8 S! {7 F/ B  {9 E, e

# [% I8 N' }& ~( S6 q 由于目标函数是平方和的形式,因此这是一个非线性最小二乘拟合问题。相应的 LINGO 程序为:
- ~; J5 }) U8 \: X, h. X% E, O- w7 U7 K+ i; Q) P
MODEL: + w& b$ F$ G2 Y5 k2 l5 u
TITLE 飞机定位模型3; 1 P/ r6 i4 A$ K
SETS: 7 Q$ O& t' `3 U2 [  k  M# y
VOR/1..3/:x0,y0,cita,sigma,alpha; : G* H; x5 z4 k* p' k) }
ENDSETS
4 D- L  ?" C, b6 [INIT:
2 }+ _8 o0 T) F/ n8 ?x=1000; y=900;
" N- v4 {3 D5 Q2 r1 }6 `5 YENDINIT
' V, r3 D9 s0 h4 Y0 v$ A! lDATA:
6 B0 O+ x' |  }; [- z: {! ax0, y0, cita, sigma =
: n, g  u2 X. U: `* s" T5 H7 K3 |746  1393 161.2   0.8 9 l' d. Y, b+ g
629  375 45.1     0.6 ! j2 u2 C5 @9 N+ V6 r3 i
1571 259 309.0    1.3; ( g# k  F5 G$ M* C
x4 y4 d4 sigma4=155,987,864.3,2.0; # a4 U- U& x, Y0 x8 P, @/ V/ c
ENDDATA
* Y$ S; Q  M' V# _* S8 ?# r7 Kcalc:
$ [: t4 G4 S5 ]) P1 b7 B+ u@for(VOR:cita=cita*3.14159/180;sigma=sigma*3.14159/180); / c" J7 j4 x1 B1 p! Q& k
endcalc " l  b  G( r. V) Q& X( H" L
min=@sum(VOR:((alpha-cita)/sigma)^2)+((d4-((x-x4)^2+(y-y4)^2)^.5 )/ sigma4 )^2;
3 I+ V8 U# Y) u% w$ g* S7 r; u@for(VOR: @tan(alpha)=(x-x0)/(y-y0) ); # N$ G! ?% P$ H: m' B( I5 W3 j. v$ s
END
9 F4 n  R% }/ f% @7 D  u7 b5 e2 W 启动 LINGO 的全局最优求解程序求解,得到全局最优解 x=978.3071,y= 723.9841,对应的目标函数的值为 0.668035。 这里得到的误差比模型 1 的大,这是因为模型 1 中使用的是绝对误差,而这里使用的是相对于精度 的误差。对角度而言,分母  很少,所以相对误差比绝对误差大,这是可以理解的。 * S6 ?5 e' y' P3 d1 k6 v) {
————————————————) B' |1 C/ R$ \1 ?: @" |
版权声明:本文为CSDN博主「wamg潇潇」的原创文章,遵循CC 4.0 BY-SA版权协议,转载请附上原文出处链接及本声明。, S, ]5 D9 o$ ?9 y5 c& D
原文链接:https://blog.csdn.net/qq_29831163/java/article/details/89389044
7 e$ |/ ~* H# F, b
" T5 C. s. p8 ^6 ?7 g6 r' h1 D2 P4 u* p

2 E3 C  u: j9 X0 v) Y




欢迎光临 数学建模社区-数学中国 (http://www.madio.net/) Powered by Discuz! X2.5