generated from AfonsoCMSousa/CPP-Template
120 lines
4.1 KiB
C++
120 lines
4.1 KiB
C++
// include/telemetry.cpp
|
|
// Telemetry server implementation for broadcasting car telemetry data to connected clients.
|
|
#include "telemetry.h"
|
|
|
|
std::vector<int> telemetry_clients;
|
|
pthread_mutex_t clients_mutex = PTHREAD_MUTEX_INITIALIZER;
|
|
|
|
// Broadcast telemetry to all connected clients
|
|
void broadcast_telemetry(const api_packet& packet) {
|
|
telemetry_packet telem;
|
|
telem.server_id = packet.tracker_id;
|
|
telem.car_count = 0;
|
|
|
|
// Convert api_packet to telemetry_packet
|
|
for (int i = 0; i < MAX_PLAYERS; i++) {
|
|
if (packet.cars[i].isConnected) {
|
|
auto& car = telem.cars[telem.car_count];
|
|
|
|
car.carID = packet.cars[i].carID;
|
|
strncpy(car.driver_name, packet.cars[i].driver_name, sizeof(car.driver_name) - 1);
|
|
car.driver_name[sizeof(car.driver_name) - 1] = '\0';
|
|
strncpy(car.driver_guid, packet.cars[i].driver_GUID, sizeof(car.driver_guid) - 1);
|
|
car.driver_guid[sizeof(car.driver_guid) - 1] = '\0';
|
|
strncpy(car.car_model, packet.cars[i].car_model, sizeof(car.car_model) - 1);
|
|
car.car_model[sizeof(car.car_model) - 1] = '\0';
|
|
car.normalizedSplinePos = packet.cars[i].normalizedSplinePos;
|
|
|
|
// Calculate speed from velocity vector (m/s to km/h)
|
|
float speed_ms = std::sqrt(
|
|
std::pow(packet.cars[i].velocity.x, 2.0f) +
|
|
std::pow(packet.cars[i].velocity.y, 2.0f) +
|
|
std::pow(packet.cars[i].velocity.z, 2.0f)
|
|
);
|
|
car.speed_kmh = speed_ms * 3.6f;
|
|
|
|
car.gear = packet.cars[i].carGear;
|
|
car.rpm = packet.cars[i].carRPM;
|
|
car.last_lap_time = packet.cars[i].lap_time;
|
|
car.best_lap_time = 0; // TODO: Track best lap
|
|
car.current_lap = packet.cars[i].total_laps_completed;
|
|
car.position = telem.car_count + 1; // Temporary position
|
|
|
|
telem.car_count++;
|
|
}
|
|
}
|
|
|
|
// Broadcast to all connected clients
|
|
pthread_mutex_lock(&clients_mutex);
|
|
|
|
for (auto it = telemetry_clients.begin(); it != telemetry_clients.end();) {
|
|
ssize_t sent = send(*it, &telem, sizeof(telem), MSG_NOSIGNAL);
|
|
|
|
if (sent < 0) {
|
|
// Client disconnected, remove from list
|
|
printf("[T] Telemetry client %d disconnected\n", *it);
|
|
close(*it);
|
|
it = telemetry_clients.erase(it);
|
|
} else {
|
|
++it;
|
|
}
|
|
}
|
|
|
|
pthread_mutex_unlock(&clients_mutex);
|
|
}
|
|
|
|
// Thread to accept telemetry client connections
|
|
void* telemetry_server_thread(void* arg) {
|
|
(void)arg;
|
|
|
|
int server_fd = socket(AF_UNIX, SOCK_STREAM, 0);
|
|
if (server_fd < 0) {
|
|
perror("[!] Telemetry socket creation failed");
|
|
return NULL;
|
|
}
|
|
|
|
unlink(TELEMETRY_SOCKET_PATH);
|
|
|
|
struct sockaddr_un addr;
|
|
addr.sun_family = AF_UNIX;
|
|
strncpy(addr.sun_path, TELEMETRY_SOCKET_PATH, sizeof(addr.sun_path) - 1);
|
|
addr.sun_path[sizeof(addr.sun_path) - 1] = '\0';
|
|
|
|
if (bind(server_fd, (struct sockaddr*)&addr, sizeof(addr)) < 0) {
|
|
perror("[!] Telemetry socket bind failed");
|
|
close(server_fd);
|
|
return NULL;
|
|
}
|
|
|
|
if (listen(server_fd, 5) < 0) {
|
|
perror("[!] Telemetry socket listen failed");
|
|
close(server_fd);
|
|
return NULL;
|
|
}
|
|
|
|
printf("[+] Telemetry server listening on %s\n", TELEMETRY_SOCKET_PATH);
|
|
|
|
while (1) {
|
|
int client_fd = accept(server_fd, NULL, NULL);
|
|
if (client_fd < 0) {
|
|
perror("[!] Telemetry accept failed");
|
|
continue;
|
|
}
|
|
|
|
pthread_mutex_lock(&clients_mutex);
|
|
|
|
if (telemetry_clients.size() < (size_t)MAX_TELEMETRY_CLIENTS) {
|
|
telemetry_clients.push_back(client_fd);
|
|
printf("[+] Telemetry client connected (total: %zu)\n", telemetry_clients.size());
|
|
} else {
|
|
printf("[!] Max telemetry clients reached, rejecting connection\n");
|
|
close(client_fd);
|
|
}
|
|
|
|
pthread_mutex_unlock(&clients_mutex);
|
|
}
|
|
|
|
close(server_fd);
|
|
return NULL;
|
|
}
|