From dc1cd37ddf6fad14b4909c449d8b31518cd95d75 Mon Sep 17 00:00:00 2001 From: ackimixs Date: Wed, 15 May 2024 20:40:37 +0200 Subject: [PATCH] map --- TCPServer.cpp | 6 ++++-- 1 file changed, 4 insertions(+), 2 deletions(-) diff --git a/TCPServer.cpp b/TCPServer.cpp index 19b3c2c..3cb5fb9 100644 --- a/TCPServer.cpp +++ b/TCPServer.cpp @@ -175,12 +175,14 @@ void TCPServer::handleMessage(const std::string& message, int clientSocket) else if (args[0] == "1") { int speed; + value = -value; + if (value < 0) { - speed = static_cast((-value * (70 + 370) / 32767) - 370); // Maps [-32767, 0] to [-370, -70] + speed = static_cast((value * (70 + 370) / 32767) - 370); // Maps [-32767, 0] to [-370, -70] } else if (value == 0) { speed = 0; // Maps 0 to 0 } else { - speed = static_cast((-value * (70 + 310) / 32768) + 70); // Maps [0, 32768] to [70, 310] + speed = static_cast((value * (70 + 310) / 32768) + 70); // Maps [0, 32768] to [70, 310] } if (!handleEmergecnyFlag) {