Added #pragma once
Added NearestNode class
NearestNode test