add delay before sending the message

src/Crazyflie.cpp

@@ -14,7 +14,7 @@
 #include <cmath>
 #include <inttypes.h>
 #include <regex>
-
+#include <iostream>
 #define FIRMWARE_BUGGY
 
 Logger EmptyLogger;
@@ -1351,10 +1351,12 @@ void CrazyflieBroadcaster::sendDesCableStatesSetpoint(
   crtpDesCableStatesSetpointRequest req;
   size_t j = 0;
   for (const auto entry : data) {
+    // std::cout << "s " << (int)entry.id << std::endl;
     req.add(entry.id, entry.mu_ref_x, entry.mu_ref_y, entry.mu_ref_z, entry.qid_ref_x, entry.qid_ref_y, entry.qid_ref_z);
     ++j;
     if (j==2) {
       m_connection.send(req);
+      std::this_thread::sleep_for(std::chrono::milliseconds(1));
       req.clear();
       j = 0;
     }