Some debug...

- ros rate not working!!! freezes!!
- son ros_info print...