Underwater 3D localization and communication for mobile networked robots