Added toString() to Node and Route. Added some basic tests in Main()