CHOMP: Covariant Hamiltonian Optimization for Motion Planning - The Robotics Institute Carnegie Mellon University