Refactored how the persistence (now called sensor_activations) worked

1 files changed, 19 insertions, 0 deletions

diff --git a/src/survive_sensor_activations.c b/src/survive_sensor_activations.c
new file mode 100644
index 0000000..6daded4
--- /dev/null
+++ b/src/survive_sensor_activations.c
@@ -0,0 +1,19 @@
+#include <survive.h>
+
+bool SurviveSensorActivations_isPairValid(const SurviveSensorActivations *self, uint32_t tolerance,
+										  uint32_t timecode_now, uint32_t idx, int lh) {
+	const uint32_t *data_timecode = self->timecode[idx][lh];
+	return !(timecode_now - data_timecode[0] > tolerance || timecode_now - data_timecode[1] > tolerance);
+}
+
+void SurviveSensorActivations_add(SurviveSensorActivations *self, struct PoserDataLight *lightData) {
+	int axis = (lightData->acode & 1);
+	uint32_t *data_timecode = &self->timecode[lightData->sensor_id][lightData->lh][axis];
+	FLT *angle = &self->angles[lightData->sensor_id][lightData->lh][axis];
+
+	*angle = lightData->angle;
+	*data_timecode = lightData->timecode;
+}
+
+// Roughly 31ms at a 48mhz clock rate
+uint32_t SurviveSensorActivations_default_tolerance = 1500000;
\ No newline at end of file