fm_unify_coords function

Unify coordinates to 3-column matrix