untangle function

Attempts to untangle crossing branches for plotting