FindNode and Find_Closest

This is not tested! but, it compiles, and in theory is correct. Some Go
syntax things might cause use problems, but assuming I understood the
general function correctly, that won't take much time to fix if there
are Go issues.