2
2
mock GPS (GNSS) messages as NMEA sentences to ROS
3
3
"""
4
4
from datetime import datetime
5
- from typing import Final , Optional , Tuple
5
+ from typing import Final , Tuple
6
6
7
7
import numpy as np
8
8
import pynmea2
@@ -27,12 +27,6 @@ class NMEANode(MockGPSNode):
27
27
ROS_D_DEM_VERTICAL_DATUM = 5703
28
28
"""Default for :attr:`.dem_vertical_datum`"""
29
29
30
- ROS_D_PORT = "/dev/ttyS1"
31
- """Default for :attr:`.port`"""
32
-
33
- ROS_D_BAUDRATE = 9600
34
- """Default for :attr:`.baudrate`"""
35
-
36
30
# EPSG code for WGS 84 and a common mean sea level datum (e.g., EGM96)
37
31
_EPSG_WGS84 = 4326
38
32
_EPSG_MSL = 5773 # Example: EGM96
@@ -61,22 +55,10 @@ def __init__(self, *args, **kwargs):
61
55
# Subscribe
62
56
self .odometry
63
57
64
- @property
65
- @ROS .parameter (ROS_D_PORT , descriptor = _ROS_PARAM_DESCRIPTOR_READ_ONLY )
66
- def port (self ) -> Optional [str ]:
67
- """Serial port for outgoing NMEA messages"""
68
-
69
- @property
70
- @ROS .parameter (ROS_D_BAUDRATE , descriptor = _ROS_PARAM_DESCRIPTOR_READ_ONLY )
71
- def baudrate (self ) -> Optional [int ]:
72
- """Baudrate for outgoing NMEA messages"""
73
-
74
58
def _publish (self , mock_gps_dict : MockGPSNode .MockGPSDict ) -> None :
75
59
eph_sqrd = mock_gps_dict ["eph" ] ** 2
76
60
epv_sqrd = mock_gps_dict ["epv" ] ** 2
77
61
78
- self .get_logger ().info (f"publishin { mock_gps_dict } " )
79
-
80
62
self .publish_nmea_sentences (
81
63
rms = np .sqrt (eph_sqrd + epv_sqrd ),
82
64
sd_x = np .sqrt (eph_sqrd / 2 ),
0 commit comments