39 #include <pcl/pcl_config.h>
42 #ifndef __PCL_IO_OPENNI_GRABBER__
43 #define __PCL_IO_OPENNI_GRABBER__
45 #include <pcl/io/eigen.h>
46 #include <pcl/io/boost.h>
47 #include <pcl/io/grabber.h>
48 #include <pcl/io/openni_camera/openni_driver.h>
49 #include <pcl/io/openni_camera/openni_device_kinect.h>
50 #include <pcl/io/openni_camera/openni_image.h>
51 #include <pcl/io/openni_camera/openni_depth_image.h>
52 #include <pcl/io/openni_camera/openni_ir_image.h>
55 #include <pcl/common/synchronizer.h>
72 typedef boost::shared_ptr<OpenNIGrabber>
Ptr;
73 typedef boost::shared_ptr<const OpenNIGrabber>
ConstPtr;
77 OpenNI_Default_Mode = 0,
84 OpenNI_QQVGA_25Hz = 7,
85 OpenNI_QQVGA_30Hz = 8,
90 typedef void (sig_cb_openni_image) (
const boost::shared_ptr<openni_wrapper::Image>&);
91 typedef void (sig_cb_openni_depth_image) (
const boost::shared_ptr<openni_wrapper::DepthImage>&);
92 typedef void (sig_cb_openni_ir_image) (
const boost::shared_ptr<openni_wrapper::IRImage>&);
93 typedef void (sig_cb_openni_image_depth_image) (
const boost::shared_ptr<openni_wrapper::Image>&,
const boost::shared_ptr<openni_wrapper::DepthImage>&,
float constant) ;
94 typedef void (sig_cb_openni_ir_depth_image) (
const boost::shared_ptr<openni_wrapper::IRImage>&,
const boost::shared_ptr<openni_wrapper::DepthImage>&,
float constant) ;
95 typedef void (sig_cb_openni_point_cloud) (
const boost::shared_ptr<const pcl::PointCloud<pcl::PointXYZ> >&);
96 typedef void (sig_cb_openni_point_cloud_rgb) (
const boost::shared_ptr<const pcl::PointCloud<pcl::PointXYZRGB> >&);
97 typedef void (sig_cb_openni_point_cloud_rgba) (
const boost::shared_ptr<const pcl::PointCloud<pcl::PointXYZRGBA> >&);
98 typedef void (sig_cb_openni_point_cloud_i) (
const boost::shared_ptr<const pcl::PointCloud<pcl::PointXYZI> >&);
107 const Mode& depth_mode = OpenNI_Default_Mode,
108 const Mode& image_mode = OpenNI_Default_Mode);
130 getFramesPerSecond () const;
133 inline boost::shared_ptr<openni_wrapper::OpenNIDevice>
137 std::vector<std::pair<
int, XnMapOutputMode> >
138 getAvailableDepthModes () const;
141 std::vector<std::pair<
int, XnMapOutputMode> >
142 getAvailableImageModes () const;
153 setRGBCameraIntrinsics (const
double rgb_focal_length_x,
154 const
double rgb_focal_length_y,
155 const
double rgb_principal_point_x,
156 const
double rgb_principal_point_y)
158 rgb_focal_length_x_ = rgb_focal_length_x;
159 rgb_focal_length_y_ = rgb_focal_length_y;
160 rgb_principal_point_x_ = rgb_principal_point_x;
161 rgb_principal_point_y_ = rgb_principal_point_y;
172 double &rgb_focal_length_y,
173 double &rgb_principal_point_x,
174 double &rgb_principal_point_y)
const
176 rgb_focal_length_x = rgb_focal_length_x_;
177 rgb_focal_length_y = rgb_focal_length_y_;
178 rgb_principal_point_x = rgb_principal_point_x_;
179 rgb_principal_point_y = rgb_principal_point_y_;
192 rgb_focal_length_x_ = rgb_focal_length_y_ = rgb_focal_length;
205 rgb_focal_length_x_ = rgb_focal_length_x;
206 rgb_focal_length_y_ = rgb_focal_length_y;
216 rgb_focal_length_x = rgb_focal_length_x_;
217 rgb_focal_length_y = rgb_focal_length_y_;
230 const double depth_focal_length_y,
231 const double depth_principal_point_x,
232 const double depth_principal_point_y)
234 depth_focal_length_x_ = depth_focal_length_x;
235 depth_focal_length_y_ = depth_focal_length_y;
236 depth_principal_point_x_ = depth_principal_point_x;
237 depth_principal_point_y_ = depth_principal_point_y;
248 double &depth_focal_length_y,
249 double &depth_principal_point_x,
250 double &depth_principal_point_y)
const
252 depth_focal_length_x = depth_focal_length_x_;
253 depth_focal_length_y = depth_focal_length_y_;
254 depth_principal_point_x = depth_principal_point_x_;
255 depth_principal_point_y = depth_principal_point_y_;
266 depth_focal_length_x_ = depth_focal_length_y_ = depth_focal_length;
279 depth_focal_length_x_ = depth_focal_length_x;
280 depth_focal_length_y_ = depth_focal_length_y;
290 depth_focal_length_x = depth_focal_length_x_;
291 depth_focal_length_y = depth_focal_length_y_;
301 const uint16_t* shift_data_ptr,
302 uint16_t* depth_data_ptr,
303 std::size_t size)
const
306 boost::shared_ptr<openni_wrapper::OpenNIDevice> openni_device =
309 const uint16_t* shift_data_it = shift_data_ptr;
310 uint16_t* depth_data_it = depth_data_ptr;
313 for (std::size_t i=0; i<size; ++i)
315 *depth_data_it = openni_device->shiftToDepth(*shift_data_it);
327 onInit (
const std::string& device_id,
const Mode& depth_mode,
const Mode& image_mode);
331 setupDevice (
const std::string& device_id,
const Mode& depth_mode,
const Mode& image_mode);
339 startSynchronization ();
343 stopSynchronization ();
347 mapConfigMode2XnMode (
int mode, XnMapOutputMode &xnmode)
const;
352 imageCallback (boost::shared_ptr<openni_wrapper::Image> image,
void* cookie);
356 depthCallback (boost::shared_ptr<openni_wrapper::DepthImage> depth_image,
void* cookie);
360 irCallback (boost::shared_ptr<openni_wrapper::IRImage> ir_image,
void* cookie);
364 imageDepthImageCallback (
const boost::shared_ptr<openni_wrapper::Image> &image,
365 const boost::shared_ptr<openni_wrapper::DepthImage> &depth_image);
369 irDepthImageCallback (
const boost::shared_ptr<openni_wrapper::IRImage> &image,
370 const boost::shared_ptr<openni_wrapper::DepthImage> &depth_image);
380 checkImageAndDepthSynchronizationRequired ();
384 checkImageStreamRequired ();
388 checkDepthStreamRequired ();
392 checkIRStreamRequired ();
398 boost::shared_ptr<pcl::PointCloud<pcl::PointXYZ> >
399 convertToXYZPointCloud (
const boost::shared_ptr<openni_wrapper::DepthImage> &depth)
const;
406 convertToXYZRGBPointCloud (
const boost::shared_ptr<openni_wrapper::Image> &image,
407 const boost::shared_ptr<openni_wrapper::DepthImage> &depth_image)
const;
413 boost::shared_ptr<pcl::PointCloud<pcl::PointXYZI> >
414 convertToXYZIPointCloud (
const boost::shared_ptr<openni_wrapper::IRImage> &image,
415 const boost::shared_ptr<openni_wrapper::DepthImage> &depth_image)
const;
422 boost::shared_ptr<openni_wrapper::OpenNIDevice>
device_;
449 bool operator () (
const XnMapOutputMode& mode1,
const XnMapOutputMode & mode2)
const
451 if (mode1.nXRes < mode2.nXRes)
453 else if (mode1.nXRes > mode2.nXRes)
455 else if (mode1.nYRes < mode2.nYRes)
457 else if (mode1.nYRes > mode2.nYRes)
459 else if (mode1.nFPS < mode2.nFPS)
490 EIGEN_MAKE_ALIGNED_OPERATOR_NEW
493 boost::shared_ptr<openni_wrapper::OpenNIDevice>
500 #endif // __PCL_IO_OPENNI_GRABBER__
501 #endif // HAVE_OPENNI