Implementation for Issue #3

Now it is possible to visualize the agent path.