Merge branch 'next' into raa

lib/include/srslte/common/buffer_pool.h

@@ -164,6 +164,7 @@ public:
     }
     b->reset();
     pool->deallocate(b);
+    b = NULL;
   }
 private:
   buffer_pool<byte_buffer_t> *pool; 

lib/include/srslte/common/logger_stdout.h

@@ -42,7 +42,10 @@ namespace srslte {
   {
   public:
     void log(std::string *msg) {
-      fprintf(stdout, "%s", msg->c_str());
+      if (msg) {
+        fprintf(stdout, "%s", msg->c_str());
+        delete msg;
+      }
     }
   };
 

lib/include/srslte/interfaces/ue_interfaces.h

@@ -492,6 +492,7 @@ typedef struct {
   float estimator_fil_w;   
   bool rssi_sensor_enabled;
   bool sic_pss_enabled;
+  float rx_gain_offset;
 } phy_args_t; 
 
 

lib/include/srslte/upper/rlc_am.h

@@ -71,6 +71,7 @@ class rlc_am
 {
 public:
   rlc_am();
+  ~rlc_am();
   void init(log          *rlc_entity_log_,
             uint32_t              lcid_,
             srsue::pdcp_interface_rlc   *pdcp_,

lib/include/srslte/upper/rlc_um.h

@@ -50,6 +50,7 @@ class rlc_um
 {
 public:
   rlc_um();
+  ~rlc_um();
 
   void init(log          *rlc_entity_log_,
             uint32_t              lcid_,

lib/src/phy/fec/viterbi.c

@@ -166,9 +166,15 @@ void free37_avx2_16bit(void *o) {
   if (q->symbols_uc) {
     free(q->symbols_uc);
   }
+  if (q->symbols_us) {
+    free(q->symbols_us);
+  }
   if (q->tmp) {
     free(q->tmp);
   }
+  if (q->tmp_s) {
+    free(q->tmp_s);
+  }
   delete_viterbi37_avx2_16bit(q->ptr);
 }
 

lib/src/phy/ue/ue_ul.c

@@ -355,7 +355,7 @@ int srslte_ue_ul_pucch_encode(srslte_ue_ul_t *q, srslte_uci_data_t uci_data,
     }
     
     if (q->normalize_en) {
-      float norm_factor = (float) 0.8*q->cell.nof_prb/5;
+      float norm_factor = (float) q->cell.nof_prb/15/10;
       srslte_vec_sc_prod_cfc(output_signal, norm_factor, output_signal, SRSLTE_SF_LEN_PRB(q->cell.nof_prb));
     }
     ret = SRSLTE_SUCCESS; 

lib/src/upper/rlc_am.cc

@@ -68,6 +68,12 @@ rlc_am::rlc_am() : tx_sdu_queue(16)
   do_status     = false;
 }
 
+rlc_am::~rlc_am()
+{
+  // reset RLC and dealloc SDUs
+  stop();
+}
+
 void rlc_am::init(srslte::log                 *log_,
                   uint32_t                     lcid_,
                   srsue::pdcp_interface_rlc   *pdcp_,

lib/src/upper/rlc_um.cc

@@ -59,6 +59,11 @@ rlc_um::rlc_um() : tx_sdu_queue(16)
   pdu_lost = false;
 }
 
+rlc_um::~rlc_um()
+{
+  stop();
+}
+
 void rlc_um::init(srslte::log                 *log_,
                   uint32_t                     lcid_,
                   srsue::pdcp_interface_rlc   *pdcp_,
@@ -114,12 +119,13 @@ void rlc_um::empty_queue() {
 void rlc_um::stop()
 {
   reset();
-  mac_timers->timer_release_id(reordering_timer_id);
+  if (mac_timers) {
+    mac_timers->timer_release_id(reordering_timer_id);
+  }
 }
 
 void rlc_um::reset()
 {
-  
   // Empty tx_sdu_queue before locking the mutex 
   empty_queue();
 
@@ -129,12 +135,17 @@ void rlc_um::reset()
   vr_ux    = 0;
   vr_uh    = 0;
   pdu_lost = false;
-  if(rx_sdu)
+  if(rx_sdu) {
     rx_sdu->reset();
-  if(tx_sdu)
+  }
+
+  if(tx_sdu) {
     tx_sdu->reset();
-  if(mac_timers)
+  }
+
+  if(mac_timers) {
     reordering_timer->stop();
+  }
   
   // Drop all messages in RX window
   std::map<uint32_t, rlc_umd_pdu_t>::iterator it;

lib/test/upper/rlc_am_stress_test.cc

@@ -85,6 +85,7 @@ private:
       usleep(100);
     }
     running = false;
+    byte_buffer_pool::get_instance()->deallocate(pdu);
   }
 
   rlc_interface_mac *rlc1;

lib/test/upper/rlc_am_test.cc

@@ -59,6 +59,14 @@ public:
     n_sdus = 0;
   }
 
+  ~rlc_am_tester(){
+    for (uint32_t i = 0; i < 10; i++) {
+      if (sdus[i] != NULL) {
+        byte_buffer_pool::get_instance()->deallocate(sdus[i]);
+      }
+    }
+  }
+
   // PDCP interface
   void write_pdu(uint32_t lcid, byte_buffer_t *sdu)
   {
@@ -1048,24 +1056,91 @@ void resegment_test_6()
   }
 }
 
+void reset_test()
+{
+  srslte::log_filter log1("RLC_AM_1");
+  srslte::log_filter log2("RLC_AM_2");
+  log1.set_level(srslte::LOG_LEVEL_DEBUG);
+  log2.set_level(srslte::LOG_LEVEL_DEBUG);
+  log1.set_hex_limit(-1);
+  log2.set_hex_limit(-1);
+  rlc_am_tester     tester;
+  mac_dummy_timers  timers;
+
+  rlc_am rlc1;
+  int len;
+
+  log1.set_level(srslte::LOG_LEVEL_DEBUG);
+
+  rlc1.init(&log1, 1, &tester, &tester, &timers);
+
+  LIBLTE_RRC_RLC_CONFIG_STRUCT cnfg;
+  cnfg.rlc_mode = LIBLTE_RRC_RLC_MODE_AM;
+  cnfg.dl_am_rlc.t_reordering = LIBLTE_RRC_T_REORDERING_MS5;
+  cnfg.dl_am_rlc.t_status_prohibit = LIBLTE_RRC_T_STATUS_PROHIBIT_MS5;
+  cnfg.ul_am_rlc.max_retx_thresh = LIBLTE_RRC_MAX_RETX_THRESHOLD_T4;
+  cnfg.ul_am_rlc.poll_byte = LIBLTE_RRC_POLL_BYTE_KB25;
+  cnfg.ul_am_rlc.poll_pdu = LIBLTE_RRC_POLL_PDU_P4;
+  cnfg.ul_am_rlc.t_poll_retx = LIBLTE_RRC_T_POLL_RETRANSMIT_MS5;
+
+  rlc1.configure(&cnfg);
+
+  // Push 1 SDU of size 10 into RLC1
+  byte_buffer_t sdu_buf;
+  *sdu_buf.msg    = 1; // Write the index into the buffer
+  sdu_buf.N_bytes = 100;
+  rlc1.write_sdu(&sdu_buf);
+
+  // read 1 PDU from RLC1 and force segmentation
+  byte_buffer_t pdu_bufs;
+  len = rlc1.read_pdu(pdu_bufs.msg, 4);
+  pdu_bufs.N_bytes = len;
+
+  // reset RLC1
+  rlc1.reset();
+
+  // read another PDU segment from RLC1
+  len = rlc1.read_pdu(pdu_bufs.msg, 4);
+  pdu_bufs.N_bytes = len;
+
+  // now empty RLC buffer
+  len = rlc1.read_pdu(pdu_bufs.msg, 100);
+  pdu_bufs.N_bytes = len;
+
+  assert(0 == rlc1.get_buffer_state());
+}
+
 int main(int argc, char **argv) {
   basic_test();
   byte_buffer_pool::get_instance()->cleanup();
+
   concat_test();
   byte_buffer_pool::get_instance()->cleanup();
+
   segment_test();
   byte_buffer_pool::get_instance()->cleanup();
+
   retx_test();
   byte_buffer_pool::get_instance()->cleanup();
+
   resegment_test_1();
   byte_buffer_pool::get_instance()->cleanup();
+
   resegment_test_2();
   byte_buffer_pool::get_instance()->cleanup();
+
   resegment_test_3();
   byte_buffer_pool::get_instance()->cleanup();
+
   resegment_test_4();
   byte_buffer_pool::get_instance()->cleanup();
+
   resegment_test_5();
   byte_buffer_pool::get_instance()->cleanup();
+
   resegment_test_6();
+  byte_buffer_pool::get_instance()->cleanup();
+
+  reset_test();
+  byte_buffer_pool::get_instance()->cleanup();
 }

lib/test/upper/rlc_um_test.cc

@@ -62,6 +62,14 @@ public:
     n_sdus = 0;
   }
 
+  ~rlc_um_tester(){
+    for (uint32_t i = 0; i < NBUFS; i++) {
+      if (sdus[i] != NULL) {
+        byte_buffer_pool::get_instance()->deallocate(sdus[i]);
+      }
+    }
+  }
+
   // PDCP interface
   void write_pdu(uint32_t lcid, byte_buffer_t *sdu)
   {

srsue/hdr/phy/phch_worker.h

@@ -70,6 +70,9 @@ public:
   void start_plot();
 
   float get_ref_cfo();
+  float get_snr();
+  float get_rsrp();
+  float get_noise();
   float get_cfo();
   float get_ul_cfo();
 

srsue/src/main.cc

@@ -162,7 +162,11 @@ void parse_args(all_args_t *args, int argc, char *argv[]) {
      bpo::value<bool>(&args->expert.phy.rssi_sensor_enabled)->default_value(true),
      "Enable or disable RF frontend RSSI sensor. In some USRP devices can cause segmentation fault")
 
-    ("expert.prach_gain",
+    ("expert.rx_gain_offset",
+     bpo::value<float>(&args->expert.phy.rx_gain_offset)->default_value(10),
+     "RX Gain offset to add to rx_gain to correct RSRP value")
+
+      ("expert.prach_gain",
      bpo::value<float>(&args->expert.phy.prach_gain)->default_value(-1.0),
      "Disable PRACH power control")
 

srsue/src/phy/phch_common.cc

@@ -62,9 +62,10 @@ phch_common::phch_common(uint32_t max_mutex_) : tx_mutex(max_mutex_)
   bzero(zeros, 50000*sizeof(cf_t));
 
   // FIXME: This is an ugly fix to avoid the TX filters to empty
+  /*
   for (int i=0;i<50000;i++) {
     zeros[i] = 0.01*cexpf(((float) i/50000)*0.1*_Complex_I);
-  }
+  }*/
 
   reset();
 

srsue/src/phy/phch_recv.cc

@@ -687,10 +687,11 @@ void phch_recv::run_thread()
             case 1:
 
               if (last_worker) {
-                Debug("SF: cfo_tot=%7.1f Hz, ref=%f Hz, pss=%f Hz\n",
+                Debug("SF: cfo_tot=%7.1f Hz, ref=%f Hz, pss=%f Hz, snr_sf=%.2f dB, rsrp=%.2f dB, noise=%.2f dB\n",
                         srslte_ue_sync_get_cfo(&ue_sync),
                      15000*last_worker->get_ref_cfo(),
-                     15000*ue_sync.strack.cfo_pss_mean);
+                     15000*ue_sync.strack.cfo_pss_mean,
+                     last_worker->get_snr(), last_worker->get_rsrp(), last_worker->get_noise());
               }
 
               last_worker = worker;

srsue/src/phy/phch_worker.cc

@@ -203,6 +203,22 @@ float phch_worker::get_ref_cfo()
   return srslte_chest_dl_get_cfo(&ue_dl.chest);
 }
 
+float phch_worker::get_snr()
+{
+  return 10*log10(srslte_chest_dl_get_snr(&ue_dl.chest));
+}
+
+float phch_worker::get_rsrp()
+{
+  return 10*log10(srslte_chest_dl_get_rsrp(&ue_dl.chest));
+}
+
+float phch_worker::get_noise()
+{
+  return 10*log10(srslte_chest_dl_get_noise_estimate(&ue_dl.chest));
+}
+
+
 float phch_worker::get_cfo()
 {
   return cfo;
@@ -1370,7 +1386,7 @@ void phch_worker::update_measurements()
           phy->last_radio_rssi = phy->get_radio()->get_rssi();
           phy->rx_gain_offset = phy->avg_rssi_dbm - phy->last_radio_rssi + 30;
         } else {
-          phy->rx_gain_offset = phy->get_radio()->get_rx_gain();
+          phy->rx_gain_offset = phy->get_radio()->get_rx_gain() + phy->args->rx_gain_offset;
         }
       }
       rssi_read_cnt++;