void* new_protocol_thread(void* arg) {
struct sockaddr_in addr;
int length;
unsigned char buffer[2048];
int bytesread;
short sourceport;
fprintf(stderr,"new_protocol_thread: receiver=%d\n", receiver);
micsamples=0;
iqindex=4;
fprintf(stderr,"outputsamples=%d\n", outputsamples);
data_socket=socket(PF_INET,SOCK_DGRAM,IPPROTO_UDP);
if(data_socket<0) {
fprintf(stderr,"metis: create socket failed for data_socket: receiver=%d\n",receiver);
exit(-1);
}
int optval = 1;
setsockopt(data_socket, SOL_SOCKET, SO_REUSEADDR, &optval, sizeof(optval));
// bind to the interface
if(bind(data_socket,(struct sockaddr*)&radio->info.network.interface_address,radio->info.network.interface_length)<0) {
fprintf(stderr,"metis: bind socket failed for data_socket: receiver=%d\n",receiver);
exit(-1);
}
memcpy(&base_addr,&radio->info.network.address,radio->info.network.address_length);
base_addr_length=radio->info.network.address_length;
base_addr.sin_port=htons(GENERAL_REGISTERS_FROM_HOST_PORT);
memcpy(&receiver_addr,&radio->info.network.address,radio->info.network.address_length);
receiver_addr_length=radio->info.network.address_length;
receiver_addr.sin_port=htons(RECEIVER_SPECIFIC_REGISTERS_FROM_HOST_PORT);
memcpy(&transmitter_addr,&radio->info.network.address,radio->info.network.address_length);
transmitter_addr_length=radio->info.network.address_length;
transmitter_addr.sin_port=htons(TRANSMITTER_SPECIFIC_REGISTERS_FROM_HOST_PORT);
memcpy(&high_priority_addr,&radio->info.network.address,radio->info.network.address_length);
high_priority_addr_length=radio->info.network.address_length;
high_priority_addr.sin_port=htons(HIGH_PRIORITY_FROM_HOST_PORT);
memcpy(&audio_addr,&radio->info.network.address,radio->info.network.address_length);
audio_addr_length=radio->info.network.address_length;
audio_addr.sin_port=htons(AUDIO_FROM_HOST_PORT);
memcpy(&iq_addr,&radio->info.network.address,radio->info.network.address_length);
iq_addr_length=radio->info.network.address_length;
iq_addr.sin_port=htons(TX_IQ_FROM_HOST_PORT);
memcpy(&data_addr,&radio->info.network.address,radio->info.network.address_length);
data_addr_length=radio->info.network.address_length;
data_addr.sin_port=htons(RX_IQ_TO_HOST_PORT+receiver);
samples=0;
audioindex=4; // leave space for sequence
audiosequence=0L;
new_protocol_general();
new_protocol_start();
new_protocol_high_priority(1);
while(running) {
bytesread=recvfrom(data_socket,buffer,sizeof(buffer),0,(struct sockaddr*)&addr,&length);
if(bytesread<0) {
fprintf(stderr,"recvfrom socket failed for new_protocol_thread: receiver=%d", receiver);
exit(1);
}
short sourceport=ntohs(addr.sin_port);
//fprintf(stderr,"received packet length %d from port %d\n",bytesread,sourceport);
switch(sourceport) {
case RX_IQ_TO_HOST_PORT:
process_iq_data(buffer);
break;
case COMMAND_RESPONCE_TO_HOST_PORT:
process_command_response(buffer);
break;
case HIGH_PRIORITY_TO_HOST_PORT:
process_high_priority(buffer);
break;
case MIC_LINE_TO_HOST_PORT:
if(!local_microphone) {
process_mic_data(buffer);
}
break;
default:
break;
}
if(running) {
sem_wait(&send_general_sem);
if(send_general==1) {
new_protocol_general();
send_general=0;
}
sem_post(&send_general_sem);
sem_wait(&send_high_priority_sem);
if(send_high_priority==1) {
new_protocol_high_priority(1);
send_high_priority=0;
}
sem_post(&send_high_priority_sem);
}
}
close(data_socket);
}
void* new_protocol_thread(void* arg) {
DISCOVERED* d=&discovered[selected_device];
struct sockaddr_in addr;
int length;
unsigned char buffer[2048];
int bytesread;
short sourceport;
long sequence;
long long timestamp;
int bitspersample;
int samplesperframe;
int b;
int leftsample;
int rightsample;
float leftsamplefloat;
float rightsamplefloat;
int previous_ptt;
int previous_dot;
int previous_dash;
int samples;
//float leftinputbuffer[BUFFER_SIZE];
//float rightinputbuffer[BUFFER_SIZE];
double iqinputbuffer[BUFFER_SIZE*2];
int outputsamples;
//float leftoutputbuffer[BUFFER_SIZE];
//float rightoutputbuffer[BUFFER_SIZE];
double audiooutputbuffer[BUFFER_SIZE*2];
short leftaudiosample;
short rightaudiosample;
long audiosequence;
unsigned char audiobuffer[1444];
int audioindex;
int micsample;
float micsamplefloat;
int micsamples;
/*
float micleftinputbuffer[BUFFER_SIZE]; // 48000
float micrightinputbuffer[BUFFER_SIZE];
*/
double micinputbuffer[BUFFER_SIZE*2];
int micoutputsamples;
/*
float micleftoutputbuffer[BUFFER_SIZE*4]; // 192000
float micrightoutputbuffer[BUFFER_SIZE*4];
*/
double micoutputbuffer[BUFFER_SIZE*4*2];
double gain;
int isample;
int qsample;
long tx_iq_sequence;
unsigned char iqbuffer[1444];
int iqindex;
int i, j;
fprintf(stderr,"new_protocol_thread: receiver=%d\n", receiver);
micsamples=0;
iqindex=4;
switch(sample_rate) {
case 48000:
outputsamples=BUFFER_SIZE;
break;
case 96000:
outputsamples=BUFFER_SIZE/2;
break;
case 192000:
outputsamples=BUFFER_SIZE/4;
break;
case 384000:
outputsamples=BUFFER_SIZE/8;
break;
case 768000:
outputsamples=BUFFER_SIZE/16;
break;
case 1536000:
outputsamples=BUFFER_SIZE/32;
break;
}
micoutputsamples=BUFFER_SIZE*4; // 48000 in, 192000 out
fprintf(stderr,"outputsamples=%d\n", outputsamples);
data_socket=socket(PF_INET,SOCK_DGRAM,IPPROTO_UDP);
if(data_socket<0) {
fprintf(stderr,"metis: create socket failed for data_socket: receiver=%d\n",receiver);
exit(-1);
}
int optval = 1;
setsockopt(data_socket, SOL_SOCKET, SO_REUSEADDR, &optval, sizeof(optval));
// bind to the interface
if(bind(data_socket,(struct sockaddr*)&d->interface_address,d->interface_length)<0) {
fprintf(stderr,"metis: bind socket failed for data_socket: receiver=%d\n",receiver);
exit(-1);
}
memcpy(&base_addr,&d->address,d->address_length);
base_addr_length=d->address_length;
base_addr.sin_port=htons(GENERAL_REGISTERS_FROM_HOST_PORT);
memcpy(&receiver_addr,&d->address,d->address_length);
receiver_addr_length=d->address_length;
receiver_addr.sin_port=htons(RECEIVER_SPECIFIC_REGISTERS_FROM_HOST_PORT);
memcpy(&transmitter_addr,&d->address,d->address_length);
transmitter_addr_length=d->address_length;
transmitter_addr.sin_port=htons(TRANSMITTER_SPECIFIC_REGISTERS_FROM_HOST_PORT);
memcpy(&high_priority_addr,&d->address,d->address_length);
high_priority_addr_length=d->address_length;
high_priority_addr.sin_port=htons(HIGH_PRIORITY_FROM_HOST_PORT);
memcpy(&audio_addr,&d->address,d->address_length);
audio_addr_length=d->address_length;
audio_addr.sin_port=htons(AUDIO_FROM_HOST_PORT);
memcpy(&iq_addr,&d->address,d->address_length);
iq_addr_length=d->address_length;
iq_addr.sin_port=htons(TX_IQ_FROM_HOST_PORT);
memcpy(&data_addr,&d->address,d->address_length);
data_addr_length=d->address_length;
data_addr.sin_port=htons(RX_IQ_TO_HOST_PORT+receiver);
samples=0;
audioindex=4; // leave space for sequence
audiosequence=0L;
new_protocol_general();
new_protocol_start();
new_protocol_high_priority(1,0,drive);
while(running) {
bytesread=recvfrom(data_socket,buffer,sizeof(buffer),0,(struct sockaddr*)&addr,&length);
if(bytesread<0) {
fprintf(stderr,"recvfrom socket failed for new_protocol_thread: receiver=%d", receiver);
exit(1);
}
short sourceport=ntohs(addr.sin_port);
//fprintf(stderr,"received packet length %d from port %d\n",bytesread,sourceport);
if(sourceport==RX_IQ_TO_HOST_PORT) {
sequence=((buffer[0]&0xFF)<<24)+((buffer[1]&0xFF)<<16)+((buffer[2]&0xFF)<<8)+(buffer[3]&0xFF);
timestamp=((long long)(buffer[4]&0xFF)<<56)+((long long)(buffer[5]&0xFF)<<48)+((long long)(buffer[6]&0xFF)<<40)+((long long)(buffer[7]&0xFF)<<32);
((long long)(buffer[8]&0xFF)<<24)+((long long)(buffer[9]&0xFF)<<16)+((long long)(buffer[10]&0xFF)<<8)+(long long)(buffer[11]&0xFF);
bitspersample=((buffer[12]&0xFF)<<8)+(buffer[13]&0xFF);
samplesperframe=((buffer[14]&0xFF)<<8)+(buffer[15]&0xFF);
//fprintf(stderr,"samples per frame %d\n",samplesperframe);
if(!isTransmitting()) {
b=16;
for(i=0; i<samplesperframe; i++) {
leftsample = (int)((signed char) buffer[b++]) << 16;
leftsample += (int)((unsigned char)buffer[b++]) << 8;
leftsample += (int)((unsigned char)buffer[b++]);
rightsample = (int)((signed char) buffer[b++]) << 16;
rightsample += (int)((unsigned char)buffer[b++]) << 8;
rightsample += (int)((unsigned char)buffer[b++]);
leftsamplefloat=(float)leftsample/8388607.0; // for 24 bits
rightsamplefloat=(float)rightsample/8388607.0; // for 24 bits
//leftinputbuffer[samples]=leftsamplefloat;
//rightinputbuffer[samples]=rightsamplefloat;
iqinputbuffer[samples*2]=(double)leftsamplefloat;
iqinputbuffer[(samples*2)+1]=(double)rightsamplefloat;
samples++;
if(samples==BUFFER_SIZE) {
int error;
fexchange0(CHANNEL_RX0+receiver, iqinputbuffer, audiooutputbuffer, &error);
if(error!=0) {
fprintf(stderr,"fexchange0 returned error: %d for receiver %d\n", error,receiver);
}
Spectrum0(1, CHANNEL_RX0+receiver, 0, 0, iqinputbuffer);
for(j=0; j<outputsamples; j++) {
leftaudiosample=(short)(audiooutputbuffer[j*2]*32767.0*volume);
rightaudiosample=(short)(audiooutputbuffer[(j*2)+1]*32767.0*volume);
audiobuffer[audioindex++]=leftaudiosample>>8;
audiobuffer[audioindex++]=leftaudiosample;
audiobuffer[audioindex++]=rightaudiosample>>8;
audiobuffer[audioindex++]=rightaudiosample;
if(audioindex>=sizeof(audiobuffer)) {
// insert the sequence
audiobuffer[0]=audiosequence>>24;
audiobuffer[1]=audiosequence>>16;
audiobuffer[2]=audiosequence>>8;
audiobuffer[3]=audiosequence;
// send the buffer
if(sendto(data_socket,audiobuffer,sizeof(audiobuffer),0,(struct sockaddr*)&audio_addr,audio_addr_length)<0) {
fprintf(stderr,"sendto socket failed for audio\n");
exit(1);
}
audioindex=4;
audiosequence++;
}
}
samples=0;
}
}