ArduSub: Using IMU for horizontal positioning

A post was split to a new topic: Increase MAVLink IMU data rate