make_matrix_part_two function

Make PCL matrix part two