23 lines
545 B
GDScript
23 lines
545 B
GDScript
extends Node
|
|
|
|
|
|
var M2FT: float = 3.28084
|
|
var FT2M: float = 1/3.28084
|
|
|
|
var WGS84_A_M = 6378137.0
|
|
var WGS84_B_M = 6356752.314245
|
|
var EARTH_RADIUS_M = (2*WGS84_A_M + WGS84_B_M) / 3
|
|
var EARTH_RADIUS_KM = EARTH_RADIUS_M / 1000
|
|
# 8171221.7221355
|
|
var WGS84_AB = WGS84_A_M * WGS84_B_M
|
|
|
|
var g = 9.80665
|
|
|
|
|
|
|
|
func calc_wgs84_altitude(latitude_rad: float):
|
|
var theta_rad = abs(latitude_rad)
|
|
var a_sin_2 = (WGS84_A_M ** 2) * (sin(theta_rad)**2)
|
|
var b_cos_2 = (WGS84_B_M ** 2) * (cos(theta_rad)**2)
|
|
return WGS84_AB / sqrt(a_sin_2 + b_cos_2)
|