Improve the corobot_diagnostics package and make sure that the corobot_pantilt and the corobot_phidget_ik don't take all the cpu while running