if5_tools.c 6.86 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45
/*******************************************************************************
    OpenAirInterface
    Copyright(c) 1999 - 2014 Eurecom

    OpenAirInterface 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 3 of the License, or
    (at your option) any later version.


    OpenAirInterface 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 OpenAirInterface.The full GNU General Public License is
   included in this distribution in the file called "COPYING". If not,
   see <http://www.gnu.org/licenses/>.

  Contact Information
  OpenAirInterface Admin: openair_admin@eurecom.fr
  OpenAirInterface Tech : openair_tech@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

 *******************************************************************************/

/*! \file PHY/LTE_TRANSPORT/if5_tools.c
* \brief 
* \author S. Sandeep Kumar, Raymond Knopp
* \date 2016
* \version 0.1
* \company Eurecom
* \email: ee13b1025@iith.ac.in, knopp@eurecom.fr 
* \note
* \warning
*/

#include "PHY/defs.h"

#include "targets/ARCH/ETHERNET/USERSPACE/LIB/if_defs.h"


Sandeep Kumar's avatar
Sandeep Kumar committed
46
void send_IF5(PHY_VARS_eNB *eNB, openair0_timestamp proc_timestamp, int subframe, uint8_t *seqno, uint16_t packet_type) {      
47 48
  
  LTE_DL_FRAME_PARMS *fp=&eNB->frame_parms;
49 50
  int32_t *txp[fp->nb_antennas_tx], *rxp[fp->nb_antennas_rx]; 
  int32_t *tx_buffer=NULL;
51 52

  uint16_t packet_id=0, i=0;
Sandeep Kumar's avatar
Sandeep Kumar committed
53 54 55

  uint32_t spp_eth  = (uint32_t) eNB->ifdevice.openair0_cfg->samples_per_packet;
  uint32_t spsf     = (uint32_t) eNB->ifdevice.openair0_cfg->samples_per_frame/10;
56
  
Sandeep Kumar's avatar
Sandeep Kumar committed
57 58
  if (packet_type == IF5_RRH_GW_DL) {    

59
    for (i=0; i < fp->nb_antennas_tx; i++)
Sandeep Kumar's avatar
Sandeep Kumar committed
60
      txp[i] = (void*)&eNB->common_vars.txdata[0][i][subframe*fp->samples_per_tti];
61 62
    
    for (packet_id=0; packet_id < spsf / spp_eth; packet_id++) {
Sandeep Kumar's avatar
Sandeep Kumar committed
63
          
64
      eNB->ifdevice.trx_write_func(&eNB->ifdevice,
Sandeep Kumar's avatar
Sandeep Kumar committed
65
                                   (proc_timestamp + packet_id*spp_eth),
Sandeep Kumar's avatar
Sandeep Kumar committed
66
                                   txp,
67 68 69
                                   spp_eth,
                                   fp->nb_antennas_tx,
                                   0);
Sandeep Kumar's avatar
Sandeep Kumar committed
70 71 72 73

      for (i=0; i < fp->nb_antennas_tx; i++)
        txp[i] += spp_eth;

74 75
    }
    
Sandeep Kumar's avatar
Sandeep Kumar committed
76
  } else if (packet_type == IF5_RRH_GW_UL) {
Sandeep Kumar's avatar
Sandeep Kumar committed
77
        
Sandeep Kumar's avatar
Sandeep Kumar committed
78 79 80 81
    for (i=0; i < fp->nb_antennas_rx; i++)
      rxp[i] = (void*)&eNB->common_vars.rxdata[0][i][subframe*fp->samples_per_tti];
    
    for (packet_id=0; packet_id < spsf / spp_eth; packet_id++) {
Sandeep Kumar's avatar
Sandeep Kumar committed
82

Sandeep Kumar's avatar
Sandeep Kumar committed
83 84
      eNB->ifdevice.trx_write_func(&eNB->ifdevice,
                                   (proc_timestamp + packet_id*spp_eth),
Sandeep Kumar's avatar
Sandeep Kumar committed
85
                                   rxp,
Sandeep Kumar's avatar
Sandeep Kumar committed
86 87 88
                                   spp_eth,
                                   fp->nb_antennas_rx,
                                   0);
Sandeep Kumar's avatar
Sandeep Kumar committed
89 90 91 92

      for (i=0; i < fp->nb_antennas_rx; i++)
        rxp[i] += spp_eth;

Sandeep Kumar's avatar
Sandeep Kumar committed
93
    }    
94
    
Sandeep Kumar's avatar
Sandeep Kumar committed
95
  } else if (packet_type == IF5_MOBIPASS) {    
96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112
    uint16_t db_fulllength=640;
    
    __m128i *data_block=NULL, *data_block_head=NULL;

    __m128i *txp128;
    __m128i t0, t1;

    tx_buffer = memalign(16, MAC_HEADER_SIZE_BYTES + sizeof_IF5_mobipass_header_t + db_fulllength*sizeof(int16_t));
    IF5_mobipass_header_t *header = (IF5_mobipass_header_t *)(tx_buffer + MAC_HEADER_SIZE_BYTES);
    data_block_head = (__m128i *)(tx_buffer + MAC_HEADER_SIZE_BYTES + sizeof_IF5_mobipass_header_t + 4);
    
    header->flags = 0;
    header->fifo_status = 0;  
    header->seqno = *seqno;
    header->ack = 0;
    header->word0 = 0;  
    
Sandeep Kumar's avatar
Sandeep Kumar committed
113
    txp[0] = (void*)&eNB->common_vars.txdata[0][0][subframe*eNB->frame_parms.samples_per_tti];
114 115 116
    txp128 = (__m128i *) txp[0];
              
    for (packet_id=0; packet_id<(fp->samples_per_tti*2)/db_fulllength; packet_id++) {
Sandeep Kumar's avatar
Sandeep Kumar committed
117
      header->time_stamp = proc_timestamp + packet_id*db_fulllength; 
118 119 120
      data_block = data_block_head; 
    
      for (i=0; i<db_fulllength>>3; i+=2) {
121 122
        t0 = _mm_srai_epi16(*txp128++, 4);
        t1 = _mm_srai_epi16(*txp128++, 4);   
123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139
        
        *data_block++ = _mm_packs_epi16(t0, t1);     
      }
      
      // Write the packet to the fronthaul
      if ((eNB->ifdevice.trx_write_func(&eNB->ifdevice,
                                        packet_id,
                                        &tx_buffer,
                                        db_fulllength,
                                        1,
                                        IF5_MOBIPASS)) < 0) {
        perror("ETHERNET write for IF5_MOBIPASS\n");
      }
    
      header->seqno += 1;    
    }  
    *seqno = header->seqno;
Sandeep Kumar's avatar
Sandeep Kumar committed
140
    
141 142 143 144 145 146 147 148 149
  } else {    
    AssertFatal(1==0, "send_IF5 - Unknown packet_type %x", packet_type);     
  }  
  
  free(tx_buffer);
  return;  		    
}


