Tools: mount POI lock Aux Func/Switch test ensure level

Author: lthall

Tools/autotest/arducopter.py

@@ -6650,9 +6650,10 @@ def MountPOIFromAuxFunction(self):
         mount_roll, mount_pitch, mount_yaw, mount_yaw_is_absolute = self.get_mount_roll_pitch_yaw_deg()
         assert -46 <= mount_pitch <= -44, f"Pitch is out of range: {mount_pitch}"
         self.fly_guided_move_local(100, 100, 70)   # move and check that pitch and yaw track
+        WaitAndMaintainAttitude(self, 0, 0, epsilon=1, minimum_duration=1, timeout=5).run()
         mount_roll, mount_pitch, mount_yaw, mount_yaw_is_absolute = self.get_mount_roll_pitch_yaw_deg()
-        assert -17 <= mount_pitch <= -15, f"Pitch2 is out of range: {mount_pitch}"
-        assert -179 <= mount_yaw <= -176, f"Yaw2 is out of range: {mount_yaw}"
+        assert -27 <= mount_pitch <= -23, f"Pitch2 is out of range: {mount_pitch}"
+        assert -179 <= mount_yaw <= -175, f"Yaw2 is out of range: {mount_yaw}"
         self.set_rc(10, 1500)  # switch to middle to return to RC target mode and check that mount reverts to initial angles
         mount_roll, mount_pitch, mount_yaw, mount_yaw_is_absolute = self.get_mount_roll_pitch_yaw_deg()
         assert -46 <= mount_pitch <= -44, f"Pitch3 is out of range: {mount_pitch}"