DUNE/src/AUV/Navigation/SMO: SMO fix for inital point.