Added navigation class, with brief implementation of A*