From 9173989e6360b4fbe58001c8bbd7cd2f273d8bb3 Mon Sep 17 00:00:00 2001
From: Andrew Tridgell <andrew@tridgell.net>
Date: Thu, 9 May 2019 19:23:35 +1000
Subject: [PATCH] AP_Mission: save waypoint number for watchdog reset

---
 libraries/AP_Mission/AP_Mission.cpp | 3 +++
 1 file changed, 3 insertions(+)

diff --git a/libraries/AP_Mission/AP_Mission.cpp b/libraries/AP_Mission/AP_Mission.cpp
index 30c60a2b06..9859cd83af 100644
--- a/libraries/AP_Mission/AP_Mission.cpp
+++ b/libraries/AP_Mission/AP_Mission.cpp
@@ -223,6 +223,9 @@ void AP_Mission::update()
         return;
     }
 
+    // save persistent waypoint_num for watchdog restore
+    hal.util->persistent_data.waypoint_num = _nav_cmd.index;
+
     // check if we have an active nav command
     if (!_flags.nav_cmd_loaded || _nav_cmd.index == AP_MISSION_CMD_INDEX_NONE) {
         // advance in mission if no active nav command