Segmentation fault removed, ROS_INFO(string.c_str()) had problem