Added another DVL model. Added I-P controllers for testing.