|
1 | 1 | """ |
2 | 2 | Transforms involving DCA (Downrange, Crossrange, Above) |
3 | 3 |
|
4 | | -This module provides functions to convert coordinates between DCA and |
| 4 | +This module provides functions to convert coordinates between DCA and |
5 | 5 | other coordinate systems such as ENU (East, North, Up), NED (North, East, Down), |
6 | | -ECEF (Earth-Centered, Earth-Fixed), and geodetic coordinates (latitude, longitude, altitude). |
| 6 | +ECEF (Earth-Centered, Earth-Fixed), and geodetic coordinates (latitude, longitude, altitude). |
7 | 7 |
|
8 | 8 | It also includes transformations to/from AER (Azimuth, Elevation, Range). |
9 | 9 |
|
|
21 | 21 | - dca2aer: Convert DCA to AER coordinates. |
22 | 22 | """ |
23 | 23 |
|
| 24 | +from __future__ import annotations |
| 25 | + |
24 | 26 | from .mathfun import sin, cos, radians |
25 | 27 | from .ecef import ecef2enu, enu2ecef |
26 | 28 | from .enu import geodetic2enu, enu2geodetic, aer2enu, enu2aer |
|
39 | 41 | "dca2aer", |
40 | 42 | ] |
41 | 43 |
|
42 | | -ELL = Ellipsoid.from_name("wgs84") # Default reference ellipsoid (WGS84) |
43 | | - |
44 | 44 |
|
45 | | -def enu2dca(e, n, u, heading, deg=True): |
| 45 | +def enu2dca(e, n, u, heading, deg: bool = True): |
46 | 46 | """ |
47 | 47 | Converts ENU (East, North, Up) coordinates to DCA (Downrange, Crossrange, Above). |
48 | 48 | """ |
| 49 | + |
49 | 50 | if deg: |
50 | 51 | heading = radians(heading) |
| 52 | + |
51 | 53 | dr = e * sin(heading) + n * cos(heading) |
52 | 54 | cr = -e * cos(heading) + n * sin(heading) |
53 | | - a = u |
54 | | - return dr, cr, a |
| 55 | + |
| 56 | + return dr, cr, u |
55 | 57 |
|
56 | 58 |
|
57 | | -def dca2enu(dr, cr, a, heading, deg=True): |
| 59 | +def dca2enu(dr, cr, above, heading, deg: bool = True): |
58 | 60 | """ |
59 | 61 | Converts DCA (Downrange, Crossrange, Above) coordinates to ENU (East, North, Up). |
60 | 62 | """ |
| 63 | + |
61 | 64 | if deg: |
62 | 65 | heading = radians(heading) |
| 66 | + |
63 | 67 | e = dr * sin(heading) - cr * cos(heading) |
64 | 68 | n = dr * cos(heading) + cr * sin(heading) |
65 | | - u = a |
66 | | - return e, n, u |
| 69 | + |
| 70 | + return e, n, above |
67 | 71 |
|
68 | 72 |
|
69 | | -def dca2ned(dr, cr, a, heading, deg=True): |
| 73 | +def dca2ned(dr, cr, above, heading, deg: bool = True): |
70 | 74 | """ |
71 | 75 | Converts DCA (Downrange, Crossrange, Above) coordinates to NED (North, East, Down). |
72 | 76 | """ |
73 | | - e, n, u = dca2enu(dr, cr, a, heading, deg=deg) |
| 77 | + e, n, u = dca2enu(dr, cr, above, heading, deg=deg) |
74 | 78 | return n, e, -u |
75 | 79 |
|
76 | 80 |
|
77 | | -def ned2dca(n, e, d, heading, deg=True): |
| 81 | +def ned2dca(n, e, d, heading, deg: bool = True): |
78 | 82 | """ |
79 | 83 | Converts NED (North, East, Down) coordinates to DCA (Downrange, Crossrange, Above). |
80 | 84 | """ |
81 | | - dr, cr, a = enu2dca(e, n, -d, heading, deg=deg) |
82 | | - return dr, cr, a |
| 85 | + dr, cr, above = enu2dca(e, n, -d, heading, deg=deg) |
| 86 | + return dr, cr, above |
83 | 87 |
|
84 | 88 |
|
85 | | -def ecef2dca(x, y, z, lat0, lon0, h0, heading, ell=ELL, deg=True): |
| 89 | +def ecef2dca(x, y, z, lat0, lon0, h0, heading, ell: Ellipsoid | None = None, deg: bool = True): |
86 | 90 | """ |
87 | 91 | Converts ECEF (Earth-Centered, Earth-Fixed) coordinates to DCA (Downrange, Crossrange, Above). |
88 | 92 | """ |
| 93 | + |
89 | 94 | e, n, u = ecef2enu(x, y, z, lat0, lon0, h0, ell, deg=deg) |
90 | 95 | return enu2dca(e, n, u, heading, deg=deg) |
91 | 96 |
|
92 | 97 |
|
93 | | -def dca2ecef(dr, cr, a, lat0, lon0, h0, heading, ell=ELL, deg=True): |
| 98 | +def dca2ecef( |
| 99 | + dr, cr, above, lat0, lon0, h0, heading, ell: Ellipsoid | None = None, deg: bool = True |
| 100 | +): |
94 | 101 | """ |
95 | 102 | Converts DCA (Downrange, Crossrange, Above) coordinates to ECEF (Earth-Centered, Earth-Fixed) coordinates. |
96 | 103 | """ |
97 | | - e, n, u = dca2enu(dr, cr, a, heading, deg=deg) |
| 104 | + |
| 105 | + e, n, u = dca2enu(dr, cr, above, heading, deg=deg) |
98 | 106 | return enu2ecef(e, n, u, lat0, lon0, h0, ell, deg=deg) |
99 | 107 |
|
100 | 108 |
|
101 | | -def geodetic2dca(lat, lon, h, lat0, lon0, h0, heading, ell=ELL, deg=True): |
| 109 | +def geodetic2dca( |
| 110 | + lat, lon, h, lat0, lon0, h0, heading, ell: Ellipsoid | None = None, deg: bool = True |
| 111 | +): |
102 | 112 | """ |
103 | 113 | Converts geodetic coordinates (latitude, longitude, altitude) to DCA (Downrange, Crossrange, Above) coordinates. |
104 | 114 | """ |
105 | 115 | e, n, u = geodetic2enu(lat, lon, h, lat0, lon0, h0, ell, deg=deg) |
106 | 116 | return enu2dca(e, n, u, heading, deg=deg) |
107 | 117 |
|
108 | 118 |
|
109 | | -def dca2geodetic(dr, cr, a, lat0, lon0, h0, heading, ell=ELL, deg=True): |
| 119 | +def dca2geodetic( |
| 120 | + dr, cr, above, lat0, lon0, h0, heading, ell: Ellipsoid | None = None, deg: bool = True |
| 121 | +): |
110 | 122 | """ |
111 | 123 | Converts DCA (Downrange, Crossrange, Above) coordinates to geodetic coordinates (latitude, longitude, altitude). |
112 | 124 | """ |
113 | | - e, n, u = dca2enu(dr, cr, a, heading, deg=deg) |
| 125 | + e, n, u = dca2enu(dr, cr, above, heading, deg=deg) |
114 | 126 | return enu2geodetic(e, n, u, lat0, lon0, h0, ell, deg=deg) |
115 | 127 |
|
116 | 128 |
|
117 | | -def aer2dca(az, el, srange, heading, deg=True): |
| 129 | +def aer2dca(az, el, srange, heading, deg: bool = True): |
118 | 130 | """ |
119 | 131 | Converts AER (Azimuth, Elevation, Range) coordinates to DCA (Downrange, Crossrange, Above). |
120 | 132 | """ |
121 | 133 | e, n, u = aer2enu(az, el, srange, deg=deg) |
122 | 134 | return enu2dca(e, n, u, heading, deg=deg) |
123 | 135 |
|
124 | 136 |
|
125 | | -def dca2aer(dr, cr, a, heading, deg=True): |
| 137 | +def dca2aer(dr, cr, above, heading, deg: bool = True): |
126 | 138 | """ |
127 | 139 | Converts DCA (Downrange, Crossrange, Above) coordinates to AER (Azimuth, Elevation, Range). |
128 | 140 | """ |
129 | | - e, n, u = dca2enu(dr, cr, a, heading, deg=deg) |
| 141 | + e, n, u = dca2enu(dr, cr, above, heading, deg=deg) |
130 | 142 | return enu2aer(e, n, u, deg=deg) |
0 commit comments