#!/usr/bin/env python
import ecto
from ecto_opencv.highgui import imshow
from ecto_opencv.calib import DepthTo3d
from image_pipeline import Rectifier, StereoModelLoader, DepthRegister, CameraModelToCv, CV_INTER_NN
from ecto_openni import OpenNICapture, DEPTH_RGB, DEPTH_IR, RGB, IR, IRGamma, enumerate_devices
from ecto_object_recognition.conversion import MatToPointCloudXYZRGB
from ecto_pcl import PointCloudT2PointCloud, CloudViewer, XYZRGB
openni_reg = True
print enumerate_devices()
capture = OpenNICapture('Camera',
stream_mode=DEPTH_RGB,
registration=openni_reg,
latched=False)
depthTo3d = DepthTo3d('Depth ~> 3d')
to_xyzrgb = MatToPointCloudXYZRGB('OpenCV ~> PCL')
pcl_cloud = PointCloudT2PointCloud('conversion', format=XYZRGB)
cloud_viewer = CloudViewer('Cloud Display')
plasm = ecto.Plasm()
plasm.connect(capture['K'] >> depthTo3d['K'],
capture['image'] >> imshow('Image Display')[:],
capture['depth'] >> depthTo3d['depth'],
depthTo3d['points3d'] >> to_xyzrgb['points'],
capture['image'] >> to_xyzrgb['image'],
to_xyzrgb[:] >> pcl_cloud[:], pcl_cloud[:] >> cloud_viewer[:])
if __name__ == '__main__':
from ecto.opts import doit
#!/usr/bin/env python
import ecto
from ecto_opencv.highgui import imshow
from ecto_opencv.calib import DepthTo3d
from image_pipeline import Rectifier, StereoModelLoader, DepthRegister, CameraModelToCv, CV_INTER_NN
from ecto_openni import OpenNICapture, DEPTH_RGB, DEPTH_IR, RGB, IR, IRGamma, enumerate_devices
from image_pipeline_conversion import MatToPointCloudXYZRGB
from ecto_pcl import PointCloudT2PointCloud, CloudViewer, XYZRGB
openni_reg = True
print enumerate_devices()
capture = OpenNICapture(stream_mode=DEPTH_RGB, registration=openni_reg, latched=False)
stereo_model = StereoModelLoader(left_fname='left.yml', right_fname="right.yml", stereo_fname='stereo.yml');
plasm = ecto.Plasm()
if not openni_reg:
rect_rgb = Rectifier()
rect_depth = Rectifier(cx_offset=-4,cy_offset=-4,interpolation_mode=CV_INTER_NN)
reg_depth = DepthRegister()
plasm.connect(
capture['image'] >> rect_rgb['image'],
stereo_model['left_model'] >> rect_rgb['camera'],
capture['depth'] >> rect_depth['image'],
stereo_model['right_model'] >> rect_depth['camera'],
# hook up the registration
stereo_model['stereo_model'] >> reg_depth['rgbd_model'],
rect_depth['image'] >> reg_depth['image']