diff --git a/simulation/src/range_likelihood.cpp b/simulation/src/range_likelihood.cpp index b7f243b9fef4a8585d4cf6124520ea3753b47f10..75ca0ea5d45101945fc2a5ff26d639f6d2e05911 100644 --- a/simulation/src/range_likelihood.cpp +++ b/simulation/src/range_likelihood.cpp @@ -370,9 +370,17 @@ void RangeLikelihood::compute_scores(int cols, int rows, void RangeLikelihood::addNoise(){ + // Other noises: + // edge noise: look for edges in the range image and add a few pixels here and there + // texture noise: look at the normals and + + // Add Gaussian Noise + // TODO: make the variance a parameter + // TODO: might want to add a range-based variance + float variance = 0.0015; for (int i=0;i 1){ depth_buffer_[i] =1.0; }else if(depth_buffer_[i] < 0){ @@ -389,6 +397,7 @@ void RangeLikelihood::compute_scores(int cols, int rows, // 20m = ~1070 kinect return - not not well calibrated // The fitted model here cannot work for long ranges: // http://www.ros.org/wiki/kinect_calibration/technical + // TODO: make a parameter int bins =470; for (int i=0;i