KB8PMY
/
QnetGateway
mirror of https://github.com/n7tae/QnetGateway.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

future in g2_link

Browse Source
pull/1/head
Tom Early 9 years ago
parent 43bcf25e03
commit 430ae8efa9
1 changed files with 122 additions and 158 deletions
Show Stats Download Patch File Download Diff File

274
g2_link.cpp
Unescape View File

@ -44,7 +44,8 @@
#include <arpa/inet.h> #include <arpa/inet.h>
#include <netdb.h> #include <netdb.h>
#include <pthread.h> #include <future>
#include <exception>
#include <atomic> #include <atomic>
/* Required for Binary search trees using C++ STL */ /* Required for Binary search trees using C++ STL */
#include <string> #include <string>
@ -285,8 +286,8 @@ static bool resolve_rmt(char *name, int type, struct sockaddr_in *addr);
static void audio_notify(char *notify_msg); static void audio_notify(char *notify_msg);
static void rptr_ack(short i); static void rptr_ack(short i);
static void *audio_notify_run(void *arg); static void AudioNotifyThread(char *arg);
static void *rptr_ack_run(void *arg); static void RptrAckThread(char *arg);
static bool resolve_rmt(char *name, int type, struct sockaddr_in *addr) static bool resolve_rmt(char *name, int type, struct sockaddr_in *addr)
{ {
@ -352,9 +353,6 @@ static void send_heartbeat()
static void rptr_ack(short i) static void rptr_ack(short i)
{ {
pthread_t rptr_ack_thread;
pthread_attr_t attr;
int rc = 0;
static char mod_and_RADIO_ID[3][22]; static char mod_and_RADIO_ID[3][22];
struct tm tmp; struct tm tmp;
@ -391,21 +389,21 @@ static void rptr_ack(short i)
} }
} }
pthread_attr_init(&attr); std::future<void> ackthread;
pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED); try {
rc = pthread_create(&rptr_ack_thread, &attr, rptr_ack_run, (void *)(mod_and_RADIO_ID[i])); ackthread = std::async(std::launch::async, RptrAckThread, mod_and_RADIO_ID[i]);
if (rc != 0) } catch (const std::exception &e) {
traceit("failed to start rptr_ack thread for mod %c\n", mod_and_RADIO_ID[i][0]); traceit("Failed to launch RptrAckThread(). Exception: %s\n", e.what());
pthread_attr_destroy(&attr); }
return; return;
} }
static void *rptr_ack_run(void *arg) static void RptrAckThread(char *arg)
{ {
char from_mod = *((char *)arg); char from_mod = arg[0];
char RADIO_ID[21]; char RADIO_ID[21];
memcpy(RADIO_ID, (char *)arg + 1, 21); memcpy(RADIO_ID, arg + 1, 21);
unsigned char rptr_ack[56]; unsigned char buf[56];
struct timespec nanos; struct timespec nanos;
unsigned int aseed; unsigned int aseed;
time_t tnow = 0; time_t tnow = 0;
@ -417,154 +415,126 @@ static void *rptr_ack_run(void *arg)
act.sa_flags = SA_RESTART; act.sa_flags = SA_RESTART;
if (sigaction(SIGTERM, &act, 0) != 0) { if (sigaction(SIGTERM, &act, 0) != 0) {
traceit("sigaction-TERM failed, error=%d\n", errno); traceit("sigaction-TERM failed, error=%d\n", errno);
traceit("rptr_ack thread exiting...\n"); return;
pthread_exit(NULL);
} }
if (sigaction(SIGINT, &act, 0) != 0) { if (sigaction(SIGINT, &act, 0) != 0) {
traceit("sigaction-INT failed, error=%d\n", errno); traceit("sigaction-INT failed, error=%d\n", errno);
traceit("rptr_ack thread exiting...\n"); return;
pthread_exit(NULL);
} }
time(&tnow); time(&tnow);
aseed = tnow + pthread_self(); aseed = tnow + pthread_self();
u_int16_t streamid_raw = (::rand_r(&aseed) % 65535U) + 1U; u_int16_t streamid_raw = (::rand_r(&aseed) % 65535U) + 1U;
sleep(delay_before); sleep(delay_before);
traceit("sending ACK+text, mod:[%c], RADIO_ID=[%s]\n", from_mod, RADIO_ID); traceit("sending ACK+text, mod:[%c], RADIO_ID=[%s]\n", from_mod, RADIO_ID);
memcpy(rptr_ack,"DSVT", 4); memcpy(buf,"DSVT", 4);
rptr_ack[4] = 0x10; buf[4] = 0x10;
rptr_ack[5] = 0x00; buf[5] = 0x00;
rptr_ack[6] = 0x00; buf[6] = 0x00;
rptr_ack[7] = 0x00; buf[7] = 0x00;
rptr_ack[8] = 0x20; buf[8] = 0x20;
rptr_ack[9] = 0x00; buf[9] = 0x00;
rptr_ack[10] = 0x01; buf[10] = 0x01;
rptr_ack[11] = 0x00; buf[11] = 0x00;
rptr_ack[12] = streamid_raw / 256U; buf[12] = streamid_raw / 256U;
rptr_ack[13] = streamid_raw % 256U; buf[13] = streamid_raw % 256U;
rptr_ack[14] = 0x80; buf[14] = 0x80;
rptr_ack[15] = 0x01; /* we do not want to set this to 0x01 */ buf[15] = 0x01; /* we do not want to set this to 0x01 */
rptr_ack[16] = 0x00; buf[16] = 0x00;
rptr_ack[17] = 0x00; buf[17] = 0x00;
memcpy(rptr_ack + 18, owner.c_str(), CALL_SIZE); memcpy(buf + 18, owner.c_str(), CALL_SIZE);
rptr_ack[25] = from_mod; buf[25] = from_mod;
memcpy(rptr_ack + 26, owner.c_str(), CALL_SIZE); memcpy(buf + 26, owner.c_str(), CALL_SIZE);
rptr_ack[33] = 'G'; buf[33] = 'G';
memcpy(rptr_ack + 34, "CQCQCQ ", CALL_SIZE); memcpy(buf + 34, "CQCQCQ ", CALL_SIZE);
memcpy(rptr_ack + 42, owner.c_str(), CALL_SIZE); memcpy(buf + 42, owner.c_str(), CALL_SIZE);
rptr_ack[49] = from_mod; buf[49] = from_mod;
memcpy(rptr_ack + 50, "RPTR", 4); memcpy(buf + 50, "RPTR", 4);
calcPFCS(rptr_ack,56); calcPFCS(buf,56);
(void)sendto(rptr_sock,(char *)rptr_ack,56,0,(struct sockaddr *)&toLocalg2,sizeof(toLocalg2)); (void)sendto(rptr_sock, (char *)buf, 56, 0, (struct sockaddr *)&toLocalg2,sizeof(toLocalg2));
nanos.tv_sec = 0; nanos.tv_sec = 0;
nanos.tv_nsec = delay_between * 1000000; nanos.tv_nsec = delay_between * 1000000;
nanosleep(&nanos,0); nanosleep(&nanos,0);
rptr_ack[4] = 0x20; buf[4] = 0x20;
memcpy((char *)rptr_ack + 15, silence, 9); memcpy((char *)rptr_ack + 15, silence, 9);
/* start sending silence + announcement text */ /* start sending silence + announcement text */
for (int i=0; i<10; i++) {
rptr_ack[14] = 0x00; buf[14] = i;
rptr_ack[24] = 0x55; switch (i) {
rptr_ack[25] = 0x2d; case 0:
rptr_ack[26] = 0x16; buf[24] = 0x55;
(void)sendto(rptr_sock,(char *)rptr_ack,27,0,(struct sockaddr *)&toLocalg2,sizeof(toLocalg2)); buf[25] = 0x2d;
nanos.tv_sec = 0; buf[26] = 0x16;
nanos.tv_nsec = delay_between * 1000000; break;
nanosleep(&nanos,0); case 1:
buf[24] = '@' ^ 0x70;
rptr_ack[14] = 0x01; buf[25] = RADIO_ID[0] ^ 0x4f;
rptr_ack[24] = '@' ^ 0x70; buf[26] = RADIO_ID[1] ^ 0x93;
rptr_ack[25] = RADIO_ID[0] ^ 0x4f; break;
rptr_ack[26] = RADIO_ID[1] ^ 0x93; case 2:
(void)sendto(rptr_sock,(char *)rptr_ack,27,0,(struct sockaddr *)&toLocalg2,sizeof(toLocalg2)); buf[24] = RADIO_ID[2] ^ 0x70;
nanos.tv_sec = 0; buf[25] = RADIO_ID[3] ^ 0x4f;
nanos.tv_nsec = delay_between * 1000000; buf[26] = RADIO_ID[4] ^ 0x93;
nanosleep(&nanos,0); break;
case 3:
rptr_ack[14] = 0x02; buf[24] = 'A' ^ 0x70;
rptr_ack[24] = RADIO_ID[2] ^ 0x70; buf[25] = RADIO_ID[5] ^ 0x4f;
rptr_ack[25] = RADIO_ID[3] ^ 0x4f; buf[26] = RADIO_ID[6] ^ 0x93;
rptr_ack[26] = RADIO_ID[4] ^ 0x93; break;
(void)sendto(rptr_sock,(char *)rptr_ack,27,0,(struct sockaddr *)&toLocalg2,sizeof(toLocalg2)); case 4:
nanos.tv_sec = 0; buf[24] = RADIO_ID[7] ^ 0x70;
nanos.tv_nsec = delay_between * 1000000; buf[25] = RADIO_ID[8] ^ 0x4f;
nanosleep(&nanos,0); buf[26] = RADIO_ID[9] ^ 0x93;
break;
rptr_ack[14] = 0x03; case 5:
rptr_ack[24] = 'A' ^ 0x70; buf[24] = 'B' ^ 0x70;
rptr_ack[25] = RADIO_ID[5] ^ 0x4f; buf[25] = RADIO_ID[10] ^ 0x4f;
rptr_ack[26] = RADIO_ID[6] ^ 0x93; buf[26] = RADIO_ID[11] ^ 0x93;
(void)sendto(rptr_sock,(char *)rptr_ack,27,0,(struct sockaddr *)&toLocalg2,sizeof(toLocalg2)); break;
nanos.tv_sec = 0; case 6:
nanos.tv_nsec = delay_between * 1000000; buf[24] = RADIO_ID[12] ^ 0x70;
nanosleep(&nanos,0); buf[25] = RADIO_ID[13] ^ 0x4f;
buf[26] = RADIO_ID[14] ^ 0x93;
rptr_ack[14] = 0x04; break;
rptr_ack[24] = RADIO_ID[7] ^ 0x70; case 7:
rptr_ack[25] = RADIO_ID[8] ^ 0x4f; buf[24] = 'C' ^ 0x70;
rptr_ack[26] = RADIO_ID[9] ^ 0x93; buf[25] = RADIO_ID[15] ^ 0x4f;
(void)sendto(rptr_sock,(char *)rptr_ack,27,0,(struct sockaddr *)&toLocalg2,sizeof(toLocalg2)); buf[26] = RADIO_ID[16] ^ 0x93;
nanos.tv_sec = 0; break;
nanos.tv_nsec = delay_between * 1000000; case 8:
nanosleep(&nanos,0); buf[24] = RADIO_ID[17] ^ 0x70;
buf[25] = RADIO_ID[18] ^ 0x4f;
rptr_ack[14] = 0x05; buf[26] = RADIO_ID[19] ^ 0x93;
rptr_ack[24] = 'B' ^ 0x70; break;
rptr_ack[25] = RADIO_ID[10] ^ 0x4f; case 9:
rptr_ack[26] = RADIO_ID[11] ^ 0x93; buf[14] |= 0x40;
(void)sendto(rptr_sock,(char *)rptr_ack,27,0,(struct sockaddr *)&toLocalg2,sizeof(toLocalg2)); memset(buf + 15, 0, 9);
nanos.tv_sec = 0; buf[24] = 0x70;
nanos.tv_nsec = delay_between * 1000000; buf[25] = 0x4f;
nanosleep(&nanos,0); buf[26] = 0x93;
break;
rptr_ack[14] = 0x06; }
rptr_ack[24] = RADIO_ID[12] ^ 0x70; (void)sendto(rptr_sock, (char *)buf, 27, 0, (struct sockaddr *)&toLocalg2,sizeof(toLocalg2));
rptr_ack[25] = RADIO_ID[13] ^ 0x4f; if (i < 9) {
rptr_ack[26] = RADIO_ID[14] ^ 0x93;
(void)sendto(rptr_sock,(char *)rptr_ack,27,0,(struct sockaddr *)&toLocalg2,sizeof(toLocalg2));
nanos.tv_sec = 0;
nanos.tv_nsec = delay_between * 1000000;
nanosleep(&nanos,0);
rptr_ack[14] = 0x07;
rptr_ack[24] = 'C' ^ 0x70;
rptr_ack[25] = RADIO_ID[15] ^ 0x4f;
rptr_ack[26] = RADIO_ID[16] ^ 0x93;
(void)sendto(rptr_sock,(char *)rptr_ack,27,0,(struct sockaddr *)&toLocalg2,sizeof(toLocalg2));
nanos.tv_sec = 0;
nanos.tv_nsec = delay_between * 1000000;
nanosleep(&nanos,0);
rptr_ack[14] = 0x08;
rptr_ack[24] = RADIO_ID[17] ^ 0x70;
rptr_ack[25] = RADIO_ID[18] ^ 0x4f;
rptr_ack[26] = RADIO_ID[19] ^ 0x93;
(void)sendto(rptr_sock,(char *)rptr_ack,27,0,(struct sockaddr *)&toLocalg2,sizeof(toLocalg2));
nanos.tv_sec = 0; nanos.tv_sec = 0;
nanos.tv_nsec = delay_between * 1000000; nanos.tv_nsec = delay_between * 1000000;
nanosleep(&nanos,0); nanosleep(&nanos,0);
}
rptr_ack[14] = 0x09 | 0x40; }
memset((char *)rptr_ack + 15, 0, 9);
rptr_ack[24] = 0x70;
rptr_ack[25] = 0x4f;
rptr_ack[26] = 0x93;
(void)sendto(rptr_sock,(char *)rptr_ack,27,0,(struct sockaddr *)&toLocalg2,sizeof(toLocalg2));
traceit("finished sending ACK+text to mod:[%c]\n", from_mod); traceit("finished sending ACK+text to mod:[%c]\n", from_mod);
pthread_exit(NULL); return;
} }
static void print_status_file() static void print_status_file()
@ -4099,24 +4069,20 @@ void audio_notify(char *msg)
strcpy(notify_msg[i], msg); strcpy(notify_msg[i], msg);
int rc = 0; std::future<void> thread;
pthread_t audio_notify_thread; try {
pthread_attr_t attr; thread = std::async(std::launch::async, AudioNotifyThread, notify_msg[i]);
} catch (const std::exception &e) {
pthread_attr_init(&attr); traceit("failed to start AudioAckThread(). Exception: %s\n", e.what());
pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED); }
rc = pthread_create(&audio_notify_thread, &attr, audio_notify_run, (void *)(notify_msg[i]));
if (rc != 0)
traceit("failed to start audio_notify thread for mod %c\n", *msg);
pthread_attr_destroy(&attr);
return; return;
} }
static void *audio_notify_run(void *arg) static void AudioNotifyThread(char *arg)
{ {
char notify_msg[64]; char notify_msg[64];
strcpy(notify_msg, (char *)arg); strcpy(notify_msg, arg);
unsigned short rlen = 0; unsigned short rlen = 0;
size_t nread = 0; size_t nread = 0;
@ -4143,13 +4109,11 @@ static void *audio_notify_run(void *arg)
act.sa_flags = SA_RESTART; act.sa_flags = SA_RESTART;
if (sigaction(SIGTERM, &act, 0) != 0) { if (sigaction(SIGTERM, &act, 0) != 0) {
traceit("sigaction-TERM failed, error=%d\n", errno); traceit("sigaction-TERM failed, error=%d\n", errno);
traceit("audio_notify thread exiting...\n"); return;
pthread_exit(NULL);
} }
if (sigaction(SIGINT, &act, 0) != 0) { if (sigaction(SIGINT, &act, 0) != 0) {
traceit("sigaction-INT failed, error=%d\n", errno); traceit("sigaction-INT failed, error=%d\n", errno);
traceit("audio_notify thread exiting...\n"); return;
pthread_exit(NULL);
} }
memset(RADIO_ID, ' ', 20); memset(RADIO_ID, ' ', 20);
@ -4159,13 +4123,13 @@ static void *audio_notify_run(void *arg)
if ((mod != 'A') && (mod != 'B') && (mod != 'C')) { if ((mod != 'A') && (mod != 'B') && (mod != 'C')) {
traceit("Invalid module %c in %s\n", mod, notify_msg); traceit("Invalid module %c in %s\n", mod, notify_msg);
pthread_exit(NULL); return;
} }
p = strstr(notify_msg, ".dat"); p = strstr(notify_msg, ".dat");
if (!p) { if (!p) {
traceit("Incorrect filename in %s\n", notify_msg); traceit("Incorrect filename in %s\n", notify_msg);
pthread_exit(NULL); return;
} }
if (p[4] == '_') { if (p[4] == '_') {
@ -4190,7 +4154,7 @@ static void *audio_notify_run(void *arg)
fp = fopen(temp_file, "rb"); fp = fopen(temp_file, "rb");
if (!fp) { if (!fp) {
traceit("Failed to open file %s for reading\n", temp_file); traceit("Failed to open file %s for reading\n", temp_file);
pthread_exit(NULL); return;
} }
/* stupid DVTOOL + 4 byte num_of_records */ /* stupid DVTOOL + 4 byte num_of_records */
@ -4198,12 +4162,12 @@ static void *audio_notify_run(void *arg)
if (nread != 1) { if (nread != 1) {
traceit("Cant read first 10 bytes from %s\n", temp_file); traceit("Cant read first 10 bytes from %s\n", temp_file);
fclose(fp); fclose(fp);
pthread_exit(NULL); return;
} }
if (memcmp(dstar_buf, "DVTOOL", 6) != 0) { if (memcmp(dstar_buf, "DVTOOL", 6) != 0) {
traceit("DVTOOL keyword not found in %s\n", temp_file); traceit("DVTOOL keyword not found in %s\n", temp_file);
fclose(fp); fclose(fp);
pthread_exit(NULL); return;
} }
time(&tnow); time(&tnow);
@ -4319,7 +4283,7 @@ static void *audio_notify_run(void *arg)
} }
fclose(fp); fclose(fp);
traceit("finished sending File to mod:[%c]\n", mod); traceit("finished sending File to mod:[%c]\n", mod);
pthread_exit(NULL); return;
} }
int main(int argc, char **argv) int main(int argc, char **argv)

Write Preview
Loading…
Cancel
Save

Powered by TurnKey Linux.