20230528 Backstopping functions

Written By Team Inspiration

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

Team Inspiration
Previous

20230529 ForwardDist Function
Next

20230526 Depth Hold test