Enabled CHOMP and OMPL.
Added missing dependencies to package.xml.