openair0_lib.c 18.1 KB
Newer Older
1
/*******************************************************************************
2
    OpenAirInterface
3 4 5 6 7 8 9 10 11 12 13 14 15 16
    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
17 18
    along with OpenAirInterface.The full GNU General Public License is
    included in this distribution in the file called "COPYING". If not,
19 20 21 22 23
    see <http://www.gnu.org/licenses/>.

   Contact Information
   OpenAirInterface Admin: openair_admin@eurecom.fr
   OpenAirInterface Tech : openair_tech@eurecom.fr
24
   OpenAirInterface Dev  : openair4g-devel@lists.eurecom.fr
25

ghaddab's avatar
ghaddab committed
26
   Address      : Eurecom, Campus SophiaTech, 450 Route des Chappes, CS 50193 - 06904 Biot Sophia Antipolis cedex, FRANCE
27 28

 *******************************************************************************/
29 30 31 32 33 34 35 36 37 38 39

/** openair0_lib : API to interface with ExpressMIMO-1&2 kernel driver
*
*  Authors: Matthias Ihmig <matthias.ihmig@mytum.de>, 2013
*           Raymond Knopp <raymond.knopp@eurecom.fr>
*
*  Changelog:
*  28.01.2013: Initial version
*/

#include <fcntl.h>
40 41 42 43 44
#include <sys/ioctl.h>
#include <sys/mman.h>
#include <string.h>
#include <unistd.h>
#include <stdio.h>
Raymond Knopp's avatar
 
Raymond Knopp committed
45
#include <stdlib.h>
46 47 48

#include "openair0_lib.h"
#include "openair_device.h"
Raymond Knopp's avatar
 
Raymond Knopp committed
49 50
#include "common_lib.h"
#define max(a,b) ((a)>(b) ? (a) : (b))
51
exmimo_pci_interface_bot_virtual_t openair0_exmimo_pci[MAX_CARDS]; // contains userspace pointers for each card
52 53 54 55 56 57 58 59 60

char *bigshm_top[MAX_CARDS] = INIT_ZEROS;

int openair0_fd;
int openair0_num_antennas[MAX_CARDS];
int openair0_num_detected_cards = 0;

unsigned int PAGE_SHIFT;

Raymond Knopp's avatar
 
Raymond Knopp committed
61
static uint32_t                      rf_local[4] =       {8255000,8255000,8255000,8255000}; // UE zepto
62 63
//{8254617, 8254617, 8254617, 8254617}; //eNB khalifa
//{8255067,8254810,8257340,8257340}; // eNB PETRONAS
Raymond Knopp's avatar
 
Raymond Knopp committed
64 65 66 67

static uint32_t                      rf_vcocal[4] =      {910,910,910,910};
static uint32_t                      rf_vcocal_850[4] =  {2015, 2015, 2015, 2015};
static uint32_t                      rf_rxdc[4] =        {32896,32896,32896,32896};
68 69 70 71

unsigned int log2_int( unsigned int x )
{
  unsigned int ans = 0 ;
72

73
  while( x>>=1 ) ans++;
74

75 76 77 78 79
  return ans ;
}

