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

patch

Browse Source
This commit is contained in:
ackimixs
2024-04-10 18:13:39 +02:00
parent 7a85fd53a7
commit ef16d8ec4c
1 changed files with 9 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files

16
MyTCPClient.cpp
View File

@@ -30,7 +30,7 @@ void MyTCPClient::handleMessage(const std::string &message) {
} else if (token[2] == "angle") {
std::vector<std::string> args = TCPSocket::split(token[3], ",");
double angle = std::stof(args[1]) / 100;
double angle = std::stod(args[1]) / 100;
//convert to degres
double angleDegrees = angle * 180 / 3.14159265359;
@@ -42,7 +42,7 @@ void MyTCPClient::handleMessage(const std::string &message) {
} else if (token[2] == "set") {
std::vector<std::string> args = TCPSocket::split(token[3], ",");
double angle = std::stof(args[2]) / 100;
double angle = std::stod(args[2]) / 100;
//convert to degres
double angleDegrees = angle * 180 / 3.14159265359;
@@ -92,12 +92,14 @@ void MyTCPClient::handleMessageFromArduino(const std::string &message) {
} else if (waitForResponse) {
std::cout << "Received from arduino : " << message << std::endl;
std::vector<std::string> token = TCPSocket::split(message, ",");
double x = std::stof(token[0]);
double y = std::stof(token[1]);
double theta = std::stof(token[2]);
if (token.size() == 3) {
double x = std::stod(token[0]);
double y = std::stod(token[1]);
double theta = std::stod(token[2]);
this->sendMessage("arduino;strat;set pos;" + std::to_string(x) + "," + std::to_string(y) + "," + std::to_string(theta));
waitForResponse = false;
this->sendMessage("arduino;strat;set pos;" + std::to_string(x) + "," + std::to_string(y) + "," + std::to_string(theta));
waitForResponse = false;
}
}
}