Fixed velocity to 0 when agent is on destination. Added tests for velocity and distance functions on agent