registration[point]: Add cost matrix calculation.