if4_tools.c 12.6 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
/*******************************************************************************
    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/if4_tools.c
* \brief 
32
* \author S. Sandeep Kumar, Raymond Knopp
33 34 35
* \date 2016
* \version 0.1
* \company Eurecom
36
* \email: ee13b1025@iith.ac.in, knopp@eurecom.fr 
37 38 39 40
* \note
* \warning
*/

41
#include "PHY/defs.h"
42
#include "PHY/TOOLS/alaw_lut.h"
43

44 45
//#include "targets/ARCH/ETHERNET/USERSPACE/LIB/if_defs.h"
#include "targets/ARCH/ETHERNET/USERSPACE/LIB/ethernet_lib.h"
46
#include "UTIL/LOG/vcd_signal_dumper.h"
47

48
void send_IF4p5(PHY_VARS_eNB *eNB, int frame, int subframe, uint16_t packet_type, int k) {
49 50
  LTE_DL_FRAME_PARMS *fp = &eNB->frame_parms;
  int32_t **txdataF = eNB->common_vars.txdataF[0];
51
  int32_t **rxdataF = eNB->common_vars.rxdataF[0];
52
  int16_t **rxsigF = eNB->prach_vars.rxsigF;  
53
  void *tx_buffer = eNB->ifbuffer.tx;
54
      
55
  uint16_t symbol_id=0, element_id=0;
56
  uint16_t db_fulllength, db_halflength; 
57
  int slotoffsetF=0, blockoffsetF=0; 
58

59
  uint16_t *data_block=NULL, *i=NULL;
60

61 62 63
  IF4p5_header_t *packet_header=NULL;
  eth_state_t *eth = (eth_state_t*) (eNB->ifdevice.priv);

64 65 66
  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME( VCD_SIGNAL_DUMPER_FUNCTIONS_SEND_IF4, 1 );   

  if (packet_type == IF4p5_PDLFFT) {
67 68
    db_fulllength = 12*fp->N_RB_DL;
    db_halflength = (db_fulllength)>>1;
69
    slotoffsetF = (subframe)*(fp->ofdm_symbol_size)*((fp->Ncp==1) ? 12 : 14) + 1;
70
    blockoffsetF = slotoffsetF + fp->ofdm_symbol_size - db_halflength - 1; 
71

72 73 74 75 76 77 78 79
    if (eth->flags == ETH_RAW_IF4p5_MODE) {
      packet_header = (IF4p5_header_t *)(tx_buffer + MAC_HEADER_SIZE_BYTES);
      data_block = (uint16_t*)(tx_buffer + MAC_HEADER_SIZE_BYTES + sizeof_IF4p5_header_t);
    } else {
      packet_header = (IF4p5_header_t *)(tx_buffer);
      data_block = (uint16_t*)(tx_buffer + sizeof_IF4p5_header_t);
    }    
    gen_IF4p5_dl_header(packet_header, frame, subframe);
80 81
		    
    for (symbol_id=0; symbol_id<fp->symbols_per_tti; symbol_id++) {
82
      
83
      for (element_id=0; element_id<db_halflength; element_id++) {
84 85 86 87 88
        i = (uint16_t*) &txdataF[0][blockoffsetF+element_id];
        data_block[element_id] = ((uint16_t) lin2alaw[*i]) | (lin2alaw[*(i+1)]<<8);

        i = (uint16_t*) &txdataF[0][slotoffsetF+element_id];
        data_block[element_id+db_halflength] = ((uint16_t) lin2alaw[*i]) | (lin2alaw[*(i+1)]<<8);        
89 90
      }
				 		
91 92
      packet_header->frame_status &= ~(0x000f<<26);
      packet_header->frame_status |= (symbol_id&0x000f)<<26; 
93
			
94
      if ((eNB->ifdevice.trx_write_func(&eNB->ifdevice,
95
                                        symbol_id,
96
                                        &tx_buffer,
97 98
                                        db_fulllength,
      			                            1,
99 100
                                        IF4p5_PDLFFT)) < 0) {
        perror("ETHERNET write for IF4p5_PDLFFT\n");
101
      }
102 103 104
      
      slotoffsetF  += fp->ofdm_symbol_size;
      blockoffsetF += fp->ofdm_symbol_size;    
105
    }
106
  } else if (packet_type == IF4p5_PULFFT) {
107 108
    db_fulllength = 12*fp->N_RB_UL;
    db_halflength = (db_fulllength)>>1;
Sandeep Kumar's avatar
Sandeep Kumar committed
109
    slotoffsetF = 1;
110
    blockoffsetF = slotoffsetF + fp->ofdm_symbol_size - db_halflength - 1; 
111

112 113 114 115 116 117 118 119
    if (eth->flags == ETH_RAW_IF4p5_MODE) {
      packet_header = (IF4p5_header_t *)(tx_buffer + MAC_HEADER_SIZE_BYTES);
      data_block = (uint16_t*)(tx_buffer + MAC_HEADER_SIZE_BYTES + sizeof_IF4p5_header_t);
    } else {
      packet_header = (IF4p5_header_t *)(tx_buffer);
      data_block = (uint16_t*)(tx_buffer + sizeof_IF4p5_header_t);
    }
    gen_IF4p5_ul_header(packet_header, frame, subframe);
120

121
    for (symbol_id=0; symbol_id<fp->symbols_per_tti; symbol_id++) {			
122
      LOG_I(PHY,"IF4p5_PULFFT: frame %d, subframe %d, symbol %d\n",frame,subframe,symbol_id);
123
      for (element_id=0; element_id<db_halflength; element_id++) {
124 125 126 127 128
        i = (uint16_t*) &rxdataF[0][blockoffsetF+element_id];
        data_block[element_id] = ((uint16_t) lin2alaw[*i]) | (lin2alaw[*(i+1)]<<8);

        i = (uint16_t*) &rxdataF[0][slotoffsetF+element_id];
        data_block[element_id+db_halflength] = ((uint16_t) lin2alaw[*i]) | (lin2alaw[*(i+1)]<<8);        
129 130
      }
       			
131 132
      packet_header->frame_status &= ~(0x000f<<26);
      packet_header->frame_status |= (symbol_id&0x000f)<<26; 
133
			
134
      if ((eNB->ifdevice.trx_write_func(&eNB->ifdevice,
135
                                        symbol_id,
136
                                        &tx_buffer,
137 138
                                        db_fulllength,
      			                            1,
139 140
                                        IF4p5_PULFFT)) < 0) {
        perror("ETHERNET write for IF4p5_PULFFT\n");
141
      }
142

143 144
      slotoffsetF  += fp->ofdm_symbol_size;
      blockoffsetF += fp->ofdm_symbol_size;    
145
    }		
146
  } else if (packet_type == IF4p5_PRACH) {
147
    // FIX: hard coded prach samples length
148
    LOG_I(PHY,"IF4p5_PRACH: frame %d, subframe %d\n",frame,subframe);
Raymond Knopp's avatar
Raymond Knopp committed
149
    db_fulllength = 840*2;
150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167
    if (eth->flags == ETH_RAW_IF4p5_MODE) {
      packet_header = (IF4p5_header_t *)(tx_buffer + MAC_HEADER_SIZE_BYTES);
      data_block = (uint16_t*)(tx_buffer + MAC_HEADER_SIZE_BYTES + sizeof_IF4p5_header_t);
    } else {
      packet_header = (IF4p5_header_t *)(tx_buffer);
      data_block = (uint16_t*)(tx_buffer + sizeof_IF4p5_header_t);
    }  
    gen_IF4p5_prach_header(packet_header, frame, subframe);

    if (eth->flags == ETH_RAW_IF4p5_MODE) {
      memcpy((int16_t*)(tx_buffer + MAC_HEADER_SIZE_BYTES + sizeof_IF4p5_header_t),
             (&rxsigF[0][k]), 
             db_fulllength*sizeof(int16_t));
    } else {
      memcpy((int16_t*)(tx_buffer + sizeof_IF4p5_header_t),
             (&rxsigF[0][k]),
             db_fulllength*sizeof(int16_t));
    }
168 169

    if ((eNB->ifdevice.trx_write_func(&eNB->ifdevice,
170
                                      symbol_id,
171
                                      &tx_buffer,
172 173
                                      db_fulllength,
                                      1,
174 175
                                      IF4p5_PRACH)) < 0) {
      perror("ETHERNET write for IF4p5_PRACH\n");
176
    }      
177
  } else {    
178
    AssertFatal(1==0, "send_IF4p5 - Unknown packet_type %x", packet_type);     
179
  }
180 181

  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME( VCD_SIGNAL_DUMPER_FUNCTIONS_SEND_IF4, 0 );  
182
  return;  		    
183
}
184