int openair0_open(void)
{
80 81
  exmimo_pci_interface_bot_virtual_t exmimo_pci_kvirt[MAX_CARDS];
  void *bigshm_top_kvirtptr[MAX_CARDS];
Raymond Knopp's avatar
 
Raymond Knopp committed
82

83 84
  int card;
  int ant;
Raymond Knopp's avatar
 
Raymond Knopp committed
85

86
  PAGE_SHIFT = log2_int( sysconf( _SC_PAGESIZE ) );
Raymond Knopp's avatar
 
Raymond Knopp committed
87

88

89 90 91
  if ((openair0_fd = open("/dev/openair0", O_RDWR,0)) <0) {
    return -1;
  }
Raymond Knopp's avatar
 
Raymond Knopp committed
92

93
  ioctl(openair0_fd, openair_GET_NUM_DETECTED_CARDS, &openair0_num_detected_cards);
Raymond Knopp's avatar
 
Raymond Knopp committed
94

95 96


97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122
  if ( openair0_num_detected_cards == 0 ) {
    fprintf(stderr, "No cards detected!\n");
    return -4;
  }

  ioctl(openair0_fd, openair_GET_BIGSHMTOPS_KVIRT, &bigshm_top_kvirtptr[0]);
  ioctl(openair0_fd, openair_GET_PCI_INTERFACE_BOTS_KVIRT, &exmimo_pci_kvirt[0]);

  //printf("bigshm_top_kvirtptr (MAX_CARDS %d): %p  %p  %p  %p\n", MAX_CARDS,bigshm_top_kvirtptr[0], bigshm_top_kvirtptr[1], bigshm_top_kvirtptr[2], bigshm_top_kvirtptr[3]);



  for( card=0; card < openair0_num_detected_cards; card++) {
    bigshm_top[card] = (char *)mmap( NULL,
                                     BIGSHM_SIZE_PAGES<<PAGE_SHIFT,
                                     PROT_READ|PROT_WRITE,
                                     MAP_SHARED, //|MAP_FIXED,//MAP_SHARED,
                                     openair0_fd,
                                     ( openair_mmap_BIGSHM | openair_mmap_Card(card) )<<PAGE_SHIFT);

    if (bigshm_top[card] == MAP_FAILED) {
      openair0_close();
      return -2;
    }

    // calculate userspace addresses
Raymond Knopp's avatar
 
Raymond Knopp committed
123
#if __x86_64
124 125 126 127
    openair0_exmimo_pci[card].firmware_block_ptr = (bigshm_top[card] +  (int64_t)exmimo_pci_kvirt[0].firmware_block_ptr - (int64_t)bigshm_top_kvirtptr[0]);
    openair0_exmimo_pci[card].printk_buffer_ptr  = (bigshm_top[card] +  (int64_t)exmimo_pci_kvirt[0].printk_buffer_ptr  - (int64_t)bigshm_top_kvirtptr[0]);
    openair0_exmimo_pci[card].exmimo_config_ptr  = (exmimo_config_t*) (bigshm_top[card] +  (int64_t)exmimo_pci_kvirt[0].exmimo_config_ptr  - (int64_t)bigshm_top_kvirtptr[0]);
    openair0_exmimo_pci[card].exmimo_id_ptr      = (exmimo_id_t*)     (bigshm_top[card] +  (int64_t)exmimo_pci_kvirt[0].exmimo_id_ptr      - (int64_t)bigshm_top_kvirtptr[0]);
Raymond Knopp's avatar
 
Raymond Knopp committed
128
#else
129 130 131 132
    openair0_exmimo_pci[card].firmware_block_ptr = (bigshm_top[card] +  (int32_t)exmimo_pci_kvirt[0].firmware_block_ptr - (int32_t)bigshm_top_kvirtptr[0]);
    openair0_exmimo_pci[card].printk_buffer_ptr  = (bigshm_top[card] +  (int32_t)exmimo_pci_kvirt[0].printk_buffer_ptr  - (int32_t)bigshm_top_kvirtptr[0]);
    openair0_exmimo_pci[card].exmimo_config_ptr  = (exmimo_config_t*) (bigshm_top[card] +  (int32_t)exmimo_pci_kvirt[0].exmimo_config_ptr  - (int32_t)bigshm_top_kvirtptr[0]);
    openair0_exmimo_pci[card].exmimo_id_ptr      = (exmimo_id_t*)     (bigshm_top[card] +  (int32_t)exmimo_pci_kvirt[0].exmimo_id_ptr      - (int32_t)bigshm_top_kvirtptr[0]);
Raymond Knopp's avatar
 
Raymond Knopp committed
133 134
#endif

135 136 137 138 139 140 141 142 143 144 145 146 147 148
    /*
          printf("openair0_exmimo_pci.firmware_block_ptr (%p) =  bigshm_top(%p) + exmimo_pci_kvirt.firmware_block_ptr(%p) - bigshm_top_kvirtptr(%p)\n",
              openair0_exmimo_pci[card].firmware_block_ptr, bigshm_top, exmimo_pci_kvirt[card].firmware_block_ptr, bigshm_top_kvirtptr[card]);
          printf("card%d, openair0_exmimo_pci.exmimo_id_ptr      (%p) =  bigshm_top(%p) + exmimo_pci_kvirt.exmimo_id_ptr     (%p) - bigshm_top_kvirtptr(%p)\n",
              card, openair0_exmimo_pci[card].exmimo_id_ptr, bigshm_top[card], exmimo_pci_kvirt[card].exmimo_id_ptr, bigshm_top_kvirtptr[card]);
    */

    /*
    if (openair0_exmimo_pci[card].exmimo_id_ptr->board_swrev != BOARD_SWREV_CNTL2)
      {
        error("Software revision %d and firmware revision %d do not match, Please update either Software or Firmware",BOARD_SWREV_CNTL2,openair0_exmimo_pci[card].exmimo_id_ptr->board_swrev);
        return -5;
      }
    */
Raymond Knopp's avatar
 
Raymond Knopp committed
149

150 151
    if ( openair0_exmimo_pci[card].exmimo_id_ptr->board_exmimoversion == 1)
      openair0_num_antennas[card] = 2;
152

153 154
    if ( openair0_exmimo_pci[card].exmimo_id_ptr->board_exmimoversion == 2)
      openair0_num_antennas[card] = 4;
155

ghaddab's avatar
 
ghaddab committed
156

157
    for (ant=0; ant<openair0_num_antennas[card]; ant++) {
Raymond Knopp's avatar
 
Raymond Knopp committed
158
#if __x86_64__
159 160
      openair0_exmimo_pci[card].rxcnt_ptr[ant] = (unsigned int *) (bigshm_top[card] +  (int64_t)exmimo_pci_kvirt[card].rxcnt_ptr[ant] - (int64_t)bigshm_top_kvirtptr[card]);
      openair0_exmimo_pci[card].txcnt_ptr[ant] = (unsigned int *) (bigshm_top[card] +  (int64_t)exmimo_pci_kvirt[card].txcnt_ptr[ant] - (int64_t)bigshm_top_kvirtptr[card]);
Raymond Knopp's avatar
 
Raymond Knopp committed
161
#else
162 163
      openair0_exmimo_pci[card].rxcnt_ptr[ant] = (unsigned int *) (bigshm_top[card] +  (int32_t)exmimo_pci_kvirt[card].rxcnt_ptr[ant] - (int32_t)bigshm_top_kvirtptr[card]);
      openair0_exmimo_pci[card].txcnt_ptr[ant] = (unsigned int *) (bigshm_top[card] +  (int32_t)exmimo_pci_kvirt[card].txcnt_ptr[ant] - (int32_t)bigshm_top_kvirtptr[card]);
Raymond Knopp's avatar
 
Raymond Knopp committed
164
#endif
165
    }
166

167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191
    for (ant=0; ant<openair0_num_antennas[card]; ant++) {
      openair0_exmimo_pci[card].adc_head[ant] = mmap( NULL,
          ADAC_BUFFERSZ_PERCHAN_B,
          PROT_READ|PROT_WRITE,
          MAP_SHARED, //|MAP_FIXED,//MAP_SHARED,
          openair0_fd,
          ( openair_mmap_RX(ant) | openair_mmap_Card(card) )<<PAGE_SHIFT );

      openair0_exmimo_pci[card].dac_head[ant] = mmap( NULL,
          ADAC_BUFFERSZ_PERCHAN_B,
          PROT_READ|PROT_WRITE,
          MAP_SHARED, //|MAP_FIXED,//MAP_SHARED,
          openair0_fd,
          ( openair_mmap_TX(ant) | openair_mmap_Card(card) )<<PAGE_SHIFT );

      if (openair0_exmimo_pci[card].adc_head[ant] == MAP_FAILED || openair0_exmimo_pci[card].dac_head[ant] == MAP_FAILED) {
        openair0_close();
        return -3;
      }
    }

    //printf("p_exmimo_config = %p, p_exmimo_id = %p\n", openair0_exmimo_pci.exmimo_config_ptr, openair0_exmimo_pci.exmimo_id_ptr);

    printf("card %d: ExpressMIMO %d, HW Rev %d, SW Rev 0x%d, %d antennas\n", card, openair0_exmimo_pci[card].exmimo_id_ptr->board_exmimoversion,
           openair0_exmimo_pci[card].exmimo_id_ptr->board_hwrev, openair0_exmimo_pci[card].exmimo_id_ptr->board_swrev, openair0_num_antennas[card]);
ghaddab's avatar
 
ghaddab committed
192

193 194 195
  } // end for(card)

  return 0;
196
}
197 198


