Nav modules

Conversion of:
nav_survey rectangle (maybe it souldn't be converted since it's not an "extra" navigation function??)
poly_survey_adv (with example flight plan)