185

186
void recv_IF4p5(PHY_VARS_eNB *eNB, int *frame, int *subframe, uint16_t *packet_type, uint32_t *symbol_number) {
187 188 189
  LTE_DL_FRAME_PARMS *fp = &eNB->frame_parms;
  int32_t **txdataF = eNB->common_vars.txdataF[0];
  int32_t **rxdataF = eNB->common_vars.rxdataF[0];
190
  int16_t **rxsigF = eNB->prach_vars.rxsigF;  
191
  void *rx_buffer = eNB->ifbuffer.rx;
192 193

  uint16_t element_id;
194
  uint16_t db_fulllength, db_halflength; 
Sandeep Kumar's avatar
Sandeep Kumar committed
195
  int slotoffsetF=0, blockoffsetF=0; 
196
  eth_state_t *eth = (eth_state_t*) (eNB->ifdevice.priv);
197 198

  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME( VCD_SIGNAL_DUMPER_FUNCTIONS_RECV_IF4, 1 );   
199
  
200
  if (eNB->node_function == NGFI_RRU_IF4p5) {
201
    db_fulllength = (12*fp->N_RB_DL); 
202
  } else {
203
    db_fulllength = (12*fp->N_RB_UL);     
204 205 206
  }  
  db_halflength = db_fulllength>>1;

207
  IF4p5_header_t *packet_header=NULL;
208
  uint16_t *data_block=NULL, *i=NULL;
209
     
210
  if (eNB->ifdevice.trx_read_func(&eNB->ifdevice,
211
                                  (int64_t*) packet_type,
212 213
                                  &rx_buffer,
                                  db_fulllength,
214
                                  0) < 0) {
215 216
    perror("ETHERNET read");
  }
217 218 219 220 221 222 223 224

  if (eth->flags == ETH_RAW_IF4p5_MODE) {
    packet_header = (IF4p5_header_t*) (rx_buffer+MAC_HEADER_SIZE_BYTES);
    data_block = (uint16_t*) (rx_buffer+MAC_HEADER_SIZE_BYTES+sizeof_IF4p5_header_t);
  } else {
    packet_header = (IF4p5_header_t*) (rx_buffer);
    data_block = (uint16_t*) (rx_buffer+sizeof_IF4p5_header_t);
  }
225

luhan wang's avatar
luhan wang committed
226 227

  
228
  *frame = ((packet_header->frame_status)>>6)&0xffff;
229
  *subframe = ((packet_header->frame_status)>>22)&0x000f;
luhan wang's avatar
luhan wang committed
230

231
  *packet_type = packet_header->sub_type; 
Raymond Knopp's avatar
Raymond Knopp committed
232 233


234
  if (*packet_type == IF4p5_PDLFFT) {          
Sandeep Kumar's avatar
Sandeep Kumar committed
235 236
    *symbol_number = ((packet_header->frame_status)>>26)&0x000f;         

237 238
    LOG_I(PHY,"DL_IF4p5: CC_id %d : frame %d, subframe %d, symbol %d\n",eNB->CC_id,*frame,*subframe,*symbol_number);

Sandeep Kumar's avatar
Sandeep Kumar committed
239
    slotoffsetF = (*symbol_number)*(fp->ofdm_symbol_size) + (*subframe)*(fp->ofdm_symbol_size)*((fp->Ncp==1) ? 12 : 14) + 1;
240 241
    blockoffsetF = slotoffsetF + fp->ofdm_symbol_size - db_halflength - 1; 
        
242
    for (element_id=0; element_id<db_halflength; element_id++) {
243 244 245
      i = (uint16_t*) &txdataF[0][blockoffsetF+element_id];
      *i = alaw2lin[ (data_block[element_id] & 0xff) ]; 
      *(i+1) = alaw2lin[ (data_block[element_id]>>8) ];
246

247 248 249
      i = (uint16_t*) &txdataF[0][slotoffsetF+element_id];
      *i = alaw2lin[ (data_block[element_id+db_halflength] & 0xff) ]; 
      *(i+1) = alaw2lin[ (data_block[element_id+db_halflength]>>8) ];
250
    }
Sandeep Kumar's avatar
Sandeep Kumar committed
251
		        
252
  } else if (*packet_type == IF4p5_PULFFT) {         
253
    *symbol_number = ((packet_header->frame_status)>>26)&0x000f;         
Sandeep Kumar's avatar
Sandeep Kumar committed
254

Sandeep Kumar's avatar
Sandeep Kumar committed
255
    slotoffsetF = (*symbol_number)*(fp->ofdm_symbol_size) + 1;
256
    blockoffsetF = slotoffsetF + fp->ofdm_symbol_size - db_halflength - 1; 
257 258
    
    for (element_id=0; element_id<db_halflength; element_id++) {
259 260 261
      i = (uint16_t*) &rxdataF[0][blockoffsetF+element_id];
      *i = alaw2lin[ (data_block[element_id] & 0xff) ]; 
      *(i+1) = alaw2lin[ (data_block[element_id]>>8) ];
262

263 264 265
      i = (uint16_t*) &rxdataF[0][slotoffsetF+element_id];
      *i = alaw2lin[ (data_block[element_id+db_halflength] & 0xff) ]; 
      *(i+1) = alaw2lin[ (data_block[element_id+db_halflength]>>8) ];
266 267
    }
		
268
  } else if (*packet_type == IF4p5_PRACH) {    
Sandeep Kumar's avatar
Sandeep Kumar committed
269
    // FIX: hard coded prach samples length
270
    db_fulllength = 840*2;
271 272 273 274 275 276 277 278 279 280 281

    if (eth->flags == ETH_RAW_IF4p5_MODE) {		
      memcpy((&rxsigF[0][0]), 
             (int16_t*) (rx_buffer+MAC_HEADER_SIZE_BYTES+sizeof_IF4p5_header_t), 
             db_fulllength*sizeof(int16_t));
    } else {
      memcpy((&rxsigF[0][0]),
             (int16_t*) (rx_buffer+sizeof_IF4p5_header_t),
             db_fulllength*sizeof(int16_t));
    }

282
  } else {
283
    AssertFatal(1==0, "recv_IF4p5 - Unknown packet_type %x", *packet_type);            
284
  }
285 286

  VCD_SIGNAL_DUMPER_DUMP_FUNCTION_BY_NAME( VCD_SIGNAL_DUMPER_FUNCTIONS_RECV_IF4, 0 );     
287
  return;   
288 289
}

