Max
modify SensorPacketHandling so it can handle early packet handling
TODO modify a bit more to discard "very early" packet
only mode 1 is implemented