Fixed bunch of stuff. The gains are now self tunable. The zeroing barrier function is now a soft constraint and a barrier function provides the hard constraint. The math checks out and the test cases pass
Fixed bunch of stuff. The gains are now self tunable. The zeroing barrier function is now a soft constraint and a barrier function provides the hard constraint. The math checks out and the test cases pass

varunmurali1/safe_navigation