Code for moddeling a AUV system. Part of project in EiT.