From d6b2584592db7dee1afc3462870d176daa540a38 Mon Sep 17 00:00:00 2001
From: Randy Mackay <rmackay9@yahoo.com>
Date: Thu, 27 Jun 2024 15:58:18 +0900
Subject: [PATCH] AP_Scripting: example script to release gripper on thrust
 loss

---
 .../copter-release-gripper-thrust-loss.lua    | 48 +++++++++++++++++++
 1 file changed, 48 insertions(+)
 create mode 100644 libraries/AP_Scripting/examples/copter-release-gripper-thrust-loss.lua

diff --git a/libraries/AP_Scripting/examples/copter-release-gripper-thrust-loss.lua b/libraries/AP_Scripting/examples/copter-release-gripper-thrust-loss.lua
new file mode 100644
index 00000000000000..4d47b18836d011
--- /dev/null
+++ b/libraries/AP_Scripting/examples/copter-release-gripper-thrust-loss.lua
@@ -0,0 +1,48 @@
+--[[
+This script should only be used on multicopters
+The gripper is released when thrust loss is detected
+Note that thrust loss false positives are common meaning the gripper may be released unnecessarily
+--]]
+
+local MAV_SEVERITY = {EMERGENCY=0, ALERT=1, CRITICAL=2, ERROR=3, WARNING=4, NOTICE=5, INFO=6, DEBUG=7}
+
+local update_interval_ms = 100
+local thrust_loss_counter = 0
+
+function update()
+
+   -- return immediately if not armed
+   if not arming:is_armed() then
+      thrust_loss_counter = 0
+      return update, update_interval_ms
+   end
+
+   -- return if no thrust loss
+   if not MotorsMatrix:get_thrust_boost() then
+      thrust_loss_counter = 0
+      return update, update_interval_ms
+   end
+
+   -- return if vehicle is not descending (or cannot retrieve climb rate)
+   local vel_NED = ahrs:get_velocity_NED()
+   if vel_NED == nil or vel_NED:z() <= 0 then
+      thrust_loss_counter = 0
+      return update, update_interval_ms
+   end
+
+   -- vehicle is descending and thrust loss is detected
+   thrust_loss_counter = thrust_loss_counter + 1
+   if thrust_loss_counter < 10 then
+      return update, update_interval_ms
+   end
+
+   -- release gripper and warn user
+   if not gripper:released() then
+      gripper:release()
+      gcs:send_text(MAV_SEVERITY.WARNING, "Thrust loss, gripper released!")
+   end
+
+   return update, update_interval_ms
+end
+
+return update, update_interval_ms