199 200
int openair0_close(void)
{
201 202 203 204 205 206 207 208 209 210 211 212 213 214 215
  int ant;
  int card;

  close(openair0_fd);

  for (card=0; card<openair0_num_detected_cards; card++) {
    if (bigshm_top[card] != NULL && bigshm_top[card] != MAP_FAILED)
      munmap(bigshm_top[card], BIGSHM_SIZE_PAGES<<PAGE_SHIFT);

    for (ant=0; ant<openair0_num_antennas[card]; ant++) {
      if (openair0_exmimo_pci[card].adc_head[ant] != NULL && openair0_exmimo_pci[card].adc_head[ant] != MAP_FAILED)
        munmap(openair0_exmimo_pci[card].adc_head[ant], ADAC_BUFFERSZ_PERCHAN_B);

      if (openair0_exmimo_pci[card].dac_head[ant] != NULL && openair0_exmimo_pci[card].dac_head[ant] != MAP_FAILED)
        munmap(openair0_exmimo_pci[card].dac_head[ant], ADAC_BUFFERSZ_PERCHAN_B);
216
    }
217 218 219
  }

  return 0;
220 221 222 223
}

int openair0_dump_config(int card)
{
224
  return ioctl(openair0_fd, openair_DUMP_CONFIG, card);
225 226 227 228
}

