7fa972be6a
version: sunnypilot v2025.003.000 (dev) date: 2026-02-09T02:04:38 master commit: 254f55ac15a40343d7255f2f098de3442e0c4a6f
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
|