The general algorithm was given for a 6 DOF vehicle and tested using simulation. The results obtained for a full airship model have shown that the control scheme guarantees satisfactory performance.