StereoOdo: Draw 3D points