mirror of
https://github.com/30hours/3lips.git
synced 2024-11-08 12:25:42 +00:00
Cleanup geometry
This commit is contained in:
parent
7ddd8ad533
commit
8d40699da9
2 changed files with 1 additions and 62 deletions
|
@ -5,7 +5,6 @@
|
|||
|
||||
import math
|
||||
import numpy as np
|
||||
import pyproj
|
||||
|
||||
class Geometry:
|
||||
|
||||
|
@ -39,69 +38,10 @@ class Geometry:
|
|||
# Calculate ECEF coordinates
|
||||
ecef_x = (N + altitude) * cos_lat * math.cos(lon_rad)
|
||||
ecef_y = (N + altitude) * cos_lat * math.sin(lon_rad)
|
||||
#ecef_z = (N * (1 - f) + altitude) * sin_lat
|
||||
ecef_z = ((1-(e**2)) * N + altitude) * sin_lat
|
||||
|
||||
return ecef_x, ecef_y, ecef_z
|
||||
|
||||
# def ecef2lla(x, y, z):
|
||||
|
||||
# # WGS84 parameters
|
||||
# a = 6378137.0 # semi-major axis in meters
|
||||
# f = 1 / 298.257223563 # flattening
|
||||
# b = (1 - f) * a # semi-minor axis
|
||||
|
||||
# # Calculate eccentricity squared
|
||||
# e_squared = (a**2 - b**2) / a**2
|
||||
|
||||
# # Calculate longitude
|
||||
# lon = math.atan2(y, x)
|
||||
|
||||
# # Calculate distance from the origin to the XY plane
|
||||
# r = math.sqrt(x**2 + y**2)
|
||||
|
||||
# # Calculate latitude
|
||||
# lat = math.atan2(z, r)
|
||||
|
||||
# # Calculate altitude
|
||||
# sin_lat = math.sin(lat)
|
||||
# N = a / math.sqrt(1 - e_squared * sin_lat**2)
|
||||
# alt = r / math.cos(lat) - N
|
||||
|
||||
# return math.degrees(lat), math.degrees(lon), alt
|
||||
|
||||
# def ecef2lla(x, y, z):
|
||||
|
||||
# # WGS84 ellipsoid constants
|
||||
# a = 6378137
|
||||
# es = (8.1819190842622e-2) ** 2
|
||||
|
||||
# # Calculations
|
||||
# b = np.sqrt(a ** 2 * (1 - es))
|
||||
# ep = (a ** 2 - b ** 2) / b ** 2
|
||||
|
||||
# p = np.sqrt(x ** 2 + y ** 2)
|
||||
# th = np.arctan2(a * z, b * p)
|
||||
# lon = np.arctan2(y, x)
|
||||
# lat = np.arctan2(z + ep ** 2 * b * np.sin(th) ** 3, p - es ** 2 * a * np.cos(th) ** 3)
|
||||
# N = a / np.sqrt(1 - es * np.sin(lat) ** 2)
|
||||
# alt = p / np.cos(lat) - N
|
||||
|
||||
# # Return lon in range [0, 2*pi)
|
||||
# lon = np.mod(lon, 2 * np.pi)
|
||||
|
||||
# # Correct for numerical instability in altitude near exact poles
|
||||
# # (after this correction, error is about 2 millimeters, which is about
|
||||
# # the same as the numerical precision of the overall function)
|
||||
# k = np.abs(x) < 1e-3 # Use x for the condition
|
||||
# alt = np.where(k, np.abs(z) - b, alt)
|
||||
|
||||
# # Convert radians to degrees
|
||||
# lat = lat * (180 / np.pi)
|
||||
# lon = lon * (180 / np.pi)
|
||||
|
||||
# return lat, lon, alt
|
||||
|
||||
def ecef2lla(x, y, z):
|
||||
# WGS84 ellipsoid constants:
|
||||
a = 6378137
|
||||
|
|
|
@ -1,3 +1,2 @@
|
|||
numpy==1.26.4
|
||||
requests==2.31.0
|
||||
pyproj==3.6.1
|
||||
requests==2.31.0
|
Loading…
Reference in a new issue