Unifies sac_model_normal_parallel_plane with sac_model_normal_plane, removes duplicated code