PROJECT FINISHED
Added unit tests for AStartPathFinder