diff --git a/TCPServer.cpp b/TCPServer.cpp index a3646e3..f23bd3d 100644 --- a/TCPServer.cpp +++ b/TCPServer.cpp @@ -97,6 +97,11 @@ void TCPServer::acceptConnections() void TCPServer::handleMessage(const std::string& message, int clientSocket) { std::cout << "Message from : " << clientSocket << " : " << message << std::endl; + + if (message.find("request robotPose") != std::string::npos) + { + broadcastMessage("robotPose 12 13 14 15"); + } } diff --git a/TCPServer.h b/TCPServer.h index bb03d94..787e54b 100644 --- a/TCPServer.h +++ b/TCPServer.h @@ -44,7 +44,7 @@ public: // Broadcast message to all connected clients void broadcastMessage(const char* message, int senderSocket = -1); // Modified method signature - void handleMessage(const std::string& message, int clientSocket); + void handleMessage(const std::string& message, int clientSocket = -1); void clientDisconnected(int clientSocket); // New method to handle client disconnection