collapse_branch function

Collapse branches under a tolerance level