Sandeep Kumar's avatar
Sandeep Kumar committed
150
void recv_IF5(PHY_VARS_eNB *eNB, openair0_timestamp *proc_timestamp, int subframe, uint16_t packet_type) {
151 152

  LTE_DL_FRAME_PARMS *fp=&eNB->frame_parms;
153 154
  int32_t *txp[fp->nb_antennas_tx], *rxp[fp->nb_antennas_rx]; 

155
  uint16_t packet_id=0, i=0;
Sandeep Kumar's avatar
Sandeep Kumar committed
156 157 158 159 160

  int32_t spp_eth  = (int32_t) eNB->ifdevice.openair0_cfg->samples_per_packet;
  int32_t spsf     = (int32_t) eNB->ifdevice.openair0_cfg->samples_per_frame/10;

  openair0_timestamp timestamp[spsf / spp_eth];
161
  
Sandeep Kumar's avatar
Sandeep Kumar committed
162
  if (packet_type == IF5_RRH_GW_DL) {
Sandeep Kumar's avatar
Sandeep Kumar committed
163
        
Sandeep Kumar's avatar
Sandeep Kumar committed
164 165
    for (i=0; i < fp->nb_antennas_tx; i++)
      txp[i] = (void*)&eNB->common_vars.txdata[0][i][subframe*fp->samples_per_tti];
166 167
    
    for (packet_id=0; packet_id < spsf / spp_eth; packet_id++) {
Sandeep Kumar's avatar
Sandeep Kumar committed
168

169 170
      eNB->ifdevice.trx_read_func(&eNB->ifdevice,
                                  &timestamp[packet_id],
Sandeep Kumar's avatar
Sandeep Kumar committed
171
                                  txp,
172
                                  spp_eth,
Sandeep Kumar's avatar
Sandeep Kumar committed
173
                                  fp->nb_antennas_tx);
Sandeep Kumar's avatar
Sandeep Kumar committed
174 175 176 177

      for (i=0; i < fp->nb_antennas_tx; i++)
        txp[i] += spp_eth;

178 179
    }
    
Sandeep Kumar's avatar
Sandeep Kumar committed
180 181
    *proc_timestamp = timestamp[0];
    
Sandeep Kumar's avatar
Sandeep Kumar committed
182
  } else if (packet_type == IF5_RRH_GW_UL) { 
Sandeep Kumar's avatar
Sandeep Kumar committed
183 184 185
    
    for (i=0; i < fp->nb_antennas_rx; i++)
      rxp[i] = (void*)&eNB->common_vars.rxdata[0][i][subframe*fp->samples_per_tti];
186
    
Sandeep Kumar's avatar
Sandeep Kumar committed
187
    for (packet_id=0; packet_id < spsf / spp_eth; packet_id++) {
Sandeep Kumar's avatar
Sandeep Kumar committed
188

Sandeep Kumar's avatar
Sandeep Kumar committed
189 190
      eNB->ifdevice.trx_read_func(&eNB->ifdevice,
                                  &timestamp[packet_id],
Sandeep Kumar's avatar
Sandeep Kumar committed
191
                                  rxp,
Sandeep Kumar's avatar
Sandeep Kumar committed
192 193
                                  spp_eth,
                                  fp->nb_antennas_rx);
Sandeep Kumar's avatar
Sandeep Kumar committed
194 195 196 197

      for (i=0; i < fp->nb_antennas_rx; i++)
        rxp[i] += spp_eth;

Sandeep Kumar's avatar
Sandeep Kumar committed
198 199 200 201
    }

    *proc_timestamp = timestamp[0];
      
202 203 204 205 206 207 208 209 210
  } else if (packet_type == IF5_MOBIPASS) {
    
    
  } else {
    AssertFatal(1==0, "recv_IF5 - Unknown packet_type %x", packet_type);     
  }  
  
  return;  
}