Wrote a function to get back to the nav tower

It has a while true loop for testing. Will need to call the function
multiple times.