Chris' proposal for the motion planning module