RP-248 Migrate Husky base to ros_control

Migrate to ros_control using horizon C++ API

Fix #5 #3 
diagnostics rate limiting isn't customizable, and separate loop is needed to publish husky_status_msg_ anyway, so force_update is used