diff --git a/svo/include/svo/feature_detection.h b/svo/include/svo/feature_detection.h index 85e57c66..a5f5d266 100644 --- a/svo/include/svo/feature_detection.h +++ b/svo/include/svo/feature_detection.h @@ -61,13 +61,23 @@ class AbstractDetector void setGridOccpuancy(const Vector2d& px); protected: + static const int border_ = 8; //!< no feature should be within 8px of border. const int cell_size_; const int n_pyr_levels_; const int grid_n_cols_; const int grid_n_rows_; vector grid_occupancy_; + void resetGrid(); + void setExistingFeatures(const Features& fts); + + inline int getCellIndex(int x, int y, int level) + { + const int scale = (1< DetectorPtr;