Subsystem block (determine force, mass and inertia)

Subsystem block (determining direction cosine matrix)

Subsystem block (determining angular accelerations)

Subsystem block (determining angular velocities)

$C:\Users\admin\Desktop\auv1\inputparameters.png$

input parameters taken from Reference