Navigator rewrite: create list of navigation modes

@julianoes
I'm looking through the potential code changes and thought that I would fix one of the TODOs.

Mainly I'm trying to learn the coding style of the Pixhawk community so feel free to reject or give comments.