Fix SendAsyncMessage to place message in correct location (#18)

Makuna · Jan 7, 2018 · 7ff258d · 7ff258d
1 parent 904a906
commit 7ff258d
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/src/MessageTask.cpp b/src/MessageTask.cpp
@@ -32,7 +32,7 @@ bool MessageTask::SendAsyncMessage(const Message& message, bool withinIsr)
         if (nextIndex != _indexFront)
         {
             // copy message into queue
-            volatile uint8_t* pQueue = _pQueue + (nextIndex * _messageSize);
+            volatile uint8_t* pQueue = _pQueue + (_indexBack * _messageSize);
             const uint8_t* pMessage = (const uint8_t*)&message;
             for (uint8_t i = 0; i < message.Size; i++)
             {