From d506462cd9b669a45f812534fbfbbfc80abd892a Mon Sep 17 00:00:00 2001
From: bkleiner <b.kleiner@str8labs.com>
Date: Thu, 27 Jun 2024 11:32:44 +0200
Subject: [PATCH] msp: fix motor config

---
 src/io/msp.c | 12 +++++++-----
 1 file changed, 7 insertions(+), 5 deletions(-)

diff --git a/src/io/msp.c b/src/io/msp.c
index 17e028e7a..c8be49913 100644
--- a/src/io/msp.c
+++ b/src/io/msp.c
@@ -158,12 +158,14 @@ static void msp_process_serial_cmd(msp_t *msp, msp_magic_t magic, uint16_t cmd,
     break;
   }
   case MSP_MOTOR_CONFIG: {
-    uint16_t data[3] = {
-        1070, // min throttle
-        2000, // max throttle
-        1000, // min command
+    uint16_t data[5] = {
+        1070,         // min throttle
+        2000,         // max throttle
+        1000,         // min command
+        (0 << 8) | 4, // motor count &  motor pole count
+        0,            // dshot telemetry & esc sensor
     };
-    msp_send_reply(msp, magic, cmd, (uint8_t *)data, 3 * sizeof(uint16_t));
+    msp_send_reply(msp, magic, cmd, (uint8_t *)data, 5 * sizeof(uint16_t));
     break;
   }
   case MSP_MOTOR: {