First version of pursuit and evade
Improved upon wall avoidance