这是一篇经纬高(LLA)坐标转东北天坐标(ENU)的详细推导,并给出近似转换的过程和结果
参考资料:
https://blog.csdn.net/qq_34213260/article/details/109133847
ECEF坐标系和ENU坐标系之间的关系如上图所示,各坐标系的定义在此不再赘述。
LLA坐标:Lat、Lon、Alt坐标,表示在ECEF坐标系下,其中Lat和Lon用角度(
。
^。
。
)或弧度(rad)表示,Alt用米(m)表示;
ENU坐标:东北天坐标系下的坐标,该坐标系的原点需要指定,原点向东为x轴,原点向北为y轴,原点指向天为z轴,构成右手直角坐标系,该系下的坐标表示都是米制单位;
LLA坐标转换成ENU坐标的过程主要分为两步:LLA->ECEF->ENU
其中主要参数的定义如下:
b
=
6356752.3142
b=6356752.3142
b
=
6
3
5
6
7
5
2
.
3
1
4
2
e
2
=
f
(
2
−
f
)
e^2=f(2-f)
e
2
=
f
(
2
−
f
)
N
=
a
1
−
e
2
s
i
n
2
(
l
a
t
)
N=\frac{a}{\sqrt{1-e^2sin^2(lat)}}
N
=
1
−
e
2
s
i
n
2
(
l
a
t
)
a
其中b为椭球短半径,e为椭球偏心率
(1)LLA->ECEF:(无需给定起点,一对一转换)
从最上面一幅图中可以轻易得到同一点在这两个坐标系之间的转换关系,如下:
X
e
c
e
f
=
(
N
+
a
l
t
)
c
o
s
(
l
a
t
)
c
o
s
(
l
o
n
)
X_{ecef}=(N+alt)cos(lat)cos(lon)
X
e
c
e
f
=
(
N
+
a
l
t
)
c
o
s
(
l
a
t
)
c
o
s
(
l
o
n
)
Y
e
c
e
f
=
(
N
+
a
l
t
)
c
o
s
(
l
a
t
)
s
i
n
(
l
o
n
)
Y_{ecef}=(N+alt)cos(lat)sin(lon)
Y
e
c
e
f
=
(
N
+
a
l
t
)
c
o
s
(
l
a
t
)
s
i
n
(
l
o
n
)
Z
e
c
e
f
=
(
N
(
1
−
e
2
)
+
a
l
t
)
s
i
n
(
l
a
t
)
Z_{ecef}=(N(1-e^2)+alt)sin(lat)
Z
e
c
e
f
=
(
N
(
1
−
e
2
)
+
a
l
t
)
s
i
n
(
l
a
t
)
(2)ECEF->ENU:(需要给定起点)
假设ENU坐标系的
坐标原点
对应的ECEF坐标和LLA坐标分别为:
O
e
c
e
f
=
(
X
0
,
Y
0
,
Z
0
)
O_{ecef}=(X_0,Y_0,Z_0)
O
e
c
e
f
=
(
X
0
,
Y
0
,
Z
0
)
O
l
l
a
=
(
l
a
t
0
,
l
o
n
0
,
a
l
t
0
)
O_{lla}=(lat_0,lon_0,alt_0)
O
l
l
a
=
(
l
a
t
0
,
l
o
n
0
,
a
l
t
0
)
假设空间中有另一点P,且:
P
e
c
e
f
=
(
X
,
Y
,
Z
)
P_{ecef}=(X,Y,Z)
P
e
c
e
f
=
(
X
,
Y
,
Z
)
则P在ENU系下的坐标为:
P
e
n
u
=
R
E
C
E
F
E
N
U
(
P
e
c
e
f
−
O
e
c
e
f
)
(1)
P_{enu}=R_{ECEF}^{ENU}(P_{ecef}-O_{ecef})\tag{1}
P
e
n
u
=
R
E
C
E
F
E
N
U
(
P
e
c
e
f
−
O
e
c
e
f
)
(
1
)
其中只有
R
E
C
E
F
E
N
U
R_{ECEF}^{ENU}
R
E
C
E
F
E
N
U
是未知的,下面对其进行推导:
R
E
C
E
F
E
N
U
R_{ECEF}^{ENU}
R
E
C
E
F
E
N
U
可以分解为如下三个旋转过程:
ECEF–>绕
Z
e
c
e
f
Z_{ecef}
Z
e
c
e
f
轴逆时针旋转
λ
\lambda
λ
(经度)–>绕
Y
e
c
e
f
′
Y_{ecef}^{‘}
Y
e
c
e
f
′
轴逆时针旋转(
90
−
ϕ
90-\phi
9
0
−
ϕ
)(
ϕ
:
\phi:
ϕ
:
纬度)–>绕
Z
e
c
e
f
′
′
Z_{ecef}^{”}
Z
e
c
e
f
′
′
逆时针旋转90–>ENU
上述问题是典型的空间中点不动,坐标系转动的问题,按顺序记三次旋转分别为
R
1
、
R
2
、
R
3
R_1、R_2、R_3
R
1
、
R
2
、
R
3
,则:
R
1
=
[
c
o
s
(
λ
)
s
i
n
(
λ
)
0
−
s
i
n
(
λ
)
c
o
s
(
λ
)
0
0
0
1
]
R_1= \begin{bmatrix} cos(\lambda) & sin(\lambda) & 0 \\ -sin(\lambda) & cos(\lambda) & 0 \\ 0 & 0 & 1 \end{bmatrix}
R
1
=
⎣
⎡
c
o
s
(
λ
)
−
s
i
n
(
λ
)
0
s
i
n
(
λ
)
c
o
s
(
λ
)
0
0
0
1
⎦
⎤
R
2
=
[
s
i
n
(
ϕ
)
0
−
c
o
s
(
ϕ
)
0
1
0
c
o
s
(
ϕ
)
0
s
i
n
(
ϕ
)
]
R_2= \begin{bmatrix} sin(\phi) & 0 & -cos(\phi) \\ 0 & 1 & 0 \\ cos(\phi) & 0 & sin(\phi) \end{bmatrix}
R
2
=
⎣
⎡
s
i
n
(
ϕ
)
0
c
o
s
(
ϕ
)
0
1
0
−
c
o
s
(
ϕ
)
0
s
i
n
(
ϕ
)
⎦
⎤
R
3
=
[
0
1
0
−
1
0
0
0
0
1
]
R_3= \begin{bmatrix} 0 & 1 & 0 \\ -1 & 0 & 0 \\ 0 & 0 & 1 \end{bmatrix}
R
3
=
⎣
⎡
0
−
1
0
1
0
0
0
0
1
⎦
⎤
则:
R
E
C
E
F
E
N
U
=
R
3
∗
R
2
∗
R
1
=
[
−
s
i
n
(
λ
)
c
o
s
(
λ
)
0
−
s
i
n
(
ϕ
)
c
o
s
(
λ
)
−
s
i
n
(
ϕ
)
s
i
n
(
λ
)
c
o
s
(
ϕ
)
c
o
s
(
ϕ
)
c
o
s
(
λ
)
c
o
s
(
ϕ
)
s
i
n
(
λ
)
s
i
n
(
ϕ
)
]
R_{ECEF}^{ENU}=R_3*R_2*R_1= \begin{bmatrix} -sin(\lambda) & cos(\lambda) & 0 \\ -sin(\phi)cos(\lambda) & -sin(\phi)sin(\lambda) & cos(\phi) \\ cos(\phi)cos(\lambda) & cos(\phi)sin(\lambda) & sin(\phi) \end{bmatrix}
R
E
C
E
F
E
N
U
=
R
3
∗
R
2
∗
R
1
=
⎣
⎡
−
s
i
n
(
λ
)
−
s
i
n
(
ϕ
)
c
o
s
(
λ
)
c
o
s
(
ϕ
)
c
o
s
(
λ
)
c
o
s
(
λ
)
−
s
i
n
(
ϕ
)
s
i
n
(
λ
)
c
o
s
(
ϕ
)
s
i
n
(
λ
)
0
c
o
s
(
ϕ
)
s
i
n
(
ϕ
)
⎦
⎤
将上式带入到公式(1)中可以得到:
P
e
n
u
=
R
E
C
E
F
E
N
U
(
P
e
c
e
f
−
O
e
c
e
f
)
=
[
−
s
i
n
(
l
o
n
0
)
c
o
s
(
l
o
n
0
)
0
−
s
i
n
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
−
s
i
n
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
c
o
s
(
l
a
t
0
)
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
s
i
n
(
l
a
t
0
)
]
∗
[
X
−
X
0
Y
−
Y
0
Z
−
Z
0
]
(2)
P_{enu}=R_{ECEF}^{ENU}(P_{ecef}-O_{ecef})= \begin{bmatrix} -sin(lon_0) & cos(lon_0) & 0 \\ -sin(lat_0)cos(lon_0) & -sin(lat_0)sin(lon_0) & cos(lat_0) \\ cos(lat_0)cos(lon_0) & cos(lat_0)sin(lon_0) & sin(lat_0) \end{bmatrix}* \begin{bmatrix} X-X_0 \\ Y-Y_0 \\ Z-Z_0 \end{bmatrix}\tag{2}
P
e
n
u
=
R
E
C
E
F
E
N
U
(
P
e
c
e
f
−
O
e
c
e
f
)
=
⎣
⎡
−
s
i
n
(
l
o
n
0
)
−
s
i
n
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
c
o
s
(
l
o
n
0
)
−
s
i
n
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
0
c
o
s
(
l
a
t
0
)
s
i
n
(
l
a
t
0
)
⎦
⎤
∗
⎣
⎡
X
−
X
0
Y
−
Y
0
Z
−
Z
0
⎦
⎤
(
2
)
至此完成了LLA坐标到ENU坐标的转换,且无近似,下面对公式(2)进行近似推导
由于
X
=
(
N
+
a
l
t
)
c
o
s
(
l
a
t
)
c
o
s
(
l
o
n
)
X=(N+alt)cos(lat)cos(lon)
X
=
(
N
+
a
l
t
)
c
o
s
(
l
a
t
)
c
o
s
(
l
o
n
)
Y
=
(
N
+
a
l
t
)
c
o
s
(
l
a
t
)
s
i
n
(
l
o
n
)
Y=(N+alt)cos(lat)sin(lon)
Y
=
(
N
+
a
l
t
)
c
o
s
(
l
a
t
)
s
i
n
(
l
o
n
)
Z
=
(
N
(
1
−
e
2
)
+
a
l
t
)
s
i
n
(
l
a
t
)
Z=(N(1-e^2)+alt)sin(lat)
Z
=
(
N
(
1
−
e
2
)
+
a
l
t
)
s
i
n
(
l
a
t
)
X
0
=
(
N
0
+
a
l
t
0
)
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
X_0=(N_0+alt_0)cos(lat_0)cos(lon_0)
X
0
=
(
N
0
+
a
l
t
0
)
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
Y
0
=
(
N
0
+
a
l
t
0
)
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
Y_0=(N_0+alt_0)cos(lat_0)sin(lon_0)
Y
0
=
(
N
0
+
a
l
t
0
)
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
Z
0
=
(
N
0
(
1
−
e
2
)
+
a
l
t
0
)
s
i
n
(
l
a
t
0
)
Z_0=(N_0(1-e^2)+alt_0)sin(lat_0)
Z
0
=
(
N
0
(
1
−
e
2
)
+
a
l
t
0
)
s
i
n
(
l
a
t
0
)
所以
X
−
X
0
=
(
N
+
a
l
t
)
c
o
s
(
l
a
t
)
c
o
s
(
l
o
n
)
−
(
N
0
+
a
l
t
0
)
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
=
(
N
+
a
l
t
)
c
o
s
(
l
a
t
)
c
o
s
(
l
o
n
)
−
(
N
+
a
l
t
0
)
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
=
(
N
+
a
l
t
0
+
δ
a
l
t
)
c
o
s
(
l
a
t
0
+
δ
l
a
t
)
c
o
s
(
l
o
n
0
+
δ
l
o
n
)
−
(
N
+
a
l
t
0
)
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
=
(
N
+
a
l
t
0
)
c
o
s
(
l
a
t
0
+
δ
l
a
t
)
c
o
s
(
l
o
n
0
+
δ
l
o
n
)
−
(
N
+
a
l
t
0
)
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
+
δ
a
l
t
c
o
s
(
l
a
t
0
+
δ
l
a
t
)
c
o
s
(
l
o
n
0
+
δ
l
o
n
)
=
(
N
+
a
l
t
0
)
[
c
o
s
(
l
a
t
0
+
δ
l
a
t
)
c
o
s
(
l
o
n
0
+
δ
l
o
n
)
−
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
]
+
δ
a
l
t
c
o
s
(
l
a
t
0
+
δ
l
a
t
)
c
o
s
(
l
o
n
0
+
δ
l
o
n
)
=
(
N
+
a
l
t
0
)
[
(
c
o
s
(
l
a
t
0
)
c
o
s
(
δ
l
a
t
)
−
s
i
n
(
l
a
t
0
)
s
i
n
(
δ
l
a
t
)
)
(
c
o
s
(
l
o
n
0
)
c
o
s
(
δ
l
o
n
)
−
s
i
n
(
l
o
n
0
)
s
i
n
(
δ
l
o
n
)
)
−
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
]
+
δ
a
l
t
c
o
s
(
l
a
t
0
+
δ
l
a
t
)
c
o
s
(
l
o
n
0
+
δ
l
o
n
)
=
(
N
+
a
l
t
0
)
(
−
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
c
o
s
(
δ
l
a
t
)
s
i
n
(
δ
l
o
n
)
−
s
i
n
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
s
i
n
(
δ
l
a
t
)
c
o
s
(
δ
l
o
n
)
)
+
δ
a
l
t
c
o
s
(
l
a
t
0
+
δ
l
a
t
)
c
o
s
(
l
o
n
0
+
δ
l
o
n
)
=
(
N
+
a
l
t
0
)
(
−
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
∗
δ
l
o
n
−
s
i
n
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
∗
δ
l
a
t
)
+
δ
a
l
t
c
o
s
(
l
a
t
0
+
δ
l
a
t
)
c
o
s
(
l
o
n
0
+
δ
l
o
n
)
=
(
N
+
a
l
t
0
)
(
−
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
∗
δ
l
o
n
−
s
i
n
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
∗
δ
l
a
t
)
+
δ
a
l
t
[
(
c
o
s
(
l
a
t
0
)
−
s
i
n
(
l
a
t
0
)
∗
δ
l
a
t
)
(
c
o
s
(
l
o
n
0
)
−
s
i
n
(
l
o
n
0
)
∗
δ
l
o
n
)
]
=
(
N
+
a
l
t
0
)
(
−
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
∗
δ
l
o
n
−
s
i
n
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
∗
δ
l
a
t
)
+
δ
a
l
t
[
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
−
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
∗
δ
l
o
n
−
c
o
s
(
l
o
n
0
)
s
i
n
(
l
a
t
0
)
∗
δ
l
a
t
]
=
(
N
+
a
l
t
0
)
(
−
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
∗
δ
l
o
n
−
s
i
n
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
∗
δ
l
a
t
)
+
δ
a
l
t
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
\begin{aligned} X-X_0 &= (N+alt)cos(lat)cos(lon)-(N_0+alt_0)cos(lat_0)cos(lon_0)\\ &= (N+alt)cos(lat)cos(lon)-(N+alt_0)cos(lat_0)cos(lon_0)\\ &= (N+alt_0+\delta{alt})cos(lat_0+\delta{lat})cos(lon_0+\delta{lon})-(N+alt_0)cos(lat_0)cos(lon_0)\\ &= (N+alt_0)cos(lat_0+\delta{lat})cos(lon_0+\delta{lon})-(N+alt_0)cos(lat_0)cos(lon_0)+\delta{alt}cos(lat_0+\delta{lat})cos(lon_0+\delta{lon})\\ &= (N+alt_0)\left[cos(lat_0+\delta{lat})cos(lon_0+\delta{lon})-cos(lat_0)cos(lon_0) \right]+\delta{alt}cos(lat_0+\delta{lat})cos(lon_0+\delta{lon})\\ &= (N+alt_0)\left[(cos(lat_0)cos(\delta{lat})-sin(lat_0)sin(\delta{lat}))(cos(lon_0)cos(\delta{lon})-sin(lon_0)sin(\delta{lon}))-cos(lat_0)cos(lon_0) \right]+\delta{alt}cos(lat_0+\delta{lat})cos(lon_0+\delta{lon})\\ &= (N+alt_0)(-cos(lat_0)sin(lon_0)cos(\delta{lat})sin(\delta{lon})-sin(lat_0)cos(lon_0)sin(\delta{lat})cos(\delta{lon}))+\delta{alt}cos(lat_0+\delta{lat})cos(lon_0+\delta{lon})\\ &= (N+alt_0)(-cos(lat_0)sin(lon_0)*\delta{lon}-sin(lat_0)cos(lon_0)*\delta{lat})+\delta{alt}cos(lat_0+\delta{lat})cos(lon_0+\delta{lon})\\ &= (N+alt_0)(-cos(lat_0)sin(lon_0)*\delta{lon}-sin(lat_0)cos(lon_0)*\delta{lat})+\delta{alt}\left[(cos(lat_0)-sin(lat_0)*\delta{lat})(cos(lon_0)-sin(lon_0)*\delta{lon})\right]\\ &= (N+alt_0)(-cos(lat_0)sin(lon_0)*\delta{lon}-sin(lat_0)cos(lon_0)*\delta{lat})+\delta{alt}\left[cos(lat_0)cos(lon_0)-cos(lat_0)sin(lon_0)*\delta{lon}-cos(lon_0)sin(lat_0)*\delta{lat} \right]\\ &= (N+alt_0)(-cos(lat_0)sin(lon_0)*\delta{lon}-sin(lat_0)cos(lon_0)*\delta{lat})+\delta{alt}cos(lat_0)cos(lon_0) \end{aligned}
X
−
X
0
=
(
N
+
a
l
t
)
c
o
s
(
l
a
t
)
c
o
s
(
l
o
n
)
−
(
N
0
+
a
l
t
0
)
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
=
(
N
+
a
l
t
)
c
o
s
(
l
a
t
)
c
o
s
(
l
o
n
)
−
(
N
+
a
l
t
0
)
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
=
(
N
+
a
l
t
0
+
δ
a
l
t
)
c
o
s
(
l
a
t
0
+
δ
l
a
t
)
c
o
s
(
l
o
n
0
+
δ
l
o
n
)
−
(
N
+
a
l
t
0
)
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
=
(
N
+
a
l
t
0
)
c
o
s
(
l
a
t
0
+
δ
l
a
t
)
c
o
s
(
l
o
n
0
+
δ
l
o
n
)
−
(
N
+
a
l
t
0
)
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
+
δ
a
l
t
c
o
s
(
l
a
t
0
+
δ
l
a
t
)
c
o
s
(
l
o
n
0
+
δ
l
o
n
)
=
(
N
+
a
l
t
0
)
[
c
o
s
(
l
a
t
0
+
δ
l
a
t
)
c
o
s
(
l
o
n
0
+
δ
l
o
n
)
−
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
]
+
δ
a
l
t
c
o
s
(
l
a
t
0
+
δ
l
a
t
)
c
o
s
(
l
o
n
0
+
δ
l
o
n
)
=
(
N
+
a
l
t
0
)
[
(
c
o
s
(
l
a
t
0
)
c
o
s
(
δ
l
a
t
)
−
s
i
n
(
l
a
t
0
)
s
i
n
(
δ
l
a
t
)
)
(
c
o
s
(
l
o
n
0
)
c
o
s
(
δ
l
o
n
)
−
s
i
n
(
l
o
n
0
)
s
i
n
(
δ
l
o
n
)
)
−
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
]
+
δ
a
l
t
c
o
s
(
l
a
t
0
+
δ
l
a
t
)
c
o
s
(
l
o
n
0
+
δ
l
o
n
)
=
(
N
+
a
l
t
0
)
(
−
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
c
o
s
(
δ
l
a
t
)
s
i
n
(
δ
l
o
n
)
−
s
i
n
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
s
i
n
(
δ
l
a
t
)
c
o
s
(
δ
l
o
n
)
)
+
δ
a
l
t
c
o
s
(
l
a
t
0
+
δ
l
a
t
)
c
o
s
(
l
o
n
0
+
δ
l
o
n
)
=
(
N
+
a
l
t
0
)
(
−
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
∗
δ
l
o
n
−
s
i
n
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
∗
δ
l
a
t
)
+
δ
a
l
t
c
o
s
(
l
a
t
0
+
δ
l
a
t
)
c
o
s
(
l
o
n
0
+
δ
l
o
n
)
=
(
N
+
a
l
t
0
)
(
−
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
∗
δ
l
o
n
−
s
i
n
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
∗
δ
l
a
t
)
+
δ
a
l
t
[
(
c
o
s
(
l
a
t
0
)
−
s
i
n
(
l
a
t
0
)
∗
δ
l
a
t
)
(
c
o
s
(
l
o
n
0
)
−
s
i
n
(
l
o
n
0
)
∗
δ
l
o
n
)
]
=
(
N
+
a
l
t
0
)
(
−
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
∗
δ
l
o
n
−
s
i
n
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
∗
δ
l
a
t
)
+
δ
a
l
t
[
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
−
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
∗
δ
l
o
n
−
c
o
s
(
l
o
n
0
)
s
i
n
(
l
a
t
0
)
∗
δ
l
a
t
]
=
(
N
+
a
l
t
0
)
(
−
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
∗
δ
l
o
n
−
s
i
n
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
∗
δ
l
a
t
)
+
δ
a
l
t
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
同理,有
Y
−
Y
0
=
(
N
+
a
l
t
0
)
(
δ
l
o
n
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
−
δ
l
a
t
s
i
n
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
)
+
δ
a
l
t
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
Y-Y_0=(N+alt_0)(\delta{lon}cos(lat_0)cos(lon_0)-\delta{lat}sin(lat_0)sin(lon_0))+\delta{alt}cos(lat_0)sin(lon_0)
Y
−
Y
0
=
(
N
+
a
l
t
0
)
(
δ
l
o
n
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
−
δ
l
a
t
s
i
n
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
)
+
δ
a
l
t
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
将以上两式带入到(2)中可以得到点P在ENU系下的东向坐标:
e
=
−
s
i
n
(
l
o
n
0
)
∗
(
X
−
X
0
)
+
c
o
s
(
l
o
n
0
)
∗
(
Y
−
Y
0
)
=
−
s
i
n
(
l
o
n
0
)
(
(
N
+
a
l
t
0
)
(
−
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
∗
δ
l
o
n
−
s
i
n
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
∗
δ
l
a
t
)
+
δ
a
l
t
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
)
+
c
o
s
(
l
o
n
0
)
(
(
N
+
a
l
t
0
)
(
δ
l
o
n
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
−
δ
l
a
t
s
i
n
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
)
+
δ
a
l
t
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
)
=
(
N
+
a
l
t
0
)
(
s
i
n
(
l
o
n
0
)
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
∗
δ
l
o
n
)
+
(
N
+
a
l
t
0
)
(
c
o
s
(
l
a
t
0
)
c
o
s
2
(
l
o
n
0
)
∗
δ
l
o
n
)
=
(
N
+
a
l
t
0
)
∗
δ
l
o
n
c
o
s
(
l
a
t
0
)
(
s
i
n
2
(
l
o
n
0
)
+
c
o
s
2
(
l
o
n
0
)
)
=
(
N
+
a
l
t
0
)
∗
δ
l
o
n
c
o
s
(
l
a
t
0
)
≈
a
∗
δ
l
o
n
c
o
s
(
l
a
t
0
)
\begin{aligned} e &= -sin(lon_0)*(X-X_0)+cos(lon_0)*(Y-Y_0)\\ &= -sin(lon_0)((N+alt_0)(-cos(lat_0)sin(lon_0)*\delta{lon}-sin(lat_0)cos(lon_0)*\delta{lat})+\delta{alt}cos(lat_0)cos(lon_0))+cos(lon_0)((N+alt_0)(\delta{lon}cos(lat_0)cos(lon_0)-\delta{lat}sin(lat_0)sin(lon_0))+\delta{alt}cos(lat_0)sin(lon_0))\\ &= (N+alt_0)(sin(lon_0)cos(lat_0)sin(lon_0)*\delta{lon})+(N+alt_0)(cos(lat_0)cos^2(lon_0)*\delta{lon})\\ &= (N+alt_0)*\delta{lon}cos(lat_0)(sin^2(lon_0)+cos^2(lon_0))\\ &= (N+alt_0)*\delta{lon}cos(lat_0)\\ &\approx a*\delta{lon}cos(lat_0) \end{aligned}
e
=
−
s
i
n
(
l
o
n
0
)
∗
(
X
−
X
0
)
+
c
o
s
(
l
o
n
0
)
∗
(
Y
−
Y
0
)
=
−
s
i
n
(
l
o
n
0
)
(
(
N
+
a
l
t
0
)
(
−
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
∗
δ
l
o
n
−
s
i
n
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
∗
δ
l
a
t
)
+
δ
a
l
t
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
)
+
c
o
s
(
l
o
n
0
)
(
(
N
+
a
l
t
0
)
(
δ
l
o
n
c
o
s
(
l
a
t
0
)
c
o
s
(
l
o
n
0
)
−
δ
l
a
t
s
i
n
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
)
+
δ
a
l
t
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
)
=
(
N
+
a
l
t
0
)
(
s
i
n
(
l
o
n
0
)
c
o
s
(
l
a
t
0
)
s
i
n
(
l
o
n
0
)
∗
δ
l
o
n
)
+
(
N
+
a
l
t
0
)
(
c
o
s
(
l
a
t
0
)
c
o
s
2
(
l
o
n
0
)
∗
δ
l
o
n
)
=
(
N
+
a
l
t
0
)
∗
δ
l
o
n
c
o
s
(
l
a
t
0
)
(
s
i
n
2
(
l
o
n
0
)
+
c
o
s
2
(
l
o
n
0
)
)
=
(
N
+
a
l
t
0
)
∗
δ
l
o
n
c
o
s
(
l
a
t
0
)
≈
a
∗
δ
l
o
n
c
o
s
(
l
a
t
0
)
类似的,可以得到n、u坐标,最终得到如下的近似结果:
P
e
n
u
=
[
e
n
u
]
=
[
a
∗
δ
l
o
n
c
o
s
(
l
a
t
0
)
a
∗
δ
l
a
t
δ
a
l
t
]
P_{enu}= \begin{bmatrix} e\\n\\u \end{bmatrix}= \begin{bmatrix} a*\delta{lon}cos(lat_0)\\a*\delta{lat}\\\delta{alt} \end{bmatrix}
P
e
n
u
=
⎣
⎡
e
n
u
⎦
⎤
=
⎣
⎡
a
∗
δ
l
o
n
c
o
s
(
l
a
t
0
)
a
∗
δ
l
a
t
δ
a
l
t
⎦
⎤