From 061893b35d2eebedfb64d65a35061a289eeb63b5 Mon Sep 17 00:00:00 2001 From: xdrm-brackets Date: Sat, 29 Apr 2017 17:09:47 +0200 Subject: [PATCH] [CREATED] ctrlTerm emulation in C --- command-terminal/c-emul/main.c | 348 +++++++++++++++++++++++++++++++++ 1 file changed, 348 insertions(+) create mode 100644 command-terminal/c-emul/main.c diff --git a/command-terminal/c-emul/main.c b/command-terminal/c-emul/main.c new file mode 100644 index 0000000..f096e08 --- /dev/null +++ b/command-terminal/c-emul/main.c @@ -0,0 +1,348 @@ +#include +#include +#include +#include +#include +#include // close +#include +#include // getaddrinfo, getnameinfo +#include + + +#define TERMREQ_FBK 0x01 +#define TERMREQ_CAP 0x02 +#define TERMREQ_SPD 0x04 +#define TERMREQ_ALT 0x08 + +#define PLANE_LEN ( sizeof(char)*6+sizeof(int)*5 ) +struct plane{ + char code[6]; + int x; + int y; + int z; + int cap; + int spd; + char online; +}; + +struct plane_update{ + char flags; + int z; + int cap; + int spd; + char done; +}; + +#define TERMREQ_LEN ( sizeof(char)+PLANE_LEN ) +struct term_req{ + char flags; + struct plane update; +}; + +struct term_res{ + char flags; + char n; + struct plane* data; +}; + + +#define BINDHDR_LEN ( sizeof(char)+sizeof(in_addr_t)+sizeof(unsigned short) ) +#define BINDHEAD_UDP 0x01 // is terminal (ask for UDP socket) +#define BINDHEAD_TCP 0x02 // is plane (ask for TCP socket) +#define BINDHEAD_CTL 0x04 // is ctrlTerm (else: viewTerm) + +struct bind_header{ + char flags; + in_addr_t addr; + unsigned short port; +}; + + + + +int main(int argc, char* argv[]){ + + socklen_t len; + int msocket, csocket; + struct sockaddr_in mcast, server; + char buffer[512]; + struct bind_header bh; + struct in_addr ip; + struct term_req tr; + struct term_res trs; + int i, nb; + int count, last; + + /************************************************ + **** DEMANDE MULTICAST **** + ************************************************/ + printf("DEMANDE MCAST\n=============\n\n"); + if( 1 ){ + + /* [1] Initialisation socket + =========================================================*/ + /* 1. Création socket */ + msocket = socket(AF_INET, SOCK_DGRAM, 0); + + if( msocket == -1 ) + return EXIT_FAILURE; + + /* 2. Reset des valeurs */ + bzero(&mcast, sizeof(struct sockaddr_in)); + + /* 3. On définit les infos */ + mcast.sin_family = AF_INET; + mcast.sin_port = htons(4446); + mcast.sin_addr.s_addr = inet_addr("224.0.0.3"); + + + /* [2] On demande une socket de communication + =========================================================*/ + /* 1. Création de la requête */ + len = sizeof(struct sockaddr_in); + if( sendto(msocket, "\5\1\2\3\4\0\1", sizeof(char)*7, 0, (struct sockaddr*) &mcast, len) < 0 ){ + printf("cannot send multicast message.\n"); + return EXIT_FAILURE; + } + + /* [3] On récupère la réponse + =========================================================*/ + /* 1. On récupère la réponse */ + if( recvfrom(msocket, buffer, 512, 0, (struct sockaddr*) &mcast, &len) < BINDHDR_LEN ){ + printf("cannot receive multicast response.\n"); + return EXIT_FAILURE; + } + + /* 2. On parse la réponse */ + memcpy(&bh.flags, buffer, sizeof(char)); + memcpy(&bh.addr, buffer+sizeof(char), sizeof(in_addr_t)); + memcpy(&bh.port, buffer+sizeof(char)+sizeof(in_addr_t), sizeof(unsigned short)); + // bh.addr = ntohl(bh.addr); + bh.port = ntohs(bh.port); + ip.s_addr = bh.addr; + printf("Received: { flags: %d, addr: %x/'%s', port: %d}\n", bh.flags, bh.addr, inet_ntoa(ip), bh.port); + + close(msocket); + + } + + + + + + /************************************************ + **** CONNECTION UDP **** + ************************************************/ + printf("CONNECTION UDP\n==============\n\n"); + if( 1 ){ + + /* [1] Initialisation socket + =========================================================*/ + /* 1. Création socket */ + csocket = socket(AF_INET, SOCK_DGRAM, 0); + + if( csocket == -1 ) + return EXIT_FAILURE; + + /* 2. Reset des valeurs */ + bzero(&server, sizeof(struct sockaddr_in)); + + /* 3. On définit les infos */ + server.sin_family = AF_INET; + server.sin_port = htons(bh.port); + server.sin_addr.s_addr = ip.s_addr; + + + /* [2] Initialisation de la connexion + =========================================================*/ + if( sendto(csocket, "0", 1, 0, (struct sockaddr*) &server, len) < 0 ){ + printf("Cannot send message through command socket.\n"); + return EXIT_FAILURE; + } + + } + + + + + + /************************************************ + **** DEMANDE INFO CLASSIQUE **** + ************************************************/ + if( 1 ){ + printf("DEMANDE DES DONNEES UNIQUEMENT\n==============================\n\n"); + + /* [1] Preparing request + =========================================================*/ + tr.flags = TERMREQ_FBK; + strcpy(tr.update.code, "CODE1"); + tr.update.x = 1; + tr.update.y = 2; + tr.update.z = 3; + tr.update.cap = 4; + tr.update.spd = 5; + printf("Sending { flags: %d; plane: #%s { z=%d; cap=%d; speed=%d} }\n", tr.flags, tr.update.code, tr.update.z, tr.update.cap, tr.update.spd); + + tr.update.x = htonl(tr.update.x); + tr.update.y = htonl(tr.update.y); + tr.update.z = htonl(tr.update.z); + tr.update.cap = htonl(tr.update.cap); + tr.update.spd = htonl(tr.update.spd); + + /* [2] Filling buffer + =========================================================*/ + bzero(buffer, 512); + memcpy(buffer+sizeof(char)*0+sizeof(int)*0, &tr.flags, sizeof(char)); + memcpy(buffer+sizeof(char)*1+sizeof(int)*0, &tr.update.code, sizeof(char)*6); + memcpy(buffer+sizeof(char)*7+sizeof(int)*0, &tr.update.x, sizeof(int)); + memcpy(buffer+sizeof(char)*7+sizeof(int)*1, &tr.update.y, sizeof(int)); + memcpy(buffer+sizeof(char)*7+sizeof(int)*2, &tr.update.z, sizeof(int)); + memcpy(buffer+sizeof(char)*7+sizeof(int)*3, &tr.update.cap, sizeof(int)); + memcpy(buffer+sizeof(char)*7+sizeof(int)*4, &tr.update.spd, sizeof(int)); + + + /* [3] Sending request + =========================================================*/ + if( sendto(csocket, buffer, 7+sizeof(int)*5+1, 0, (struct sockaddr*) &server, len) < 0 ){ + printf("Cannot ask for simple data.\n"); + return EXIT_FAILURE; + } + + /* [4] Fetch & print data + =========================================================*/ + /* 1. On récupère la réponse */ + len = sizeof(struct sockaddr_in); + nb = recvfrom(csocket, buffer, 512, 0, (struct sockaddr*) &server, &len); + + printf("%d bytes received\n", nb); + + if( nb < 2 ){ + printf("Error receiving simple data.\n"); + return EXIT_FAILURE; + } + + /* 2. On parse la réponse */ + count = 0; last = sizeof(char); memcpy(&trs.flags, buffer+count, last); + count += last; last = sizeof(char); memcpy(&trs.n, buffer+count, last); + + trs.data = malloc( sizeof(struct plane) * trs.n ); + + + for( i = 0 ; i < trs.n ; i++ ){ + count += last; last = sizeof(char)*6; memcpy(&trs.data[i].code, buffer+count, last); + count += last; last = sizeof(int); memcpy(&trs.data[i].x, buffer+count, last); + count += last; last = sizeof(int); memcpy(&trs.data[i].y, buffer+count, last); + count += last; last = sizeof(int); memcpy(&trs.data[i].z, buffer+count, last); + count += last; last = sizeof(int); memcpy(&trs.data[i].cap, buffer+count, last); + count += last; last = sizeof(int); memcpy(&trs.data[i].spd, buffer+count, last); + + trs.data[i].x = ntohl(trs.data[i].x); + trs.data[i].y = ntohl(trs.data[i].y); + trs.data[i].z = ntohl(trs.data[i].z); + trs.data[i].cap = ntohl(trs.data[i].cap); + trs.data[i].spd = ntohl(trs.data[i].spd); + + printf("Plane[%s@%d] { (%d,%d,%d), cap: %d, spd: %d}\n", trs.data[i].code, i, trs.data[i].x, trs.data[i].y, trs.data[i].z, trs.data[i].cap, trs.data[i].spd); + } + + + } + + + + /************************************************ + **** DEMANDE MISE A JOUR SIMPLE **** + ************************************************/ + if( 1 ){ + printf("DEMANDE D'UPDATE SIMPLE\n=======================\n\n"); + + if( trs.n < 1 ){ + printf("No plane to update.\n"); + return EXIT_FAILURE; + } + + + /* [1] Preparing request + =========================================================*/ + tr.flags = TERMREQ_SPD; + memcpy(&tr.update, &trs.data[0], sizeof(struct plane)); + tr.update.spd = 1000; + + printf("Update req { flags: %d; plane: #%s { z=%d; cap=%d; speed=%d} }\n", tr.flags, tr.update.code, tr.update.z, tr.update.cap, tr.update.spd); + tr.update.x = htonl(tr.update.x); + tr.update.y = htonl(tr.update.y); + tr.update.z = htonl(tr.update.z); + tr.update.cap = htonl(tr.update.cap); + tr.update.spd = htonl(tr.update.spd); + + /* [2] Filling buffer + =========================================================*/ + bzero(buffer, 512); + memcpy(buffer+sizeof(char)*0+sizeof(int)*0, &tr.flags, sizeof(char)); + memcpy(buffer+sizeof(char)*1+sizeof(int)*0, &tr.update.code, sizeof(char)*6); + memcpy(buffer+sizeof(char)*7+sizeof(int)*0, &tr.update.x, sizeof(int)); + memcpy(buffer+sizeof(char)*7+sizeof(int)*1, &tr.update.y, sizeof(int)); + memcpy(buffer+sizeof(char)*7+sizeof(int)*2, &tr.update.z, sizeof(int)); + memcpy(buffer+sizeof(char)*7+sizeof(int)*3, &tr.update.cap, sizeof(int)); + memcpy(buffer+sizeof(char)*7+sizeof(int)*4, &tr.update.spd, sizeof(int)); + + + /* [3] Sending request + =========================================================*/ + if( sendto(csocket, buffer, 7+sizeof(int)*5+1, 0, (struct sockaddr*) &server, len) < 0 ){ + printf("Cannot ask for simple update.\n"); + return EXIT_FAILURE; + } + + /* [4] Fetch & print data + =========================================================*/ + /* 1. On récupère la réponse */ + len = sizeof(struct sockaddr_in); + nb = recvfrom(csocket, buffer, 512, 0, (struct sockaddr*) &server, &len); + + printf("%d bytes received\n", nb); + + if( nb < 1 ){ + printf("Error receiving simple update.\n"); + return EXIT_FAILURE; + } + + + /* 2. On parse la réponse */ + count = 0; last = sizeof(char); memcpy(&trs.flags, buffer+count, last); + count += last; last = sizeof(char); memcpy(&trs.n, buffer+count, last); + printf("Flag received : %d\n", trs.flags); + + trs.data = malloc( sizeof(struct plane) * trs.n ); + + + for( i = 0 ; i < trs.n ; i++ ){ + count += last; last = sizeof(char)*6; memcpy(&trs.data[i].code, buffer+count, last); + count += last; last = sizeof(int); memcpy(&trs.data[i].x, buffer+count, last); + count += last; last = sizeof(int); memcpy(&trs.data[i].y, buffer+count, last); + count += last; last = sizeof(int); memcpy(&trs.data[i].z, buffer+count, last); + count += last; last = sizeof(int); memcpy(&trs.data[i].cap, buffer+count, last); + count += last; last = sizeof(int); memcpy(&trs.data[i].spd, buffer+count, last); + + trs.data[i].x = ntohl(trs.data[i].x); + trs.data[i].y = ntohl(trs.data[i].y); + trs.data[i].z = ntohl(trs.data[i].z); + trs.data[i].cap = ntohl(trs.data[i].cap); + trs.data[i].spd = ntohl(trs.data[i].spd); + + printf("Plane[%s@%d] { (%d,%d,%d), cap: %d, spd: %d}\n", trs.data[i].code, i, trs.data[i].x, trs.data[i].y, trs.data[i].z, trs.data[i].cap, trs.data[i].spd); + } + + + } + + /************************************************ + **** DEMANDE MISE A JOUR COMBINEE **** + ************************************************/ + + + + + + return EXIT_SUCCESS; +} \ No newline at end of file