From 54d259335274674911c0996fd9944487f7c288d3 Mon Sep 17 00:00:00 2001
From: ackimixs <ackimixs@protonmail.com>
Date: Wed, 15 May 2024 20:02:13 +0200
Subject: [PATCH] speed

---
 TCPServer.cpp | 10 +++++++++-
 1 file changed, 9 insertions(+), 1 deletion(-)

diff --git a/TCPServer.cpp b/TCPServer.cpp
index f436e4f..d4b33eb 100644
--- a/TCPServer.cpp
+++ b/TCPServer.cpp
@@ -173,7 +173,15 @@ void TCPServer::handleMessage(const std::string& message, int clientSocket)
                 }
             }
             else if (args[0] == "1") {
-                int speed = static_cast<int>((- value * (310 - 70) / 32767.0f) + 70);
+                int speed;
+                if (value < 0) {
+                    speed = static_cast<int>((value * (70 + 310) / 310) - 70);
+                } else if (value == 0) {
+                    speed = 0;
+                } else {
+                    speed = static_cast<int>((value * (70 + 310) / 310) + 70);
+                }
+
                 if (!handleEmergecnyFlag) {
                     this->broadcastMessage("strat;arduino;speed;" + std::to_string(speed) + "\n");
                 }