Corrected the lat/lon conversions in EstimatedState to NavSts message. Started working on the more generic IMC remapper.