Motion Planning

Documentation coming soon.