数学建模社区-数学中国

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

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

/ u: h( V9 x3 Z/ j. F0 v/ X8 D2 q* W5 |/ K

+ ?1 ^8 V8 g! O+ P, S. M% C& H4 q# u( q) P: K
  (1)问题分析 ) X/ d$ p' y' m; j+ w
, T# a, d* ?! u* g( y
记 4 种设备 VOR1、VOR2、VOR3、DME 的坐标为  (以 km 为单位),i=1,2,3,4 ;VOR1、VOR2、VOR3 测量得到的角度为 (从图中可以看出,按照航空飞行管理的惯例,该角度是从北开始,沿顺时针方向的角度,取值在  之间),角度的误差限为;DME 测量得到的距离为 (单位:km),距离的误差限为 4 σ。设飞机当前位置的坐标为 ,则问题就是在表 9 的已知数据下计算  
, m  t9 ?& q5 l
3 s4 S: a% V/ R) F' w* y" Z' R0 u3 z# }* g9 F, S# l
- w% z4 Q$ }4 K: N# E- X, v& o
(2)模型 1 及求解 1 b& b! L  d3 v* N( b; m
" I$ D: I: }6 ~3 s! G
图中角度  是点   和点 的连线与 y 轴的夹角(以 y 轴正向为基准,顺时针方向夹角为正,而不考虑逆时针方向的夹角),于是角度 的正切     ( 1 )4 |; n% T3 P: q: l$ n8 r

! Q: Z/ ?- D2 p+ c  J" h对 DME 测量得到的距离,显然有      ( 2 )8 b8 }7 A" r7 q0 o! n
, s) X4 Y. r# b
直接利用上面得到的 4 个等式确定飞机的坐标 y x, ,这是一个求解超定(非线性) 方程组的问题,在最小二乘准则下使计算值与测量值的误差平方和最小(越接近 0 越 好),则需要求解
# o. u! H2 f* g1 k' Q  H) c. v
% i; C. q. d0 O  s" ]5 Q/ ]; M( a ( 3 )/ o# |+ i; g/ |( h5 z$ B
式(3)是一个非线性(无约束)最小二乘拟合问题。很容易写出其 LINGO 程序 如下:
* V( h" R  m: T: l# R( {7 n: Y0 ~) y) D5 P( D) M7 ~2 R' v& D1 }
MODEL: 0 D* x7 X. ]2 m
TITLE 飞机定位模型1;
, ]1 m  ?8 I0 W% uSETS:
% t& c4 w' [  b9 O  zVOR/1..3/:x0,y0,cita,sigma;
, r& X: x, e! O4 k( u+ jENDSETS # }; u# X/ c3 ?
DATA: 3 v0 \; }* O4 a: \
x0, y0, cita, sigma = " F% s" y+ U% L$ A* H/ D0 I
746  1393 161.2   0.8 1 E0 S5 F4 u/ {+ ^6 U
629  375 45.1     0.6
" {2 x; R/ J5 f0 O: [1571 259 309.0    1.3; 4 t" z1 a, \% Y3 ]. R# V$ L
x4 y4 d4 sigma4=155,987,864.3,2.0; * u% m. F. y" V3 a* s4 p
ENDDATA ; s' B9 \4 f9 P6 l  I
calc: 3 @+ P9 q: e  X' P8 Q0 t
@for(VOR:cita=cita*3.14159/180;sigma=sigma*3.14159/180); , K5 R& ?0 @% X6 e" S' ^
endcalc
6 E' B7 b; r; ^9 Y6 P! @min=@sum(VOR:@sqr((x-x0)/(y-y0)-@tan(cita)))+@sqr(d4-@sqrt(@sqr(x -x4)+@sqr(y-y4))); # g. q3 J; Y! R3 J8 q. C% I& x4 v
END
2 }7 k0 e4 L; L% v/ K0 L上述程序必须使用全局求解器进行求解,否则求得的是一个局部最优解。用 “LINGO|OPTIONS”菜单命令启动“Global Solver”选项卡上的“Use Global Solver”选项,然后求解,可以得到全局最优解 x=1019.306 ,y= 987.2909  ,对应的目标函/ u- d9 ]+ g  Y1 ~" p
数值为 0.4729562,这里的解受π 的取值影响很大。 6 U1 [' A+ y3 Q0 `3 r1 c
: a6 f+ B) V# i8 P! m; ]
(3)模型 2 及求解
: r* q& E5 b. O5 f- h* P0 U8 B* x- a" j7 A
注意到这个问题中角度和距离的单位是不一致的(角度为弧度,距离为公里),因 此将这 4 个误差平方和同等对待(相加)不是很合适。并且,4 种设备测量的精度(误差限)不同,而上面的方法根本没有考虑测量误差问题。如何利用测量设备的精度信息? 这就需要看对例中给出的设备精度如何理解。 一种可能的理解是:设备的测量误差是均匀分布的。以 VOR1 为例,目前测得的角度为  ,测量精度为 ,所以实际的角度应该位于区间   内。对其它设备也可以类似理解。由于 很少,即测量精度很高,所以在相应区间内正切函数 tan 的单调性成立。于是可以得到一组不等式:. l* W  D6 S3 G

) @8 D& c2 l$ @/ o! T7 q: z; h5 J
6 Q/ s# g2 y+ D5 X1 p9 e2 T/ n) ?( Z% K1 q2 |( {) l" v
  也就是说,飞机坐标应该位于上述不等式组成的区域内。 由于这里假设设备的测量误差是均匀分布的,所以飞机坐标在这个区域内的每个 点上的可能性应该也是一样的,我们最好应该给出这个区域的 x和 y 坐标的最大值和最小值。于是我们可以分别以 min x ,  max x ,  min y,  max y为目标,以上面的区域限制条件为约束,求出x 和 y 坐标的最大值和最小值。 . |& a5 V9 m# Y, T1 J
