Add search part 2

#3 
Agent finds and executes path to goal.