MAVLinkHILSystem: GPS delay fixed