Tools: copter and sub autotests delay 2 sec after setting origin

This gives more time for the AHRS update to consume the origin and output the global-position-int mavlink message

Author: rmackay9

Tools/autotest/arducopter.py

@@ -3775,6 +3775,7 @@ def set_origin(self, loc, timeout=60):
                 int(loc.lng * 1e7),
                 int(loc.alt * 1e3)
             )
+            self.delay_sim_time(2)
             gpi = self.assert_receive_message('GLOBAL_POSITION_INT')
             self.progress("gpi=%s" % str(gpi))
             if gpi.lat != 0:
@@ -4384,6 +4385,7 @@ def VisionPosition(self):
                                                     old_pos.lat,
                                                     old_pos.lon,
                                                     old_pos.alt)
+            self.delay_sim_time(2)
             gpi = self.assert_receive_message('GLOBAL_POSITION_INT')
             self.progress("gpi=%s" % str(gpi))
             if gpi.lat != 0:
@@ -4454,6 +4456,7 @@ def BodyFrameOdom(self):
                                                     old_pos.lat,
                                                     old_pos.lon,
                                                     old_pos.alt)
+            self.delay_sim_time(2)
             gpi = self.assert_receive_message('GLOBAL_POSITION_INT')
             self.progress("gpi=%s" % str(gpi))
             if gpi.lat != 0:

Tools/autotest/ardusub.py

@@ -901,7 +901,7 @@ def SetGlobalOrigin(self):
 
         # This should set the EKF origin, write an ORGN msg to df and a GPS_GLOBAL_ORIGIN msg to MAVLink
         self.mav.mav.set_gps_global_origin_send(1, int(47.607584 * 1e7), int(-122.343911 * 1e7), 0)
-        self.delay_sim_time(1)
+        self.delay_sim_time(2)
 
         if not self.current_onboard_log_contains_message('ORGN'):
             raise NotAchievedException("Did not find expected ORGN message")