MissionRotation LUA - Load one of up to 10 mission files

libraries/AP_Scripting/applets/MissionRotation.lua

@@ -0,0 +1,117 @@
+-- Script to load one of up to 10 mission files based on AUX switch state
+-- Always loads mission0.txt at boot, cycles missions on AUX high if held less than 3 seconds
+-- Reset the mission0.txt if AUX is high for more than 3 seconds
+
+local MAV_SEVERITY = {EMERGENCY=0, ALERT=1, CRITICAL=2, ERROR=3, WARNING=4, NOTICE=5, INFO=6, DEBUG=7}
+local rc_switch = rc:find_channel_for_option(24)
+
+if not rc_switch then
+    gcs:send_text(MAV_SEVERITY.ERROR, "Mission Reset switch not assigned")
+    return
+end
+
+local current_mission_index = 0
+local max_missions = 9
+local high_timer = 0
+
+local function read_mission(file_name)
+    if vehicle:get_mode() == 3 then
+        return false
+    end
+
+    local file = io.open(file_name, "r")
+    if not file then
+        return false
+    end
+
+    local header = file:read('l')
+    assert(string.find(header, 'QGC WPL 110') == 1, file_name .. ': incorrect format')
+
+    if vehicle:get_mode() ~= 3 then
+        if not mission:clear() then
+            gcs:send_text(MAV_SEVERITY.ERROR, "Could not clear current mission")
+            file:close()
+            return false
+        end
+    end
+
+    local item = mavlink_mission_item_int_t()
+    local index = 0
+
+    while true do
+        local data = {}
+        for i = 1, 12 do
+            data[i] = file:read('n')
+            if data[i] == nil then
+                if i == 1 then
+                    file:close()
+                    return true
+                else
+                    mission:clear()
+                    error('Failed to read file: premature end of data')
+                end
+            end
+        end
+
+        item:seq(data[1])
+        item:frame(data[3])
+        item:command(data[4])
+        item:param1(data[5])
+        item:param2(data[6])
+        item:param3(data[7])
+        item:param4(data[8])
+        item:x(data[9] * 10^7)
+        item:y(data[10] * 10^7)
+        item:z(data[11])
+
+        if not mission:set_item(index, item) then
+            mission:clear()
+            error(string.format('Failed to set mission item %i', index))
+        end
+        index = index + 1
+    end
+end
+
+if not read_mission("mission0.txt") then
+    gcs:send_text(MAV_SEVERITY.CRITICAL, "Critical error: mission0.txt not found, script stopped")
+    return
+end
+
+local function load_next_mission()
+    if vehicle:get_mode() == 3 then
+        return
+    end
+
+    current_mission_index = (current_mission_index + 1) % (max_missions + 1)
+    local file_name = string.format("mission%d.txt", current_mission_index)
+    if read_mission(file_name) then
+        gcs:send_text(MAV_SEVERITY.WARNING, "Loaded mission: " .. file_name)
+    end
+end
+
+function update()
+    local sw_pos = rc_switch:get_aux_switch_pos()
+
+    if sw_pos == 2 then
+        high_timer = high_timer + 1
+        if high_timer >= 3 then
+            if vehicle:get_mode() ~= 3 then
+                current_mission_index = 0
+                if read_mission("mission0.txt") then
+                    gcs:send_text(MAV_SEVERITY.WARNING, "Reset to mission0.txt")
+                end
+            end
+            high_timer = 0
+        end
+    else
+        if high_timer > 0 and high_timer < 3 then
+            load_next_mission()
+        end
+        high_timer = 0
+    end
+
+    return update, 1000
+end
+
+gcs:send_text(MAV_SEVERITY.NOTICE, "Mission Rotation loaded")
+return update, 1000

libraries/AP_Scripting/applets/MissionRotation.md

@@ -0,0 +1,21 @@
+# MissionRotation LUA script
+
+This LUA script is an evolution on the MissionSelector.LUA.
+
+Allows you to select up to 10 missions, either while arming or in the unarmed state.
+
+Requires that an RCx_OPTION be set to 24 (Mission Reset).
+
+The scripts should be installed in the SCRIPTS folder on the MicroSD, and the mission files in the root.
+
+The mission file called mission0.txt (the default mission) must exist and is loaded at boot, if the script does not find it it stops working.
+
+To load to the next mission file just bring AUX switch from low to high for no more than three seconds, each switch high-low loads the next mission file in numerical order.
+
+If the next mission file numerically does not exist load the next one, at the end of the rotation it returns to load mission0.txt.
+
+If AUX is held at high state for more than three seconds the script will restart by loading mission0.txt.
+
+If a mission switch is attempted in AUTO flight mode, a warning “Could not clear current mission” will be shown and no operation will be performed.
+
+Provides for sending messages under any condition, load or error.