Unifies sac_model_normal_parallel_plane with sac_model_normal_plane, removes duplicated code
tmp
tmp
tmp
tmp
fix compile error
cluster tmp