Trajectory control of solid body spatial motion