Moved some algorithm logic from ArcNode to Algorithm
Fixed a NPE with the arctree