Some improvment to output

* Use ROS_INFO_STREAM instead of ROS_INFO in some cases
* Don't output performance in ROS_INFO, can be enabled with a cmake option