Heinrichs Weikamp: Add logging for compass events.

subsurface · Jan 11, 2025 · 41238fc · 41238fc
1 parent 34556d4
commit 41238fc
Showing 1 changed file with 34 additions and 0 deletions.
diff --git a/src/hw_ostc_parser.c b/src/hw_ostc_parser.c
@@ -1131,6 +1131,40 @@ hw_ostc_parser_internal_foreach (hw_ostc_parser_t *parser, dc_sample_callback_t
 				offset += 2;
 				length -= 2;
 			}
+
+			// Compass heading update
+			if (events & 0x0200) {
+				if (length < 2) {
+					ERROR (abstract->context, "Buffer overflow detected!");
+					return DC_STATUS_DATAFORMAT;
+				}
+
+				if (callback) {
+					unsigned int heading = array_uint16_le(data + offset);
+					dc_sample_value_t sample = {
+						.event.type = SAMPLE_EVENT_STRING,
+						.event.flags = SAMPLE_FLAGS_SEVERITY_INFO,
+					};
+
+					if (heading & 0x8000) {
+						sample.event.name = "Cleared compass heading";
+					} else {
+						if (heading & 0x4000) {
+							sample.event.type = SAMPLE_EVENT_HEADING;
+							sample.event.name = "Set compass heading";
+						} else {
+							sample.event.name = "Logged compass heading";
+						}
+
+						sample.event.value = heading & 0x1FF;
+					}
+
+					callback(DC_SAMPLE_EVENT, &sample, userdata);
+				}
+
+				offset += 2;
+				length -= 2;
+			}
 		}
 
 		// Extended sample info.