RP-248 Migrate Husky base to ros_control

Fix #5 #3 #2