openair0_lib.c 18.4 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) {
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 332 333
    /* device specific */
    openair0_cfg[card].txlaunch_wait = 1;//manage when TX processing is triggered
    openair0_cfg[card].txlaunch_wait_slotcount = 1; //manage when TX processing is triggered
    openair0_cfg[card].iq_txshift = 4;//shift
    openair0_cfg[card].iq_rxrescale = 15;//rescale iqs

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

Raymond Knopp's avatar
 
Raymond Knopp committed
352
    }
353

354
#if (BOARD_SWREV_CNTL2>=0x0A)
355

356 357
    for (ant=0; ant<4; ant++)
      p_exmimo_config->framing.resampling_factor[ant] = resampling_factor;
358

359 360 361
#else
    p_exmimo_config->framing.resampling_factor = resampling_factor;
#endif
362 363

    for (ant=0; ant<4; ant++) {
364
      if (openair0_cfg[card].rx_freq[ant] || openair0_cfg[card].tx_freq[ant]) {
365
	ACTIVE_RF += (1<<ant)<<5;
366
        p_exmimo_config->rf.rf_mode[ant] = RF_MODE_BASE;
367 368
        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]);
369
      }
370

371
      if (openair0_cfg[card].tx_freq[ant]) {
372 373 374
        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];
375

376
      }
377

378
      if (openair0_cfg[card].rx_freq[ant]) {
379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401
        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;
402
      }
403

404 405
      p_exmimo_config->rf.rf_local[ant]   = rf_local[ant];
      p_exmimo_config->rf.rf_rxdc[ant]    = rf_rxdc[ant];
406

407
      if (( p_exmimo_config->rf.rf_freq_tx[ant] >= 850000000) && ( p_exmimo_config->rf.rf_freq_tx[ant] <= 865000000)) {
408 409 410 411 412 413 414 415
        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;
416 417
      }
    }
418

419 420 421 422 423 424 425 426 427
    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);
    }

428
    ret = ioctl(openair0_fd, openair_DUMP_CONFIG, card);
429

430 431
    if (ret!=0)
      return(-1);
432

Raymond Knopp's avatar
 
Raymond Knopp committed
433
  }
434

Raymond Knopp's avatar
 
Raymond Knopp committed
435
  return(0);
Raymond Knopp's avatar
 
Raymond Knopp committed
436 437
}

438 439
int openair0_reconfig(openair0_config_t *openair0_cfg)
{
440

441 442 443
  int ant, card;

  exmimo_config_t         *p_exmimo_config;
444
  //  exmimo_id_t             *p_exmimo_id;
445 446 447 448 449 450 451 452 453

  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;
454
    //    p_exmimo_id     = openair0_exmimo_pci[card].exmimo_id_ptr;
455 456

    for (ant=0; ant<4; ant++) {
457
      if (openair0_cfg[card].tx_freq[ant]) {
458 459 460
        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]);
461
      }
462

463
      if (openair0_cfg[card].rx_freq[ant]) {
464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481
        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;
        }
482 483 484
      }
    }
  }
485

486 487 488
  return(0);
}

489 490 491 492 493 494 495 496 497 498 499 500
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);
  
}
501

502 503 504 505
int openair0_set_gains(openair0_device* device, openair0_config_t *openair0_cfg){
  return(0);
}

506
unsigned int *openair0_daq_cnt(void) {
Raymond Knopp's avatar
 
Raymond Knopp committed
507 508 509 510

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

}