int openair0_get_frame(int card)
{
229
  return ioctl(openair0_fd, openair_GET_FRAME, card);
230 231 232 233
}

int openair0_start_rt_acquisition(int card)
{
234
  return ioctl(openair0_fd, openair_START_RT_ACQUISITION, card);
235 236 237 238
}

int openair0_stop(int card)
{
239
  return ioctl(openair0_fd, openair_STOP, card);
240 241
}

ghaddab's avatar
 
ghaddab committed
242 243
int openair0_stop_without_reset(int card)
{
244
  return ioctl(openair0_fd, openair_STOP_WITHOUT_RESET, card);
ghaddab's avatar
 
ghaddab committed
245
}
Raymond Knopp's avatar
 
Raymond Knopp committed
246 247

#define MY_RF_MODE      (RXEN + TXEN + TXLPFNORM + TXLPFEN + TXLPF25 + RXLPFNORM + RXLPFEN + RXLPF25 + LNA1ON +LNAMax + RFBBNORM + DMAMODE_RX + DMAMODE_TX)
ghaddab's avatar
 
ghaddab committed
248
#define RF_MODE_BASE    (LNA1ON + RFBBNORM)
Raymond Knopp's avatar
 
Raymond Knopp committed
249

250
int device_init(openair0_device *device, openair0_config_t *openair0_cfg, char *cfgfile) {
Raymond Knopp's avatar
 
Raymond Knopp committed
251 252

  // Initialize card
253
  //  exmimo_config_t         *p_exmimo_config;
254
  exmimo_id_t             *p_exmimo_id;
Raymond Knopp's avatar
 
Raymond Knopp committed
255
  int ret;
Raymond Knopp's avatar
 
Raymond Knopp committed
256

Raymond Knopp's avatar
 
Raymond Knopp committed
257
  ret = openair0_open();
Raymond Knopp's avatar
 
Raymond Knopp committed
258 259


Raymond Knopp's avatar
 
Raymond Knopp committed
260 261 262
  if ( ret != 0 ) {
    if (ret == -1)
      printf("Error opening /dev/openair0");
263

Raymond Knopp's avatar
 
Raymond Knopp committed
264 265
    if (ret == -2)
      printf("Error mapping bigshm");
266

Raymond Knopp's avatar
 
Raymond Knopp committed
267 268
    if (ret == -3)
      printf("Error mapping RX or TX buffer");
269

Raymond Knopp's avatar
 
Raymond Knopp committed
270 271 272
    return(ret);
  }

273 274
  if (openair0_num_detected_cards>MAX_CARDS) {
    printf ("Detected %d number of cards, but MAX_CARDS=%d\n", openair0_num_detected_cards, MAX_CARDS);
275
  } else {
276 277 278
    printf ("Detected %d number of cards, %d number of antennas.\n", openair0_num_detected_cards, openair0_num_antennas[0]);
  }

279
  //  p_exmimo_config = openair0_exmimo_pci[0].exmimo_config_ptr;
Raymond Knopp's avatar
 
Raymond Knopp committed
280
  p_exmimo_id     = openair0_exmimo_pci[0].exmimo_id_ptr;
281

Raymond Knopp's avatar
 
Raymond Knopp committed
282 283 284 285 286
  printf("Card %d: ExpressMIMO %d, HW Rev %d, SW Rev 0x%d\n", 0, p_exmimo_id->board_exmimoversion, p_exmimo_id->board_hwrev, p_exmimo_id->board_swrev);

  // check if the software matches firmware
  if (p_exmimo_id->board_swrev!=BOARD_SWREV_CNTL2) {
    printf("Software revision %d and firmware revision %d do not match. Please update either the firmware or the software!\n",BOARD_SWREV_CNTL2,p_exmimo_id->board_swrev);
287 288
    return(-1);
  }
Raymond Knopp's avatar
 
Raymond Knopp committed
289

290 291
  device->type             = EXMIMO_DEV; 

292 293
  return(0);
}
Raymond Knopp's avatar
 
