From 08dd1e6c639ea19c273855c818c66bb0de482309 Mon Sep 17 00:00:00 2001
From: Pavel Kirienko <pavel.kirienko@gmail.com>
Date: Wed, 1 Jul 2015 19:16:10 +0300
Subject: [PATCH] Tail byte transmission fix

---
 libuavcan/src/transport/uc_frame.cpp | 3 +++
 1 file changed, 3 insertions(+)

diff --git a/libuavcan/src/transport/uc_frame.cpp b/libuavcan/src/transport/uc_frame.cpp
index 944bd8871e..6d49fec0db 100644
--- a/libuavcan/src/transport/uc_frame.cpp
+++ b/libuavcan/src/transport/uc_frame.cpp
@@ -155,10 +155,13 @@ bool Frame::compile(CanFrame& out_can_frame) const
         tail |= (1U << 5);
     }
 
+    UAVCAN_ASSERT(payload_len_ < sizeof(static_cast<CanFrame*>(NULL)->data));
+
     out_can_frame.dlc = static_cast<uint8_t>(payload_len_);
     (void)copy(payload_, payload_ + payload_len_, out_can_frame.data);
 
     out_can_frame.data[out_can_frame.dlc] = tail;
+    out_can_frame.dlc++;
 
     /*
      * Discriminator