Development of the Guidance Navigation and Control System of the Folaga AUV for Autonomous Acoustic Surveys in the WiMUST Project