Added first simple GPS implementation

This commit is contained in:
dario
2023-12-14 23:29:09 +01:00
parent 751887e6d8
commit 33e5eba3a6
3 changed files with 57 additions and 11 deletions

View File

@@ -0,0 +1,17 @@
from typing import List
from numpy.typing import ArrayLike
from sensors.gps import GPS
from spatz.dataset import ArrayLike, Dataset
from spatz.logger import ArrayLike, Logger
from spatz.transforms import Transform
class Erinome_I(GPS):
def __init__(self, dataset: Dataset, logger: Logger, transforms: List[Transform] = []):
super().__init__(dataset, logger, transforms)
def _sensor_specific_effects(self, x: ArrayLike) -> ArrayLike:
# TODO: What's the GPS module's behavior?
return x

33
spatz/sensors/gps/gps.py Normal file
View File

@@ -0,0 +1,33 @@
from typing import Any, List
from numpy.linalg import norm
from numpy.typing import ArrayLike
from spatz.dataset import ArrayLike, Dataset
from spatz.logger import ArrayLike, Logger
from spatz.sensors import Sensor, NA
from spatz.transforms import Transform
# WG84 googlen (world model GPS)
class GPS(Sensor):
def __init__(self, dataset: Dataset, logger: Logger, transforms: List[Transform] = []):
"""GPS Module which provides the following information:
- Longitude (in °)
- Latitiude (in °)
- Altitude (in °)
"""
super().__init__(dataset, logger, transforms)
def _get_data(self) -> ArrayLike:
vel = norm(self._dataset.get_velocity())
# TODO: At which speed do we assume that GPS becomes unreliable?
if vel / self._dataset.get_mach_number() > 1:
return NA
x = self._dataset.fetch_values(['latitude', 'longitude', 'altitude'])
x = self._sensor_specific_effects(x)
return x