void SensorHandlerRGBDCamera::callback(const sensor_msgs::ImageConstPtr& raw_intensity_image, const sensor_msgs::ImageConstPtr& raw_depth_image){
  if (!_isCalibrated){
    _calibrationCallback(raw_intensity_image,raw_depth_image);
  } else {
    _sensorCallback(raw_intensity_image,raw_depth_image);
  }
}
void SensorHandlerOmnicam::callback(const sensor_msgs::ImageConstPtr& msg){
  if(!_isCalibrated){
    _calibrationCallback(msg);
  }
  else{
    _sensorCallback(msg);
  }
}