Format debug messages
Added distance tracking
Added timing fns
Bug fix: randomWalk
Added avoidance; not integrated