Change camera parameters based on values on CameraInfo topic (listed as comments in the file)
Try to set the rtslam debug level to Off, although I don't think it's working.
Set the sensor manager start date after initialize all sensors.
Finish the hardware threads when there's no more publisher or data to process.