Text this: Double Integrator Model and Invariant Manifold Theory Algorithm for an X4-AUV