Added grid nav logic to the repo

grid navigation logic (java)
will be translated to assembly later