From ea95ba94e6e79df2c0ff6cdff3314997453f3ff8 Mon Sep 17 00:00:00 2001
From: Roman Lut <11955117+RomanLut@users.noreply.github.com>
Date: Sun, 26 Jun 2022 17:50:05 +0300
Subject: [PATCH] adjusted parameters passing

---
 src/main/fc/fc_msp.c | 8 ++++----
 1 file changed, 4 insertions(+), 4 deletions(-)

diff --git a/src/main/fc/fc_msp.c b/src/main/fc/fc_msp.c
index 2b5094bc06..f099c0722b 100644
--- a/src/main/fc/fc_msp.c
+++ b/src/main/fc/fc_msp.c
@@ -3474,10 +3474,10 @@ bool mspFCProcessInOutCommand(uint16_t cmdMSP, sbuf_t *dst, sbuf_t *src, mspResu
 				DISABLE_STATE(GPS_FIX);
 			}
 
-			sbufWriteU16(dst, input[INPUT_STABILIZED_ROLL] + 500);
-			sbufWriteU16(dst, input[INPUT_STABILIZED_PITCH] + 500);
-			sbufWriteU16(dst, input[INPUT_STABILIZED_YAW] + 500);
-			sbufWriteU16(dst, input[INPUT_STABILIZED_THROTTLE] + 500);
+			sbufWriteU16(dst, (uint16_t)input[INPUT_STABILIZED_ROLL]);
+			sbufWriteU16(dst, (uint16_t)input[INPUT_STABILIZED_PITCH]);
+			sbufWriteU16(dst, (uint16_t)input[INPUT_STABILIZED_YAW]);
+			sbufWriteU16(dst, (uint16_t)input[INPUT_STABILIZED_THROTTLE]);
 
 			simulatorData.debugIndex++;
 			if (simulatorData.debugIndex == 8){