SanityCheck: Make sure INS is in a navigation safe mode

This prevents attempting to fly position hold while in either the
complimentary filter or indoor mode while they are not tested.
Absolutely no matter what indoor mode should not be permitted.