/* Copyright (C) Hansi Reiser, dl9rdz * * partially based on dxlAPRS toolchain * * Copyright (C) Christian Rabler * * SPDX-License-Identifier: GPL-2.0+ */ #include #include #include //#include //#include #include #include #include #include "aprs.h" #if 0 int openudp(const char *ip, int port, struct sockaddr_in *si) { int fd; if((fd=socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP))==-1) return -1; memset((char *)&si, 0, sizeof(si)); si->sin_family = AF_INET; si->sin_port = htons(port); if(inet_aton(ip, &(si->sin_addr))==0) { return -1; } return fd; } int sendudp(int fd, struct sockaddr_in *si, char *frame, int framelen) { if(sendto(fd, frame, framelen, 0, (struct sockaddr *)si, sizeof(struct sockaddr_in))==-1) { return -1; } return 0; } #endif void aprsstr_append(char *b, const char *data) { int blen=strlen(b); int len=strlen(data); if(blen+len>APRS_MAXLEN) len=APRS_MAXLEN-blen; strncat(b, data, len); } uint32_t realcard(float x) { if(x<0) return 0; else return (uint32_t)x; } /* CRC for AXUDP frames */ #define APRSCRC_POLY 0x8408 static uint8_t CRCL[256]; static uint8_t CRCH[256]; void aprs_gencrctab(void) { uint32_t c; uint32_t crc; uint32_t i; for (c = 0UL; c<=255UL; c++) { crc = 255UL-c; for (i = 0UL; i<=7UL; i++) { if ((crc&1)) crc = (uint32_t)((uint32_t)(crc>>1)^APRSCRC_POLY); else crc = crc>>1; } /* end for */ CRCL[c] = (uint8_t)crc; CRCH[c] = (uint8_t)(255UL-(crc>>8)); } /* end for */ } /* end Gencrctab() */ static void aprsstr_appcrc(char frame[], uint32_t frame_len, int32_t size) { uint8_t h; uint8_t l; uint8_t b; int32_t i; int32_t tmp; l = 0U; h = 0U; tmp = size-1L; i = 0L; if (i<=tmp) for (;; i++) { b = (uint8_t)((uint8_t)(uint8_t)frame[i]^l); l = CRCL[b]^h; h = CRCH[b]; if (i==tmp) break; } /* end for */ frame[size] = (char)l; frame[size+1L] = (char)h; } /* end aprsstr_appcrc() */ static int mkaprscall(int32_t * p, char raw[], uint32_t * i, const char mon[], char sep1, char sep2, char sep3, uint32_t sbase) { uint32_t s; uint32_t l; l = 0UL; while ((((mon[*i] && mon[*i]!=sep1) && mon[*i]!=sep2) && mon[*i]!=sep3) && mon[*i]!='-') { s = (uint32_t)(uint8_t)mon[*i]*2UL&255UL; if (s<=64UL) return 0; raw[*p] = (char)s; ++*p; ++*i; ++l; if (l>=7UL) return 0; } while (l<6UL) { raw[*p] = '@'; ++*p; ++l; } s = 0UL; if (mon[*i]=='-') { ++*i; while ((uint8_t)mon[*i]>='0' && (uint8_t)mon[*i]<='9') { s = (s*10UL+(uint32_t)(uint8_t)mon[*i])-48UL; ++*i; } if (s>15UL) return 0; } raw[*p] = (char)((s+sbase)*2UL); ++*p; return 1; } /* end call() */ // returns raw len, 0 in case of error extern int aprsstr_mon2raw(const char *mon, char raw[], int raw_len) { uint32_t r; uint32_t n; uint32_t i; uint32_t tmp; int p = 7L; i = 0UL; fprintf(stderr,"mon2raw for %s\n", mon); if (!mkaprscall(&p, raw, &i, mon, '>', 0, 0, 48UL)) { return 0; } p = 0L; if (mon[i]!='>') return 0; /* ">" */ ++i; if (!mkaprscall(&p, raw, &i, mon, ':', ',', 0, 112UL)) { return 0; } p = 14L; n = 0UL; while (mon[i]==',') { ++i; if (!mkaprscall(&p, raw, &i, mon, ':', ',', '*', 48UL)) { return 0; } ++n; if (n>8UL) { return 0; } if (mon[i]=='*') { /* "*" has repeatet sign */ ++i; r = (uint32_t)p; if (r>=21UL) for (tmp = (uint32_t)(r-21UL)/7UL;;) { raw[r-1UL] = (char)((uint32_t)(uint8_t)raw[r-1UL]+128UL); /* set "has repeated" flags */ if (!tmp) break; --tmp; r -= 7UL; } /* end for */ } } if (p==0L || mon[i]!=':') { return 0; } raw[p-1L] = (char)((uint32_t)(uint8_t)raw[p-1L]+1UL); /* end address field mark */ raw[p] = '\003'; ++p; raw[p] = '\360'; ++p; ++i; n = 256UL; while (mon[i]) { /* copy info part */ if (p>=(int32_t)(raw_len-1)-2L || n==0UL) { return 0; } raw[p] = mon[i]; ++p; ++i; --n; } aprsstr_appcrc(raw, raw_len, p); fprintf(stderr,"results in %s\n",raw); return p+2; } /* end mon2raw() */ extern int aprsstr_mon2kiss(const char *mon, char raw[], int raw_len) { char tmp[201]; int len = aprsstr_mon2raw(mon, tmp, 201); if(len==0) return 0; int idx=0; raw[idx++] = '\xC0'; for(int i=0; i=raw_len) return 0; } return idx; } #define FEET (1.0/0.3048) #define KNOTS (1.851984) #define X2C_max_longcard 0xFFFFFFFFUL static uint32_t X2C_TRUNCC(double x, uint32_t min0, uint32_t max0) { uint32_t i; if (x < (double)min0) i = (uint32_t)min0; if (x > (double)max0) i = (uint32_t)max0; i = (uint32_t)x; if ((double)i > x) --i; return i; } static uint32_t truncc(double r) { if (r<=0.0) return 0UL; else if (r>=2.E+9) return 2000000000UL; else return (uint32_t)X2C_TRUNCC(r,0UL,X2C_max_longcard); return 0; } /* end truncc() */ static uint32_t dao91(double x) /* radix91(xx/1.1) of dddmm.mmxx */ { double a; a = fabs(x); return ((truncc((a-(double)(float)truncc(a))*6.E+5)%100UL) *20UL+11UL)/22UL; } /* end dao91() */ char b[201]; char raw[201]; char *aprs_senddata(SondeInfo *s, const char *usercall, const char *sym) { // float lat, float lon, float alt, float speed, float dir, float climb, const char *type, const char *objname, const char *usercall, const char *sym, const char *comm) *b=0; aprsstr_append(b, usercall); aprsstr_append(b, ">"); const char *destcall="APZRDZ"; aprsstr_append(b, destcall); // uncompressed aprsstr_append(b, ":;"); char tmp[10]; snprintf(tmp,10,"%s ",s->id); aprsstr_append(b, tmp); aprsstr_append(b, "*"); // time int i = strlen(b); int sec = s->time % 86400; snprintf(b+i, APRS_MAXLEN-1, "%02d%02d%02dz", sec/(60*60), (sec%(60*60))/60, sec%60); i = strlen(b); //aprsstr_append_data(time, ds); int lati = abs((int)s->lat); int latm = (fabs(s->lat)-lati)*6000; snprintf(b+i, APRS_MAXLEN-i, "%02d%02d.%02d%c%c", lati, latm/100, latm%100, s->lat<0?'S':'N', sym[0]); i = strlen(b); int loni = abs((int)s->lon); int lonm = (fabs(s->lon)-loni)*6000; snprintf(b+i, APRS_MAXLEN-i, "%03d%02d.%02d%c%c", loni, lonm/100, lonm%100, s->lon<0?'W':'E', sym[1]); if(s->hs>0.5) { i=strlen(b); snprintf(b+i, APRS_MAXLEN-i, "%03d/%03d", realcard(s->dir+1.5), realcard(s->hs*1.0/KNOTS+0.5)); } if(s->alt>0.5) { i=strlen(b); snprintf(b+i, APRS_MAXLEN-i, "/A=%06d", realcard(s->alt*FEET+0.5)); } int dao=1; if(dao) { i=strlen(b); snprintf(b+i, APRS_MAXLEN-i, "!w%c%c!", 33+dao91(s->lat), 33+dao91(s->lon)); } strcat(b, "&"); char comm[100]; snprintf(comm, 100, "Clb=%.1fm/s %.3fMHz Type=%s", s->vs, s->freq, sondeTypeStr[s->type]); strcat(b, comm); if(s->type==STYPE_M20||s->type==STYPE_M10||s->type==STYPE_DFM||s->type==STYPE_DFM06||s->type==STYPE_DFM09) { snprintf(comm, 100, " ser=%s", s->ser); strcat(b, comm); } return b; } #if 0 int main(int argc, char *argv[]) { Gencrctab(); struct sockaddr_in si; int fd = openudp("127.0.0.1",9002,&si); if(fd<0) { fprintf(stderr,"open failed\n"); return 1; } float lat=48, lon=10; while(1) { const char *str = aprs_senddata(lat, lon, 543, 5, 180, 1.5, "RS41", "TE0ST", "TE1ST", "EO"); int rawlen = aprsstr_mon2raw(str, raw, APRS_MAXLEN); sendudp(fd, raw, rawlen); str = "OE3XKC>APMI06,qAR,OE3XLR:;ER-341109*111111z4803.61NE01532.39E0145.650MHz R15k OE3XPA"; rawlen = aprsstr_mon2raw(str, raw, APRS_MAXLEN); sendudp(fd, &si, raw, rawlen); lat += 0.002; lon += 0.01; sleep(5); } } #endif