ADDED: testing framework for FindClosest
FIXED: small AddNodes fixed. MOVED: All FindNode helpers to FindNodeHelpers.go