From 1d22cf70b338e3d1d9827547db5117f2e5c319df Mon Sep 17 00:00:00 2001
From: supiiik <mjenis@atlas.sk>
Date: Sun, 3 Jun 2018 13:53:10 +0200
Subject: [PATCH] MSP for smart_feedforward and throttle boost

Added 3 new MSP values: throttle boost and smart feedforward
---
 src/main/interface/msp.c | 8 ++++++++
 1 file changed, 8 insertions(+)

diff --git a/src/main/interface/msp.c b/src/main/interface/msp.c
index 841d718839..6dc2659051 100644
--- a/src/main/interface/msp.c
+++ b/src/main/interface/msp.c
@@ -1263,6 +1263,9 @@ static bool mspProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst)
         sbufWriteU16(dst, currentPidProfile->itermThrottleThreshold);
         sbufWriteU16(dst, currentPidProfile->itermAcceleratorGain);
         sbufWriteU16(dst, currentPidProfile->dtermSetpointWeight);
+        sbufWriteU8(dst, currentPidProfile->smart_feedforward);
+        sbufWriteU8(dst, currentPidProfile->throttle_boost);
+        sbufWriteU8(dst, currentPidProfile->throttle_boost_cutoff);
         break;
 
     case MSP_SENSOR_CONFIG:
@@ -1726,6 +1729,11 @@ static mspResult_e mspProcessInCommand(uint8_t cmdMSP, sbuf_t *src)
         if (sbufBytesRemaining(src) >= 2) {
             currentPidProfile->dtermSetpointWeight = sbufReadU16(src);
         }
+        if (sbufBytesRemaining(src) >= 3) {
+            currentPidProfile->smart_feedforward = sbufReadU8(src);
+            currentPidProfile->throttle_boost = sbufReadU8(src);
+            currentPidProfile->throttle_boost_cutoff = sbufReadU8(src);
+        }
         pidInitConfig(currentPidProfile);
         break;