make_matrix_part_one function

Make PCL matrix part one