Adds a bunch of logic
Progress
Merge pull request #1 from chrisfarrell/master

Add navigation/move logic for agent