mirror of
https://github.com/brmlab/acarsdec.git
synced 2025-07-31 21:23:37 +02:00
303 lines
7.4 KiB
C
303 lines
7.4 KiB
C
/*
|
|
* Copyright (c) 2007 by Thierry Leconte (F4DWV)
|
|
*
|
|
* $Id: serv.c,v 1.2 2007/04/22 16:14:41 f4dwv Exp $
|
|
*
|
|
* This code is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU Library General Public License version 2
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU Library General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Library General Public
|
|
* License along with this library; if not, write to the Free Software
|
|
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*
|
|
*/
|
|
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <sys/types.h>
|
|
#include <sys/socket.h>
|
|
#include <netinet/in.h>
|
|
#include <errno.h>
|
|
|
|
#include "acarsdec.h"
|
|
|
|
static int sa, sc;
|
|
|
|
int init_serv(short port)
|
|
{
|
|
struct sockaddr_in locaddr, remaddr;
|
|
socklen_t len;
|
|
char c;
|
|
int res;
|
|
|
|
sa = socket(PF_INET, SOCK_STREAM, 0);
|
|
if (sa < 0) {
|
|
fprintf(stderr, "socket : %s\n", strerror(errno));
|
|
return -1;
|
|
}
|
|
|
|
memset(&locaddr, 0, sizeof(locaddr));
|
|
locaddr.sin_family = AF_INET;
|
|
locaddr.sin_port = htons(port);
|
|
locaddr.sin_addr.s_addr = htonl(INADDR_LOOPBACK);
|
|
|
|
len = sizeof(locaddr);
|
|
res = bind(sa, (struct sockaddr *) &locaddr, len);
|
|
if (res) {
|
|
fprintf(stderr, "bind : %s\n", strerror(errno));
|
|
return -1;
|
|
}
|
|
|
|
res = listen(sa, 1);
|
|
if (res) {
|
|
fprintf(stderr, "listen : %s\n", strerror(errno));
|
|
return -1;
|
|
}
|
|
|
|
memset(&remaddr, 0, sizeof(remaddr));
|
|
len = sizeof(remaddr);
|
|
sc = accept(sa, (struct sockaddr *) &remaddr, &len);
|
|
if (sc < 0) {
|
|
fprintf(stderr, "accept : %s\n", strerror(errno));
|
|
return -1;
|
|
}
|
|
|
|
do {
|
|
res = read(sc, &c, 1);
|
|
} while (res == 1 && c != '\n');
|
|
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/* convert ACARS position reports to APRS position */
|
|
static void toaprs(int la, char lac, int ln, char lnc, int prec, char *out)
|
|
{
|
|
int lad, lnd;
|
|
float lam, lnm;
|
|
|
|
lad = la / 10000;
|
|
lnd = ln / 10000;
|
|
lam = (float) (la - (lad * 10000)) * 60.0 / 10000.0;
|
|
lnm = (float) (ln - (lnd * 10000)) * 60.0 / 10000.0;
|
|
|
|
switch (prec) {
|
|
case 0:
|
|
sprintf(out, "%02d%02.0f. %c/%03d%02.0f. %c^", lad, lam, lac, lnd, lnm, lnc);
|
|
break;
|
|
case 1:
|
|
sprintf(out, "%02d%04.1f %c/%03d%04.1f %c^", lad, lam, lac, lnd, lnm, lnc);
|
|
break;
|
|
case 2:
|
|
default:
|
|
sprintf(out, "%02d%05.2f%c/%03d%05.2f%c^", lad, lam, lac, lnd, lnm, lnc);
|
|
break;
|
|
}
|
|
}
|
|
|
|
int posconv(char *txt, unsigned char *label, char *pos)
|
|
{
|
|
char lac, lnc;
|
|
int la, ln;
|
|
char las[7], lns[7];
|
|
int n;
|
|
char *p;
|
|
|
|
/*try different heuristics */
|
|
|
|
n = sscanf(txt, "#M1BPOS%c%05d%c%063d,", &lac, &la, &lnc, &ln);
|
|
if (n == 4 && (lac == 'N' || lac == 'S') && (lnc == 'E' || lnc == 'W')) {
|
|
la *= 10;
|
|
ln *= 10;
|
|
toaprs(la, lac, ln, lnc, 1, pos);
|
|
return 0;;
|
|
}
|
|
n = sscanf(txt, "#M1AAEP%c%06d%c%07d", &lac, &la, &lnc, &ln);
|
|
if (n == 4 && (lac == 'N' || lac == 'S') && (lnc == 'E' || lnc == 'W')) {
|
|
toaprs(la, lac, ln, lnc, 2, pos);
|
|
return 0;;
|
|
}
|
|
|
|
if (strncmp(txt, "#M1B", 4) == 0) {
|
|
if ((p = strstr(txt, "/FPO")) != NULL) {
|
|
n = sscanf(p, "/FPO%c%05d%c%06d", &lac, &la, &lnc, &ln);
|
|
if (n == 4 && (lac == 'N' || lac == 'S')
|
|
&& (lnc == 'E' || lnc == 'W')) {
|
|
la *= 10;
|
|
ln *= 10;
|
|
toaprs(la, lac, ln, lnc, 1, pos);
|
|
return 0;;
|
|
}
|
|
}
|
|
if ((p = strstr(txt, "/PS")) != NULL) {
|
|
n = sscanf(p, "/PS%c%05d%c%06d", &lac, &la, &lnc, &ln);
|
|
if (n == 4 && (lac == 'N' || lac == 'S')
|
|
&& (lnc == 'E' || lnc == 'W')) {
|
|
la *= 10;
|
|
ln *= 10;
|
|
toaprs(la, lac, ln, lnc, 1, pos);
|
|
return 0;;
|
|
}
|
|
}
|
|
}
|
|
|
|
n = sscanf(txt, "FST01%*8s%c%06d%c%07d", &lac, &la, &lnc, &ln);
|
|
if (n == 4 && (lac == 'N' || lac == 'S') && (lnc == 'E' || lnc == 'W')) {
|
|
toaprs(la, lac, ln, lnc, 2, pos);
|
|
return 0;;
|
|
}
|
|
|
|
n = sscanf(txt, "(2%c%5c%c%6c", &lac, las, &lnc, lns);
|
|
if (n == 4 && (lac == 'N' || lac == 'S') && (lnc == 'E' || lnc == 'W')) {
|
|
las[5] = 0;
|
|
lns[6] = 0;
|
|
la = 10 * atoi(las);
|
|
ln = 10 * atoi(lns);
|
|
toaprs(la, lac, ln, lnc, 1, pos);
|
|
return 0;;
|
|
}
|
|
|
|
n = sscanf(txt, "(:2%c%5c%c%6c", &lac, las, &lnc, lns);
|
|
if (n == 4 && (lac == 'N' || lac == 'S') && (lnc == 'E' || lnc == 'W')) {
|
|
las[5] = 0;
|
|
lns[6] = 0;
|
|
la = 10 * atoi(las);
|
|
ln = 10 * atoi(lns);
|
|
toaprs(la, lac, ln, lnc, 1, pos);
|
|
return 0;;
|
|
}
|
|
|
|
|
|
n = sscanf(txt, "(2%*4s%c%5c%c%6c", &lac, las, &lnc, lns);
|
|
if (n == 4 && (lac == 'N' || lac == 'S') && (lnc == 'E' || lnc == 'W')) {
|
|
las[5] = 0;
|
|
lns[6] = 0;
|
|
la = 10 * atoi(las);
|
|
ln = 10 * atoi(lns);
|
|
toaprs(la, lac, ln, lnc, 1, pos);
|
|
return 0;;
|
|
}
|
|
|
|
n = sscanf(txt, "LAT %c%3c.%3c/LON %c%3c.%3c", &lac, las, &(las[3]),
|
|
&lnc, lns, &(lns[3]));
|
|
if (n == 6 && (lac == 'N' || lac == 'S') && (lnc == 'E' || lnc == 'W')) {
|
|
las[6] = 0;
|
|
lns[6] = 0;
|
|
la = 10 * atoi(las);
|
|
ln = 10 * atoi(lns);
|
|
toaprs(la, lac, ln, lnc, 1, pos);
|
|
return 0;;
|
|
}
|
|
|
|
|
|
n = sscanf(txt, "#DFB(POS-%*6s-%04d%c%05d%c/", &la, &lac, &ln, &lnc);
|
|
if (n == 4 && (lac == 'N' || lac == 'S') && (lnc == 'E' || lnc == 'W')) {
|
|
la *= 100;
|
|
ln *= 100;
|
|
toaprs(la, lac, ln, lnc, 0, pos);
|
|
return 0;;
|
|
}
|
|
|
|
n = sscanf(txt, "#DFB*POS\a%*8s%c%04d%c%05d/", &lac, &la, &lnc, &ln);
|
|
if (n == 4 && (lac == 'N' || lac == 'S') && (lnc == 'E' || lnc == 'W')) {
|
|
la *= 100;
|
|
ln *= 100;
|
|
toaprs(la, lac, ln, lnc, 0, pos);
|
|
return 0;;
|
|
}
|
|
|
|
n = sscanf(txt, "POS%c%05d%c%06d,", &lac, &la, &lnc, &ln);
|
|
if (n == 4 && (lac == 'N' || lac == 'S') && (lnc == 'E' || lnc == 'W')) {
|
|
la *= 10;
|
|
ln *= 10;
|
|
toaprs(la, lac, ln, lnc, 1, pos);
|
|
return 0;;
|
|
}
|
|
|
|
n = sscanf(txt, "POS%*2s,%c%05d%c%06d,", &lac, &la, &lnc, &ln);
|
|
if (n == 4 && (lac == 'N' || lac == 'S') && (lnc == 'E' || lnc == 'W')) {
|
|
la *= 10;
|
|
ln *= 10;
|
|
toaprs(la, lac, ln, lnc, 1, pos);
|
|
return 0;;
|
|
}
|
|
|
|
n = sscanf(txt, "RCL%*2s,%c%05d%c%06d,", &lac, &la, &lnc, &ln);
|
|
if (n == 4 && (lac == 'N' || lac == 'S') && (lnc == 'E' || lnc == 'W')) {
|
|
la *= 10;
|
|
ln *= 10;
|
|
toaprs(la, lac, ln, lnc, 1, pos);
|
|
return 0;;
|
|
}
|
|
|
|
n = sscanf(txt, "TWX%*2s,%c%05d%c%06d,", &lac, &la, &lnc, &ln);
|
|
if (n == 4 && (lac == 'N' || lac == 'S') && (lnc == 'E' || lnc == 'W')) {
|
|
la *= 10;
|
|
ln *= 10;
|
|
toaprs(la, lac, ln, lnc, 1, pos);
|
|
return 0;;
|
|
}
|
|
|
|
n = sscanf(txt, "CLA%*2s,%c%05d%c%06d,", &lac, &la, &lnc, &ln);
|
|
if (n == 4 && (lac == 'N' || lac == 'S') && (lnc == 'E' || lnc == 'W')) {
|
|
la *= 10;
|
|
ln *= 10;
|
|
toaprs(la, lac, ln, lnc, 1, pos);
|
|
return 0;;
|
|
}
|
|
|
|
n = sscanf(txt, "%c%05d/%c%06d,", &lac, &la, &lnc, &ln);
|
|
if (n == 4 && (lac == 'N' || lac == 'S') && (lnc == 'E' || lnc == 'W')) {
|
|
la *= 10;
|
|
ln *= 10;
|
|
toaprs(la, lac, ln, lnc, 1, pos);
|
|
return 0;;
|
|
}
|
|
|
|
return 1;
|
|
}
|
|
|
|
int send_mesg(msg_t * msg)
|
|
{
|
|
char apstr[512];
|
|
char txt[512];
|
|
char pos[64];
|
|
unsigned char *ind;
|
|
|
|
if(msg->label[0]=='_' && msg->label[1]==0x7f)
|
|
return 0;
|
|
|
|
strcpy(txt,msg->txt);
|
|
for(ind = txt;*ind != 0 ;ind++) {
|
|
if(*ind==0x0a || *ind == 0x0d) *ind=' ';
|
|
}
|
|
|
|
ind = msg->addr;
|
|
while (*ind == '.' && *ind != 0)
|
|
ind++;
|
|
|
|
if (posconv(msg->txt, msg->label, pos))
|
|
sprintf(apstr, "%s>ACARS:>Fid:%s Lbl:%s %s\n", ind, msg->fid,msg->label,txt);
|
|
else
|
|
sprintf(apstr, "%s>ACARS:!%sFid:%s Lbl:%s %s\n", ind, pos,msg->fid,msg->label,txt);
|
|
|
|
write(sc, apstr, strlen(apstr));
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
void end_serv(void)
|
|
{
|
|
close(sc);
|
|
close(sa);
|
|
}
|