40 #ifndef PCL_KEYPOINTS_BRISK_KEYPOINT_2D_IMPL_H_
41 #define PCL_KEYPOINTS_BRISK_KEYPOINT_2D_IMPL_H_
43 #include <pcl/common/io.h>
46 template <
typename Po
intInT,
typename Po
intOutT,
typename IntensityT>
bool
51 PCL_ERROR (
"[pcl::%s::initCompute] init failed.!\n", name_.c_str ());
55 if (!input_->isOrganized ())
57 PCL_ERROR (
"[pcl::%s::initCompute] %s doesn't support non organized clouds!\n", name_.c_str ());
65 template <
typename Po
intInT,
typename Po
intOutT,
typename IntensityT>
void
69 const int width = int (input_->width);
70 const int height = int (input_->height);
73 std::vector<unsigned char> image_data (width*height);
75 for (std::size_t i = 0; i < image_data.size (); ++i)
76 image_data[i] = static_cast<unsigned char> (intensity_ ((*input_)[i]));
85 output.width = int (output.points.size ());
87 output.is_dense =
false;
90 if (remove_invalid_3D_keypoints_)
93 for (std::size_t i = 0; i < output.size (); ++i)
97 bilinearInterpolation (input_, output[i].x, output[i].y, pt);
101 output_clean.push_back (output[i]);
103 output = output_clean;
104 output.is_dense =
true;