RP-248 Migrate Husky base to ros_control

Migrate to ros_control using horizon C++ API

Fix #5 #3 
Is it actually necessary to have a separate loop for this? Diagnostics can handle rate limiting all on its own. cf. https://github.com/ros/diagnostics/blob/hydro-devel/diagnostic_updater/src/example.cpp#L236