|
28 | 28 | MQTT_TOPIC_IN_RADAR_SWEEP: str = env("MQTT_TOPIC_IN_RADAR_SWEEP", "CROWSNEST/SEAHORSE/RADAR/0/SWEEP") |
29 | 29 | MQTT_TOPIC_IN_LIDAR_SWEEP: str = env("MQTT_TOPIC_IN_LIDAR_SWEEP", "CROWSNEST/SEAHORSE/LIDAR/0/POINTCLOUD") |
30 | 30 | MQTT_TOPIC_IN_HEADING: str = env("MQTT_TOPIC_IN_HEADING", "CROWSNEST/SEAHORSE/GNSS/0/JSON") |
31 | | -CORR_HEADING: int = env("CORR_HEADING", 0) |
| 31 | +CORR_HEADING: int = env.int("CORR_HEADING", 0) |
32 | 32 | MQTT_TOPIC_OUT_RADAR_NORTHUP: str = env("MQTT_TOPIC_OUT_RADAR_NORTHUP", "CROWSNEST/SEAHORSE/RADAR/0/NUP") |
33 | 33 | MQTT_TOPIC_OUT_LIDAR_NORTHUP: str = env("MQTT_TOPIC_OUT_LIDAR_NORTHUP", "CROWSNEST/SEAHORSE/LIDAR/0/NUP") |
34 | 34 |
|
35 | 35 |
|
36 | 36 | # Setup logger |
37 | | -LOG_LEVEL = env.log_level("LOG_LEVEL", logging.WARNING) |
| 37 | +LOG_LEVEL = env.log_level("LOG_LEVEL", logging.INFO) |
| 38 | +# log_level = env.log_level("LOG_LEVEL") |
38 | 39 | logging.basicConfig(level=LOG_LEVEL) |
39 | 40 | logging.captureWarnings(True) |
40 | 41 | warnings.filterwarnings("once") |
@@ -93,13 +94,19 @@ def on_message(client, userdata, message): |
93 | 94 | payload = json.loads(msg) |
94 | 95 | topic = message.topic |
95 | 96 |
|
96 | | - LOGGER.info(message.topic) |
| 97 | + LOGGER.debug(message.topic) |
97 | 98 |
|
98 | 99 | if "message" in payload: |
99 | 100 | msg = payload["message"] |
100 | 101 |
|
101 | 102 | if topic == MQTT_TOPIC_IN_HEADING: |
102 | | - corrected_heading = CORR_HEADING + float(msg["heading"]) |
| 103 | + LOGGER.debug("Heading message: %s", msg["heading"]) |
| 104 | + LOGGER.debug("Heading tyep: %s", type(msg["heading"])) |
| 105 | + LOGGER.debug("Heading CORR: %s", type(CORR_HEADING)) |
| 106 | + LOGGER.debug("Heading CORR: %s", CORR_HEADING) |
| 107 | + |
| 108 | + heading = float(msg["heading"]) |
| 109 | + corrected_heading = CORR_HEADING + heading |
103 | 110 |
|
104 | 111 | # Check that heading is within 0-360 after correction |
105 | 112 | if corrected_heading < 360: |
@@ -184,9 +191,15 @@ def rotate_points_azimuth(input_stream): |
184 | 191 | source_heading = Stream() |
185 | 192 |
|
186 | 193 | # MQTT publish stream |
187 | | - pipe_heading = source_heading.latest() |
188 | | - # combined = source.latest().zip(pipe_heading) |
189 | | - combined = source.latest().zip_latest(pipe_heading) |
| 194 | + |
| 195 | + # Original with latest() to slow |
| 196 | + # pipe_heading = source_heading.latest() |
| 197 | + # combined = source.latest().zip_latest(pipe_heading) |
| 198 | + |
| 199 | + # New version with only zip_latest looks to be managing it |
| 200 | + pipe_heading = source_heading |
| 201 | + combined = source.zip_latest(pipe_heading) |
| 202 | + |
190 | 203 | combined.map(rotate_points_azimuth).map(to_brefv_raw).sink(to_mqtt) |
191 | 204 |
|
192 | 205 | LOGGER.info("Connecting to MQTT broker...") |
|
0 commit comments