290

291 292 293
void gen_IF4p5_dl_header(IF4p5_header_t *dl_packet, int frame, int subframe) {      
  dl_packet->type = IF4p5_PACKET_TYPE; 
  dl_packet->sub_type = IF4p5_PDLFFT;
294

295
  dl_packet->rsvd = 0;
296 297
  
  // Set frame status
Sandeep Kumar's avatar
Sandeep Kumar committed
298 299 300
  dl_packet->frame_status = 0;
  dl_packet->frame_status |= (frame&0xffff)<<6;
  dl_packet->frame_status |= (subframe&0x000f)<<22;
301 302
}

303

304
void gen_IF4p5_ul_header(IF4p5_header_t *ul_packet, int frame, int subframe) {  
Raymond Knopp's avatar
Raymond Knopp committed
305

306 307
  ul_packet->type = IF4p5_PACKET_TYPE; 
  ul_packet->sub_type = IF4p5_PULFFT;
308

309
  ul_packet->rsvd = 0;
310 311
  
  // Set frame status
Sandeep Kumar's avatar
Sandeep Kumar committed
312 313 314
  ul_packet->frame_status = 0;
  ul_packet->frame_status |= (frame&0xffff)<<6;
  ul_packet->frame_status |= (subframe&0x000f)<<22;
315 316
}

