BFS_agent works

Bugs
Changed a few `print`s to `println`
Added `depth` to `Node`
Added `.equals` to `State` and `Position`