rqt_robot_monitor) Fixed bugs that were caused somehow in cleaning process in the last few commits.