From 244edc11a21bbd5f549adf100ae408f6adf966b6 Mon Sep 17 00:00:00 2001
From: ackimixs <ackimixs@protonmail.com>
Date: Wed, 10 Apr 2024 15:03:20 +0200
Subject: [PATCH] add clear message and change angle to radian

---
 MyTCPClient.cpp | 7 +++++--
 1 file changed, 5 insertions(+), 2 deletions(-)

diff --git a/MyTCPClient.cpp b/MyTCPClient.cpp
index 2282403..96fa3eb 100644
--- a/MyTCPClient.cpp
+++ b/MyTCPClient.cpp
@@ -51,8 +51,11 @@ void MyTCPClient::handleMessage(const std::string &message) {
                 return;
             }
             int servo = std::stoi(args[0]);
-            int angle = std::stoi(args[1]);
-            this->pwm_setServoPosition(servo, angle);
+            double angleRad = std::stof(args[1]) / 100;
+            int angleDeg = static_cast<int>(angleRad * 180 / 3.14159);
+            this->pwm_setServoPosition(servo, angleDeg);
+        } else if (token[2] == "clear") {
+            this->pwm_clear();
         }
     }
 }