Fixed catkin warnings