Point cloud loaded and copied to matrix correctly