Added depth node
Fixed the kalman filter and added subscriber to the detector