i/rtabmap_ros
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap_ros.git synced 2026-10-12 04:29:49 +08:00
Code Issues Packages Projects Releases Wiki Activity

Adding an option to cut incoming depth

Browse Source
This commit is contained in:
JRombouts
2015-07-08 12:49:15 -07:00
parent cc139c6664
commit 37a53d91c2
1 changed files with 10 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/nodelets/point_cloud_xyz.cpp
+10 -7
View File
@@ -70,7 +70,8 @@ public:
approxSyncDisparity_(0), approxSyncDisparity_(0),
exactSyncDepth_(0), exactSyncDepth_(0),
exactSyncDisparity_(0), exactSyncDisparity_(0),
cut_(0) cut_right_(0),
cut_left_(0)
{} {}
virtual ~PointCloudXYZ() virtual ~PointCloudXYZ()
@@ -100,7 +101,8 @@ private:
pnh.param("decimation", decimation_, decimation_); pnh.param("decimation", decimation_, decimation_);
pnh.param("noise_filter_radius", noiseFilterRadius_, noiseFilterRadius_); pnh.param("noise_filter_radius", noiseFilterRadius_, noiseFilterRadius_);
pnh.param("noise_filter_min_neighbors", noiseFilterMinNeighbors_, noiseFilterMinNeighbors_); pnh.param("noise_filter_min_neighbors", noiseFilterMinNeighbors_, noiseFilterMinNeighbors_);
pnh.param("cut", cut_, cut_); pnh.param("cut_left", cut_left_, cut_left_);
pnh.param("cut_right", cut_right_, cut_right_);
ROS_INFO("Approximate time sync = %s", approxSync?"true":"false"); ROS_INFO("Approximate time sync = %s", approxSync?"true":"false");
if(approxSync) if(approxSync)
@@ -153,12 +155,12 @@ private:
int rows = image.rows; int rows = image.rows;
int cols = image.cols; int cols = image.cols;
if (cut_>0){ if (cut_left_>0){
cv::Mat pRoi = image(cv::Rect(0, 0, cut_, rows)); cv::Mat pRoi = image(cv::Rect(0, 0, cut_left_, rows));
pRoi.setTo(cv::Scalar(0.)); pRoi.setTo(cv::Scalar(0.));
} }
else if (cut_<0){ if (cut_right_<0){
cv::Mat pRoi = image(cv::Rect(cols+cut_, 0, -cut_, rows)); cv::Mat pRoi = image(cv::Rect(cols-cut_right_, 0, cut_right_, rows));
pRoi.setTo(cv::Scalar(0.)); pRoi.setTo(cv::Scalar(0.));
} }
@@ -258,7 +260,8 @@ private:
int decimation_; int decimation_;
double noiseFilterRadius_; double noiseFilterRadius_;
int noiseFilterMinNeighbors_; int noiseFilterMinNeighbors_;
int cut_; int cut_left_;
int cut_right_;
ros::Publisher cloudPub_; ros::Publisher cloudPub_;