Motion Planning for Physical Systems