Merge pull request #141 from ipa-fxm/hydro_vel_control

Bring in velocity/Cartesian controllers