317

318 319 320
void gen_IF4p5_prach_header(IF4p5_header_t *prach_packet, int frame, int subframe) {
  prach_packet->type = IF4p5_PACKET_TYPE; 
  prach_packet->sub_type = IF4p5_PRACH;
321

322
  prach_packet->rsvd = 0;
323 324
  
  // Set LTE Prach configuration
Sandeep Kumar's avatar
Sandeep Kumar committed
325 326 327
  prach_packet->frame_status = 0;
  prach_packet->frame_status |= (frame&0xffff)<<6;
  prach_packet->frame_status |= (subframe&0x000f)<<22;
328
} 
329 330


331
void malloc_IF4p5_buffer(PHY_VARS_eNB *eNB) {
332
  // Keep the size large enough 
333 334 335 336 337 338 339 340
  eth_state_t *eth = (eth_state_t*) (eNB->ifdevice.priv);
  if (eth->flags == ETH_RAW_IF4p5_MODE) {
    eNB->ifbuffer.tx = malloc(RAW_IF4p5_PRACH_SIZE_BYTES);
    eNB->ifbuffer.rx = malloc(RAW_IF4p5_PRACH_SIZE_BYTES); 
  } else {     
    eNB->ifbuffer.tx = malloc(UDP_IF4p5_PRACH_SIZE_BYTES);
    eNB->ifbuffer.rx = malloc(UDP_IF4p5_PRACH_SIZE_BYTES);
  }
341
}