/* * Copyright (C) 2010 by Scott Lawson KI4LKF * Copyright (C) 2017-2020 by Thomas Early N7TAE * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * 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 General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "IRCDDB.h" #include "IRCutils.h" #include "QnetConfigure.h" #include "QnetGateway.h" #include "Utilities.h" #ifndef CFG_DIR #define CFG_DIR "/usr/local/etc" #endif const std::string GW_VERSION("QnetGateway-626"); int CQnetGateway::FindIndex(const int i) const { if (i<0 || i > 2) return -1; int index = Index[i]; if (index < 0) { if (AF_INET == link_family[i]) { index = ii[1] ? 1 : 0; } else if (AF_INET6 == link_family[i]) { index = 0; } } return index; } bool CQnetGateway::Printable(unsigned char *s) { bool rval = false; for (unsigned i=0; s[i]; i++) { if (0 == isprint(s[i])) { rval = true; s[i] = '?'; } } return rval; } bool CQnetGateway::VoicePacketIsSync(const unsigned char *text) const { return *text==0x55U && *(text+1)==0x2DU && *(text+2)==0x16U; } void CQnetGateway::UnpackCallsigns(const std::string &str, std::set &set, const std::string &delimiters) { std::string::size_type lastPos = str.find_first_not_of(delimiters, 0); // Skip delimiters at beginning. std::string::size_type pos = str.find_first_of(delimiters, lastPos); // Find first non-delimiter. while (std::string::npos != pos || std::string::npos != lastPos) { std::string element = str.substr(lastPos, pos-lastPos); if (element.length()>=3 && element.length()<=8) { ToUpper(element); element.resize(CALL_SIZE, ' '); set.insert(element); // Found a token, add it to the list. } else fprintf(stderr, "found bad callsign in list: %s\n", str.c_str()); lastPos = str.find_first_not_of(delimiters, pos); // Skip delimiters. pos = str.find_first_of(delimiters, lastPos); // Find next non-delimiter. } } void CQnetGateway::PrintCallsigns(const std::string &key, const std::set &set) { printf("%s = [", key.c_str()); for (auto it=set.begin(); it!=set.end(); it++) { if (it != set.begin()) printf(","); printf("%s", (*it).c_str()); } printf("]\n"); } void CQnetGateway::set_dest_rptr(const char mod, std::string &call) { std::list linklist; if (qnDB.FindLS(mod, linklist)) return; auto count = linklist.size(); if (count != 1) printf("set_dest_rptr() returned %d link sets\n", int(count)); if (0 == count) return; call.assign(linklist.front().callsign); } /* compute checksum */ void CQnetGateway::calcPFCS(unsigned char *packet, int len) { const unsigned short crc_tabccitt[256] = { 0x0000,0x1189,0x2312,0x329b,0x4624,0x57ad,0x6536,0x74bf,0x8c48,0x9dc1,0xaf5a,0xbed3,0xca6c,0xdbe5,0xe97e,0xf8f7, 0x1081,0x0108,0x3393,0x221a,0x56a5,0x472c,0x75b7,0x643e,0x9cc9,0x8d40,0xbfdb,0xae52,0xdaed,0xcb64,0xf9ff,0xe876, 0x2102,0x308b,0x0210,0x1399,0x6726,0x76af,0x4434,0x55bd,0xad4a,0xbcc3,0x8e58,0x9fd1,0xeb6e,0xfae7,0xc87c,0xd9f5, 0x3183,0x200a,0x1291,0x0318,0x77a7,0x662e,0x54b5,0x453c,0xbdcb,0xac42,0x9ed9,0x8f50,0xfbef,0xea66,0xd8fd,0xc974, 0x4204,0x538d,0x6116,0x709f,0x0420,0x15a9,0x2732,0x36bb,0xce4c,0xdfc5,0xed5e,0xfcd7,0x8868,0x99e1,0xab7a,0xbaf3, 0x5285,0x430c,0x7197,0x601e,0x14a1,0x0528,0x37b3,0x263a,0xdecd,0xcf44,0xfddf,0xec56,0x98e9,0x8960,0xbbfb,0xaa72, 0x6306,0x728f,0x4014,0x519d,0x2522,0x34ab,0x0630,0x17b9,0xef4e,0xfec7,0xcc5c,0xddd5,0xa96a,0xb8e3,0x8a78,0x9bf1, 0x7387,0x620e,0x5095,0x411c,0x35a3,0x242a,0x16b1,0x0738,0xffcf,0xee46,0xdcdd,0xcd54,0xb9eb,0xa862,0x9af9,0x8b70, 0x8408,0x9581,0xa71a,0xb693,0xc22c,0xd3a5,0xe13e,0xf0b7,0x0840,0x19c9,0x2b52,0x3adb,0x4e64,0x5fed,0x6d76,0x7cff, 0x9489,0x8500,0xb79b,0xa612,0xd2ad,0xc324,0xf1bf,0xe036,0x18c1,0x0948,0x3bd3,0x2a5a,0x5ee5,0x4f6c,0x7df7,0x6c7e, 0xa50a,0xb483,0x8618,0x9791,0xe32e,0xf2a7,0xc03c,0xd1b5,0x2942,0x38cb,0x0a50,0x1bd9,0x6f66,0x7eef,0x4c74,0x5dfd, 0xb58b,0xa402,0x9699,0x8710,0xf3af,0xe226,0xd0bd,0xc134,0x39c3,0x284a,0x1ad1,0x0b58,0x7fe7,0x6e6e,0x5cf5,0x4d7c, 0xc60c,0xd785,0xe51e,0xf497,0x8028,0x91a1,0xa33a,0xb2b3,0x4a44,0x5bcd,0x6956,0x78df,0x0c60,0x1de9,0x2f72,0x3efb, 0xd68d,0xc704,0xf59f,0xe416,0x90a9,0x8120,0xb3bb,0xa232,0x5ac5,0x4b4c,0x79d7,0x685e,0x1ce1,0x0d68,0x3ff3,0x2e7a, 0xe70e,0xf687,0xc41c,0xd595,0xa12a,0xb0a3,0x8238,0x93b1,0x6b46,0x7acf,0x4854,0x59dd,0x2d62,0x3ceb,0x0e70,0x1ff9, 0xf78f,0xe606,0xd49d,0xc514,0xb1ab,0xa022,0x92b9,0x8330,0x7bc7,0x6a4e,0x58d5,0x495c,0x3de3,0x2c6a,0x1ef1,0x0f78 }; unsigned short crc_dstar_ffff = 0xffff; short int low, high; unsigned short tmp; switch (len) { case 56: low = 15; high = 54; break; case 58: low = 17; high = 56; break; default: return; } for (unsigned short int i = low; i < high ; i++) { unsigned short short_c = 0x00ff & (unsigned short)packet[i]; tmp = (crc_dstar_ffff & 0x00ff) ^ short_c; crc_dstar_ffff = (crc_dstar_ffff >> 8) ^ crc_tabccitt[tmp]; } crc_dstar_ffff = ~crc_dstar_ffff; tmp = crc_dstar_ffff; if (len == 56) { packet[54] = (unsigned char)(crc_dstar_ffff & 0xff); packet[55] = (unsigned char)((tmp >> 8) & 0xff); } else { packet[56] = (unsigned char)(crc_dstar_ffff & 0xff); packet[57] = (unsigned char)((tmp >> 8) & 0xff); } return; } /* process configuration file */ bool CQnetGateway::ReadConfig(char *cfgFile) { const std::string estr; // an empty string CQnetConfigure cfg; if (cfg.Initialize(cfgFile)) return true; // ircddb std::string path("ircddb_login"); if (cfg.GetValue(path, estr, owner, 3, CALL_SIZE-2)) return true; OWNER = owner; ToLower(owner); ToUpper(OWNER); printf("OWNER='%s'\n", OWNER.c_str()); OWNER.resize(CALL_SIZE, ' '); path.assign("ircddb"); for (int i=0; i<2; i++) { std::string p(path + std::to_string(i) + "_"); cfg.GetValue(p+"host", estr, ircddb[i].ip, 0, MAXHOSTNAMELEN); cfg.GetValue(p+"port", estr, ircddb[i].port, 1000, 65535); cfg.GetValue(p+"password", estr, IRCDDB_PASSWORD[i], 0, 512); } if ((ircddb[0].ip.size()+ircddb[1].ip.size() > 0) && (0 == ircddb[0].ip.compare(ircddb[1].ip))) { fprintf(stderr, "IRC networks must be different\n"); return true; } // module for (int m=0; m<3; m++) { path.assign("module_"); path.append(1, 'a' + m); std::string type; if (cfg.GetValue(path, estr, type, 1, 16)) { Rptr.mod[m].defined = false; } else { printf("Found Module: %s = '%s'\n", path.c_str(), type.c_str()); if (0 == type.compare("dvap")) { Rptr.mod[m].package_version.assign(GW_VERSION+".DVAP"); } else if (0 == type.compare("dvrptr")) { Rptr.mod[m].package_version.assign(GW_VERSION+".DVRPTR"); } else if (0 == type.compare("mmdvmhost")) { Rptr.mod[m].package_version.assign(GW_VERSION+".Relay"); } else if (0 == type.compare("mmdvmmodem")) { Rptr.mod[m].package_version.assign(GW_VERSION+".Modem"); } else if (0 == type.compare("itap")) { Rptr.mod[m].package_version.assign(GW_VERSION+".ITAP"); } else if (0 == type.compare("thumbdv")) { Rptr.mod[m].package_version.assign(GW_VERSION+".ThumbDV"); } else { printf("module type '%s' is invalid\n", type.c_str()); return true; } Rptr.mod[m].defined = true; path.append(1, '_'); if (cfg.KeyExists(path+"tx_frequency")) { cfg.GetValue(path+"tx_frequency", type, Rptr.mod[m].frequency, 0.0, 6.0E9); double rx_freq; cfg.GetValue(path+"rx_frequency", type, rx_freq, 0.0, 6.0E9); if (0.0 == rx_freq) rx_freq = Rptr.mod[m].frequency; Rptr.mod[m].offset = rx_freq - Rptr.mod[m].frequency; } else if (cfg.KeyExists(path+"frequency")) { cfg.GetValue(path+"frequency", type, Rptr.mod[m].frequency, 0.0, 1.0E9); Rptr.mod[m].offset = 0.0; } else { Rptr.mod[m].frequency = Rptr.mod[m].offset = 0.0; } cfg.GetValue(path+"range", type, Rptr.mod[m].range, 0.0, 1609344.0); cfg.GetValue(path+"agl", type, Rptr.mod[m].agl, 0.0, 1000.0); cfg.GetValue(path+"is_hf", type, IS_HF[m]); } } if (! (Rptr.mod[0].defined || Rptr.mod[1].defined || Rptr.mod[2].defined)) { printf("No modules defined!\n"); return true; } // gateway path.assign("gateway_"); cfg.GetValue(path+"ip", estr, g2_external.ip, 7, 64); cfg.GetValue(path+"port", estr, g2_external.port, 1024, 65535); cfg.GetValue(path+"ipv6_ip", estr, g2_ipv6_external.ip, 7, 64); cfg.GetValue(path+"ipv6_port", estr, g2_ipv6_external.port, 1024, 65535); cfg.GetValue(path+"header_regen", estr, GATEWAY_HEADER_REGEN); cfg.GetValue(path+"send_qrgs_maps", estr, GATEWAY_SEND_QRGS_MAP); cfg.GetValue(path+"tolink", estr, tolink, 1, FILENAME_MAX); cfg.GetValue(path+"fromremote", estr, fromremote, 1, FILENAME_MAX); for (int m=0; m<3; m++) { if (Rptr.mod[m].defined) { cfg.GetValue(path+"tomodem"+std::string(1, 'a'+m), estr, tomodem[m], 1, FILENAME_MAX); cfg.GetValue(path+"latitude", estr, Rptr.mod[m].latitude, -90.0, 90.0); cfg.GetValue(path+"longitude", estr, Rptr.mod[m].longitude, -180.0, 180.0); cfg.GetValue(path+"desc1", estr, Rptr.mod[m].desc1, 0, 20); cfg.GetValue(path+"desc2", estr, Rptr.mod[m].desc2, 0, 20); cfg.GetValue(path+"url", estr, Rptr.mod[m].url, 0, 80); } } path.append("find_route"); if (cfg.KeyExists(path)) { std::string csv; cfg.GetValue(path, estr, csv, 0, 10240); UnpackCallsigns(csv, findRoute); PrintCallsigns(path, findRoute); } // APRS path.assign("aprs_"); cfg.GetValue(path+"enable", estr, APRS_ENABLE); cfg.GetValue(path+"host", estr, Rptr.aprs.ip, 7, MAXHOSTNAMELEN); cfg.GetValue(path+"port", estr, Rptr.aprs.port, 10000, 65535); cfg.GetValue(path+"interval", estr, Rptr.aprs_interval, 40, 1000); cfg.GetValue(path+"filter", estr, Rptr.aprs_filter, 0, 512); // log path.assign("log_"); cfg.GetValue(path+"qso", estr, LOG_QSO); cfg.GetValue(path+"irc", estr, LOG_IRC); cfg.GetValue(path+"dtmf", estr, LOG_DTMF); cfg.GetValue(path+"debug", estr, LOG_DEBUG); // file path.assign("file_"); cfg.GetValue(path+"echotest", estr, FILE_ECHOTEST, 2, FILENAME_MAX); cfg.GetValue(path+"dtmf", estr, FILE_DTMF, 2, FILENAME_MAX); cfg.GetValue(path+"qnvoice_file", estr, FILE_QNVOICE_FILE, 2, FILENAME_MAX); // timing path.assign("timing_play_"); cfg.GetValue(path+"wait", estr, TIMING_PLAY_WAIT, 1, 10); cfg.GetValue(path+"delay", estr, TIMING_PLAY_DELAY, 9, 25); path.assign("timing_timeout_"); cfg.GetValue(path+"echo", estr, TIMING_TIMEOUT_ECHO, 1, 10); cfg.GetValue(path+"voicemail", estr, TIMING_TIMEOUT_VOICEMAIL, 1, 10); cfg.GetValue(path+"remote_g2", estr, TIMING_TIMEOUT_REMOTE_G2, 1, 10); cfg.GetValue(path+"local_rptr", estr, TIMING_TIMEOUT_LOCAL_RPTR, 1, 10); // dashboard path.assign("dash_"); cfg.GetValue(path+"show_order", estr, DASH_SHOW_ORDER, 2, 17); showLastHeard = (std::string::npos != DASH_SHOW_ORDER.find("LH")); return false; } // Create ports int CQnetGateway::open_port(const SPORTIP *pip, int family) { CSockAddress sin(family, pip->port, pip->ip.c_str()); int sock = socket(family, SOCK_DGRAM, 0); if (0 > sock) { printf("Failed to create socket on %s:%d, errno=%d, %s\n", pip->ip.c_str(), pip->port, errno, strerror(errno)); return -1; } fcntl(sock, F_SETFL, O_NONBLOCK); //int reuse = 1; //if (::setsockopt(sock, SOL_SOCKET, SO_REUSEADDR, (char *)&reuse, sizeof(reuse)) == -1) { // printf("Cannot set the UDP socket (port %u) option, err: %d, %s\n", pip->port, errno, strerror(errno)); // return -1; //} if (bind(sock, sin.GetCPointer(), sizeof(struct sockaddr_storage)) != 0) { printf("Failed to bind %s:%d, errno=%d, %s\n", pip->ip.c_str(), pip->port, errno, strerror(errno)); close(sock); return -1; } return sock; } /* receive data from the irc server and save it */ void CQnetGateway::GetIRCDataThread(const int i) { IRCDDB_RESPONSE_TYPE type; short last_status = 0; short threshold = 0; bool not_announced[3]; for (int i=0; i<3; i++) not_announced[i] = Rptr.mod[i].defined; // announce to all modules that are defined! bool is_quadnet = (std::string::npos != ircddb[i].ip.find(".openquad.net")); bool doFind = true; while (IsRunning()) { int rc = ii[i]->getConnectionState(); if (rc > 5 && rc < 8 && is_quadnet) { char ch = '\0'; if (not_announced[0]) ch = 'A'; else if (not_announced[1]) ch = 'B'; else if (not_announced[2]) ch = 'C'; if (ch) { // we need to announce, but can we? struct stat sbuf; if (stat(FILE_QNVOICE_FILE.c_str(), &sbuf)) { // yes, there is no FILE_QNVOICE_FILE, so create it FILE *fp = fopen(FILE_QNVOICE_FILE.c_str(), "w"); if (fp) { fprintf(fp, "%c_connected2network.dat_WELCOME_TO_QUADNET", ch); fclose(fp); not_announced[ch - 'A'] = false; } else fprintf(stderr, "could not open %s\n", FILE_QNVOICE_FILE.c_str()); } } if (doFind) { printf("Finding Routes for...\n"); for (auto it=findRoute.begin(); it!=findRoute.end(); it++) { std::this_thread::sleep_for(std::chrono::milliseconds(800)); printf("\t'%s'\n", it->c_str()); ii[i]->findUser(*it); } doFind = false; } } threshold++; if (threshold >= 100) { if ((rc == 0) || (rc == 10)) { if (last_status != 0) { printf("irc status=%d, probable disconnect...\n", rc); last_status = 0; } } else if (rc == 7) { if (last_status != 2) { printf("irc status=%d, probable connect...\n", rc); last_status = 2; } } else { if (last_status != 1) { printf("irc status=%d, probable connect...\n", rc); last_status = 1; } } threshold = 0; } while (((type = ii[i]->getMessageType()) != IDRT_NONE) && IsRunning()) { switch (type) { case IDRT_PING: { std::string rptr, gate, addr; ii[i]->receivePing(rptr); if (! rptr.empty()) { ReplaceChar(rptr, '_', ' '); ii[i]->cache.findRptrData(rptr, gate, addr); if (addr.empty()) break; CSockAddress to; if (addr.npos == rptr.find(':')) to.Initialize(AF_INET, (unsigned short)g2_external.port, addr.c_str()); else to.Initialize(AF_INET6, (unsigned short)g2_ipv6_external.port, addr.c_str()); sendto(g2_sock[i], "PONG", 4, 0, to.GetCPointer(), to.GetSize()); if (LOG_QSO) printf("Sent 'PONG' to %s\n", addr.c_str()); } } break; default: break; } // switch (type) } // while (IsRunning()) std::this_thread::sleep_for(std::chrono::milliseconds(500)); } printf("GetIRCDataThread[%i] exiting...\n", i); return; } /* return codes: 0=OK(found it), 1=TRY AGAIN, 2=FAILED(bad data) */ int CQnetGateway::get_yrcall_rptr_from_cache(const int i, const std::string &call, std::string &rptr, std::string &gate, std::string &addr, char RoU) { switch (RoU) { case 'U': ii[i]->cache.findUserData(call, rptr, gate, addr); if (rptr.empty()) { printf("Could not find last heard repeater for user '%s'\n", call.c_str()); return 1; } break; case 'R': rptr.assign(call); ii[i]->cache.findRptrData(call, gate, addr); break; default: fprintf(stderr, "ERROR: Invalid Rou of '%c'\n", RoU); return 2; } std::string temp; if (rptr.at(7) == 'G') { fprintf(stderr, "ERROR: Invalid module %c\n", rptr.at(7)); return 2; } if (addr.empty()) { printf("Couldn't find IP address for %s\n", ('R' == RoU) ? "repeater" : "user"); return 1; } return 0; } int CQnetGateway::get_yrcall_rptr(const std::string &call, std::string &rptr, std::string &gate, std::string &addr, char RoU) // returns 0 if unsuccessful, otherwise returns ii index plus one { int rval[2] = { 1, 1 }; for (int i=0; i<2; i++) { if (ii[i]) { rval[i] = get_yrcall_rptr_from_cache(i, call, rptr, gate, addr, RoU); if (0 == rval[i]) return i + 1; } } /* at this point, the data is not in cache */ for (int i=0; i<2; i++) { if (ii[i] && (1 == rval[i])) { if (ii[i]->getConnectionState() > 5) { // we can try a find if (RoU == 'U') { printf("User [%s] not in local cache, try again\n", call.c_str()); /*** YRCALL=KJ4NHFBL ***/ if (((call.at(6) == 'A') || (call.at(6) == 'B') || (call.at(6) == 'C')) && (call.at(7) == 'L')) printf("If this was a gateway link request, that is ok\n"); if (!ii[i]->findUser(call)) printf("findUser(%s): Network error\n", call.c_str()); } else if (RoU == 'R') { printf("Repeater [%s] not found\n", call.c_str()); } } } } return 0; } bool CQnetGateway::Flag_is_ok(unsigned char flag) { // normal break emr emr+break return 0x00U==flag || 0x08U==flag || 0x20U==flag || 0x28U==flag; } void CQnetGateway::ProcessTimeouts() { for (int i=0; i<3; i++) { time_t t_now; /* echotest recording timed out? */ if (recd[i].last_time != 0) { time(&t_now); if ((t_now - recd[i].last_time) > TIMING_TIMEOUT_ECHO) { printf("Inactivity on echotest recording module %c, removing stream id=%04x\n", 'A'+i, ntohs(recd[i].streamid)); recd[i].streamid = 0; recd[i].last_time = 0; close(recd[i].fd); recd[i].fd = -1; // printf("Closed echotest audio file:[%s]\n", recd[i].file); /* START: echotest thread setup */ try { std::async(std::launch::async, &CQnetGateway::PlayFileThread, this, std::ref(recd[i])); } catch (const std::exception &e) { printf("Failed to start echotest thread. Exception: %s\n", e.what()); // when the echotest thread runs, it deletes the file, // Because the echotest thread did NOT start, we delete the file here unlink(recd[i].file); } /* END: echotest thread setup */ } } /* voicemail recording timed out? */ if (vm[i].last_time != 0) { time(&t_now); if ((t_now - vm[i].last_time) > TIMING_TIMEOUT_VOICEMAIL) { printf("Inactivity on voicemail recording module %c, removing stream id=%04x\n", 'A'+i, ntohs(vm[i].streamid)); vm[i].streamid = 0; vm[i].last_time = 0; close(vm[i].fd); vm[i].fd = -1; // printf("Closed voicemail audio file:[%s]\n", vm[i].file); } } // any stream going to local repeater timed out? if (toRptr[i].last_time != 0) { time(&t_now); // The stream can be from a cross-band, or from a remote system, // so we could use either FROM_LOCAL_RPTR_TIMEOUT or FROM_REMOTE_G2_TIMEOUT // but FROM_REMOTE_G2_TIMEOUT makes more sense, probably is a bigger number if ((t_now - toRptr[i].last_time) > TIMING_TIMEOUT_REMOTE_G2) { printf("Inactivity to local rptr module %c, removing stream id %04x\n", 'A'+i, ntohs(toRptr[i].saved_hdr.streamid)); // Send end_of_audio to local repeater. // Let the repeater re-initialize end_of_audio.streamid = toRptr[i].saved_hdr.streamid; end_of_audio.ctrl = toRptr[i].sequence | 0x40; ToModem[i].Write(end_of_audio.title, 27); toRptr[i].last_time = 0; } } /* any stream coming from local repeater timed out ? */ if (band_txt[i].last_time != 0) { time(&t_now); if ((t_now - band_txt[i].last_time) > TIMING_TIMEOUT_LOCAL_RPTR) { /* This local stream never went to a remote system, so trace the timeout */ if (to_remote_g2[i].toDstar.AddressIsZero()) printf("Inactivity from local rptr module %c, removing stream id %04x\n", 'A'+i, ntohs(band_txt[i].streamID)); band_txt[i].Initialize(); } } /* any stream from local repeater to a remote gateway timed out ? */ if (! to_remote_g2[i].toDstar.AddressIsZero()) { time(&t_now); if ((t_now - to_remote_g2[i].last_time) > TIMING_TIMEOUT_LOCAL_RPTR) { printf("Inactivity from local rptr mod %c, removing stream id %04x\n", 'A'+i, ntohs(to_remote_g2[i].streamid)); to_remote_g2[i].toDstar.Clear(); to_remote_g2[i].streamid = 0; to_remote_g2[i].last_time = 0; } } } } bool CQnetGateway::ProcessG2Msg(const unsigned char *data, const int mod, std::string &smrtgrp) { static unsigned int part[3] = { 0 }; static char txt[3][21]; if ((data[0] != 0x55u) || (data[1] != 0x2du) || (data[2] != 0x16u)) { const unsigned char c[3] = { static_cast(data[0] ^ 0x70u), static_cast(data[1] ^ 0x4fu), static_cast(data[2] ^ 0x93u) }; // unscramble if (part[mod]) { // we are in a message if (part[mod] % 2) { // this is the second part of the 2-frame pair memcpy(txt[mod]+(5u*(part[mod]/2u)+2u), c, 3); if (++part[mod] > 7) { // we've got everything! part[mod] = 0; // now we can start over if (0 == strncmp(txt[mod], "VIA SMARTGP ", 12)) smrtgrp.assign(txt[mod]+12); if (smrtgrp.size() < 8) { // something bad happened smrtgrp.empty(); return false; } return true; } } else { // we'll get here when part[mod] = 2, 4 or 6 unsigned int sequence = part[mod]++ / 2; // this is the sequency we are expecting, 1, 2 or 3 if ((sequence | 0x40u) == c[0]) { memcpy(txt[mod]+(5u*sequence), c+1, 2); // got it, copy the 2 remainin chars } else { part[mod] = 0; // unexpected } } } else if (0x40u == c[0]) { // start a new message memcpy(txt[mod], c+1, 2); memset(txt[mod]+2, 0, 19); part[mod] = 1; } } else { part[mod] = 0; // messages will never be spread across a superframe } return false; } void CQnetGateway::ProcessIncomingSD(const SDSVT &dsvt, const int source_sock) { int i; for (i=0; i<3; i++) { if (Rptr.mod[i].defined && (toRptr[i].saved_hdr.streamid == dsvt.streamid)) break; } // if i==3, then the streamid of this voice packet didn't match any module SSD &sd = sdin[i]; if (VoicePacketIsSync(dsvt.vasd.text)) { sd.first = true; return; } const unsigned char c[3] = { static_cast(dsvt.vasd.text[0] ^ 0x70u), static_cast(dsvt.vasd.text[1] ^ 0x4fu), static_cast(dsvt.vasd.text[2] ^ 0x93u) }; // unscramble if (sd.first) { // this is the first of a two voice-packet pair // get the "size" and type from the first byte sd.size = 0x0FU & c[0]; if (sd.size > 5) { sd.size = 5; } int size = sd.size; if (size > 2) size = 2; sd.type = 0xF0U & c[0]; switch (sd.type) { case 0x30U: // GPS data if (sd.size + sd.ig < 255) { memcpy(sd.gps+sd.ig, c+1, size); if (c[1]=='\r' || c[2]=='\r') { sd.gps[sd.ig + ((c[1] == '\r') ? 0 : 1)] = '\0'; if (i < 3) { Printable(sd.gps); if (showLastHeard && gps.Parse((const char *)&sd.gps)) { char call[CALL_SIZE+1]; memcpy(call, toRptr[i].saved_hdr.hdr.mycall, CALL_SIZE); call[CALL_SIZE] = '\0'; qnDB.UpdatePosition(call, gps.MaidenHead(), gps.Latitude(), gps.Longitude()); } } sd.ig = sd.size = 0; } else { sd.ig += size; sd.size -= size; } } else { printf("GPS string is too large at %d bytes\n", sd.ig + sd.size); sd.ig = sd.size = 0; } sd.first = false; break; case 0x40U: // 20 character user message if (sd.size * 5 == sd.im) { memcpy(sd.message+sd.im, c+1, 2); sd.im += 2; sd.size = 3; } else { //printf("A message voiceframe, #%d, is out of order because message size is %d\n", sd.size, sd.im); sd.im = sd.size = 0; } sd.first = false; break; case 0x50U: // header if (3 == i) { // only when the streamid can't be matched if (sd.size + sd.ih < 42) { // make sure there's room memcpy(sd.header+sd.ih, c+1, size); sd.ih += size; if (sd.ih == 41) { // we have liftoff, calculate the checksum memcpy(sdheader.hdr.flag, sd.header, 39); calcPFCS(sdheader.title, 56); if (0 == memcmp(sd.header+39, sdheader.hdr.pfcs, 2)) { // checksum looks okay int mod = sdheader.hdr.rpt2[CALL_SIZE-1] - 'A'; // the sd header lists the gateway first, so we check here to see if there's a match if (mod >= 0 && mod < 3 && Rptr.mod[mod].defined) { printf("Got a slow data header: %36.36s\n", sd.header+3); unsigned char call[CALL_SIZE]; // swap rpt1 and rpt2 memcpy(call, sdheader.hdr.rpt1, CALL_SIZE); memcpy(sdheader.hdr.rpt1, sdheader.hdr.rpt2, CALL_SIZE); memcpy(sdheader.hdr.rpt2, call, CALL_SIZE); calcPFCS(sdheader.title, 56); ProcessG2Header(sdheader, source_sock); // start the voice stream sd.ih = sd.size = 0; } else { fprintf(stderr, "Got a valid slow data header but module %d doesn't exist\n", mod); } } } } else { //printf("Header overflow, message has %d bytes, trying to add %d more\n", sd.ih, sd.size); sd.ih = sd.size = 0; } } sd.first = false; break; } } else { // this is the second of a two voice-frame pair sd.first = true; if (0 == sd.size) return; switch (sd.type) { case 0x30U: // GPS memcpy(sd.gps+sd.ig, c, sd.size); if (c[0]=='\r' || c[1]=='\r' || c[2]=='\r') { if (c[0]=='\r') sd.gps[sd.ig] = '\0'; else if (c[1]=='\r') sd.gps[sd.ig+1] = '\0'; else sd.gps[sd.ig+2] = '\0'; if (i < 3) { Printable(sd.gps); if (showLastHeard && gps.Parse((const char *)&sd.gps)) { char call[CALL_SIZE+1]; memcpy(call, toRptr[i].saved_hdr.hdr.mycall, CALL_SIZE); call[CALL_SIZE] = '\0'; qnDB.UpdatePosition(call, gps.MaidenHead(), gps.Latitude(), gps.Longitude()); } } sd.ig = 0; } else { sd.ig += sd.size; sd.gps[sd.ig] = 0; } break; case 0x40U: // message memcpy(sd.message+sd.im, c, 3); sd.im += 3; if (sd.im >= 20) { sd.message[20] = '\0'; Printable(sd.message); if (showLastHeard && (i < 3) && memcmp(toRptr[i].saved_hdr.hdr.sfx, "RPTR", 4) && memcmp(sd.message, "VIA SMARTGP", 11)) { char call[CALL_SIZE+1]; memcpy(call, toRptr[i].saved_hdr.hdr.mycall, CALL_SIZE); call[CALL_SIZE] = '\0'; qnDB.UpdateMessage(call, (const char *)&(sd.message)); } sd.im = 0; } break; case 0x50U: // header if ((3 == i) && sd.size) { memcpy(sd.header+sd.ih, c, 3); sd.ih += 3; } break; } } } void CQnetGateway::ProcessOutGoingSD(const SDSVT &dsvt) { int i; for (i=0; i<3; i++) { if (Rptr.mod[i].defined && (toRptr[i].saved_hdr.streamid == dsvt.streamid)) break; } // if i==3, then the streamid of this voice packet didn't match any module if (i > 2) return; SSD &sd = sdout[i]; if (VoicePacketIsSync(dsvt.vasd.text)) { sd.first = true; return; } const unsigned char c[3] = { static_cast(dsvt.vasd.text[0] ^ 0x70u), static_cast(dsvt.vasd.text[1] ^ 0x4fu), static_cast(dsvt.vasd.text[2] ^ 0x93u) }; // unscramble if (sd.first) { // this is the first of a two voice-packet pair // get the "size" and type from the first byte sd.size = 0x0FU & c[0]; if (sd.size > 5) { sd.size = 5; } int size = sd.size; if (size > 2) size = 2; sd.type = 0xF0U & c[0]; switch (sd.type) { case 0x30U: // GPS data if (sd.size + sd.ig < 255) { memcpy(sd.gps+sd.ig, c+1, size); if (c[1]=='\r' || c[2]=='\r') { sd.gps[sd.ig + ((c[1] == '\r') ? 0 : 1)] = '\0'; if (i < 3) { Printable(sd.gps); if (showLastHeard && gps.Parse((const char *)&sd.gps)) { qnDB.UpdatePosition(band_txt[i].mycall.c_str(), gps.MaidenHead(), gps.Latitude(), gps.Longitude()); if (APRS_ENABLE && (! band_txt[i].is_gps_sent) && (time(NULL) - band_txt[i].gps_last_time > 30)) { std::string call(band_txt[i].mycall); const char *s = gps.APRS(call, Rptr.mod[i].call.c_str()); if (! aprs->aprs_sock.Write((unsigned char *)s, strlen(s))) { time(&band_txt[i].gps_last_time); band_txt[i].is_gps_sent = true; } } } } sd.ig = sd.size = 0; } else { sd.ig += size; sd.size -= size; } } else { printf("GPS string is too large at %d bytes\n", sd.ig + sd.size); sd.ig = sd.size = 0; } sd.first = false; break; case 0x40U: // 20 character user message if (sd.size * 5 == sd.im) { memcpy(sd.message+sd.im, c+1, 2); sd.im += 2; sd.size = 3; } else { //printf("A message voiceframe, #%d, is out of order because message size is %d\n", sd.size, sd.im); sd.im = sd.size = 0; } sd.first = false; break; } } else { if (! band_txt[i].sent_key_on_msg && vPacketCount[i] > 100) { // 100 voice packets received and still no 20-char message! band_txt[i].txt.clear(); if (0 == band_txt[i].urcall.compare(0, 6, "CQCQCQ")) set_dest_rptr(i+'A', band_txt[i].dest_rptr); int x = FindIndex(i); if (x >= 0) ii[x]->sendHeardWithTXMsg(band_txt[i].mycall, band_txt[i].sfx, band_txt[i].urcall, band_txt[i].rpt1, band_txt[i].rpt2, band_txt[i].flags[0], band_txt[i].flags[1], band_txt[i].flags[2], IS_HF[i] ? "" : band_txt[i].dest_rptr, band_txt[i].txt); band_txt[i].sent_key_on_msg = true; } // this is the second of a two voice-frame pair sd.first = true; if (0 == sd.size) return; switch (sd.type) { case 0x30U: // GPS memcpy(sd.gps+sd.ig, c, sd.size); if (c[0]=='\r' || c[1]=='\r' || c[2]=='\r') { if (c[0]=='\r') sd.gps[sd.ig] = '\0'; else if (c[1]=='\r') sd.gps[sd.ig+1] = '\0'; else sd.gps[sd.ig+2] = '\0'; if (i < 3) { Printable(sd.gps); if (showLastHeard && gps.Parse((const char *)&sd.gps)) { qnDB.UpdatePosition(band_txt[i].mycall.c_str(), gps.MaidenHead(), gps.Latitude(), gps.Longitude()); if (APRS_ENABLE && (! band_txt[i].is_gps_sent) && (time(NULL) - band_txt[i].gps_last_time > 30)) { std::string call(band_txt[i].mycall); const char *s = gps.APRS(call, Rptr.mod[i].call.c_str()); if (! aprs->aprs_sock.Write((unsigned char *)s, strlen(s))) { time(&band_txt[i].gps_last_time); band_txt[i].is_gps_sent = true; } } } } sd.ig = 0; } else { sd.ig += sd.size; sd.gps[sd.ig] = 0; } break; case 0x40U: // message memcpy(sd.message+sd.im, c, 3); sd.im += 3; if (sd.im >= 20) { sd.message[20] = '\0'; Printable(sd.message); if (! band_txt[i].sent_key_on_msg) { if (0 == band_txt[i].urcall.compare(0, 6, "CQCQCQ")) set_dest_rptr(i+'A', band_txt[i].dest_rptr); int x = FindIndex(i); if (x >= 0) ii[x]->sendHeardWithTXMsg(band_txt[i].mycall, band_txt[i].sfx, band_txt[i].urcall, band_txt[i].rpt1, band_txt[i].rpt2, band_txt[i].flags[0], band_txt[i].flags[1], band_txt[i].flags[2], IS_HF[i] ? "" : band_txt[i].dest_rptr, (const char *)sd.message); band_txt[i].sent_key_on_msg = true; } if (showLastHeard && (i < 3) && memcmp(toRptr[i].saved_hdr.hdr.sfx, "RPTR", 4) && memcmp(sd.message, "VIA SMARTGP", 11)) { char call[CALL_SIZE+1]; memcpy(call, toRptr[i].saved_hdr.hdr.mycall, CALL_SIZE); call[CALL_SIZE] = '\0'; qnDB.UpdateMessage(call, (const char *)&(sd.message)); } sd.im = 0; } break; } } } void CQnetGateway::ProcessG2Header(const SDSVT &g2buf, const int source_sock) { // Find out the local repeater module IP/port to send the data to int i = g2buf.hdr.rpt1[7] - 'A'; /* valid repeater module? */ if (i>=0 && i<3 && Rptr.mod[i].defined) { // toRptr[i] is active if a remote system is talking to it or // toRptr[i] is receiving data from a cross-band if (0==toRptr[i].last_time && 0==band_txt[i].last_time && (Flag_is_ok(g2buf.hdr.flag[0]) || 0x01U==g2buf.hdr.flag[0] || 0x40U==g2buf.hdr.flag[0])) { superframe[i].clear(); sdin[i].Init(); // with a header, we should reset the Sd structs if (LOG_QSO) { printf("id=%04x flags=%02x:%02x:%02x ur=%.8s r1=%.8s r2=%.8s my=%.8s/%.4s ", ntohs(g2buf.streamid), g2buf.hdr.flag[0], g2buf.hdr.flag[1], g2buf.hdr.flag[2], g2buf.hdr.urcall, g2buf.hdr.rpt1, g2buf.hdr.rpt2, g2buf.hdr.mycall, g2buf.hdr.sfx); if (source_sock >= 0) printf("IP=[%s]:%u\n", fromDstar.GetAddress(), fromDstar.GetPort()); else printf("UnixSock=%s\n", tolink.c_str()); } lhcallsign[i].assign((const char *)g2buf.hdr.mycall, 8); if (showLastHeard && memcmp(g2buf.hdr.sfx, "RPTR", 4) && std::regex_match(lhcallsign[i].c_str(), preg)) { lhsfx[i].assign((const char *)g2buf.hdr.sfx, 4); std::string reflector((const char *)g2buf.hdr.urcall, 8); if (0 == reflector.compare("CQCQCQ ")) set_dest_rptr('A'+i, reflector); else if (0 == reflector.compare(OWNER)) reflector.assign("CSRoute"); qnDB.UpdateLH(lhcallsign[i].c_str(), lhsfx[i].c_str(), 'A'+i, reflector.c_str()); } ToModem[i].Write(g2buf.title, 56); nextctrl[i] = 0U; /* save the header */ if (source_sock < 0) { //if (AF_INET == af_family) { char address[16]; snprintf(address, 16, "%d.0.0.0", i); fromDstar.Initialize(AF_INET, 40000U, address); //} else { // char address[8]; // snprintf(address, 8, "%d::", i); // fromDstar.Initialize(AF_INET6, 40000U, address); //} } memcpy(toRptr[i].saved_hdr.title, g2buf.title, 56); /* time it, in case stream times out */ time(&toRptr[i].last_time); toRptr[i].sequence = g2buf.ctrl; } } } void CQnetGateway::ProcessG2(const ssize_t g2buflen, SDSVT &g2buf, const int source_sock) // source_sock is the socket number of the incoming data, or -1 if it's a unix socket { if ( (g2buflen==56 || g2buflen==27) && 0==memcmp(g2buf.title, "DSVT", 4) && (g2buf.config==0x10 || g2buf.config==0x20) && g2buf.id==0x20) { if (g2buflen == 56) { ProcessG2Header(g2buf, source_sock); } else { // g2buflen == 27 ProcessIncomingSD(g2buf, source_sock); /* find out which repeater module to send the data to */ int i; for (i=0; i<3; i++) { if (Rptr.mod[i].defined) { /* streamid match ? */ bool match = (toRptr[i].saved_hdr.streamid == g2buf.streamid); if (match) { if (LOG_DEBUG) { const unsigned int ctrl = g2buf.ctrl & 0x1FU; if (VoicePacketIsSync(g2buf.vasd.text)) { if (superframe[i].size() > 65U) { printf("Frame[%c]: %s\n", 'A'+i, superframe[i].c_str()); superframe[i].clear(); } const char *ch = "#abcdefghijklmnopqrstuvwxyz"; superframe[i].append(1, (ctrl<27U) ? ch[ctrl] : '%' ); } else { const char *ch = "!ABCDEFGHIJKLMNOPQRSTUVWXYZ"; superframe[i].append(1, (ctrl<27U) ? ch[ctrl] : '*' ); } } int diff = int(0x1FU & g2buf.ctrl) - int(nextctrl[i]); if (diff) { if (diff < 0) diff += 21; if (diff < 6) { // fill up to 5 missing voice frames if (LOG_DEBUG) fprintf(stderr, "Warning: inserting %d missing voice frame(s)\n", diff); SDSVT dsvt; memcpy(dsvt.title, g2buf.title, 14U); // everything but the ctrl and voice data const unsigned char quite[9] = { 0x9EU, 0x8DU, 0x32U, 0x88U, 0x26U, 0x1AU, 0x3FU, 0x61U, 0xE8U }; memcpy(dsvt.vasd.voice, quite, 9U); while (diff-- > 0) { dsvt.ctrl = nextctrl[i]++; nextctrl[i] %= 21U; if (dsvt.ctrl) { const unsigned char silence[3] = { 0x70U, 0x4FU, 0x93U }; memcpy(dsvt.vasd.voice, silence, 3U); } else { const unsigned char sync[3] = { 0x55U, 0x2DU, 0x16U }; memcpy(dsvt.vasd.voice, sync, 3U); } ToModem[i].Write(dsvt.title, 27); } } else { if (LOG_DEBUG) printf("missing %d packets from voice stream on module %c, resetting\n", diff, 'A'+i); nextctrl[i] = g2buf.ctrl; } } if ((nextctrl[i] == (0x1FU & g2buf.ctrl)) || (0x40U & g2buf.ctrl)) { // no matter what, we will send this on if it is the closing frame if (0x40U & g2buf.ctrl) { g2buf.ctrl = (nextctrl[i] | 0x40U); } else { g2buf.ctrl = nextctrl[i]; nextctrl[i] = (nextctrl[i] + 1U) % 21U; } ToModem[i].Write(g2buf.title, 27); if (source_sock >= 0 && showLastHeard) { std::string smartgroup; if(ProcessG2Msg(g2buf.vasd.text, i, smartgroup)) { qnDB.UpdateLH(lhcallsign[i].c_str(), lhsfx[i].c_str(), 'A'+i, smartgroup.c_str()); } } } else { if (LOG_DEBUG) fprintf(stderr, "Warning: Ignoring packet because its ctrl=0x%02xU and nextctrl=0x%02xU\n", g2buf.ctrl, nextctrl[i]); } /* timeit */ time(&toRptr[i].last_time); toRptr[i].sequence = g2buf.ctrl; /* End of stream ? */ if (g2buf.ctrl & 0x40U) { /* clear the saved header */ memset(toRptr[i].saved_hdr.title, 0U, 56U); toRptr[i].last_time = 0; if (LOG_DEBUG && superframe[i].size()) { printf("Final[%c]: %s\n", 'A'+i, superframe[i].c_str()); superframe[i].clear(); } sdin[3].Init(); if (LOG_QSO) printf("id=%04x END\n", ntohs(g2buf.streamid)); } break; // we're done } } } /* no match ? */ if ((i == 3) && GATEWAY_HEADER_REGEN) { /* check if this a continuation of audio that timed out */ if (g2buf.ctrl & 0x40) ; /* we do not care about end-of-QSO */ else { /* for which repeater this stream has timed out ? */ for (i=0; i<3; i++) { if (! Rptr.mod[i].defined) continue; /* match saved stream ? */ bool match = (toRptr[i].saved_hdr.streamid == g2buf.streamid); if (match) { /* repeater module is inactive ? */ if (toRptr[i].last_time==0 && band_txt[i].last_time==0) { printf("Re-generating header for streamID=%04x\n", ntohs(g2buf.streamid)); /* re-generate/send the header */ ToModem[i].Write(toRptr[i].saved_hdr.title, 56); /* send this audio packet to repeater */ ToModem[i].Write(g2buf.title, 27); /* time it, in case stream times out */ time(&toRptr[i].last_time); toRptr[i].sequence = g2buf.ctrl; } break; } } } } } } } void CQnetGateway::ProcessModem(const ssize_t recvlen, SDSVT &dsvt) { char tempfile[FILENAME_MAX]; if (0 == memcmp(dsvt.title, "DSVT", 4)) { if ( (recvlen==56 || recvlen==27) && dsvt.id==0x20U && (dsvt.config==0x10U || dsvt.config==0x20U) ) { if (recvlen == 56) { if (LOG_QSO) printf("id=%04x start RPTR flag0=%02x ur=%.8s r1=%.8s r2=%.8s my=%.8s/%.4s\n", ntohs(dsvt.streamid), dsvt.hdr.flag[0], dsvt.hdr.urcall, dsvt.hdr.rpt1, dsvt.hdr.rpt2, dsvt.hdr.mycall, dsvt.hdr.sfx); if (0==memcmp(dsvt.hdr.rpt1, "DIRECT ", 8) && 0==memcmp(dsvt.hdr.rpt2, "DIRECT ", 8)) { // DIRECT mode??? memcpy(dsvt.hdr.rpt1, OWNER.c_str(), 7); switch (dsvt.flagb[2]) { case 0x01U: dsvt.hdr.rpt1[7] = 'B'; break; case 0x02U: dsvt.hdr.rpt1[7] = 'C'; break; default: dsvt.hdr.rpt1[7] = 'A'; break; } memcpy(dsvt.hdr.rpt2, OWNER.c_str(), 7); dsvt.hdr.rpt2[7] = 'G'; calcPFCS(dsvt.title, 56); if (LOG_QSO) printf("Resetting: r1=%.8s r2=%.8s\n", dsvt.hdr.rpt1, dsvt.hdr.rpt2); } if (0==memcmp(dsvt.hdr.rpt1, OWNER.c_str(), 7) && Flag_is_ok(dsvt.hdr.flag[0])) { int i = dsvt.hdr.rpt1[7] - 'A'; if (i>=0 && i<3) { vPacketCount[i] = 0; Index[i] = -1; if (LOG_DTMF) printf("resetting dtmf[%d] (got a header)\n", i); dtmf_last_frame[i] = 0; dtmf_counter[i] = 0; memset(dtmf_buf[i], 0, sizeof(dtmf_buf[i])); dtmf_buf_count[i] = 0; /* Initialize the LAST HEARD data for the band */ band_txt[i].streamID = dsvt.streamid; memcpy(band_txt[i].flags, dsvt.hdr.flag, 3); band_txt[i].mycall.assign((const char *)dsvt.hdr.mycall, 8); band_txt[i].sfx.assign((const char *)dsvt.hdr.sfx, 4); band_txt[i].urcall.assign((const char *)dsvt.hdr.urcall, 8); band_txt[i].rpt1.assign((const char *)dsvt.hdr.rpt1, 8); band_txt[i].rpt2.assign((const char *)dsvt.hdr.rpt2, 8); time(&band_txt[i].last_time); band_txt[i].txt.clear(); band_txt[i].sent_key_on_msg = false; band_txt[i].dest_rptr[0] = '\0'; /* try to process GPS mode: GPRMC and ID */ band_txt[i].is_gps_sent = false; // band_txt[i].gps_last_time = 0; DO NOT reset it band_txt[i].num_dv_frames = 0; band_txt[i].num_dv_silent_frames = 0; band_txt[i].num_bit_errors = 0; sdout[i].Init(); /* select the band for aprs processing, and lock on the stream ID */ if (APRS_ENABLE) aprs->SelectBand(i, ntohs(dsvt.streamid)); if (std::regex_match(band_txt[i].mycall, preg)) { qnDB.UpdateLH(band_txt[i].mycall.c_str(), band_txt[i].sfx.c_str(), 'A'+i, "Module "); } } } /* Is MYCALL valid ? */ std::string call; call.assign((char *)dsvt.hdr.mycall, 8); bool mycall_valid = std::regex_match(call.c_str(), preg); if (mycall_valid) ToLink.Write(dsvt.title, recvlen); else printf("MYCALL [%s] failed IRC expression validation\n", call.c_str()); if ( mycall_valid && memcmp(dsvt.hdr.urcall, "XLX", 3) && // not a reflector memcmp(dsvt.hdr.urcall, "XRF", 3) && memcmp(dsvt.hdr.urcall, "REF", 3) && memcmp(dsvt.hdr.urcall, "DCS", 3) && dsvt.hdr.urcall[0]!=' ' && // must have something memcmp(dsvt.hdr.urcall, "CQCQCQ", 6) ) { // urcall is NOT CQCQCQ std::string user, rptr, gate, addr; if ( dsvt.hdr.urcall[0]=='/' && // repeater routing! 0==memcmp(dsvt.hdr.rpt1, OWNER.c_str(), 7) && // rpt1 this repeater (dsvt.hdr.rpt1[7]>='A' && dsvt.hdr.rpt1[7]<='C') && // with a valid module 0==memcmp(dsvt.hdr.rpt2, OWNER.c_str(), 7) && // rpt2 is this repeater dsvt.hdr.rpt2[7]=='G' && // local Gateway Flag_is_ok(dsvt.hdr.flag[0]) ) { if (memcmp(dsvt.hdr.urcall+1, OWNER.c_str(), 6)) { // the value after the slash is NOT this repeater int i = dsvt.hdr.rpt1[7] - 'A'; if (i>=0 && i<3) { /* one radio user on a repeater module at a time */ if (to_remote_g2[i].toDstar.AddressIsZero()) { /* YRCALL=/repeater + mod */ /* YRCALL=/KJ4NHFB */ user.assign((char *)dsvt.hdr.urcall, 1, 6); user.append(" "); user.append(dsvt.hdr.urcall[7], 1); if (isspace(user.at(7))) user[7] = 'A'; Index[i] = get_yrcall_rptr(user, rptr, gate, addr, 'R'); if (Index[i]--) { /* it is a repeater */ // std::string from = OWNER.substr(0, 7); // from.append(1, i+'A'); // ii[Index[i]]->sendPing(user, from); to_remote_g2[i].streamid = dsvt.streamid; if (addr.npos == addr.find(':') && af_family[Index[i]] == AF_INET6) fprintf(stderr, "ERROR using IRC[%d]: IP returned from cache is IPV4, %s, but family is AF_INET6!\n", Index[i], addr.c_str()); to_remote_g2[i].toDstar.Initialize(af_family[Index[i]], (uint16_t)((af_family[Index[i]]==AF_INET6) ? g2_ipv6_external.port : g2_external.port), addr.c_str()); /* set rpt1 */ memset(dsvt.hdr.rpt1, ' ', 8); memcpy(dsvt.hdr.rpt1, rptr.c_str(), 8); /* set rpt2 */ memcpy(dsvt.hdr.rpt2, gate.c_str(), 8); /* set yrcall, can NOT let it be slash and repeater + module */ memcpy(dsvt.hdr.urcall, "CQCQCQ ", 8); /* set PFCS */ calcPFCS(dsvt.title, 56); // The remote repeater has been set, lets fill in the dest_rptr // so that later we can send that to the LIVE web site band_txt[i].dest_rptr.assign((char *)dsvt.hdr.rpt1, 8); // send to remote gateway for (int j=0; j<5; j++) sendto(g2_sock[Index[i]], dsvt.title, 56, 0, to_remote_g2[i].toDstar.GetCPointer(), to_remote_g2[i].toDstar.GetSize()); printf("id=%04x zone route to [%s]:%u ur=%.8s r1=%.8s r2=%.8s my=%.8s/%.4s\n", ntohs(dsvt.streamid), to_remote_g2[i].toDstar.GetAddress(), to_remote_g2[i].toDstar.GetPort(), dsvt.hdr.urcall, dsvt.hdr.rpt1, dsvt.hdr.rpt2, dsvt.hdr.mycall, dsvt.hdr.sfx); time(&(to_remote_g2[i].last_time)); } } } } } else if (memcmp(dsvt.hdr.urcall, OWNER.c_str(), 7) && // urcall is not this repeater 0==memcmp(dsvt.hdr.rpt1, OWNER.c_str(), 7) && // rpt1 is this repeater (dsvt.hdr.rpt1[7]>='A'&& dsvt.hdr.rpt1[7]<='C') && // mod is A,B,C 0==memcmp(dsvt.hdr.rpt2, OWNER.c_str(), 7) && // rpt2 is this repeater dsvt.hdr.rpt2[7]=='G' && // local Gateway Flag_is_ok(dsvt.hdr.flag[0])) { user.assign((char *)dsvt.hdr.urcall, 8); int i = dsvt.hdr.rpt1[7] - 'A'; if (i>=0 && i<3) { Index[i] = get_yrcall_rptr(user, rptr, gate, addr, 'U'); if (Index[i]--) { /* destination is a remote system */ if (0 != gate.compare(0, 7, OWNER, 0, 7)) { /* one radio user on a repeater module at a time */ if (to_remote_g2[i].toDstar.AddressIsZero()) { if (std::regex_match(user.c_str(), preg)) { // don't do a ping to a routing group std::string from((const char *)dsvt.hdr.rpt1, 8); ii[Index[i]]->sendPing(gate, from); } /* set the destination */ to_remote_g2[i].streamid = dsvt.streamid; if (addr.npos == addr.find(':') && af_family[Index[i]] == AF_INET6) fprintf(stderr, "ERROR using IRC[%d]: IP returned from cache, %s, is IPV4 but family is AF_INET6!\n", Index[i], addr.c_str()); to_remote_g2[i].toDstar.Initialize(af_family[Index[i]], (uint16_t)((af_family[Index[i]]==AF_INET6) ? g2_ipv6_external.port : g2_external.port), addr.c_str()); /* set rpt1 */ memcpy(dsvt.hdr.rpt1, rptr.c_str(), 8); /* set rpt2 */ memcpy(dsvt.hdr.rpt2, gate.c_str(), 8); /* set PFCS */ calcPFCS(dsvt.title, 56); // The remote repeater has been set, lets fill in the dest_rptr // so that later we can send that to the LIVE web site band_txt[i].dest_rptr.assign((char *)dsvt.hdr.rpt1, 8); /* send to remote gateway */ for (int j=0; j<5; j++) sendto(g2_sock[Index[i]], dsvt.title, 56, 0, to_remote_g2[i].toDstar.GetCPointer(), to_remote_g2[i].toDstar.GetSize()); printf("Callsign route to [%s]:%u id=%04x my=%.8s/%.4s ur=%.8s rpt1=%.8s rpt2=%.8s\n", to_remote_g2[i].toDstar.GetAddress(), to_remote_g2[i].toDstar.GetPort(), ntohs(dsvt.streamid), dsvt.hdr.mycall, dsvt.hdr.sfx, dsvt.hdr.urcall, dsvt.hdr.rpt1, dsvt.hdr.rpt2); time(&(to_remote_g2[i].last_time)); } } else { int i = dsvt.hdr.rpt1[7] - 'A'; if (i>=0 && i<3) { /* the user we are trying to contact is on our gateway */ /* make sure they are on a different module */ if (rptr.at(7) != dsvt.hdr.rpt1[7]) { /* The remote repeater has been set, lets fill in the dest_rptr so that later we can send that to the LIVE web site */ band_txt[i].dest_rptr.assign((char *)dsvt.hdr.rpt2, 7); band_txt[i].dest_rptr.append(1, rptr.at(7)); i = rptr.at(7) - 'A'; /* valid destination repeater module? */ if (i>=0 && i<3) { /* toRptr[i] : receiving from a remote system or cross-band band_txt[i] : local RF is talking. */ if ((toRptr[i].last_time == 0) && (band_txt[i].last_time == 0)) { printf("CALLmode cross-banding from mod %c to %c\n", dsvt.hdr.rpt1[7], rptr.at(7)); dsvt.hdr.rpt2[7] = rptr.at(7); dsvt.hdr.rpt1[7] = 'G'; calcPFCS(dsvt.title, 56); ToModem[i].Write(dsvt.title, 56); /* time it, in case stream times out */ time(&toRptr[i].last_time); toRptr[i].sequence = dsvt.ctrl; } } } } else { printf("icom rule: no routing from %.8s to %s%c\n", dsvt.hdr.rpt1, rptr.c_str(), rptr.at(7)); } } } else { if ('L' != dsvt.hdr.urcall[7]) // as long as this doesn't look like a linking command playNotInCache = true; // we need to wait until user's transmission is over } } } } else if (0 == memcmp(dsvt.hdr.urcall, " C0", 8)) { int i = dsvt.hdr.rpt1[7] - 'A'; if (i>=0 && i<3) { /* voicemail file is closed */ if ((vm[i].fd == -1) && (vm[i].file[0] != '\0')) { unlink(vm[i].file); printf("removed voicemail file: %s\n", vm[i].file); vm[i].file[0] = '\0'; } else printf("No voicemail to clear or still recording\n"); } } else if (0 == memcmp(dsvt.hdr.urcall, " R0", 8)) { int i = dsvt.hdr.rpt1[7] - 'A'; if (i>=0 && i<3) { /* voicemail file is closed */ if ((vm[i].fd == -1) && (vm[i].file[0] != '\0')) { band_txt[i].last_time = 0; band_txt[i].streamID = 0U; // prevent vm timeout snprintf(vm[i].message, 21, "VOICEMAIL ON MOD %c ", 'A'+i); try { std::async(std::launch::async, &CQnetGateway::PlayFileThread, this, std::ref(vm[i])); } catch (const std::exception &e) { printf("Failed to start voicemail playback. Exception: %s\n", e.what()); } } else printf("No voicemail to recall or still recording\n"); } } else if (0 == memcmp(dsvt.hdr.urcall, " S0", 8)) { int i = dsvt.hdr.rpt1[7] - 'A'; if (i>=0 && i<3) { if (vm[i].fd >= 0) printf("Already recording for voicemail on mod %d\n", i); else { memset(tempfile, '\0', sizeof(tempfile)); snprintf(tempfile, FILENAME_MAX, "%s/%c_%s", FILE_ECHOTEST.c_str(), dsvt.hdr.rpt1[7], "voicemail.dat2"); vm[i].fd = open(tempfile, O_CREAT | O_WRONLY | O_TRUNC | O_APPEND, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH); if (vm[i].fd < 0) printf("Failed to create file %s for voicemail\n", tempfile); else { strcpy(vm[i].file, tempfile); printf("Recording mod %c for voicemail into file:[%s]\n", dsvt.hdr.rpt1[7], vm[i].file); time(&vm[i].last_time); vm[i].streamid = dsvt.streamid; memcpy(recbuf.title, dsvt.title, 56); memset(recbuf.hdr.rpt1, ' ', 8); memcpy(recbuf.hdr.rpt1, OWNER.c_str(), OWNER.size()); recbuf.hdr.rpt1[7] = dsvt.hdr.rpt1[7]; memset(recbuf.hdr.rpt2, ' ', 8); memcpy(recbuf.hdr.rpt2, OWNER.c_str(), OWNER.size()); recbuf.hdr.rpt2[7] = 'G'; memcpy(recbuf.hdr.urcall, "CQCQCQ ", 8); calcPFCS(recbuf.title, 56); write(vm[i].fd, recbuf.title, 56); } } } } else if (0 == memcmp(dsvt.hdr.urcall, " E", 8)) { int i = dsvt.hdr.rpt1[7] - 'A'; if (i>=0 && i<3) { if (recd[i].fd >= 0) printf("Already recording for echotest on mod %d\n", i); else { memset(tempfile, '\0', sizeof(tempfile)); snprintf(tempfile, FILENAME_MAX, "%s/%c_%s", FILE_ECHOTEST.c_str(), dsvt.hdr.rpt1[7], "echotest.dat"); recd[i].fd = open(tempfile, O_CREAT | O_WRONLY | O_EXCL | O_TRUNC | O_APPEND, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH); if (recd[i].fd < 0) printf("Failed to create file %s for echotest\n", tempfile); else { strcpy(recd[i].file, tempfile); printf("Recording mod %c for echotest into file:[%s]\n", dsvt.hdr.rpt1[7], recd[i].file); snprintf(recd[i].message, 21, "ECHO ON MODULE %c ", 'A' + i); time(&recd[i].last_time); recd[i].streamid = dsvt.streamid; memcpy(recbuf.title, dsvt.title, 56); memset(recbuf.hdr.rpt1, ' ', 8); memcpy(recbuf.hdr.rpt1, OWNER.c_str(), OWNER.length()); recbuf.hdr.rpt1[7] = dsvt.hdr.rpt1[7]; memset(recbuf.hdr.rpt2, ' ', 8); memcpy(recbuf.hdr.rpt2, OWNER.c_str(), OWNER.length()); recbuf.hdr.rpt2[7] = 'G'; memcpy(recbuf.hdr.urcall, "CQCQCQ ", 8); calcPFCS(recbuf.title, 56); write (recd[i].fd, recbuf.title, 56); } } } /* check for cross-banding */ } else if ( 0==memcmp(dsvt.hdr.urcall, "CQCQCQ", 6) && // yrcall is CQCQCQ 0==memcmp(dsvt.hdr.rpt2, OWNER.c_str(), 7) && // rpt1 is this repeater 0==memcmp(dsvt.hdr.rpt1, OWNER.c_str(), 7) && // rpt2 is this repeater (dsvt.hdr.rpt1[7]>='A' && dsvt.hdr.rpt1[7]<='C') && // mod of rpt1 is A,B,C (dsvt.hdr.rpt2[7]>='A' && dsvt.hdr.rpt2[7]<='C') && // !!! usually G on rpt2, but we see A,B,C with dsvt.hdr.rpt2[7]!=dsvt.hdr.rpt1[7] ) { // cross-banding? make sure NOT the same int i = dsvt.hdr.rpt1[7] - 'A'; if (i>=0 && i<3) { // The remote repeater has been set, lets fill in the dest_rptr // so that later we can send that to the LIVE web site band_txt[i].dest_rptr.append((char *)dsvt.hdr.rpt2, 8); } i = dsvt.hdr.rpt2[7] - 'A'; // valid destination repeater module? if (i>=0 && i<3) { // toRptr[i] : receiving from a remote system or cross-band // band_txt[i] : local RF is talking. if ((toRptr[i].last_time == 0) && (band_txt[i].last_time == 0)) { printf("ZONEmode cross-banding from mod %c to %c\n", dsvt.hdr.rpt1[7], dsvt.hdr.rpt2[7]); dsvt.hdr.rpt1[7] = 'G'; calcPFCS(dsvt.title, 56); ToModem[i].Write(dsvt.title, 56); /* time it, in case stream times out */ time(&toRptr[i].last_time); toRptr[i].sequence = dsvt.ctrl; } } } } else { // recvlen is 27 for (int i=0; i<3; i++) { if (band_txt[i].streamID == dsvt.streamid) { time(&band_txt[i].last_time); if (dsvt.ctrl & 0x40) { // end of voice data if (dtmf_buf_count[i] > 0) { std::string dtmf_file(FILE_DTMF); dtmf_file.push_back('/'); dtmf_file.push_back('A'+i); dtmf_file += "_mod_DTMF_NOTIFY"; if (LOG_DTMF) printf("Saving dtmfs=[%s] into file: [%s]\n", dtmf_buf[i], dtmf_file.c_str()); FILE *dtmf_fp = fopen(dtmf_file.c_str(), "w"); if (dtmf_fp) { fprintf(dtmf_fp, "%s\n%s", dtmf_buf[i], band_txt[i].mycall.c_str()); fclose(dtmf_fp); } else printf("Failed to create dtmf file %s\n", dtmf_file.c_str()); if (LOG_DTMF) printf("resetting dtmf[%d] (printed dtmf code %s from %s)\n", i, dtmf_buf[i], band_txt[i].mycall.c_str()); memset(dtmf_buf[i], 0, sizeof(dtmf_buf[i])); dtmf_buf_count[i] = 0; dtmf_counter[i] = 0; dtmf_last_frame[i] = 0; } if (! band_txt[i].sent_key_on_msg) { band_txt[i].txt[0] = '\0'; if (0 == band_txt[i].urcall.compare(0, 6, "CQCQCQ")) { set_dest_rptr(i+'A', band_txt[i].dest_rptr); } int x = FindIndex(i); if (x >= 0) ii[x]->sendHeardWithTXMsg(band_txt[i].mycall, band_txt[i].sfx, band_txt[i].urcall, band_txt[i].rpt1, band_txt[i].rpt2, band_txt[i].flags[0], band_txt[i].flags[1], band_txt[i].flags[2], IS_HF[i] ? "" : band_txt[i].dest_rptr, band_txt[i].txt); band_txt[i].sent_key_on_msg = true; } // send the "key off" message, this will end up in the openquad.net Last Heard webpage. int index = Index[i]; if (index < 0) { if (AF_INET == link_family[i]) { index = ii[1] ? 1 : 0; } else if (AF_INET6 == link_family[i]) { index = 0; } } if (index >= 0) ii[index]->sendHeardWithTXStats(band_txt[i].mycall, band_txt[i].sfx, band_txt[i].urcall, band_txt[i].rpt1, band_txt[i].rpt2, band_txt[i].flags[0], band_txt[i].flags[1], band_txt[i].flags[2], band_txt[i].num_dv_frames, band_txt[i].num_dv_silent_frames, band_txt[i].num_bit_errors); if (playNotInCache) { // Not in cache, please try again! FILE *fp = fopen(FILE_QNVOICE_FILE.c_str(), "w"); if (fp) { fprintf(fp, "%c_notincache.dat_NOT_IN_CACHE\n", band_txt[i].rpt1.at(7)); fclose(fp); } playNotInCache = false; } band_txt[i].Initialize(); } else { // not the end of the voice stream int ber_data[3]; int ber_errs = decode.Decode(dsvt.vasd.voice, ber_data); if (ber_data[0] == 0xf85) band_txt[i].num_dv_silent_frames++; band_txt[i].num_bit_errors += ber_errs; band_txt[i].num_dv_frames++; if ((ber_data[0] & 0x0ffc) == 0xfc0) { dtmf_digit = (ber_data[0] & 0x03) | ((ber_data[2] & 0x60) >> 3); if (dtmf_counter[i] > 0) { if (dtmf_last_frame[i] != dtmf_digit) dtmf_counter[i] = 0; } dtmf_last_frame[i] = dtmf_digit; dtmf_counter[i]++; if ((dtmf_counter[i] == 5) && (dtmf_digit >= 0) && (dtmf_digit <= 15)) { if (dtmf_buf_count[i] < MAX_DTMF_BUF) { const char *dtmf_chars = "147*2580369#ABCD"; dtmf_buf[i][ dtmf_buf_count[i] ] = dtmf_chars[dtmf_digit]; dtmf_buf_count[i]++; } } const unsigned char silence[9] = { 0x9E, 0x8D, 0x32, 0x88, 0x26, 0x1A, 0x3F, 0x61, 0xE8 }; memcpy(dsvt.vasd.voice, silence, 9); } else dtmf_counter[i] = 0; } break; } vPacketCount[i]++; } ProcessOutGoingSD(dsvt); //ProcessSlowData(dsvt.vasd.text, dsvt.streamid); /* send data to qnlink */ ToLink.Write(dsvt.title, 27); /* aprs processing */ if (APRS_ENABLE) aprs->ProcessText(ntohs(dsvt.streamid), dsvt.ctrl, dsvt.vasd.voice); for (int i=0; i<3; i++) { /* find out if data must go to the remote G2 */ if (to_remote_g2[i].streamid==dsvt.streamid && Index[i]>=0) { sendto(g2_sock[Index[i]], dsvt.title, 27, 0, to_remote_g2[i].toDstar.GetCPointer(), to_remote_g2[i].toDstar.GetSize()); time(&(to_remote_g2[i].last_time)); /* Is this the end-of-stream */ if (dsvt.ctrl & 0x40) { to_remote_g2[i].toDstar.Clear(); to_remote_g2[i].streamid = 0; to_remote_g2[i].last_time = 0; } break; } else if (recd[i].fd>=0 && recd[i].streamid==dsvt.streamid) { // Is the data to be recorded for echotest time(&recd[i].last_time); write(recd[i].fd, dsvt.vasd.voice, 9); if ((dsvt.ctrl & 0x40) != 0) { recd[i].streamid = 0; recd[i].last_time = 0; close(recd[i].fd); recd[i].fd = -1; // printf("Closed echotest audio file:[%s]\n", recd[i].file); /* we are in echotest mode, so play it back */ try { std::async(std::launch::async, &CQnetGateway::PlayFileThread, this, std::ref(recd[i])); } catch (const std::exception &e) { printf("failed to start PlayFileThread. Exception: %s\n", e.what()); // When the echotest thread runs, it deletes the file, // Because the echotest thread did NOT start, we delete the file here unlink(recd[i].file); } } break; } else if ((vm[i].fd >= 0) && (vm[i].streamid==dsvt.streamid)) { // Is the data to be recorded for voicemail time(&vm[i].last_time); write(vm[i].fd, dsvt.vasd.voice, 9); if ((dsvt.ctrl & 0x40) != 0) { vm[i].streamid = 0; vm[i].last_time = 0; close(vm[i].fd); vm[i].fd = -1; // printf("Closed voicemail audio file:[%s]\n", vm[i].file); } break; } else if (toRptr[i].saved_hdr.streamid == dsvt.streamid) { // or maybe this is cross-banding data ToModem[i].Write(dsvt.title, 27); /* timeit */ time(&toRptr[i].last_time); toRptr[i].sequence = dsvt.ctrl; /* End of stream ? */ if (dsvt.ctrl & 0x40) { toRptr[i].last_time = 0; } break; } } if (0x40U & dsvt.ctrl) { if (LOG_QSO) printf("id=%04x END RPTR\n", ntohs(dsvt.streamid)); } } } } } /* run the main loop for QnetGateway */ void CQnetGateway::Process() { // dtmf stuff initialize for (int i=0; i<3; i++) { dtmf_buf_count[i] = 0; dtmf_buf[i][0] = '\0'; dtmf_last_frame[i] = 0; dtmf_counter[i] = 0U; } std::future aprs_future, irc_data_future[2]; if (APRS_ENABLE) { // start the beacon thread try { aprs_future = std::async(std::launch::async, &CQnetGateway::APRSBeaconThread, this); } catch (const std::exception &e) { printf("Failed to start the APRSBeaconThread. Exception: %s\n", e.what()); } if (aprs_future.valid()) printf("APRS beacon thread started\n"); } for (int i=0; i<2; i++) { if (ii[i]) { try { // start the IRC read thread irc_data_future[i] = std::async(std::launch::async, &CQnetGateway::GetIRCDataThread, this, i); } catch (const std::exception &e) { printf("Failed to start GetIRCDataThread[%d]. Exception: %s\n", i, e.what()); SetState(false); } if (IsRunning()) printf("get_irc_data thread[%d] started\n", i); ii[i]->kickWatchdog(GW_VERSION); } } while (IsRunning()) { ProcessTimeouts(); // wait 20 ms max int max_nfds = 0; fd_set fdset; FD_ZERO(&fdset); if (g2_sock[0] >= 0) AddFDSet(max_nfds, g2_sock[0], &fdset); if (g2_sock[1] >= 0) AddFDSet(max_nfds, g2_sock[1], &fdset); AddFDSet(max_nfds, ToLink.GetFD(), &fdset); for (int i=0; i<3; i++) { if (Rptr.mod[i].defined) AddFDSet(max_nfds, ToModem[i].GetFD(), &fdset); } AddFDSet(max_nfds, FromRemote.GetFD(), &fdset); struct timeval tv; tv.tv_sec = 0; tv.tv_usec = 20000; // 20 ms (void)select(max_nfds + 1, &fdset, 0, 0, &tv); // process packets coming from remote G2 for (int i=0; i<2; i++) { if (g2_sock[i] < 0) continue; if (IsRunning() && FD_ISSET(g2_sock[i], &fdset)) { SDSVT dsvt; socklen_t fromlen = sizeof(struct sockaddr_storage); ssize_t g2buflen = recvfrom(g2_sock[i], dsvt.title, 56, 0, fromDstar.GetPointer(), &fromlen); if (LOG_QSO && 4==g2buflen && 0==memcmp(dsvt.title, "PONG", 4)) printf("Got a pong from [%s]:%u\n", fromDstar.GetAddress(), fromDstar.GetPort()); else ProcessG2(g2buflen, dsvt, i); FD_CLR(g2_sock[i], &fdset); } } // process packets from qnremote if (IsRunning() && FD_ISSET(FromRemote.GetFD(), &fdset)) { SDSVT dsvt; const ssize_t len = FromRemote.Read(dsvt.title, 56); ProcessModem(len, dsvt); FD_CLR(FromRemote.GetFD(), &fdset); } // process packets from qnlink if (IsRunning() && FD_ISSET(ToLink.GetFD(), &fdset)) { SDSVT dsvt; ssize_t g2buflen = ToLink.Read(dsvt.title, 56); if (16==g2buflen && 0==memcmp(dsvt.title, "LINK", 4)) { SLINKFAMILY fam; memcpy(fam.title, dsvt.title, 16); if (LOG_DEBUG) { printf("Families of linked nodes: A=AF_%s, B=AF_%s, C=AF_%s\n", (AF_UNSPEC==fam.family[0]) ? "UNSPEC" : ((AF_INET==fam.family[0]) ? "INET" : "INET6"), (AF_UNSPEC==fam.family[1]) ? "UNSPEC" : ((AF_INET==fam.family[1]) ? "INET" : "INET6"), (AF_UNSPEC==fam.family[2]) ? "UNSPEC" : ((AF_INET==fam.family[2]) ? "INET" : "INET6") ); } memcpy(link_family, fam.family, 12); } else { ProcessG2(g2buflen, dsvt, -1); } FD_CLR(ToLink.GetFD(), &fdset); } // process packets coming from local repeater module(s) for (int i=0; i<3; i++) { if (IsRunning() && FD_ISSET(ToModem[i].GetFD(), &fdset)) { SDSVT dsvt; const ssize_t len = ToModem[i].Read(dsvt.title, 56); if (Rptr.mod[i].defined) ProcessModem(len, dsvt); FD_CLR(ToModem[i].GetFD(), &fdset); } } } // thread clean-up if (APRS_ENABLE) { if (aprs_future.valid()) aprs_future.get(); } for (int i=0; i<2; i++) { if (ii[i] && irc_data_future[i].valid()) irc_data_future[i].get(); } } void CQnetGateway::compute_aprs_hash() { short hash = 0x73e2; char rptr_sign[CALL_SIZE + 1]; strcpy(rptr_sign, OWNER.c_str()); char *p = strchr(rptr_sign, ' '); if (!p) { printf("Failed to build repeater callsign for aprs hash\n"); return; } *p = '\0'; p = rptr_sign; short int len = strlen(rptr_sign); for (short int i=0; i < len; i+=2) { hash ^= (*p++) << 8; hash ^= (*p++); } printf("aprs hash code=[%d] for %s\n", hash, OWNER.c_str()); Rptr.aprs_hash = hash; return; } void CQnetGateway::APRSBeaconThread() { char snd_buf[512]; char rcv_buf[512]; time_t tnow = 0; /* Every 20 seconds, the remote APRS host sends a KEEPALIVE packet-comment on the TCP/APRS port. If we have not received any KEEPALIVE packet-comment after 5 minutes we must assume that the remote APRS host is down or disappeared or has dropped the connection. In these cases, we must re-connect. There are 3 keepalive packets in one minute, or every 20 seconds. In 5 minutes, we should have received a total of 15 keepalive packets. */ short THRESHOLD_COUNTDOWN = 15; time_t last_keepalive_time; time(&last_keepalive_time); time_t last_beacon_time = 0; /* This thread is also saying to the APRS_HOST that we are ALIVE */ while (IsRunning()) { if (aprs->aprs_sock.GetFD() == -1) { aprs->Open(OWNER); if (aprs->aprs_sock.GetFD() == -1) sleep(1); else THRESHOLD_COUNTDOWN = 15; } time(&tnow); if ((tnow - last_beacon_time) > (Rptr.aprs_interval * 60)) { for (short int i=0; i<3; i++) { if (Rptr.mod[i].defined) { float tmp_lat = fabs(Rptr.mod[i].latitude); float tmp_lon = fabs(Rptr.mod[i].longitude); float lat = floor(tmp_lat); float lon = floor(tmp_lon); lat = (tmp_lat - lat) * 60.0F + lat * 100.0F; lon = (tmp_lon - lon) * 60.0F + lon * 100.0F; char lat_s[15], lon_s[15]; if (lat >= 1000.0F) sprintf(lat_s, "%.2f", lat); else if (lat >= 100.0F) sprintf(lat_s, "0%.2f", lat); else if (lat >= 10.0F) sprintf(lat_s, "00%.2f", lat); else sprintf(lat_s, "000%.2f", lat); if (lon >= 10000.0F) sprintf(lon_s, "%.2f", lon); else if (lon >= 1000.0F) sprintf(lon_s, "0%.2f", lon); else if (lon >= 100.0F) sprintf(lon_s, "00%.2f", lon); else if (lon >= 10.0F) sprintf(lon_s, "000%.2f", lon); else sprintf(lon_s, "0000%.2f", lon); /* send to aprs */ sprintf(snd_buf, "%s>APJI23,TCPIP*,qAC,%sS:!%s%cD%s%c&RNG%04u %s %s", Rptr.mod[i].call.c_str(), Rptr.mod[i].call.c_str(), lat_s, (Rptr.mod[i].latitude < 0.0) ? 'S' : 'N', lon_s, (Rptr.mod[i].longitude < 0.0) ? 'W' : 'E', (unsigned int)Rptr.mod[i].range, Rptr.mod[i].band.c_str(), GW_VERSION.c_str()); if (LOG_DEBUG) printf("APRS Beacon =[%s]\n", snd_buf); strcat(snd_buf, "\r\n"); while (IsRunning()) { if (aprs->aprs_sock.GetFD() == -1) { aprs->Open(OWNER); if (aprs->aprs_sock.GetFD() == -1) sleep(1); else THRESHOLD_COUNTDOWN = 15; } else { int rc = aprs->aprs_sock.Write((unsigned char *)snd_buf, strlen(snd_buf)); if (rc < 0) { if ((errno == EPIPE) || (errno == ECONNRESET) || (errno == ETIMEDOUT) || (errno == ECONNABORTED) || (errno == ESHUTDOWN) || (errno == EHOSTUNREACH) || (errno == ENETRESET) || (errno == ENETDOWN) || (errno == ENETUNREACH) || (errno == EHOSTDOWN) || (errno == ENOTCONN)) { printf("send_aprs_beacon: APRS_HOST closed connection,error=%d\n",errno); aprs->aprs_sock.Close(); } else if (errno == EWOULDBLOCK) { std::this_thread::sleep_for(std::chrono::milliseconds(100)); } else { /* Cant do nothing about it */ printf("send_aprs_beacon failed, error=%d\n", errno); break; } } else { // printf("APRS beacon sent\n"); break; } } int rc = aprs->aprs_sock.Read((unsigned char *)rcv_buf, sizeof(rcv_buf)); if (rc > 0) THRESHOLD_COUNTDOWN = 15; } } int rc = aprs->aprs_sock.Read((unsigned char *)rcv_buf, sizeof(rcv_buf)); if (rc > 0) THRESHOLD_COUNTDOWN = 15; } time(&last_beacon_time); } /* Are we still receiving from APRS host ? */ int rc = aprs->aprs_sock.Read((unsigned char *)rcv_buf, sizeof(rcv_buf)); if (rc < 0) { if ((errno == EPIPE) || (errno == ECONNRESET) || (errno == ETIMEDOUT) || (errno == ECONNABORTED) || (errno == ESHUTDOWN) || (errno == EHOSTUNREACH) || (errno == ENETRESET) || (errno == ENETDOWN) || (errno == ENETUNREACH) || (errno == EHOSTDOWN) || (errno == ENOTCONN)) { printf("send_aprs_beacon: recv error: APRS_HOST closed connection,error=%d\n",errno); aprs->aprs_sock.Close(); } } else if (rc == 0) { printf("send_aprs_beacon: recv: APRS shutdown\n"); aprs->aprs_sock.Close(); } else THRESHOLD_COUNTDOWN = 15; std::this_thread::sleep_for(std::chrono::milliseconds(100)); /* 20 seconds passed already ? */ time(&tnow); if ((tnow - last_keepalive_time) > 20) { /* we should be receving keepalive packets ONLY if the connection is alive */ if (aprs->aprs_sock.GetFD() >= 0) { if (THRESHOLD_COUNTDOWN > 0) THRESHOLD_COUNTDOWN--; if (THRESHOLD_COUNTDOWN == 0) { printf("APRS host keepalive timeout\n"); aprs->aprs_sock.Close(); } } /* reset timer */ time(&last_keepalive_time); } } printf("APRS beacon thread exiting...\n"); return; } void CQnetGateway::PlayFileThread(SECHO &edata) { SDSVT dsvt; const unsigned char sdsilence[3] = { 0x16U, 0x29U, 0xF5U }; const unsigned char sdsync[3] = { 0x55U, 0x2DU, 0x16U }; printf("File to playback:[%s]\n", edata.file); struct stat sbuf; if (stat(edata.file, &sbuf)) { fprintf(stderr, "Can't stat %s\n", edata.file); return; } if (sbuf.st_size < 65) { fprintf(stderr, "Error %s file is too small!\n", edata.file); return; } if ((sbuf.st_size - 56) % 9) printf("Warning %s file size of %ld is unexpected!\n", edata.file, sbuf.st_size); int ambeblocks = ((int)sbuf.st_size - 56) / 9; FILE *fp = fopen(edata.file, "rb"); if (!fp) { fprintf(stderr, "Failed to open file %s\n", edata.file); return; } if (1 != fread(dsvt.title, 56, 1, fp)) { fprintf(stderr, "PlayFile Error: Can't read header from %s\n", edata.file); fclose(fp); return; } int mod = dsvt.hdr.rpt1[7] - 'A'; if (! Rptr.mod[mod].defined) { fprintf(stderr, "Module %c is not configured, erasing file %s\n", mod+'A', edata.file); unlink(edata.file); return; } if (mod<0 || mod>2) { fprintf(stderr, "Unknown module suffix '%s'\n", dsvt.hdr.rpt1); return; } sleep(TIMING_PLAY_WAIT); // reformat and send it memcpy(dsvt.hdr.urcall, "CQCQCQ ", 8); calcPFCS(dsvt.title, 56); ToModem[mod].Write(dsvt.title, 56); dsvt.config = 0x20U; for (int i=0; irptrQTH(rptrcall, Rptr.mod[i].latitude, Rptr.mod[i].longitude, Rptr.mod[i].desc1, Rptr.mod[i].desc2, Rptr.mod[i].url, Rptr.mod[i].package_version); if (Rptr.mod[i].frequency) ii[j]->rptrQRG(rptrcall, Rptr.mod[i].frequency, Rptr.mod[i].offset, Rptr.mod[i].range, Rptr.mod[i].agl); } } } return; } bool CQnetGateway::Init(char *cfgfile) { short int i; setvbuf(stdout, (char *)NULL, _IOLBF, 0); /* Used to validate MYCALL input */ preg = std::regex("^(([1-9][A-Z])|([A-PR-Z][0-9])|([A-PR-Z][A-Z][0-9]))[0-9A-Z]*[A-Z][ ]*[ A-RT-Z]$", std::regex::extended); for (i=0; i<3; i++) { band_txt[i].Initialize(); } /* process configuration file */ if ( ReadConfig(cfgfile) ) { printf("Failed to process config file %s\n", cfgfile); return true; } // open database std::string fname(CFG_DIR); fname.append("/qn.db"); if (qnDB.Open(fname.c_str())) return true; qnDB.ClearLH(); // Open unix sockets between qngateway and qnremote printf("Connecting to qnlink at %s\n", tolink.c_str()); if (ToLink.Open(tolink.c_str(), this)) return true; printf("Opening remote port at %s\n", fromremote.c_str()); if (FromRemote.Open(fromremote.c_str())) return true; for (i=0; i<3; i++) { if (Rptr.mod[i].defined) { // open unix sockets between qngateway and each defined modem printf("Connecting to modem at %s\n", tomodem[i].c_str()); if (ToModem[i].Open(tomodem[i].c_str(), this)) return true; } // recording for echotest on local repeater modules recd[i].last_time = 0; recd[i].streamid = 0; recd[i].fd = -1; memset(recd[i].file, 0, sizeof(recd[i].file)); // recording for voicemail on local repeater modules vm[i].last_time = 0; vm[i].streamid = 0; vm[i].fd = -1; memset(vm[i].file, 0, sizeof(vm[i].file)); snprintf(vm[i].file, FILENAME_MAX, "%s/%c_%s", FILE_ECHOTEST.c_str(), 'A'+i, "voicemail.dat2"); if (access(vm[i].file, F_OK) != 0) memset(vm[i].file, 0, sizeof(vm[i].file)); else printf("Loaded voicemail file: %s for mod %d\n", vm[i].file, i); // the repeater modules run on these ports memset(toRptr[i].saved_hdr.title, 0, 56); toRptr[i].last_time = 0; toRptr[i].sequence = 0x0; } playNotInCache = false; /* build the repeater callsigns for aprs */ Rptr.mod[0].call = OWNER; for (i=OWNER.length(); i; i--) if (! isspace(OWNER[i-1])) break; Rptr.mod[0].call.resize(i); Rptr.mod[1].call = Rptr.mod[0].call; Rptr.mod[2].call = Rptr.mod[0].call; Rptr.mod[0].call += "-A"; Rptr.mod[1].call += "-B"; Rptr.mod[2].call += "-C"; Rptr.mod[0].band = "23cm"; Rptr.mod[1].band = "70cm"; Rptr.mod[2].band = "2m"; printf("Repeater callsigns: [%s] [%s] [%s]\n", Rptr.mod[0].call.c_str(), Rptr.mod[1].call.c_str(), Rptr.mod[2].call.c_str()); if (APRS_ENABLE) { aprs = new CAPRS(&Rptr); if (aprs) aprs->Init(); else { printf("aprs class init failed!\nAPRS will be turned off"); APRS_ENABLE = false; } } compute_aprs_hash(); for (int j=0; j<2; j++) { if (ircddb[j].ip.empty()) continue; ii[j] = new CIRCDDB(ircddb[j].ip, ircddb[j].port, owner, IRCDDB_PASSWORD[j], GW_VERSION.c_str()); bool ok = ii[j]->open(); if (!ok) { printf("%s open failed\n", ircddb[j].ip.c_str()); return true; } } for (int j=0; j<2; j++) { if (ircddb[j].ip.empty()) continue; int rc = ii[j]->getConnectionState(); printf("Waiting for %s connection status of 2\n", ircddb[j].ip.c_str()); i = 0; while (rc < 2) { printf("%s status=%d\n", ircddb[j].ip.c_str(), rc); if (rc < 2) { i++; sleep(5); } else break; if (!IsRunning()) break; if (i > 5) { printf("We can not wait any longer for %s...\n", ircddb[j].ip.c_str()); break; } rc = ii[j]->getConnectionState(); } switch (ii[j]->GetFamily()) { case AF_INET: printf("IRC server %s is using IPV4\n", ircddb[j].ip.c_str()); af_family[j] = AF_INET; break; case AF_INET6: printf("IRC server %s is using IPV6\n", ircddb[j].ip.c_str()); af_family[j] = AF_INET6; break; default: printf("%s server is using unknown protocol! Shutting down...\n", ircddb[j].ip.c_str()); return true; } } /* udp port 40000 must open first */ if (ii[0]) { SPORTIP *pip = (AF_INET == af_family[0]) ? &g2_external : & g2_ipv6_external; g2_sock[0] = open_port(pip, af_family[0]); if (0 > g2_sock[0]) { printf("Can't open %s:%d for %s\n", pip->ip.c_str(), pip->port, ircddb[i].ip.c_str()); return true; } if (ii[1] && (af_family[0] != af_family[1])) { // we only need to open a second port if the family for the irc servers are different! SPORTIP *pip = (AF_INET == af_family[1]) ? &g2_external : & g2_ipv6_external; g2_sock[1] = open_port(pip, af_family[1]); if (0 > g2_sock[1]) { printf("Can't open %s:%d for %s\n", pip->ip.c_str(), pip->port, ircddb[1].ip.c_str()); return true; } } } else if (ii[1]) { SPORTIP *pip = (AF_INET == af_family[1]) ? &g2_external : & g2_ipv6_external; g2_sock[1] = open_port(pip, af_family[1]); if (0 > g2_sock[1]) { printf("Can't open %s:%d for %s\n", pip->ip.c_str(), pip->port, ircddb[1].ip.c_str()); return true; } } /* Initialize the end_of_audio that will be sent to the local repeater when audio from remote G2 has timed out */ memset(end_of_audio.title, 0U, 27U); memcpy(end_of_audio.title, "DSVT", 4U); end_of_audio.id = end_of_audio.config = 0x20U; // and the slow data header memcpy(sdheader.title, "DSVT", 4); sdheader.config = 0x10; memset(sdheader.flaga, 0, 3); sdheader.id = 0x10U; sdheader.flagb[0] = 0; sdheader.flagb[1] = sdheader.flagb[2] = 0x1U; sdheader.ctrl = 0x80; /* to remote systems */ for (i = 0; i < 3; i++) { to_remote_g2[i].toDstar.Clear(); to_remote_g2[i].streamid = 0; to_remote_g2[i].last_time = 0; } printf("QnetGateway...entering processing loop\n"); if (GATEWAY_SEND_QRGS_MAP) qrgs_and_maps(); for (int i=0; i<3; i++) { sdin[i].Init(); sdout[i].Init(); } sdin[3].Init(); return false; } CQnetGateway::CQnetGateway() { ii[0] = ii[1] = NULL; } CQnetGateway::~CQnetGateway() { ToLink.Close(); FromRemote.Close(); for (int i=0; i<3; i++) { if (Rptr.mod[i].defined) ToModem[i].Close(); } if (APRS_ENABLE) { if (aprs->aprs_sock.GetFD() != -1) { aprs->aprs_sock.Close(); printf("Closed APRS\n"); } delete aprs; } for (int i=0; i<3; i++) { recd[i].last_time = 0; recd[i].streamid = 0; if (recd[i].fd >= 0) { close(recd[i].fd); unlink(recd[i].file); } } for (int i=0; i<2; i++) { if (g2_sock[i] >= 0) { close(g2_sock[i]); printf("Closed G2_EXTERNAL_PORT %d\n", i); } if (ii[i]) { ii[i]->close(); delete ii[i]; } } printf("QnetGateway exiting\n"); } int main(int argc, char **argv) { printf("VERSION %s\n", GW_VERSION.c_str()); if (argc != 2) { printf("usage: %s qn.cfg\n", argv[0]); return 1; } CQnetGateway QnetGateway; if (QnetGateway.Init(argv[1])) { return 1; } QnetGateway.Process(); printf("Leaving processing loop...\n"); }