From cab5199da8338249fd1a56d730f98619dfd64629 Mon Sep 17 00:00:00 2001
From: Andrew Tridgell <andrew@tridgell.net>
Date: Sat, 3 Nov 2018 17:27:10 +1100
Subject: [PATCH] AP_IOMCU: fixed a race in event trigger on startup

this fixes the issue with initial safety option state, and with
initial safety mask
---
 libraries/AP_IOMCU/AP_IOMCU.cpp | 4 ++++
 libraries/AP_IOMCU/AP_IOMCU.h   | 2 ++
 2 files changed, 6 insertions(+)

diff --git a/libraries/AP_IOMCU/AP_IOMCU.cpp b/libraries/AP_IOMCU/AP_IOMCU.cpp
index daf5014ed9..69f545fc5a 100644
--- a/libraries/AP_IOMCU/AP_IOMCU.cpp
+++ b/libraries/AP_IOMCU/AP_IOMCU.cpp
@@ -78,6 +78,7 @@ void AP_IOMCU::event_failed(uint8_t event)
 void AP_IOMCU::thread_main(void)
 {
     thread_ctx = chThdGetSelfX();
+    chEvtSignal(thread_ctx, initial_event_mask);
 
     uart.begin(1500*1000, 256, 256);
     uart.set_blocking_writes(false);
@@ -465,6 +466,9 @@ void AP_IOMCU::trigger_event(uint8_t event)
 {
     if (thread_ctx != nullptr) {
         chEvtSignal(thread_ctx, EVENT_MASK(event));
+    } else {
+        // thread isn't started yet, trigger this event once it is started
+        initial_event_mask |= EVENT_MASK(event);
     }
 }
 
diff --git a/libraries/AP_IOMCU/AP_IOMCU.h b/libraries/AP_IOMCU/AP_IOMCU.h
index a44f73248e..acbcc22406 100644
--- a/libraries/AP_IOMCU/AP_IOMCU.h
+++ b/libraries/AP_IOMCU/AP_IOMCU.h
@@ -114,6 +114,8 @@ private:
     // IOMCU thread
     thread_t *thread_ctx;
 
+    eventmask_t initial_event_mask;
+
     // time when we last read various pages
     uint32_t last_status_read_ms;
     uint32_t last_rc_read_ms;