Inertial Navigation System for Guidance and Control of Underwater Vehicle