|
|
|
@ -267,30 +267,19 @@ class AutoTestSub(AutoTest):
@@ -267,30 +267,19 @@ class AutoTestSub(AutoTest):
|
|
|
|
|
self.progress("Mission OK") |
|
|
|
|
|
|
|
|
|
def test_gripper_mission(self): |
|
|
|
|
with self.Context(self): |
|
|
|
|
self.test_gripper_body() |
|
|
|
|
|
|
|
|
|
def test_gripper_body(self): |
|
|
|
|
ex = None |
|
|
|
|
try: |
|
|
|
|
try: |
|
|
|
|
self.get_parameter("GRIP_ENABLE", timeout=5) |
|
|
|
|
except NotAchievedException: |
|
|
|
|
self.progress("Skipping; Gripper not enabled in config?") |
|
|
|
|
return |
|
|
|
|
self.get_parameter("GRIP_ENABLE", timeout=5) |
|
|
|
|
except NotAchievedException: |
|
|
|
|
self.progress("Skipping; Gripper not enabled in config?") |
|
|
|
|
return |
|
|
|
|
|
|
|
|
|
self.load_mission("sub-gripper-mission.txt") |
|
|
|
|
self.change_mode('LOITER') |
|
|
|
|
self.wait_ready_to_arm() |
|
|
|
|
self.arm_vehicle() |
|
|
|
|
self.change_mode('AUTO') |
|
|
|
|
self.wait_statustext("Gripper Grabbed", timeout=60) |
|
|
|
|
self.wait_statustext("Gripper Released", timeout=60) |
|
|
|
|
except Exception as e: |
|
|
|
|
self.print_exception_caught(e) |
|
|
|
|
ex = e |
|
|
|
|
if ex is not None: |
|
|
|
|
raise ex |
|
|
|
|
self.load_mission("sub-gripper-mission.txt") |
|
|
|
|
self.change_mode('LOITER') |
|
|
|
|
self.wait_ready_to_arm() |
|
|
|
|
self.arm_vehicle() |
|
|
|
|
self.change_mode('AUTO') |
|
|
|
|
self.wait_statustext("Gripper Grabbed", timeout=60) |
|
|
|
|
self.wait_statustext("Gripper Released", timeout=60) |
|
|
|
|
|
|
|
|
|
def dive_set_position_target(self): |
|
|
|
|
self.change_mode('GUIDED') |
|
|
|
|