Created new hardware interface for switching between controller modes
Added better debug info for when a controller cannot be found
Merge branch 'hydro-devel' into joint_mode_interface
hardware_interface: fix initialization order