594 lines
26 KiB
C
594 lines
26 KiB
C
|
/*************************************************************/
|
||
|
|
/* FGD_MCP.C by Oliver Delise */
|
||
|
|
/* Contact info: */
|
||
|
|
/* e-mail: delise@mail.isis.de */
|
||
|
|
/* www: http://www.isis.de/members/~odelise/progs/mmx-emu/ */
|
||
|
|
/* ftp: http://www.isis.de/members/~odelise/progs/flightgear */
|
||
|
|
/* */
|
||
|
|
/* Version 0.1-alpha */
|
||
|
|
/* The author of this program offers no waranty at all */
|
||
|
|
/* about the correct execution of this software material. */
|
||
|
|
/* Furthermore, the author can NOT be held responsible for */
|
||
|
|
/* any physical or moral damage caused by the use of this */
|
||
|
|
/* software. */
|
||
|
|
/* */
|
||
|
|
/* This is an interactive standalone Tool to communicate */
|
||
|
|
/* with any FlightGear-Deamon. */
|
||
|
|
/* This is Open Source Software with many parts */
|
||
|
|
/* shamelessly stolen from others... */
|
||
|
|
/* */
|
||
|
|
/* -> This program will use a TCP port listening on a */
|
||
|
|
/* remote or local host inside the range you give to it. */
|
||
|
|
/* I offer no warranty over the accuracy though :) */
|
||
|
|
/* There are 3 verbose modes: No info, service info, and */
|
||
|
|
/* full info. No info is good of you only want the list */
|
||
|
|
/* of the ports, no more info. The best mode is Full */
|
||
|
|
/* info, as you get error information,etc. The main */
|
||
|
|
/* output is STDOUT, and ALL the errors go to STDERR. */
|
||
|
|
/* */
|
||
|
|
/* History: v0.1pre-alpha: May 25 1999 -> First release */
|
||
|
|
/* v0.1-alpha Nov 11 1999 */
|
||
|
|
/*************************************************************/
|
||
|
|
|
||
|
|
#include <stdio.h>
|
||
|
|
#include "fgd.h"
|
||
|
|
|
||
|
|
//#define printf //
|
||
|
|
|
||
|
|
/* Netstuff */
|
||
|
|
int sock = -1;
|
||
|
|
int my_sock;
|
||
|
|
struct sockaddr_in address;
|
||
|
|
struct sockaddr_in my_address;
|
||
|
|
int result;
|
||
|
|
extern char *sys_errlist[];
|
||
|
|
extern int errno;
|
||
|
|
int current_port = 10000;
|
||
|
|
u_short base_port = 10000;
|
||
|
|
u_short end_port = 10000;
|
||
|
|
int verbose = 2;
|
||
|
|
struct hostent *host_info, *f_host_info;
|
||
|
|
struct servent *service_info;
|
||
|
|
struct utsname myname;
|
||
|
|
|
||
|
|
/* Program-stuff */
|
||
|
|
int i, j;
|
||
|
|
int fgd_len_msg = 1, fgd_status, fgd_ele_len, fgd_curpos, fgd_cnt, fgd_ppl,
|
||
|
|
fgd_ppl_old, fgd_loss;
|
||
|
|
size_t anz;
|
||
|
|
char *fgd_job, *fgd_callsign, *fgd_name, *fgd_ip, *fgd_mcp_ip;
|
||
|
|
char *buffp, *src_host, *fgd_host, *fgfs_host, *fgfs_pilot, *fgd_txt;
|
||
|
|
|
||
|
|
/* List-stuff */
|
||
|
|
|
||
|
|
const int True = 0;
|
||
|
|
const int False= -1;
|
||
|
|
|
||
|
|
struct list_ele {
|
||
|
|
unsigned char ipadr[16], callsign[16];
|
||
|
|
unsigned char lon[8], lat[8], alt[8], roll[8], pitch[8], yaw[8];
|
||
|
|
float lonf, latf, altf, speedf, rollf, pitchf, yawf;
|
||
|
|
struct list_ele *next, *prev;
|
||
|
|
};
|
||
|
|
|
||
|
|
struct list_ele *head, *tail, *act, *test, *incoming, *boss, *other; /* fgd_msg; */
|
||
|
|
|
||
|
|
/*...Create head and tail of list */
|
||
|
|
void list_init( void) {
|
||
|
|
|
||
|
|
incoming = (struct list_ele*) malloc(sizeof(struct list_ele));
|
||
|
|
boss = (struct list_ele*) malloc(sizeof(struct list_ele));
|
||
|
|
other = (struct list_ele*) malloc(sizeof(struct list_ele));
|
||
|
|
head = (struct list_ele*) malloc(sizeof(struct list_ele));
|
||
|
|
tail = (struct list_ele*) malloc(sizeof(struct list_ele));
|
||
|
|
if (head == NULL || tail == NULL) { printf("Out of memory\n"); exit(1); }
|
||
|
|
head->ipadr[0] = 0;
|
||
|
|
tail->ipadr[0] = 255;
|
||
|
|
tail->ipadr[1] = 0;
|
||
|
|
head->prev = tail->prev = head;
|
||
|
|
head->next = tail->next = tail;
|
||
|
|
act = head; /* put listpointer to beginning of list */
|
||
|
|
}
|
||
|
|
|
||
|
|
void list_output( void) {
|
||
|
|
}
|
||
|
|
|
||
|
|
void list_search( char name[16]) {
|
||
|
|
|
||
|
|
if (strcmp(name, head->next->ipadr) <= 0) act = head;
|
||
|
|
else if (strcmp(name, tail->prev->ipadr) > 0) act = tail->prev;
|
||
|
|
else {
|
||
|
|
int vergleich = strcmp(name, act->ipadr);
|
||
|
|
if (vergleich > 0)
|
||
|
|
while (strcmp(name, act->next->ipadr) > 0) {
|
||
|
|
act = act->next;
|
||
|
|
}
|
||
|
|
else if (vergleich < 0)
|
||
|
|
while (strcmp(name, act->ipadr) < 0) {
|
||
|
|
act = act->prev;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
while (strcmp(name, act->ipadr) == 0) {
|
||
|
|
act = act->prev;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void list_insert( char newip[16]) {
|
||
|
|
struct list_ele *new_ele;
|
||
|
|
|
||
|
|
new_ele = (struct list_ele*) malloc(sizeof(struct list_ele));
|
||
|
|
if (new_ele == NULL) { printf("Out of memory\n"); exit(1); }
|
||
|
|
strcpy(new_ele->ipadr, newip);
|
||
|
|
/* setting default */
|
||
|
|
strcpy(new_ele->callsign, "not assigned");
|
||
|
|
list_search( newip);
|
||
|
|
new_ele->prev = act;
|
||
|
|
new_ele->next = act->next;
|
||
|
|
act->next->prev = act->next = new_ele;
|
||
|
|
}
|
||
|
|
|
||
|
|
void list_setval( char newip[16]) {
|
||
|
|
|
||
|
|
list_search( newip);
|
||
|
|
strcpy( act->next->callsign, incoming->callsign);
|
||
|
|
printf("Callsign %s\n", act->next->callsign);
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
void list_clear( char clrip[16]) {
|
||
|
|
struct list_ele *clr_ele;
|
||
|
|
|
||
|
|
list_search( clrip);
|
||
|
|
if ( strcmp( clrip, act->next->ipadr))
|
||
|
|
printf("....Name %s nicht vorhanden", clrip);
|
||
|
|
else {
|
||
|
|
clr_ele = act->next;
|
||
|
|
act->next = act->next->next;
|
||
|
|
act->next->prev = act;
|
||
|
|
free( clr_ele);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
int list_not_in( char name[16]) {
|
||
|
|
|
||
|
|
i = True;
|
||
|
|
test = head->next;
|
||
|
|
while ((test != tail) && (i==True)) {
|
||
|
|
i = (strcmp(test->ipadr, name) ? True : False);
|
||
|
|
test = test->next;
|
||
|
|
if (verbose != 0) printf("list_not_in : %d\n",i);
|
||
|
|
}
|
||
|
|
return(i);
|
||
|
|
}
|
||
|
|
|
||
|
|
void fgd_init(void){
|
||
|
|
|
||
|
|
/* Let's init a few things */
|
||
|
|
printf("MCP: Allocating memory...");
|
||
|
|
buffp = (char *) malloc(1024); /* No I don't check if there are another KB */
|
||
|
|
fgd_job = (char *) malloc(8);
|
||
|
|
fgd_host = (char *) malloc(64);
|
||
|
|
fgd_callsign = (char *) malloc(64);
|
||
|
|
fgd_name = (char*) malloc(64);
|
||
|
|
fgd_ip = (char *) malloc(16);
|
||
|
|
fgd_mcp_ip = (char *) malloc(16);
|
||
|
|
fgfs_host = (char *) malloc(64);
|
||
|
|
fgfs_pilot = (char *) malloc(64);
|
||
|
|
src_host = (char *) malloc(64);
|
||
|
|
fgd_txt = (char *) malloc(1024);
|
||
|
|
printf("ok\nMCP: Initializing values...");
|
||
|
|
strcpy( fgd_job, "xxx");
|
||
|
|
strcpy( fgd_host, "Johnny");
|
||
|
|
strcpy( fgd_callsign, "Unknown");
|
||
|
|
strcpy( fgd_name, "Unknown");
|
||
|
|
strcpy( fgd_ip, (char *) inet_ntoa(address.sin_addr));
|
||
|
|
strcpy( fgd_txt, "");
|
||
|
|
printf("ok\n");
|
||
|
|
boss->latf = 112.3;
|
||
|
|
boss->lonf = 4.5;
|
||
|
|
boss->altf = 0.67;
|
||
|
|
boss->speedf = 100.95;
|
||
|
|
boss->rollf = 89.0;
|
||
|
|
boss->pitchf = 1.23;
|
||
|
|
boss->yawf = 456.789;
|
||
|
|
fgd_ppl = 0;
|
||
|
|
bzero((char *)&address, sizeof(address));
|
||
|
|
address.sin_family = AF_INET;
|
||
|
|
/* determinating the source/sending host */
|
||
|
|
if (uname(&myname) == 0) strcpy(src_host , myname.nodename);
|
||
|
|
printf("MCP: I'm running on HOST : %s ", src_host);
|
||
|
|
if (host_info = gethostbyname( src_host)) {
|
||
|
|
bcopy(host_info->h_addr, (char *)&address.sin_addr,host_info->h_length);
|
||
|
|
strcpy((char *) fgd_mcp_ip, (char *) inet_ntoa(address.sin_addr));
|
||
|
|
}
|
||
|
|
printf("IP : %s\n", fgd_mcp_ip);
|
||
|
|
/* resolving the destination host, here fgd's host */
|
||
|
|
if (verbose == 2) printf(" Resolving default DEAMON: %s ->", fgd_host);
|
||
|
|
if (host_info = gethostbyname( fgd_host)) {
|
||
|
|
bcopy(host_info->h_addr, (char *)&address.sin_addr,host_info->h_length);
|
||
|
|
strcpy((char *) fgd_ip, (char *) inet_ntoa(address.sin_addr));
|
||
|
|
if (verbose == 2) {
|
||
|
|
printf(" resolved\n FGD running on HOST : %s", fgd_host);
|
||
|
|
printf(" IP : %s\n", fgd_ip);
|
||
|
|
}
|
||
|
|
} else if ((address.sin_addr.s_addr = inet_addr( fgd_host)) == INADDR_NONE) {
|
||
|
|
fprintf(stderr," Could not get %s host entry !\n", fgd_host);
|
||
|
|
printf(" NOT resolved !!!\n");
|
||
|
|
exit(1);
|
||
|
|
} else if (verbose == 2) printf(" address valid\n");
|
||
|
|
|
||
|
|
if ((base_port > end_port) || ((short)base_port < 0)) {
|
||
|
|
fprintf(stderr,"Bad port range : start=%d end=%d !\n");
|
||
|
|
exit(1);
|
||
|
|
} else if (verbose == 2) {
|
||
|
|
printf(" Port range: %d to %d\n",base_port,end_port);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
void fgd_send_com( char *FGD_com, char *FGFS_host) {
|
||
|
|
|
||
|
|
strcpy( buffp, " ");
|
||
|
|
current_port = base_port;
|
||
|
|
printf(" Sending : %s\n", FGD_com);
|
||
|
|
while (current_port <= end_port) {
|
||
|
|
/* fprintf(stderr,"Trying port: %d\n",current_port); */
|
||
|
|
sock = socket(PF_INET, SOCK_STREAM, 0);
|
||
|
|
if (sock == -1)
|
||
|
|
{
|
||
|
|
fprintf(stderr, "Error assigning master socket: %s\n",sys_errlist[errno]);
|
||
|
|
exit(-1);
|
||
|
|
}
|
||
|
|
|
||
|
|
address.sin_port = htons(current_port);
|
||
|
|
printf(" address.sin_port : %d\n",htons(address.sin_port));
|
||
|
|
|
||
|
|
f_host_info = gethostbyname(src_host);
|
||
|
|
|
||
|
|
//printf ("src_host : %s", ntohs(f_host_info->h_addr));
|
||
|
|
|
||
|
|
if (connect(sock, (struct sockaddr *)&address, sizeof(address)) == 0) {
|
||
|
|
/* FIXME: make a single string instead of sending elements */
|
||
|
|
|
||
|
|
fgd_len_msg = (int) sizeof(f_host_info->h_addr);
|
||
|
|
/* send length of sender-ip */
|
||
|
|
write( sock, &fgd_len_msg,1);
|
||
|
|
/* send sender-ip */
|
||
|
|
write( sock, f_host_info->h_addr, fgd_len_msg);
|
||
|
|
/* send commando */
|
||
|
|
write( sock, FGD_com, 1);
|
||
|
|
/* send length of dummy-string, for the moment with _WHO_ to execute commando
|
||
|
|
here: his length of ip */
|
||
|
|
f_host_info = gethostbyname(FGFS_host);
|
||
|
|
fgd_len_msg = (int) sizeof(f_host_info->h_addr);
|
||
|
|
write( sock, &fgd_len_msg,1);
|
||
|
|
/* send dummy-string, for the moment with _WHO_ to execute commando
|
||
|
|
here: his ip */
|
||
|
|
write( sock, f_host_info->h_addr, fgd_len_msg);
|
||
|
|
/* END FIXME */
|
||
|
|
|
||
|
|
/* Here we send subsequent data... */
|
||
|
|
switch (atoi((char *) FGD_com)) {
|
||
|
|
case 5: fgd_len_msg = strlen( fgd_callsign);
|
||
|
|
write( sock, &fgd_len_msg,1);
|
||
|
|
/* send string, for the moment, here: callsign */
|
||
|
|
write( sock, fgd_callsign, fgd_len_msg);
|
||
|
|
/* Lon, Lat, Alt, Speed, Roll, Pitch, Yaw
|
||
|
|
hope this sprintf call is not too expensive */
|
||
|
|
sprintf( fgd_txt, " %7.3f %7.3f %7.3f %7.3f %7.3f %7.3f %7.3f",
|
||
|
|
boss->latf, boss->lonf, boss->altf, boss->speedf,
|
||
|
|
boss->rollf, boss->pitchf, boss->yawf);
|
||
|
|
write( sock, fgd_txt, 56);
|
||
|
|
break;
|
||
|
|
default: break;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
/* be verbose, this goes later into own (*void) */
|
||
|
|
printf(" Message : %s\n", FGD_com);
|
||
|
|
switch (verbose) {
|
||
|
|
case 0: printf("%d\n",current_port);
|
||
|
|
break;
|
||
|
|
case 1: service_info = getservbyport(htons(current_port),"tcp");
|
||
|
|
if (!service_info) {
|
||
|
|
printf("%d -> service name unknown\n",current_port);
|
||
|
|
} else {
|
||
|
|
printf("%d -> %s\n",current_port,service_info->s_name);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case 2: service_info = getservbyport(htons(current_port),"tcp");
|
||
|
|
if (!service_info) {
|
||
|
|
printf(" Port %d found. Service name unknown\n",current_port);
|
||
|
|
} else {
|
||
|
|
printf(" Port %d found. Service name: %s\n",current_port,service_info->s_name);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
} else if (errno == 113) {
|
||
|
|
fprintf(stderr,"No route to host !\n");
|
||
|
|
exit(1);
|
||
|
|
}
|
||
|
|
/* fprintf(stderr,"Error %d connecting socket %d to port %d: %s\n",
|
||
|
|
errno,sock,current_port,sys_errlist[errno]); */
|
||
|
|
|
||
|
|
// service_info = getservbyport(htons(current_port),"tcp");
|
||
|
|
// if (!service_info) {
|
||
|
|
|
||
|
|
|
||
|
|
|
||
|
|
/* The Receiving Part, fgd returns errormessages, succes, etc... */
|
||
|
|
do {
|
||
|
|
fgd_status = recv( sock, (char *) buffp, 4, MSG_WAITALL);
|
||
|
|
printf(" status %d\n", fgd_status);
|
||
|
|
}
|
||
|
|
// while ( (fgd_status != 4) && (fgd_status != 0) );
|
||
|
|
while ( (fgd_status == -1) || (fgd_status == -1) );
|
||
|
|
if (verbose == 2) {
|
||
|
|
printf(" Got reply : %x %x %x\n", buffp[0], buffp[1], buffp[2]);
|
||
|
|
printf(" Got reply : %x\n", &buffp);
|
||
|
|
}
|
||
|
|
if (strncmp( buffp, "FGD", 3) == 0) {
|
||
|
|
switch (atoi((char *) FGD_com)) {
|
||
|
|
case 0: read( sock, fgd_name, buffp[3]);
|
||
|
|
fgd_name[buffp[3]] = 0;
|
||
|
|
printf("FGD: FlightGear-Deamon %s detected\n", fgd_name);
|
||
|
|
break;
|
||
|
|
case 1: printf("FGD: Registering Host %s\n", FGFS_host);
|
||
|
|
break;
|
||
|
|
case 2: printf("FGD: Showing registered Hosts at %s\n", fgd_host);
|
||
|
|
if (buffp[3] != 4) {
|
||
|
|
/* FIXME: replace with SELECT to avoid broken pipes, known bug (-; */
|
||
|
|
do {
|
||
|
|
fgd_status = recv( sock, fgd_txt, buffp[3]-4, MSG_WAITALL);
|
||
|
|
// printf(" status %d\n", fgd_status);
|
||
|
|
}
|
||
|
|
// while ( (fgd_status != 4) && (fgd_status != 0) );
|
||
|
|
while ( (fgd_status == -1) || (fgd_status == -1) );
|
||
|
|
// read( sock, fgd_txt, buffp[3]-4);
|
||
|
|
fgd_curpos = 2;
|
||
|
|
for (fgd_cnt = 1; fgd_cnt < (fgd_txt[0]+1); fgd_cnt++) {
|
||
|
|
fgd_ele_len = fgd_txt[fgd_curpos-1];
|
||
|
|
bcopy( &fgd_txt[fgd_curpos], fgfs_host, fgd_ele_len);
|
||
|
|
fgfs_host[fgd_ele_len] = 0;
|
||
|
|
fgd_curpos = fgd_curpos + fgd_ele_len + 1;
|
||
|
|
printf(" #%d %s\n", fgd_cnt, fgfs_host);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
break;
|
||
|
|
case 5: printf("FGD: Receiving data from Host %s\n", FGFS_host);
|
||
|
|
read( sock, fgd_txt, buffp[3]);
|
||
|
|
fgd_txt[buffp[3]] = 0;
|
||
|
|
if (strcmp(fgd_txt, "UNKNOWN") == -1) {
|
||
|
|
printf("FGD: Data from Host %s received\n", fgd_txt);
|
||
|
|
}
|
||
|
|
else printf("FGD: Host not in list, sorry...\n");
|
||
|
|
break;
|
||
|
|
case 6: printf("FGD: Sending data to Host %s\n", FGFS_host);
|
||
|
|
if (buffp[3] != 4) {
|
||
|
|
/* FIXME: replace with SELECT */
|
||
|
|
if (verbose == 2) printf("Noch %d bytes\n", (unsigned char) buffp[3]);
|
||
|
|
do {
|
||
|
|
fgd_status = recv( sock, fgd_txt, (unsigned char) buffp[3]-4, MSG_PEEK);
|
||
|
|
if (verbose == 2) printf("Status %d\n", fgd_status);
|
||
|
|
}
|
||
|
|
while ( (fgd_status == 4) || (fgd_status == -1) );
|
||
|
|
// while ( (fgd_status == -1) || (fgd_status == -1) );
|
||
|
|
read( sock, fgd_txt, buffp[3]-4);
|
||
|
|
fgd_curpos = 2;
|
||
|
|
fgd_ppl_old = fgd_ppl;
|
||
|
|
fgd_ppl = fgd_txt[0];
|
||
|
|
/* Check if list has changed (pilot joined/left) */
|
||
|
|
if (fgd_ppl != fgd_ppl_old) {
|
||
|
|
printf(" List changed!!!\n");
|
||
|
|
for (fgd_cnt = 1; fgd_cnt <= abs(fgd_ppl - fgd_ppl_old); fgd_cnt++) {
|
||
|
|
printf(" Checkpoint\n");
|
||
|
|
incoming = head->next;
|
||
|
|
if ((fgd_ppl - fgd_ppl_old) > 0) list_insert("test\0");
|
||
|
|
else {
|
||
|
|
printf(" Clearing entry.\n");
|
||
|
|
list_clear(incoming->ipadr);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
// else {
|
||
|
|
incoming = head->next;
|
||
|
|
for (fgd_cnt = 1; fgd_cnt < (fgd_ppl+1); fgd_cnt++) {
|
||
|
|
/* IP */
|
||
|
|
fgd_ele_len = fgd_txt[fgd_curpos-1];
|
||
|
|
bcopy( &fgd_txt[fgd_curpos], incoming->ipadr, fgd_ele_len);
|
||
|
|
incoming->ipadr[fgd_ele_len] = 0;
|
||
|
|
fgd_curpos = fgd_curpos + fgd_ele_len + 1;
|
||
|
|
/* Pilot */
|
||
|
|
fgd_ele_len = fgd_txt[fgd_curpos-1];
|
||
|
|
bcopy( &fgd_txt[fgd_curpos], incoming->callsign, fgd_ele_len);
|
||
|
|
incoming->callsign[fgd_ele_len] = 0;
|
||
|
|
fgd_curpos = fgd_curpos + fgd_ele_len + 1;
|
||
|
|
/* Lon, Lat...etc */
|
||
|
|
printf(" #%d %-16s %s\n", fgd_cnt, incoming->ipadr, incoming->callsign);
|
||
|
|
printf(" curpos:%d\n", fgd_curpos);
|
||
|
|
sscanf( &fgd_txt[fgd_curpos]," %7f %7f %7f %7f %7f %7f %7f",
|
||
|
|
&incoming->latf, &incoming->lonf,
|
||
|
|
&incoming->altf, &incoming->speedf, &incoming->rollf,
|
||
|
|
&incoming->pitchf, &incoming->yawf);
|
||
|
|
printf(" lat :%7.3f\n lon :%7.3f\n alt :%7.3f\n speed :%7.3f\n roll :%7.3f\n pitch :%7.3f\n yaw :%7.3f\n",
|
||
|
|
incoming->latf, incoming->lonf, incoming->altf, incoming->speedf,
|
||
|
|
incoming->rollf, incoming->pitchf, incoming->yawf);
|
||
|
|
fgd_curpos += 56;
|
||
|
|
incoming = incoming->next;
|
||
|
|
} /* end for */
|
||
|
|
// } /* end else */
|
||
|
|
} /* end if "data available" */
|
||
|
|
/* Here reading the answer of completed command by fgd */
|
||
|
|
/* read( sock, fgd_txt, buffp[3]);
|
||
|
|
fgd_txt[buffp[3]] = 0;
|
||
|
|
if (strcmp(fgd_txt, "UNKNOWN") == -1) {
|
||
|
|
printf("FGD: Data to Host sent\n");
|
||
|
|
}
|
||
|
|
else printf("FGD: Host not in list, sorry...\n");
|
||
|
|
*/
|
||
|
|
break;
|
||
|
|
case 8: printf("FGD: Unregistering Host %s\n", FGFS_host);
|
||
|
|
read( sock, fgd_txt, buffp[3]);
|
||
|
|
fgd_txt[buffp[3]] = 0;
|
||
|
|
if (strcmp(fgd_txt, "UNKNOWN") == -1) {
|
||
|
|
printf("FGD: Host %s unregistered\n", fgd_txt);
|
||
|
|
}
|
||
|
|
else printf("FGD: Host not in list, sorry...\n");
|
||
|
|
break;
|
||
|
|
case 9: printf(" Shutdown FlightGear-Deamon %s .\n", fgd_name);
|
||
|
|
break;
|
||
|
|
default: break;
|
||
|
|
}
|
||
|
|
} else printf(" Huh?: no deamon present, yuk!!!\n");
|
||
|
|
// }
|
||
|
|
close(sock);
|
||
|
|
current_port++;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (verbose == 2) printf("fgd_com completed.\n");
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
int main(int argc, char **argv) {
|
||
|
|
|
||
|
|
list_init();
|
||
|
|
fgd_init();
|
||
|
|
for ( ; (atoi( (char*) fgd_job)) != 99;){
|
||
|
|
printf("MCP: ready...enter commando (42 help) ");
|
||
|
|
gets((char *) fgd_job);
|
||
|
|
if (verbose == 2) printf("MCP: got %s %d\n", (char *) fgd_job, strlen((char *) fgd_job));
|
||
|
|
if ( strcmp( fgd_job, "") > 0 ) switch( atoi((char*) fgd_job)) {
|
||
|
|
case 0 : if ( strcmp( (char *) fgd_job, "0") == 0 ){
|
||
|
|
printf("MCP: Scan for fgd\n");
|
||
|
|
fgd_send_com( "0", src_host);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case 1 : printf("MCP: Register to fgd\n");
|
||
|
|
fgd_send_com( "1", src_host);
|
||
|
|
break;
|
||
|
|
case 2 : printf("MCP: Show registered\n");
|
||
|
|
fgd_send_com( "2", src_host);
|
||
|
|
break;
|
||
|
|
case 3 : printf("MCP: Send MSG\n");
|
||
|
|
break;
|
||
|
|
case 4 : printf("MCP: Send MSG to ALL\n");
|
||
|
|
break;
|
||
|
|
case 5 : printf("MCP: Push Data to fgd\n");
|
||
|
|
fgd_send_com( "5", src_host);
|
||
|
|
break;
|
||
|
|
case 6 : printf("MCP: Pop Data from fgd\n");
|
||
|
|
fgd_send_com( "6", src_host);
|
||
|
|
break;
|
||
|
|
case 8 : printf("MCP: Unregister from fgd\n");
|
||
|
|
fgd_send_com( "8", src_host);
|
||
|
|
break;
|
||
|
|
case 9 : printf("MCP: Shutdown fgd-deamon\n");
|
||
|
|
fgd_send_com( "9", src_host);
|
||
|
|
break;
|
||
|
|
case 10 : printf("MCP: Choose default deamon HOST:\n");
|
||
|
|
printf(" Deamon Host IP Port\n");
|
||
|
|
printf(" %-16s%-16s%-16s%-16d\n", fgd_name, fgd_host, fgd_ip, base_port);
|
||
|
|
printf("\n Enter new Host:[%s] ", fgd_host);
|
||
|
|
gets((char *) fgd_txt);
|
||
|
|
if ( strlen(fgd_txt) != 0 ) {
|
||
|
|
strcpy(fgd_host, fgd_txt);
|
||
|
|
if (host_info = gethostbyname( fgd_host)) {
|
||
|
|
bcopy(host_info->h_addr, (char *)&address.sin_addr,host_info->h_length);
|
||
|
|
strcpy((char *) fgd_ip, (char *) inet_ntoa(address.sin_addr));
|
||
|
|
if (verbose == 2) {
|
||
|
|
printf(" resolved\n FGD running on HOST : %s", fgd_host);
|
||
|
|
printf(" IP : %s\n", fgd_ip);
|
||
|
|
}
|
||
|
|
} else if ((address.sin_addr.s_addr = inet_addr( fgd_host)) == INADDR_NONE) {
|
||
|
|
fprintf(stderr," Could not get %s host entry !\n", fgd_host);
|
||
|
|
printf(" NOT resolved !!!\n");
|
||
|
|
exit(1);
|
||
|
|
} else if (verbose == 2) printf(" address valid\n");
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case 11 : printf("MCP: Choose default deamon Port:\n");
|
||
|
|
printf(" Deamon Host IP Port\n");
|
||
|
|
printf(" %-16s%-16s%-16s%-16d\n", fgd_name, fgd_host, fgd_ip, base_port);
|
||
|
|
printf(" Enter new Port: ");
|
||
|
|
gets((char *) buffp);
|
||
|
|
current_port = atoi((char*) buffp);
|
||
|
|
if (current_port != 0) {
|
||
|
|
base_port = atoi((char*) buffp);
|
||
|
|
end_port = base_port;
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case 20 : printf("MCP: Current values:\n");
|
||
|
|
printf(" Deamon Host IP Port\n");
|
||
|
|
printf(" %-16s%-16s%-16s%-16d\n", fgd_name, fgd_host, fgd_ip, base_port);
|
||
|
|
printf(" -----------------------------------------------------\n");
|
||
|
|
printf(" Callsign Host IP Port\n");
|
||
|
|
printf(" %-16s%-16s%-16s%-16d\n", fgd_callsign, src_host, fgd_mcp_ip, base_port);
|
||
|
|
printf(" Lat Lon Alt Speed Roll Pitch Yaw\n");
|
||
|
|
printf(" %-8s % 7.3f % 7.3f % 7.3f % 7.3f % 7.3f % 7.3f % 7.3f\n", fgd_callsign, boss->latf,
|
||
|
|
boss->lonf, boss->altf, boss->speedf, boss->rollf, boss->pitchf, boss->yawf);
|
||
|
|
printf(" -----------------------------------------------------\n");
|
||
|
|
printf(" Pilot list:\n");
|
||
|
|
test = head->next;
|
||
|
|
while (test != tail) {
|
||
|
|
printf(" Callsign Host\n");
|
||
|
|
printf(" %-16s%-16s\n", test->callsign, test->ipadr);
|
||
|
|
printf(" Lat Lon Alt Speed Roll Pitch Yaw\n");
|
||
|
|
printf(" %-8s % 7.3f % 7.3f % 7.3f % 7.3f % 7.3f % 7.3f % 7.3f\n", test->callsign, test->latf,
|
||
|
|
test->lonf, test->altf, test->speedf, test->rollf, test->pitchf, test->yawf);
|
||
|
|
test = test->next;
|
||
|
|
}
|
||
|
|
printf(" -----------------------------------------------------\n");
|
||
|
|
|
||
|
|
break;
|
||
|
|
case 21 : printf("MCP: Enter your callsign, Pilot ");
|
||
|
|
gets((char *) fgd_callsign);
|
||
|
|
break;
|
||
|
|
case 42 : printf("MCP: Commands available:\n 0 Scan for fgd\n 1 Register\n");
|
||
|
|
printf(" 2 Show registered\n 3 Send MSG\n 4 Send MSG to ALL\n");
|
||
|
|
printf(" 5 Push Data to fgd\n 6 Pop Data from fgd\n");
|
||
|
|
printf(" 8 Unregister from fgd\n 9 Shutdown fgd\n");
|
||
|
|
printf("10 Set deamon HOST\n11 Set deamon PORT\n");
|
||
|
|
printf("20 Show values\n21 Set own callsign\n");
|
||
|
|
printf("31 Set deamon PORT\n");
|
||
|
|
printf("98 Stress test\n");
|
||
|
|
printf("99 Quit Master Control Program (not recommended)\n");
|
||
|
|
break;
|
||
|
|
case 98 : printf("MCP: Stress test ");
|
||
|
|
fgd_loss = 0;
|
||
|
|
list_search(fgd_mcp_ip);
|
||
|
|
other = act->next;
|
||
|
|
printf("other-ip %s\n", other->ipadr);
|
||
|
|
sleep(3);
|
||
|
|
for ( j=1; j<10000; j++) {
|
||
|
|
boss->latf += 0.001;
|
||
|
|
fgd_send_com( "5", src_host);
|
||
|
|
fgd_send_com( "6", src_host);
|
||
|
|
printf("other lat:%7.3f boss lat:%7.3f\n", other->latf, boss->latf);
|
||
|
|
if (fabs(boss->latf - other->latf) > 0.001) {
|
||
|
|
printf("other lat:%7.3f boss lat:%7.3f\n", other->latf, boss->latf);
|
||
|
|
fgd_loss++;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
printf(" Packets lost: %d\n", fgd_loss);
|
||
|
|
break;
|
||
|
|
default: break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
// fgd_send_com( argv[5], argv[6]);
|
||
|
|
free(buffp);
|
||
|
|
free(fgd_job);
|
||
|
|
free(fgd_host);
|
||
|
|
free(fgd_callsign);
|
||
|
|
free(fgd_name);
|
||
|
|
free(fgd_ip);
|
||
|
|
free(fgd_mcp_ip);
|
||
|
|
free(fgfs_host);
|
||
|
|
free(fgfs_pilot);
|
||
|
|
free(src_host);
|
||
|
|
free(fgd_txt);
|
||
|
|
printf("MCP: Exit...\n");
|
||
|
|
exit(0);
|
||
|
|
}
|