navigator: follow fixes and improvements, mavlink protocol update