19 lines
853 B
Python
19 lines
853 B
Python
from openpilot.common.transformations.orientation import numpy_wrap
|
|
from openpilot.common.transformations.transformations import (ecef2geodetic_single,
|
|
geodetic2ecef_single)
|
|
from openpilot.common.transformations.transformations import LocalCoord as LocalCoord_single
|
|
|
|
|
|
class LocalCoord(LocalCoord_single):
|
|
ecef2ned = numpy_wrap(LocalCoord_single.ecef2ned_single, (3,), (3,))
|
|
ned2ecef = numpy_wrap(LocalCoord_single.ned2ecef_single, (3,), (3,))
|
|
geodetic2ned = numpy_wrap(LocalCoord_single.geodetic2ned_single, (3,), (3,))
|
|
ned2geodetic = numpy_wrap(LocalCoord_single.ned2geodetic_single, (3,), (3,))
|
|
|
|
|
|
geodetic2ecef = numpy_wrap(geodetic2ecef_single, (3,), (3,))
|
|
ecef2geodetic = numpy_wrap(ecef2geodetic_single, (3,), (3,))
|
|
|
|
geodetic_from_ecef = ecef2geodetic
|
|
ecef_from_geodetic = geodetic2ecef
|