Simulating an underwater vehicle self-correcting guidance system with Simulink