以 min x 为例,相应的 LINGO 程序为:  & z1 _/ s3 C/ z7 a! I5 x+ `

/ h' }. M5 G0 l3 l) ]! K9 Y7 wMODEL:
( V  B" N# u5 mTITLE 飞机定位模型2;
0 a! \# Z8 r4 T0 g8 e: bSETS: VOR/1..3/:x0,y0,cita,sigma;
$ w2 F' t, M" L! \* L; X8 y" m/ ^ENDSETS 4 E9 I5 o! m' ~
INIT:
9 y( V# Q! R* l7 b" Cx=1000; y=900; 8 A1 _3 O) p( i/ [
ENDINIT & j  y' B2 e# j, {
DATA: $ B: X6 F& {) x8 N- W
x0, y0, cita, sigma = % n7 M: t( b7 Z0 q$ ^  a  ?2 D
746  1393 161.2   0.8   v( z6 ^: ?+ E7 X% {0 I
629  375 45.1     0.6 8 q% E# m3 a* ?! e4 v
1571 259 309.0    1.3;
8 n6 Z6 }. l" o/ zx4 y4 d4 sigma4=155,987,864.3,2.0; : w5 J" [; S' c
ENDDATA
% g0 O$ w3 d1 E: y% N8 M! E& H. M$ ocalc:
. u/ b5 y* Y) Q2 Y4 W1 R% Q' Z@for(VOR:cita=cita*3.14159/180;sigma=sigma*3.14159/180); & ]; x- K6 T* ?* ^* P# k8 x: E
endcalc
/ C7 Q) n4 c% ]min=x;
( [8 ~3 h2 o7 T1 A@for(VOR:(x-x0)/(y-y0)>@tan(cita-sigma));
: S' ?$ y# `  s* ^( _@for(VOR:(x-x0)/(y-y0)<@tan(cita+sigma)); 5 }. J4 d2 l8 F. s- D
d4-sigma4 <((x-x4)^2+(y-y4)^2)^.5 ;
6 S$ a, w" T% U2 k/ w* k1 Kd4+sigma4 >((x-x4)^2+(y-y4)^2)^.5 ;
& u3 }" d/ X7 N- z( KEND
; P9 v3 J9 l/ ~" u4 p注意:用 LINGO9 求解非线性问题,必须对决策变量进行初始化,否则 LINGO 可 能找不到可行解。决策变量的初值也有范围限制,取的不合适也可能找不到可行解。 求得的 x的最小值为 974. 8433。类似地(只需要换目标函数就可以了),可得 到 x的最大值为 982.2005, y 的最小值为 717.1614, y 的最大值为 733.1582。 因此,最后得到的解是一个比较大的矩形区域,大致为 . + b, v' E' P) p7 B

