Now drops data corretly. Still storing way too much redundant data (repeats of the same point)
Back to listening to Telemetry port