mirror of
https://git.intern.spaceteamaachen.de/ALPAKA/SPATZ.git
synced 2025-08-06 18:37:34 +00:00
Added first simple GPS implementation
This commit is contained in:
17
spatz/sensors/gps/erinome1.py
Normal file
17
spatz/sensors/gps/erinome1.py
Normal 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
33
spatz/sensors/gps/gps.py
Normal 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
|
Reference in New Issue
Block a user