A nonlinear optimal control method for autonomous submarines' diving

A nonlinear H-infinity (optimal) control method is developed for the problem of simultaneous control of the depth and heading angle of an autonomous submarine. This is a multi-variable nonlinear control problem and its solution allows for precise underwater navigation of the submarine. The submarine's dynamic model undergoes approximate linearization around a temporary equilibrium that is recmputed at each iteration of the control algorithm. The linearization procedure is based on Taylor series expansion and on the computation of the submarine's model Jacobian matrices. For the approximately linearized model, the optimal control problem is solved through the design of an H-infinity feedback controller. The computation of the controller's gain requires the solution of an algebraic Riccati equstion, which is repetitively performed at each step of the control method. The stability of the control scheme is proven through Lyapunov analysis. First, it is demonstrated that for the submarine's control loop, the H-infinity tracking performance criterion holds. Moroever, under moderate conditions it is shown that that the control scheme is globally asymptotically stable