Fixed bug in computeMatchingWith3D and computeMatchingWith2D when filling output structure
Fixed bug in computeMatchingWith3D and computeMatchingWith2D when filling output structure

MRPT/mrpt,MRPT/mrpt,MRPT/mrpt,MRPT/mrpt,MRPT/mrpt