Skip to content

Commit

Permalink
autotest: add test for payload place when gripper was open
Browse files Browse the repository at this point in the history
  • Loading branch information
peterbarker committed Mar 6, 2025
1 parent 75be839 commit e86cd5e
Show file tree
Hide file tree
Showing 2 changed files with 28 additions and 0 deletions.
Original file line number Diff line number Diff line change
@@ -0,0 +1,6 @@
QGC WPL 110
0 0 0 16 0.000000 0.000000 0.000000 0.000000 -35.363262 149.165237 584.000000 1
1 0 3 22 0.000000 0.000000 0.000000 0.000000 -35.363007 149.165070 20.000000 1
2 0 3 16 0.000000 0.000000 0.000000 0.000000 -35.362869 149.165222 20.000000 1
3 0 3 94 0.000000 0.000000 0.000000 0.000000 -35.363106 149.165436 20.000000 1
4 0 0 20 0.000000 0.000000 0.000000 0.000000 0 0 00.000000 1
22 changes: 22 additions & 0 deletions Tools/autotest/arducopter.py
Original file line number Diff line number Diff line change
Expand Up @@ -5063,6 +5063,27 @@ def PayloadPlaceMission(self):
self.reboot_sitl()
self.progress("All done")

def PayloadPlaceMissionOpenGripper(self):
'''test running the mission when the gripper is open'''
self.set_analog_rangefinder_parameters()
self.set_servo_gripper_parameters()
self.reboot_sitl()

self.load_mission("copter_payload_place.txt")

self.set_parameter("AUTO_OPTIONS", 3)
self.change_mode('AUTO')
self.wait_ready_to_arm()

self.arm_vehicle()

self.progress("Opening the gripper before time")
self.run_auxfunc(19, 0)

self.wait_text("Abort: Gripper Open", timeout=90)

self.wait_disarmed()

def Weathervane(self):
'''Test copter weathervaning'''
# We test nose into wind code paths and yaw direction here and test side into wind
Expand Down Expand Up @@ -11030,6 +11051,7 @@ def tests1a(self):
self.MAV_CMD_CONDITION_YAW,
self.LoiterToAlt,
self.PayloadPlaceMission,
self.PayloadPlaceMissionOpenGripper,
self.PrecisionLoiterCompanion,
self.Landing,
self.PrecisionLanding,
Expand Down

0 comments on commit e86cd5e

Please sign in to comment.