Measure velocity, speed of end effector