Removed huge eigen matrix with points and got the stitched map working