From 4b3aab2767cde3337a4694a1e12afee37b1872c4 Mon Sep 17 00:00:00 2001
From: Paul Riseborough <p_riseborough@live.com.au>
Date: Wed, 16 Mar 2016 12:57:55 +1100
Subject: [PATCH] ekf2_replay: Fix bug in replay message format handling

---
 src/modules/ekf2_replay/ekf2_replay_main.cpp | 5 +++++
 1 file changed, 5 insertions(+)

diff --git a/src/modules/ekf2_replay/ekf2_replay_main.cpp b/src/modules/ekf2_replay/ekf2_replay_main.cpp
index cecfcf2643..bcd981b2b5 100644
--- a/src/modules/ekf2_replay/ekf2_replay_main.cpp
+++ b/src/modules/ekf2_replay/ekf2_replay_main.cpp
@@ -302,6 +302,11 @@ void Ekf2Replay::parseMessage(uint8_t *source, uint8_t *destination, uint8_t typ
 			break;
 
 		case 'I':
+			memcpy(&destination[write_index], &source[write_index], sizeof(uint32_t));
+			write_index += sizeof(uint32_t);
+			break;
+
+		case 'i':
 			memcpy(&destination[write_index], &source[write_index], sizeof(int32_t));
 			write_index += sizeof(int32_t);
 			break;