Title: OPTIMAL CONTROL SYSTEM FOR A SEMI-AUTONOMOUS UNDERWATER VEHICLE