You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
18 lines
853 B
18 lines
853 B
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
|
|
|