Added routine to find node nearest point