$ T+ @7 r, F, `* T$ [  ~  (4)模型 3 及求解1 K6 q# O" v: o! B/ k+ A* @% M' @

- |2 P4 {+ ^; {5 q模型 2 得到的只是一个很大的矩形区域,仍不能令人满意。实际上,模型 2 假设 设备的测量误差是均匀分布的,这是很不合理的。一般来说,在多次测量中,应该假设设备的测量误差是正态分布的,而且均值为 0。本例中给出的精度 可以认为是测量( k3 e5 n. J- N3 w
误差的标准差。
7 H* K& @' I: }
, _6 ]& h9 N( D2 y$ R6 s- M6 i9 @在这种理解下,用各自的误差限   对测量误差进行无量纲化(也可以看成是一种加权法)处理是合理的,即求解如下的无约束优化问题更合理。 # E9 _3 F; J: j! I  O# C6 t' ]

# q( x7 O+ I  P9 ^
  M/ J) `( q3 `* k( i( J# C5 g$ R- ]+ Y7 H, e" n* f3 \. j( x# y+ F
由于目标函数是平方和的形式,因此这是一个非线性最小二乘拟合问题。相应的 LINGO 程序为:
, Z# I/ E/ P+ Q% q' Y* a
# r' j! L) r( a& mMODEL: 2 ]2 F% C# a; E0 [; `
TITLE 飞机定位模型3; , B+ H- w& w- n$ d
SETS: % t( m1 S5 [9 v( Z2 K7 k* G$ T
VOR/1..3/:x0,y0,cita,sigma,alpha; ' Y( T7 H2 {4 p/ b
ENDSETS 5 r2 @* a% }- }
INIT: 2 \7 n: E  T! K$ O' {, ], F
x=1000; y=900;   o0 }$ Z$ \$ |" l: ?, O
ENDINIT 6 D- q' S' ?# @% b
DATA:
, F5 K) `' |8 u  ix0, y0, cita, sigma =
8 b0 S1 ~% p4 o5 t/ Y" X746  1393 161.2   0.8 ) }! S$ E9 Y) I' S$ |& R+ x
629  375 45.1     0.6
* a4 h5 K. c) E4 s" O# `1571 259 309.0    1.3; 5 ]: \7 S  W( K. g' X
x4 y4 d4 sigma4=155,987,864.3,2.0;
' c9 G, h# {0 q+ w) |6 P+ F9 M$ FENDDATA 8 p* p4 }4 `. s3 @& {( W2 {
calc: : s( f3 H$ G1 G1 z; b
@for(VOR:cita=cita*3.14159/180;sigma=sigma*3.14159/180); 6 E& R$ E& j6 i0 a4 n; W( a9 Y* z' j7 U
endcalc
5 i6 {" u& L/ a; [: K, N, zmin=@sum(VOR:((alpha-cita)/sigma)^2)+((d4-((x-x4)^2+(y-y4)^2)^.5 )/ sigma4 )^2;
7 L4 ?4 P! y; j" l7 F@for(VOR: @tan(alpha)=(x-x0)/(y-y0) );
- J/ l$ X9 a, r  u4 X$ HEND
$ }' f- A- C/ J 启动 LINGO 的全局最优求解程序求解,得到全局最优解 x=978.3071,y= 723.9841,对应的目标函数的值为 0.668035。 这里得到的误差比模型 1 的大,这是因为模型 1 中使用的是绝对误差,而这里使用的是相对于精度 的误差。对角度而言,分母  很少,所以相对误差比绝对误差大,这是可以理解的。 0 w! T7 {4 R4 B0 M
————————————————
% n6 M9 i: q5 B, W, n* d: p/ _版权声明:本文为CSDN博主「wamg潇潇」的原创文章,遵循CC 4.0 BY-SA版权协议,转载请附上原文出处链接及本声明。
' Q* b4 F9 ^+ i' L原文链接:https://blog.csdn.net/qq_29831163/java/article/details/89389044' D2 W$ K8 L) r8 r0 l$ t

: r! D1 E2 b  ]" W! c- X/ N; w' f9 K
8 N5 M0 Z% Z- V( j' P: J
7 F* Y2 U5 U. ^" {3 x3 G& f




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