Fixed a problem that can not be built with catkin_make