Raymond Knopp committed
294

295
int openair0_config(openair0_config_t *openair0_cfg, int UE_flag)
296 297 298 299 300
{
  int ret;
  int ant, card;
  int resampling_factor=2;
  int rx_filter=RXLPF25, tx_filter=TXLPF25;
301
  int ACTIVE_RF=0;
302

303 304
  exmimo_config_t         *p_exmimo_config;
  exmimo_id_t             *p_exmimo_id;
305

306 307 308
  if (!openair0_cfg) {
    printf("Error, openair0_cfg is null!!\n");
    return(-1);
309 310
  }

311
  for (card=0; card<openair0_num_detected_cards; card++) {
Raymond Knopp's avatar
 
Raymond Knopp committed
312

313 314
    p_exmimo_config = openair0_exmimo_pci[card].exmimo_config_ptr;
    p_exmimo_id     = openair0_exmimo_pci[card].exmimo_id_ptr;
315

316
    if (p_exmimo_id->board_swrev>=9)
317 318
      p_exmimo_config->framing.eNB_flag   = 0;
    else
319
      p_exmimo_config->framing.eNB_flag   = !UE_flag;
320

321 322 323 324 325 326
    if (openair0_num_detected_cards==1)
      p_exmimo_config->framing.multicard_syncmode=SYNCMODE_FREE;
    else if (card==0)
      p_exmimo_config->framing.multicard_syncmode=SYNCMODE_MASTER;
    else
      p_exmimo_config->framing.multicard_syncmode=SYNCMODE_SLAVE;
327

328 329 330 331
    if (openair0_cfg[card].sample_rate==30.72e6) {
      resampling_factor = 0;
      rx_filter = RXLPF10;
      tx_filter = TXLPF10;
332
    } else if (openair0_cfg[card].sample_rate==15.36e6) {
333 334 335
      resampling_factor = 1;
      rx_filter = RXLPF5;
      tx_filter = TXLPF5;
336
    } else if (openair0_cfg[card].sample_rate==7.68e6) {
337 338 339
      resampling_factor = 2;
      rx_filter = RXLPF25;
      tx_filter = TXLPF25;
340
    } else {
341 342 343 344
      printf("Sampling rate not supported, using default 7.68MHz");
      resampling_factor = 2;
      rx_filter = RXLPF25;
      tx_filter = TXLPF25;
345

Raymond Knopp's avatar
 
Raymond Knopp committed
346
    }
347

348
#if (BOARD_SWREV_CNTL2>=0x0A)
349

350 351
    for (ant=0; ant<4; ant++)
      p_exmimo_config->framing.resampling_factor[ant] = resampling_factor;
352

353 354 355
#else
    p_exmimo_config->framing.resampling_factor = resampling_factor;
#endif
356 357

    for (ant=0; ant<4; ant++) {
358
      if (openair0_cfg[card].rx_freq[ant] || openair0_cfg[card].tx_freq[ant]) {
359
	ACTIVE_RF += (1<<ant)<<5;
360
        p_exmimo_config->rf.rf_mode[ant] = RF_MODE_BASE;
361 362
        p_exmimo_config->rf.do_autocal[ant] = 1;//openair0_cfg[card].autocal[ant];
	printf("card %d, antenna %d, autocal %d\n",card,ant,openair0_cfg[card].autocal[ant]);
363
      }
364

365
      if (openair0_cfg[card].tx_freq[ant]) {
366 367 368
        p_exmimo_config->rf.rf_mode[ant] += (TXEN + DMAMODE_TX + TXLPFNORM + TXLPFEN + tx_filter);
        p_exmimo_config->rf.rf_freq_tx[ant] = (unsigned int)openair0_cfg[card].tx_freq[ant];
        p_exmimo_config->rf.tx_gain[ant][0] = (unsigned int)openair0_cfg[card].tx_gain[ant];
369

370
      }
371

372
      if (openair0_cfg[card].rx_freq[ant]) {
373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395
        p_exmimo_config->rf.rf_mode[ant] += (RXEN + DMAMODE_RX + RXLPFNORM + RXLPFEN + rx_filter);

        p_exmimo_config->rf.rf_freq_rx[ant] = (unsigned int)openair0_cfg[card].rx_freq[ant];
        p_exmimo_config->rf.rx_gain[ant][0] = (unsigned int)openair0_cfg[card].rx_gain[ant];
        printf("openair0 : programming card %d RX antenna %d (freq %u, gain %d)\n",card,ant,p_exmimo_config->rf.rf_freq_rx[ant],p_exmimo_config->rf.rx_gain[ant][0]);

        switch (openair0_cfg[card].rxg_mode[ant]) {
        default:
        case max_gain:
          p_exmimo_config->rf.rf_mode[ant] += LNAMax;
          break;

        case med_gain:
          p_exmimo_config->rf.rf_mode[ant] += LNAMed;
          break;

        case byp_gain:
          p_exmimo_config->rf.rf_mode[ant] += LNAByp;
          break;
        }
      } else {
        p_exmimo_config->rf.rf_mode[ant] = 0;
        p_exmimo_config->rf.do_autocal[ant] = 0;
396
      }
397

398 399
      p_exmimo_config->rf.rf_local[ant]   = rf_local[ant];
      p_exmimo_config->rf.rf_rxdc[ant]    = rf_rxdc[ant];
400

401
      if (( p_exmimo_config->rf.rf_freq_tx[ant] >= 850000000) && ( p_exmimo_config->rf.rf_freq_tx[ant] <= 865000000)) {
402 403 404 405 406 407 408 409
        p_exmimo_config->rf.rf_vcocal[ant]  = rf_vcocal_850[ant];
        p_exmimo_config->rf.rffe_band_mode[ant] = DD_TDD;
      } else if (( p_exmimo_config->rf.rf_freq_tx[ant] >= 1900000000) && ( p_exmimo_config->rf.rf_freq_tx[ant] <= 2000000000)) {
        p_exmimo_config->rf.rf_vcocal[ant]  = rf_vcocal[ant];
        p_exmimo_config->rf.rffe_band_mode[ant] = B19G_TDD;
      } else {
        p_exmimo_config->rf.rf_vcocal[ant]  = rf_vcocal[ant];
        p_exmimo_config->rf.rffe_band_mode[ant] = 0;
410 411
      }
    }
412

413 414 415 416 417 418 419 420 421
    if (openair0_cfg[card].duplex_mode==duplex_mode_FDD) {
      p_exmimo_config->framing.tdd_config = DUPLEXMODE_FDD;
      printf("!!!!!setting FDD (tdd_config=%d)\n",p_exmimo_config->framing.tdd_config);
    } 
    else {
      p_exmimo_config->framing.tdd_config = DUPLEXMODE_TDD + TXRXSWITCH_LSB + ACTIVE_RF;
      printf("!!!!!setting TDD (tdd_config=%d)\n",p_exmimo_config->framing.tdd_config);
    }

422
    ret = ioctl(openair0_fd, openair_DUMP_CONFIG, card);
423

424 425
    if (ret!=0)
      return(-1);
426

Raymond Knopp's avatar
 
Raymond Knopp committed
427
  }
428

Raymond Knopp's avatar
 
Raymond Knopp committed
429
  return(0);
Raymond Knopp's avatar
 
Raymond Knopp committed
430 431
}

