Fix dependency, refactor, change log levels
Fixed removing corresponding points from cloud