add OcludedPlaneEstimator nodelet to estimate the ocluded planes