Agent.py updated 

No longer psuedo-code
TODO: Fix Distance and get_neighbors functions