Even at 5Hz that means up to 200 (+ transmission time) millisecond difference between the last reach position and the actual position. at 10 metres per second that is 2 metres error. You could do a forward looking predictive filter that assumes linear movement, but why not just capture the timing and Post process? Post processing is not hard.