Obstacle Avoidance Control Algorithm for Multi Agent Autonomous Underwater Vehicle