modelec/servo_moteurs
1
0
Fork 0
mirror of https://github.com/modelec/servo_moteurs.git synced 2026-03-18 21:40:31 +01:00
Code Issues Packages Projects Releases Wiki Activity

add clear message and change angle to radian

Browse Source
This commit is contained in:
ackimixs
2024-04-10 15:03:20 +02:00
parent 31f1125a3a
commit 244edc11a2
1 changed files with 5 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

7
MyTCPClient.cpp
View File

@@ -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();
}
}
}