Fault Tolerant Robotics using Active Diagnosis of Partially Observable Systems and Optimized Path Planning for Underwater Message Ferrying