Updated NavStiK FMU