20230528 Backstopping functions

Jun 16

Written By Maya D.

Implemented backstopping functions for more accurate navigation without inertia moving the sub

RS 2023SoftwareTesting

20230529 ForwardDist Function

20230526 Depth Hold test