Title: Three dimensional guidance for the NPS autonomous underwater vehicle