Optimize priority queue optimization: Only add elements if updated. Only work on one of the halfedges. Gives x6 speedup.