matrix_trim function

Trim matrix