A method of controlling movement of a body at spaced apart instances along a trajectory in a multi-dimensional environment by determining a current position of the body at a current instance, determining an ideal point on the trajectory, determining a vector difference between the current position and the ideal point, and adjusting the body's velocity for a subsequent instance based on the vector difference. The method may be used in motion control systems for computer-controllable machine tools.