Added depth camera to obstacle avoidance, node for subsampling the cloud to make the ray tracing feasible