def LLHtoECEF(lat, lon, alt):
    rad = np.float64(6378137.0)
f = np.float64(1.0 / 298.257223563)
cosLat = np.cos(lat)
sinLat = np.sin(lat)
FF = (1.0 - f) ** 2
C = 1 / np.sqrt(cosLat ** 2 + FF * sinLat ** 2)
S = C * FF
x = (rad * C + alt) * cosLat * np.cos(lon)
y = (rad * C + alt) * cosLat * np.sin(lon)
z = (rad * S + alt) * sinLat
Convert Latitude and Longitude to point in 3D space