Cleaning up yet again

Added an AddRange to the PriorityQueue to speed up adding so that the
sort is only done once.

Adding braces around ifs and loops