Fixed angleTo function

Need to fix the viewing and smelling functions and also change how the
ant gets back to the nest once it has found food.