Fix realtime issues
Merge branch 'master' of https://github.com/WPI-ARC/hubo_ros_control