432 433
int openair0_reconfig(openair0_config_t *openair0_cfg)
{
434

435 436 437
  int ant, card;

  exmimo_config_t         *p_exmimo_config;
438
  //  exmimo_id_t             *p_exmimo_id;
439 440 441 442 443 444 445 446 447

  if (!openair0_cfg) {
    printf("Error, openair0_cfg is null!!\n");
    return(-1);
  }

  for (card=0; card<openair0_num_detected_cards; card++) {

    p_exmimo_config = openair0_exmimo_pci[card].exmimo_config_ptr;
448
    //    p_exmimo_id     = openair0_exmimo_pci[card].exmimo_id_ptr;
449 450

    for (ant=0; ant<4; ant++) {
451
      if (openair0_cfg[card].tx_freq[ant]) {
452 453 454
        p_exmimo_config->rf.rf_freq_tx[ant] = (unsigned int)openair0_cfg[card].tx_freq[ant];
        p_exmimo_config->rf.tx_gain[ant][0] = (unsigned int)openair0_cfg[card].tx_gain[ant];
        //printf("openair0 : programming TX antenna %d (freq %u, gain %d)\n",ant,p_exmimo_config->rf.rf_freq_tx[ant],p_exmimo_config->rf.tx_gain[ant][0]);
455
      }
456

457
      if (openair0_cfg[card].rx_freq[ant]) {
458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475
        p_exmimo_config->rf.rf_freq_rx[ant] = (unsigned int)openair0_cfg[card].rx_freq[ant];
        p_exmimo_config->rf.rx_gain[ant][0] = (unsigned int)openair0_cfg[card].rx_gain[ant];
        //printf("openair0 : programming RX antenna %d (freq %u, gain %d)\n",ant,p_exmimo_config->rf.rf_freq_rx[ant],p_exmimo_config->rf.rx_gain[ant][0]);

        switch (openair0_cfg[card].rxg_mode[ant]) {
        default:
        case max_gain:
          p_exmimo_config->rf.rf_mode[ant] = (p_exmimo_config->rf.rf_mode[ant]&(~LNAGAINMASK))|LNAMax;
          break;

        case med_gain:
          p_exmimo_config->rf.rf_mode[ant] = (p_exmimo_config->rf.rf_mode[ant]&(~LNAGAINMASK))|LNAMed;
          break;

        case byp_gain:
          p_exmimo_config->rf.rf_mode[ant] = (p_exmimo_config->rf.rf_mode[ant]&(~LNAGAINMASK))|LNAByp;
          break;
        }
476 477 478
      }
    }
  }
479

480 481 482
  return(0);
}

483 484 485 486 487 488 489 490 491 492 493 494
int openair0_set_frequencies(openair0_device* device, openair0_config_t *openair0_cfg,int exmimo_dump_config) {

  if (exmimo_dump_config > 0) {
    // do a full configuration
    openair0_config(openair0_cfg,0);
  }
  else {  // just change the frequencies in pci descriptor
    openair0_reconfig(openair0_cfg);
  }
  return(0);
  
}
495

496 497 498 499
int openair0_set_gains(openair0_device* device, openair0_config_t *openair0_cfg){
  return(0);
}

500
unsigned int *openair0_daq_cnt(void) {
Raymond Knopp's avatar
 
Raymond Knopp committed
501 502 503 504

  return((unsigned int *)openair0_exmimo_pci[0].rxcnt_ptr[0]);

}