Added unit testing to Agv