increased rate to 1000Hz, uses velocity and position tolerance from message