dos2unix on eth_udp.c
This commit is contained in:
Raymond.Knopp
@@ -1,483 +1,483 @@
|
|||||||
/*******************************************************************************
|
/*******************************************************************************
|
||||||
OpenAirInterface
|
OpenAirInterface
|
||||||
Copyright(c) 1999 - 2014 Eurecom
|
Copyright(c) 1999 - 2014 Eurecom
|
||||||
|
|
||||||
OpenAirInterface is free software: you can redistribute it and/or modify
|
OpenAirInterface is free software: you can redistribute it and/or modify
|
||||||
it under the terms of the GNU General Public License as published by
|
it under the terms of the GNU General Public License as published by
|
||||||
the Free Software Foundation, either version 3 of the License, or
|
the Free Software Foundation, either version 3 of the License, or
|
||||||
(at your option) any later version.
|
(at your option) any later version.
|
||||||
|
|
||||||
|
|
||||||
OpenAirInterface is distributed in the hope that it will be useful,
|
OpenAirInterface is distributed in the hope that it will be useful,
|
||||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||||
GNU General Public License for more details.
|
GNU General Public License for more details.
|
||||||
|
|
||||||
You should have received a copy of the GNU General Public License
|
You should have received a copy of the GNU General Public License
|
||||||
along with OpenAirInterface.The full GNU General Public License is
|
along with OpenAirInterface.The full GNU General Public License is
|
||||||
included in this distribution in the file called "COPYING". If not,
|
included in this distribution in the file called "COPYING". If not,
|
||||||
see <http://www.gnu.org/licenses/>.
|
see <http://www.gnu.org/licenses/>.
|
||||||
|
|
||||||
Contact Information
|
Contact Information
|
||||||
OpenAirInterface Admin: openair_admin@eurecom.fr
|
OpenAirInterface Admin: openair_admin@eurecom.fr
|
||||||
OpenAirInterface Tech : openair_tech@eurecom.fr
|
OpenAirInterface Tech : openair_tech@eurecom.fr
|
||||||
OpenAirInterface Dev : openair4g-devel@lists.eurecom.fr
|
OpenAirInterface Dev : openair4g-devel@lists.eurecom.fr
|
||||||
|
|
||||||
Address : Eurecom, Campus SophiaTech, 450 Route des Chappes, CS 50193 - 06904 Biot Sophia Antipolis cedex, FRANCE
|
Address : Eurecom, Campus SophiaTech, 450 Route des Chappes, CS 50193 - 06904 Biot Sophia Antipolis cedex, FRANCE
|
||||||
|
|
||||||
*******************************************************************************/
|
*******************************************************************************/
|
||||||
/*! \file ethernet_lib.c
|
/*! \file ethernet_lib.c
|
||||||
* \brief API to stream I/Q samples over standard ethernet
|
* \brief API to stream I/Q samples over standard ethernet
|
||||||
* \author add alcatel Katerina Trilyraki, Navid Nikaein, Pedro Dinis, Lucio Ferreira, Raymond Knopp
|
* \author add alcatel Katerina Trilyraki, Navid Nikaein, Pedro Dinis, Lucio Ferreira, Raymond Knopp
|
||||||
* \date 2015
|
* \date 2015
|
||||||
* \version 0.2
|
* \version 0.2
|
||||||
* \company Eurecom
|
* \company Eurecom
|
||||||
* \maintainer: navid.nikaein@eurecom.fr
|
* \maintainer: navid.nikaein@eurecom.fr
|
||||||
* \note
|
* \note
|
||||||
* \warning
|
* \warning
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <arpa/inet.h>
|
#include <arpa/inet.h>
|
||||||
#include <linux/if_packet.h>
|
#include <linux/if_packet.h>
|
||||||
#include <stdio.h>
|
#include <stdio.h>
|
||||||
#include <string.h>
|
#include <string.h>
|
||||||
#include <stdlib.h>
|
#include <stdlib.h>
|
||||||
#include <sys/ioctl.h>
|
#include <sys/ioctl.h>
|
||||||
#include <sys/socket.h>
|
#include <sys/socket.h>
|
||||||
#include <net/if.h>
|
#include <net/if.h>
|
||||||
#include <netinet/ether.h>
|
#include <netinet/ether.h>
|
||||||
#include <unistd.h>
|
#include <unistd.h>
|
||||||
#include <errno.h>
|
#include <errno.h>
|
||||||
#include "vcd_signal_dumper.h"
|
#include "vcd_signal_dumper.h"
|
||||||
|
|
||||||
#include "common_lib.h"
|
#include "common_lib.h"
|
||||||
#include "ethernet_lib.h"
|
#include "ethernet_lib.h"
|
||||||
|
|
||||||
#define DEBUG 0
|
#define DEBUG 0
|
||||||
//struct sockaddr_in dest_addr[MAX_INST];
|
//struct sockaddr_in dest_addr[MAX_INST];
|
||||||
//struct sockaddr_in local_addr[MAX_INST];
|
//struct sockaddr_in local_addr[MAX_INST];
|
||||||
//int addr_len[MAX_INST];
|
//int addr_len[MAX_INST];
|
||||||
|
|
||||||
|
|
||||||
uint16_t pck_seq_num = 1;
|
uint16_t pck_seq_num = 1;
|
||||||
uint16_t pck_seq_num_cur=0;
|
uint16_t pck_seq_num_cur=0;
|
||||||
uint16_t pck_seq_num_prev=0;
|
uint16_t pck_seq_num_prev=0;
|
||||||
|
|
||||||
int eth_socket_init_udp(openair0_device *device) {
|
int eth_socket_init_udp(openair0_device *device) {
|
||||||
|
|
||||||
eth_state_t *eth = (eth_state_t*)device->priv;
|
eth_state_t *eth = (eth_state_t*)device->priv;
|
||||||
char str_local[INET_ADDRSTRLEN];
|
char str_local[INET_ADDRSTRLEN];
|
||||||
char str_remote[INET_ADDRSTRLEN];
|
char str_remote[INET_ADDRSTRLEN];
|
||||||
const char *local_ip, *remote_ip;
|
const char *local_ip, *remote_ip;
|
||||||
int local_port=0, remote_port=0;
|
int local_port=0, remote_port=0;
|
||||||
int sock_dom=0;
|
int sock_dom=0;
|
||||||
int sock_type=0;
|
int sock_type=0;
|
||||||
int sock_proto=0;
|
int sock_proto=0;
|
||||||
int enable=1;
|
int enable=1;
|
||||||
|
|
||||||
if (device->host_type == RRH_HOST ) {
|
if (device->host_type == RRH_HOST ) {
|
||||||
local_ip = device->openair0_cfg->my_addr;
|
local_ip = device->openair0_cfg->my_addr;
|
||||||
local_port = device->openair0_cfg->my_port;
|
local_port = device->openair0_cfg->my_port;
|
||||||
remote_ip = "0.0.0.0";
|
remote_ip = "0.0.0.0";
|
||||||
remote_port = 0;
|
remote_port = 0;
|
||||||
printf("[%s] local ip addr %s port %d\n", "RRH", local_ip, local_port);
|
printf("[%s] local ip addr %s port %d\n", "RRH", local_ip, local_port);
|
||||||
} else {
|
} else {
|
||||||
local_ip = device->openair0_cfg->my_addr;
|
local_ip = device->openair0_cfg->my_addr;
|
||||||
local_port = device->openair0_cfg->my_port;
|
local_port = device->openair0_cfg->my_port;
|
||||||
remote_ip = device->openair0_cfg->remote_addr;
|
remote_ip = device->openair0_cfg->remote_addr;
|
||||||
remote_port = device->openair0_cfg->remote_port;
|
remote_port = device->openair0_cfg->remote_port;
|
||||||
printf("[%s] local ip addr %s port %d\n","BBU", local_ip, local_port);
|
printf("[%s] local ip addr %s port %d\n","BBU", local_ip, local_port);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Open socket to send on */
|
/* Open socket to send on */
|
||||||
sock_dom=AF_INET;
|
sock_dom=AF_INET;
|
||||||
sock_type=SOCK_DGRAM;
|
sock_type=SOCK_DGRAM;
|
||||||
sock_proto=IPPROTO_UDP;
|
sock_proto=IPPROTO_UDP;
|
||||||
|
|
||||||
if ((eth->sockfd = socket(sock_dom, sock_type, sock_proto)) == -1) {
|
if ((eth->sockfd = socket(sock_dom, sock_type, sock_proto)) == -1) {
|
||||||
perror("ETHERNET: Error opening socket");
|
perror("ETHERNET: Error opening socket");
|
||||||
exit(0);
|
exit(0);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* initialize addresses */
|
/* initialize addresses */
|
||||||
bzero((void *)&(eth->dest_addr), sizeof(eth->dest_addr));
|
bzero((void *)&(eth->dest_addr), sizeof(eth->dest_addr));
|
||||||
bzero((void *)&(eth->local_addr), sizeof(eth->local_addr));
|
bzero((void *)&(eth->local_addr), sizeof(eth->local_addr));
|
||||||
|
|
||||||
|
|
||||||
eth->addr_len = sizeof(struct sockaddr_in);
|
eth->addr_len = sizeof(struct sockaddr_in);
|
||||||
|
|
||||||
eth->dest_addr.sin_family = AF_INET;
|
eth->dest_addr.sin_family = AF_INET;
|
||||||
inet_pton(AF_INET,remote_ip,&(eth->dest_addr.sin_addr.s_addr));
|
inet_pton(AF_INET,remote_ip,&(eth->dest_addr.sin_addr.s_addr));
|
||||||
eth->dest_addr.sin_port=htons(remote_port);
|
eth->dest_addr.sin_port=htons(remote_port);
|
||||||
inet_ntop(AF_INET, &(eth->dest_addr.sin_addr), str_remote, INET_ADDRSTRLEN);
|
inet_ntop(AF_INET, &(eth->dest_addr.sin_addr), str_remote, INET_ADDRSTRLEN);
|
||||||
|
|
||||||
|
|
||||||
eth->local_addr.sin_family = AF_INET;
|
eth->local_addr.sin_family = AF_INET;
|
||||||
inet_pton(AF_INET,local_ip,&(eth->local_addr.sin_addr.s_addr));
|
inet_pton(AF_INET,local_ip,&(eth->local_addr.sin_addr.s_addr));
|
||||||
eth->local_addr.sin_port=htons(local_port);
|
eth->local_addr.sin_port=htons(local_port);
|
||||||
inet_ntop(AF_INET, &(eth->local_addr.sin_addr), str_local, INET_ADDRSTRLEN);
|
inet_ntop(AF_INET, &(eth->local_addr.sin_addr), str_local, INET_ADDRSTRLEN);
|
||||||
|
|
||||||
|
|
||||||
/* set reuse address flag */
|
/* set reuse address flag */
|
||||||
if (setsockopt(eth->sockfd, SOL_SOCKET, SO_REUSEADDR, &enable, sizeof(int))) {
|
if (setsockopt(eth->sockfd, SOL_SOCKET, SO_REUSEADDR, &enable, sizeof(int))) {
|
||||||
perror("ETHERNET: Cannot set SO_REUSEADDR option on socket");
|
perror("ETHERNET: Cannot set SO_REUSEADDR option on socket");
|
||||||
exit(0);
|
exit(0);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* want to receive -> so bind */
|
/* want to receive -> so bind */
|
||||||
if (bind(eth->sockfd,(struct sockaddr *)ð->local_addr,eth->addr_len)<0) {
|
if (bind(eth->sockfd,(struct sockaddr *)ð->local_addr,eth->addr_len)<0) {
|
||||||
perror("ETHERNET: Cannot bind to socket");
|
perror("ETHERNET: Cannot bind to socket");
|
||||||
exit(0);
|
exit(0);
|
||||||
} else {
|
} else {
|
||||||
printf("[%s] binding to %s:%d\n","RRH",str_local,ntohs(eth->local_addr.sin_port));
|
printf("[%s] binding to %s:%d\n","RRH",str_local,ntohs(eth->local_addr.sin_port));
|
||||||
}
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
int trx_eth_read_udp_IF4p5(openair0_device *device, openair0_timestamp *timestamp, void **buff, int nsamps, int cc) {
|
int trx_eth_read_udp_IF4p5(openair0_device *device, openair0_timestamp *timestamp, void **buff, int nsamps, int cc) {
|
||||||
|
|
||||||
// Read nblocks info from packet itself
|
// Read nblocks info from packet itself
|
||||||
int nblocks = nsamps;
|
int nblocks = nsamps;
|
||||||
int bytes_received=-1;
|
int bytes_received=-1;
|
||||||
eth_state_t *eth = (eth_state_t*)device->priv;
|
eth_state_t *eth = (eth_state_t*)device->priv;
|
||||||
|
|
||||||
ssize_t packet_size = sizeof_IF4p5_header_t;
|
ssize_t packet_size = sizeof_IF4p5_header_t;
|
||||||
IF4p5_header_t *test_header = (IF4p5_header_t*)(buff[0]);
|
IF4p5_header_t *test_header = (IF4p5_header_t*)(buff[0]);
|
||||||
|
|
||||||
int block_cnt=0;
|
int block_cnt=0;
|
||||||
int again_cnt=0;
|
int again_cnt=0;
|
||||||
packet_size = max(UDP_IF4p5_PRACH_SIZE_BYTES, max(UDP_IF4p5_PULFFT_SIZE_BYTES(nblocks), UDP_IF4p5_PDLFFT_SIZE_BYTES(nblocks)));
|
packet_size = max(UDP_IF4p5_PRACH_SIZE_BYTES, max(UDP_IF4p5_PULFFT_SIZE_BYTES(nblocks), UDP_IF4p5_PDLFFT_SIZE_BYTES(nblocks)));
|
||||||
|
|
||||||
while(bytes_received == -1) {
|
while(bytes_received == -1) {
|
||||||
again:
|
again:
|
||||||
bytes_received = recvfrom(eth->sockfd,
|
bytes_received = recvfrom(eth->sockfd,
|
||||||
buff[0],
|
buff[0],
|
||||||
packet_size,
|
packet_size,
|
||||||
0,
|
0,
|
||||||
(struct sockaddr *)ð->dest_addr,
|
(struct sockaddr *)ð->dest_addr,
|
||||||
(socklen_t *)ð->addr_len);
|
(socklen_t *)ð->addr_len);
|
||||||
if (bytes_received ==-1) {
|
if (bytes_received ==-1) {
|
||||||
eth->num_rx_errors++;
|
eth->num_rx_errors++;
|
||||||
if (errno == EAGAIN) {
|
if (errno == EAGAIN) {
|
||||||
/*
|
/*
|
||||||
again_cnt++;
|
again_cnt++;
|
||||||
usleep(10);
|
usleep(10);
|
||||||
if (again_cnt == 1000) {
|
if (again_cnt == 1000) {
|
||||||
perror("ETHERNET IF4p5 READ (EAGAIN): ");
|
perror("ETHERNET IF4p5 READ (EAGAIN): ");
|
||||||
exit(-1);
|
exit(-1);
|
||||||
} else {
|
} else {
|
||||||
printf("AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN \n");
|
printf("AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN \n");
|
||||||
goto again;
|
goto again;
|
||||||
}
|
}
|
||||||
*/
|
*/
|
||||||
printf("Lost IF4p5 connection with %s\n", inet_ntoa(eth->dest_addr.sin_addr));
|
printf("Lost IF4p5 connection with %s\n", inet_ntoa(eth->dest_addr.sin_addr));
|
||||||
exit(-1);
|
exit(-1);
|
||||||
} else if (errno == EWOULDBLOCK) {
|
} else if (errno == EWOULDBLOCK) {
|
||||||
block_cnt++;
|
block_cnt++;
|
||||||
usleep(10);
|
usleep(10);
|
||||||
if (block_cnt == 1000) {
|
if (block_cnt == 1000) {
|
||||||
perror("ETHERNET IF4p5 READ (EWOULDBLOCK): ");
|
perror("ETHERNET IF4p5 READ (EWOULDBLOCK): ");
|
||||||
exit(-1);
|
exit(-1);
|
||||||
} else {
|
} else {
|
||||||
printf("BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK \n");
|
printf("BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK \n");
|
||||||
goto again;
|
goto again;
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
perror("ETHERNET IF4p5 READ");
|
perror("ETHERNET IF4p5 READ");
|
||||||
printf("(%s):\n", strerror(errno));
|
printf("(%s):\n", strerror(errno));
|
||||||
exit(-1);
|
exit(-1);
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
*timestamp = test_header->sub_type;
|
*timestamp = test_header->sub_type;
|
||||||
eth->rx_actual_nsamps = bytes_received>>1;
|
eth->rx_actual_nsamps = bytes_received>>1;
|
||||||
eth->rx_count++;
|
eth->rx_count++;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
//printf("size of third %d subtype %d frame %d subframe %d symbol %d \n", bytes_received, test_header->sub_type, ((test_header->frame_status)>>6)&0xffff, ((test_header->frame_status)>>22)&0x000f, ((test_header->frame_status)>>26)&0x000f) ;
|
//printf("size of third %d subtype %d frame %d subframe %d symbol %d \n", bytes_received, test_header->sub_type, ((test_header->frame_status)>>6)&0xffff, ((test_header->frame_status)>>22)&0x000f, ((test_header->frame_status)>>26)&0x000f) ;
|
||||||
|
|
||||||
eth->rx_nsamps = nsamps;
|
eth->rx_nsamps = nsamps;
|
||||||
return(bytes_received);
|
return(bytes_received);
|
||||||
}
|
}
|
||||||
|
|
||||||
int trx_eth_write_udp_IF4p5(openair0_device *device, openair0_timestamp timestamp, void **buff, int nsamps, int cc, int flags) {
|
int trx_eth_write_udp_IF4p5(openair0_device *device, openair0_timestamp timestamp, void **buff, int nsamps, int cc, int flags) {
|
||||||
|
|
||||||
int nblocks = nsamps;
|
int nblocks = nsamps;
|
||||||
int bytes_sent = 0;
|
int bytes_sent = 0;
|
||||||
|
|
||||||
eth_state_t *eth = (eth_state_t*)device->priv;
|
eth_state_t *eth = (eth_state_t*)device->priv;
|
||||||
|
|
||||||
ssize_t packet_size;
|
ssize_t packet_size;
|
||||||
|
|
||||||
if (flags == IF4p5_PDLFFT) {
|
if (flags == IF4p5_PDLFFT) {
|
||||||
packet_size = UDP_IF4p5_PDLFFT_SIZE_BYTES(nblocks);
|
packet_size = UDP_IF4p5_PDLFFT_SIZE_BYTES(nblocks);
|
||||||
} else if (flags == IF4p5_PULFFT) {
|
} else if (flags == IF4p5_PULFFT) {
|
||||||
packet_size = UDP_IF4p5_PULFFT_SIZE_BYTES(nblocks);
|
packet_size = UDP_IF4p5_PULFFT_SIZE_BYTES(nblocks);
|
||||||
} else if (flags == IF4p5_PRACH) {
|
} else if (flags == IF4p5_PRACH) {
|
||||||
packet_size = UDP_IF4p5_PRACH_SIZE_BYTES;
|
packet_size = UDP_IF4p5_PRACH_SIZE_BYTES;
|
||||||
} else {
|
} else {
|
||||||
printf("trx_eth_write_udp_IF4p5: unknown flags %d\n",flags);
|
printf("trx_eth_write_udp_IF4p5: unknown flags %d\n",flags);
|
||||||
return(-1);
|
return(-1);
|
||||||
}
|
}
|
||||||
|
|
||||||
eth->tx_nsamps = nblocks;
|
eth->tx_nsamps = nblocks;
|
||||||
|
|
||||||
bytes_sent = sendto(eth->sockfd,
|
bytes_sent = sendto(eth->sockfd,
|
||||||
buff[0],
|
buff[0],
|
||||||
packet_size,
|
packet_size,
|
||||||
0,
|
0,
|
||||||
(struct sockaddr*)ð->dest_addr,
|
(struct sockaddr*)ð->dest_addr,
|
||||||
eth->addr_len);
|
eth->addr_len);
|
||||||
|
|
||||||
if (bytes_sent == -1) {
|
if (bytes_sent == -1) {
|
||||||
eth->num_tx_errors++;
|
eth->num_tx_errors++;
|
||||||
perror("ETHERNET WRITE: ");
|
perror("ETHERNET WRITE: ");
|
||||||
exit(-1);
|
exit(-1);
|
||||||
} else {
|
} else {
|
||||||
eth->tx_actual_nsamps = bytes_sent>>1;
|
eth->tx_actual_nsamps = bytes_sent>>1;
|
||||||
eth->tx_count++;
|
eth->tx_count++;
|
||||||
}
|
}
|
||||||
|
|
||||||
return (bytes_sent);
|
return (bytes_sent);
|
||||||
}
|
}
|
||||||
|
|
||||||
int trx_eth_write_udp(openair0_device *device, openair0_timestamp timestamp, void **buff, int nsamps,int cc, int flags) {
|
int trx_eth_write_udp(openair0_device *device, openair0_timestamp timestamp, void **buff, int nsamps,int cc, int flags) {
|
||||||
|
|
||||||
int bytes_sent=0;
|
int bytes_sent=0;
|
||||||
eth_state_t *eth = (eth_state_t*)device->priv;
|
eth_state_t *eth = (eth_state_t*)device->priv;
|
||||||
int sendto_flag =0;
|
int sendto_flag =0;
|
||||||
int i=0;
|
int i=0;
|
||||||
//sendto_flag|=flags;
|
//sendto_flag|=flags;
|
||||||
eth->tx_nsamps=nsamps;
|
eth->tx_nsamps=nsamps;
|
||||||
|
|
||||||
for (i=0;i<cc;i++) {
|
for (i=0;i<cc;i++) {
|
||||||
/* buff[i] points to the position in tx buffer where the payload to be sent is
|
/* buff[i] points to the position in tx buffer where the payload to be sent is
|
||||||
buff2 points to the position in tx buffer where the packet header will be placed */
|
buff2 points to the position in tx buffer where the packet header will be placed */
|
||||||
void *buff2 = (void*)(buff[i]- APP_HEADER_SIZE_BYTES);
|
void *buff2 = (void*)(buff[i]- APP_HEADER_SIZE_BYTES);
|
||||||
|
|
||||||
/* we don't want to ovewrite with the header info the previous tx buffer data so we store it*/
|
/* we don't want to ovewrite with the header info the previous tx buffer data so we store it*/
|
||||||
int32_t temp0 = *(int32_t *)buff2;
|
int32_t temp0 = *(int32_t *)buff2;
|
||||||
openair0_timestamp temp1 = *(openair0_timestamp *)(buff2 + sizeof(int32_t));
|
openair0_timestamp temp1 = *(openair0_timestamp *)(buff2 + sizeof(int32_t));
|
||||||
|
|
||||||
bytes_sent = 0;
|
bytes_sent = 0;
|
||||||
|
|
||||||
/* constract application header */
|
/* constract application header */
|
||||||
// eth->pck_header.seq_num = pck_seq_num;
|
// eth->pck_header.seq_num = pck_seq_num;
|
||||||
//eth->pck_header.antenna_id = 1+(i<<1);
|
//eth->pck_header.antenna_id = 1+(i<<1);
|
||||||
//eth->pck_header.timestamp = timestamp;
|
//eth->pck_header.timestamp = timestamp;
|
||||||
*(uint16_t *)buff2 = pck_seq_num;
|
*(uint16_t *)buff2 = pck_seq_num;
|
||||||
*(uint16_t *)(buff2 + sizeof(uint16_t)) = 1+(i<<1);
|
*(uint16_t *)(buff2 + sizeof(uint16_t)) = 1+(i<<1);
|
||||||
*(openair0_timestamp *)(buff2 + sizeof(int32_t)) = timestamp;
|
*(openair0_timestamp *)(buff2 + sizeof(int32_t)) = timestamp;
|
||||||
VCD_SIGNAL_DUMPER_DUMP_VARIABLE_BY_NAME( VCD_SIGNAL_DUMPER_VARIABLES_TX_SEQ_NUM, pck_seq_num);
|
VCD_SIGNAL_DUMPER_DUMP_VARIABLE_BY_NAME( VCD_SIGNAL_DUMPER_VARIABLES_TX_SEQ_NUM, pck_seq_num);
|
||||||
|
|
||||||
while(bytes_sent < UDP_PACKET_SIZE_BYTES(nsamps)) {
|
while(bytes_sent < UDP_PACKET_SIZE_BYTES(nsamps)) {
|
||||||
#if DEBUG
|
#if DEBUG
|
||||||
printf("------- TX ------: buff2 current position=%d remaining_bytes=%d bytes_sent=%d \n",
|
printf("------- TX ------: buff2 current position=%d remaining_bytes=%d bytes_sent=%d \n",
|
||||||
(void *)(buff2+bytes_sent),
|
(void *)(buff2+bytes_sent),
|
||||||
UDP_PACKET_SIZE_BYTES(nsamps) - bytes_sent,
|
UDP_PACKET_SIZE_BYTES(nsamps) - bytes_sent,
|
||||||
bytes_sent);
|
bytes_sent);
|
||||||
#endif
|
#endif
|
||||||
/* Send packet */
|
/* Send packet */
|
||||||
bytes_sent += sendto(eth->sockfd,
|
bytes_sent += sendto(eth->sockfd,
|
||||||
buff2,
|
buff2,
|
||||||
UDP_PACKET_SIZE_BYTES(nsamps),
|
UDP_PACKET_SIZE_BYTES(nsamps),
|
||||||
sendto_flag,
|
sendto_flag,
|
||||||
(struct sockaddr*)ð->dest_addr,
|
(struct sockaddr*)ð->dest_addr,
|
||||||
eth->addr_len);
|
eth->addr_len);
|
||||||
|
|
||||||
if ( bytes_sent == -1) {
|
if ( bytes_sent == -1) {
|
||||||
eth->num_tx_errors++;
|
eth->num_tx_errors++;
|
||||||
perror("ETHERNET WRITE: ");
|
perror("ETHERNET WRITE: ");
|
||||||
exit(-1);
|
exit(-1);
|
||||||
} else {
|
} else {
|
||||||
#if DEBUG
|
#if DEBUG
|
||||||
printf("------- TX ------: nu=%d an_id=%d ts%d bytes_send=%d\n",
|
printf("------- TX ------: nu=%d an_id=%d ts%d bytes_send=%d\n",
|
||||||
*(int16_t *)buff2,
|
*(int16_t *)buff2,
|
||||||
*(int16_t *)(buff2 + sizeof(int16_t)),
|
*(int16_t *)(buff2 + sizeof(int16_t)),
|
||||||
*(openair0_timestamp *)(buff2 + sizeof(int32_t)),
|
*(openair0_timestamp *)(buff2 + sizeof(int32_t)),
|
||||||
bytes_sent);
|
bytes_sent);
|
||||||
dump_packet((device->host_type == BBU_HOST)? "BBU":"RRH", buff2, UDP_PACKET_SIZE_BYTES(nsamps), TX_FLAG);
|
dump_packet((device->host_type == BBU_HOST)? "BBU":"RRH", buff2, UDP_PACKET_SIZE_BYTES(nsamps), TX_FLAG);
|
||||||
#endif
|
#endif
|
||||||
eth->tx_actual_nsamps=bytes_sent>>2;
|
eth->tx_actual_nsamps=bytes_sent>>2;
|
||||||
eth->tx_count++;
|
eth->tx_count++;
|
||||||
pck_seq_num++;
|
pck_seq_num++;
|
||||||
if ( pck_seq_num > MAX_PACKET_SEQ_NUM(nsamps,device->openair0_cfg->samples_per_frame) ) pck_seq_num = 1;
|
if ( pck_seq_num > MAX_PACKET_SEQ_NUM(nsamps,device->openair0_cfg->samples_per_frame) ) pck_seq_num = 1;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
/* tx buffer values restored */
|
/* tx buffer values restored */
|
||||||
*(int32_t *)buff2 = temp0;
|
*(int32_t *)buff2 = temp0;
|
||||||
*(openair0_timestamp *)(buff2 + sizeof(int32_t)) = temp1;
|
*(openair0_timestamp *)(buff2 + sizeof(int32_t)) = temp1;
|
||||||
}
|
}
|
||||||
|
|
||||||
return (bytes_sent-APP_HEADER_SIZE_BYTES)>>2;
|
return (bytes_sent-APP_HEADER_SIZE_BYTES)>>2;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
int trx_eth_read_udp(openair0_device *device, openair0_timestamp *timestamp, void **buff, int nsamps, int cc) {
|
int trx_eth_read_udp(openair0_device *device, openair0_timestamp *timestamp, void **buff, int nsamps, int cc) {
|
||||||
|
|
||||||
int bytes_received=0;
|
int bytes_received=0;
|
||||||
eth_state_t *eth = (eth_state_t*)device->priv;
|
eth_state_t *eth = (eth_state_t*)device->priv;
|
||||||
// openair0_timestamp prev_timestamp = -1;
|
// openair0_timestamp prev_timestamp = -1;
|
||||||
int rcvfrom_flag =0;
|
int rcvfrom_flag =0;
|
||||||
int block_cnt=0;
|
int block_cnt=0;
|
||||||
int again_cnt=0;
|
int again_cnt=0;
|
||||||
int i=0;
|
int i=0;
|
||||||
|
|
||||||
eth->rx_nsamps=nsamps;
|
eth->rx_nsamps=nsamps;
|
||||||
|
|
||||||
for (i=0;i<cc;i++) {
|
for (i=0;i<cc;i++) {
|
||||||
/* buff[i] points to the position in rx buffer where the payload to be received will be placed
|
/* buff[i] points to the position in rx buffer where the payload to be received will be placed
|
||||||
buff2 points to the position in rx buffer where the packet header will be placed */
|
buff2 points to the position in rx buffer where the packet header will be placed */
|
||||||
void *buff2 = (void*)(buff[i]- APP_HEADER_SIZE_BYTES);
|
void *buff2 = (void*)(buff[i]- APP_HEADER_SIZE_BYTES);
|
||||||
|
|
||||||
/* we don't want to ovewrite with the header info the previous rx buffer data so we store it*/
|
/* we don't want to ovewrite with the header info the previous rx buffer data so we store it*/
|
||||||
int32_t temp0 = *(int32_t *)buff2;
|
int32_t temp0 = *(int32_t *)buff2;
|
||||||
openair0_timestamp temp1 = *(openair0_timestamp *)(buff2 + sizeof(int32_t));
|
openair0_timestamp temp1 = *(openair0_timestamp *)(buff2 + sizeof(int32_t));
|
||||||
|
|
||||||
bytes_received=0;
|
bytes_received=0;
|
||||||
block_cnt=0;
|
block_cnt=0;
|
||||||
|
|
||||||
|
|
||||||
while(bytes_received < UDP_PACKET_SIZE_BYTES(nsamps)) {
|
while(bytes_received < UDP_PACKET_SIZE_BYTES(nsamps)) {
|
||||||
again:
|
again:
|
||||||
#if DEBUG
|
#if DEBUG
|
||||||
printf("------- RX------: buff2 current position=%d remaining_bytes=%d bytes_recv=%d \n",
|
printf("------- RX------: buff2 current position=%d remaining_bytes=%d bytes_recv=%d \n",
|
||||||
(void *)(buff2+bytes_received),
|
(void *)(buff2+bytes_received),
|
||||||
UDP_PACKET_SIZE_BYTES(nsamps) - bytes_received,
|
UDP_PACKET_SIZE_BYTES(nsamps) - bytes_received,
|
||||||
bytes_received);
|
bytes_received);
|
||||||
#endif
|
#endif
|
||||||
bytes_received +=recvfrom(eth->sockfd,
|
bytes_received +=recvfrom(eth->sockfd,
|
||||||
buff2,
|
buff2,
|
||||||
UDP_PACKET_SIZE_BYTES(nsamps),
|
UDP_PACKET_SIZE_BYTES(nsamps),
|
||||||
rcvfrom_flag,
|
rcvfrom_flag,
|
||||||
(struct sockaddr *)ð->dest_addr,
|
(struct sockaddr *)ð->dest_addr,
|
||||||
(socklen_t *)ð->addr_len);
|
(socklen_t *)ð->addr_len);
|
||||||
|
|
||||||
if (bytes_received ==-1) {
|
if (bytes_received ==-1) {
|
||||||
eth->num_rx_errors++;
|
eth->num_rx_errors++;
|
||||||
if (errno == EAGAIN) {
|
if (errno == EAGAIN) {
|
||||||
again_cnt++;
|
again_cnt++;
|
||||||
usleep(10);
|
usleep(10);
|
||||||
if (again_cnt == 1000) {
|
if (again_cnt == 1000) {
|
||||||
perror("ETHERNET READ: ");
|
perror("ETHERNET READ: ");
|
||||||
exit(-1);
|
exit(-1);
|
||||||
} else {
|
} else {
|
||||||
printf("AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN \n");
|
printf("AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN AGAIN \n");
|
||||||
goto again;
|
goto again;
|
||||||
}
|
}
|
||||||
} else if (errno == EWOULDBLOCK) {
|
} else if (errno == EWOULDBLOCK) {
|
||||||
block_cnt++;
|
block_cnt++;
|
||||||
usleep(10);
|
usleep(10);
|
||||||
if (block_cnt == 1000) {
|
if (block_cnt == 1000) {
|
||||||
perror("ETHERNET READ: ");
|
perror("ETHERNET READ: ");
|
||||||
exit(-1);
|
exit(-1);
|
||||||
} else {
|
} else {
|
||||||
printf("BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK \n");
|
printf("BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK BLOCK \n");
|
||||||
goto again;
|
goto again;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
#if DEBUG
|
#if DEBUG
|
||||||
printf("------- RX------: nu=%d an_id=%d ts%d bytes_recv=%d\n",
|
printf("------- RX------: nu=%d an_id=%d ts%d bytes_recv=%d\n",
|
||||||
*(int16_t *)buff2,
|
*(int16_t *)buff2,
|
||||||
*(int16_t *)(buff2 + sizeof(int16_t)),
|
*(int16_t *)(buff2 + sizeof(int16_t)),
|
||||||
*(openair0_timestamp *)(buff2 + sizeof(int32_t)),
|
*(openair0_timestamp *)(buff2 + sizeof(int32_t)),
|
||||||
bytes_received);
|
bytes_received);
|
||||||
dump_packet((device->host_type == BBU_HOST)? "BBU":"RRH", buff2, UDP_PACKET_SIZE_BYTES(nsamps),RX_FLAG);
|
dump_packet((device->host_type == BBU_HOST)? "BBU":"RRH", buff2, UDP_PACKET_SIZE_BYTES(nsamps),RX_FLAG);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
/* store the timestamp value from packet's header */
|
/* store the timestamp value from packet's header */
|
||||||
*timestamp = *(openair0_timestamp *)(buff2 + sizeof(int32_t));
|
*timestamp = *(openair0_timestamp *)(buff2 + sizeof(int32_t));
|
||||||
/* store the sequence number of the previous packet received */
|
/* store the sequence number of the previous packet received */
|
||||||
if (pck_seq_num_cur == 0) {
|
if (pck_seq_num_cur == 0) {
|
||||||
pck_seq_num_prev = *(uint16_t *)buff2;
|
pck_seq_num_prev = *(uint16_t *)buff2;
|
||||||
} else {
|
} else {
|
||||||
pck_seq_num_prev = pck_seq_num_cur;
|
pck_seq_num_prev = pck_seq_num_cur;
|
||||||
}
|
}
|
||||||
/* get the packet sequence number from packet's header */
|
/* get the packet sequence number from packet's header */
|
||||||
pck_seq_num_cur = *(uint16_t *)buff2;
|
pck_seq_num_cur = *(uint16_t *)buff2;
|
||||||
//printf("cur=%d prev=%d buff=%d\n",pck_seq_num_cur,pck_seq_num_prev,*(uint16_t *)(buff2));
|
//printf("cur=%d prev=%d buff=%d\n",pck_seq_num_cur,pck_seq_num_prev,*(uint16_t *)(buff2));
|
||||||
if ( ( pck_seq_num_cur != (pck_seq_num_prev + 1) ) && !((pck_seq_num_prev==MAX_PACKET_SEQ_NUM(nsamps,device->openair0_cfg->samples_per_frame)) && (pck_seq_num_cur==1 )) && !((pck_seq_num_prev==1) && (pck_seq_num_cur==1))) {
|
if ( ( pck_seq_num_cur != (pck_seq_num_prev + 1) ) && !((pck_seq_num_prev==MAX_PACKET_SEQ_NUM(nsamps,device->openair0_cfg->samples_per_frame)) && (pck_seq_num_cur==1 )) && !((pck_seq_num_prev==1) && (pck_seq_num_cur==1))) {
|
||||||
printf("out of order packet received1! %d|%d|%d\n",pck_seq_num_cur,pck_seq_num_prev,(int)*timestamp);
|
printf("out of order packet received1! %d|%d|%d\n",pck_seq_num_cur,pck_seq_num_prev,(int)*timestamp);
|
||||||
}
|
}
|
||||||
VCD_SIGNAL_DUMPER_DUMP_VARIABLE_BY_NAME( VCD_SIGNAL_DUMPER_VARIABLES_RX_SEQ_NUM,pck_seq_num_cur);
|
VCD_SIGNAL_DUMPER_DUMP_VARIABLE_BY_NAME( VCD_SIGNAL_DUMPER_VARIABLES_RX_SEQ_NUM,pck_seq_num_cur);
|
||||||
VCD_SIGNAL_DUMPER_DUMP_VARIABLE_BY_NAME( VCD_SIGNAL_DUMPER_VARIABLES_RX_SEQ_NUM_PRV,pck_seq_num_prev);
|
VCD_SIGNAL_DUMPER_DUMP_VARIABLE_BY_NAME( VCD_SIGNAL_DUMPER_VARIABLES_RX_SEQ_NUM_PRV,pck_seq_num_prev);
|
||||||
eth->rx_actual_nsamps=bytes_received>>2;
|
eth->rx_actual_nsamps=bytes_received>>2;
|
||||||
eth->rx_count++;
|
eth->rx_count++;
|
||||||
}
|
}
|
||||||
|
|
||||||
}
|
}
|
||||||
/* tx buffer values restored */
|
/* tx buffer values restored */
|
||||||
*(int32_t *)buff2 = temp0;
|
*(int32_t *)buff2 = temp0;
|
||||||
*(openair0_timestamp *)(buff2 + sizeof(int32_t)) = temp1;
|
*(openair0_timestamp *)(buff2 + sizeof(int32_t)) = temp1;
|
||||||
|
|
||||||
}
|
}
|
||||||
return (bytes_received-APP_HEADER_SIZE_BYTES)>>2;
|
return (bytes_received-APP_HEADER_SIZE_BYTES)>>2;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
int eth_set_dev_conf_udp(openair0_device *device) {
|
int eth_set_dev_conf_udp(openair0_device *device) {
|
||||||
|
|
||||||
eth_state_t *eth = (eth_state_t*)device->priv;
|
eth_state_t *eth = (eth_state_t*)device->priv;
|
||||||
void *msg;
|
void *msg;
|
||||||
ssize_t msg_len;
|
ssize_t msg_len;
|
||||||
|
|
||||||
|
|
||||||
/* a BBU client sents to RRH a set of configuration parameters (openair0_config_t)
|
/* a BBU client sents to RRH a set of configuration parameters (openair0_config_t)
|
||||||
so that RF front end is configured appropriately and
|
so that RF front end is configured appropriately and
|
||||||
frame/packet size etc. can be set */
|
frame/packet size etc. can be set */
|
||||||
|
|
||||||
msg=malloc(sizeof(openair0_config_t));
|
msg=malloc(sizeof(openair0_config_t));
|
||||||
msg_len=sizeof(openair0_config_t);
|
msg_len=sizeof(openair0_config_t);
|
||||||
memcpy(msg,(void*)device->openair0_cfg,msg_len);
|
memcpy(msg,(void*)device->openair0_cfg,msg_len);
|
||||||
|
|
||||||
if (sendto(eth->sockfd,msg,msg_len,0,(struct sockaddr *)ð->dest_addr,eth->addr_len)==-1) {
|
if (sendto(eth->sockfd,msg,msg_len,0,(struct sockaddr *)ð->dest_addr,eth->addr_len)==-1) {
|
||||||
perror("ETHERNET: sendto conf_udp");
|
perror("ETHERNET: sendto conf_udp");
|
||||||
printf("addr_len : %d, msg_len %d\n",eth->addr_len,msg_len);
|
printf("addr_len : %d, msg_len %d\n",eth->addr_len,msg_len);
|
||||||
exit(0);
|
exit(0);
|
||||||
}
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
int eth_get_dev_conf_udp(openair0_device *device) {
|
int eth_get_dev_conf_udp(openair0_device *device) {
|
||||||
|
|
||||||
eth_state_t *eth = (eth_state_t*)device->priv;
|
eth_state_t *eth = (eth_state_t*)device->priv;
|
||||||
char str1[INET_ADDRSTRLEN],str[INET_ADDRSTRLEN];
|
char str1[INET_ADDRSTRLEN],str[INET_ADDRSTRLEN];
|
||||||
void *msg;
|
void *msg;
|
||||||
ssize_t msg_len;
|
ssize_t msg_len;
|
||||||
|
|
||||||
msg=malloc(sizeof(openair0_config_t));
|
msg=malloc(sizeof(openair0_config_t));
|
||||||
msg_len=sizeof(openair0_config_t);
|
msg_len=sizeof(openair0_config_t);
|
||||||
|
|
||||||
inet_ntop(AF_INET, &(eth->local_addr.sin_addr), str, INET_ADDRSTRLEN);
|
inet_ntop(AF_INET, &(eth->local_addr.sin_addr), str, INET_ADDRSTRLEN);
|
||||||
inet_ntop(AF_INET, &(eth->dest_addr.sin_addr), str1, INET_ADDRSTRLEN);
|
inet_ntop(AF_INET, &(eth->dest_addr.sin_addr), str1, INET_ADDRSTRLEN);
|
||||||
|
|
||||||
/* RRH receives from BBU openair0_config_t */
|
/* RRH receives from BBU openair0_config_t */
|
||||||
if (recvfrom(eth->sockfd,
|
if (recvfrom(eth->sockfd,
|
||||||
msg,
|
msg,
|
||||||
msg_len,
|
msg_len,
|
||||||
0,
|
0,
|
||||||
(struct sockaddr *)ð->dest_addr,
|
(struct sockaddr *)ð->dest_addr,
|
||||||
(socklen_t *)ð->addr_len)==-1) {
|
(socklen_t *)ð->addr_len)==-1) {
|
||||||
perror("ETHERNET: recv_from conf_udp");
|
perror("ETHERNET: recv_from conf_udp");
|
||||||
exit(0);
|
exit(0);
|
||||||
}
|
}
|
||||||
device->openair0_cfg=(openair0_config_t *)msg;
|
device->openair0_cfg=(openair0_config_t *)msg;
|
||||||
|
|
||||||
/* get remote ip address and port */
|
/* get remote ip address and port */
|
||||||
/* inet_ntop(AF_INET, &(eth->dest_addr.sin_addr), str1, INET_ADDRSTRLEN); */
|
/* inet_ntop(AF_INET, &(eth->dest_addr.sin_addr), str1, INET_ADDRSTRLEN); */
|
||||||
/* device->openair0_cfg->remote_port =ntohs(eth->dest_addr.sin_port); */
|
/* device->openair0_cfg->remote_port =ntohs(eth->dest_addr.sin_port); */
|
||||||
/* device->openair0_cfg->remote_addr =str1; */
|
/* device->openair0_cfg->remote_addr =str1; */
|
||||||
|
|
||||||
/* /\* restore local ip address and port *\/ */
|
/* /\* restore local ip address and port *\/ */
|
||||||
/* inet_ntop(AF_INET, &(eth->local_addr.sin_addr), str, INET_ADDRSTRLEN); */
|
/* inet_ntop(AF_INET, &(eth->local_addr.sin_addr), str, INET_ADDRSTRLEN); */
|
||||||
/* device->openair0_cfg->my_port =ntohs(eth->local_addr.sin_port); */
|
/* device->openair0_cfg->my_port =ntohs(eth->local_addr.sin_port); */
|
||||||
/* device->openair0_cfg->my_addr =str; */
|
/* device->openair0_cfg->my_addr =str; */
|
||||||
|
|
||||||
/* printf("[RRH] mod_%d socket %d connected to BBU %s:%d %s:%d\n", Mod_id, eth->sockfd,str1, device->openair0_cfg->remote_port, str, device->openair0_cfg->my_port); */
|
/* printf("[RRH] mod_%d socket %d connected to BBU %s:%d %s:%d\n", Mod_id, eth->sockfd,str1, device->openair0_cfg->remote_port, str, device->openair0_cfg->my_port); */
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user