Basic Path-finding is implemented and functional