Modify dump file pcps acquisition

src/algorithms/acquisition/gnuradio_blocks/pcps_acquisition_cc.cc

@@ -42,6 +42,7 @@
 #include <volk_gnsssdr/volk_gnsssdr.h>
 #include "control_message_factory.h"
 #include "GPS_L1_CA.h" //GPS_TWO_PI
+#include <matio.h>
 
 
 using google::LogMessage;
@@ -95,9 +96,6 @@ pcps_acquisition_cc::pcps_acquisition_cc(
     d_code_phase = 0;
     d_test_statistics = 0.0;
     d_channel = 0;
-    d_doppler_freq = 0.0;
-
-    //set_relative_rate( 1.0/d_fft_size );
 
     // COD:
     // Experimenting with the overlap/save technique for handling bit trannsitions
@@ -132,6 +130,7 @@ pcps_acquisition_cc::pcps_acquisition_cc(
     d_blocking = blocking;
     d_worker_active = false;
     d_data_buffer = static_cast<gr_complex*>(volk_gnsssdr_malloc(d_fft_size * sizeof(gr_complex), volk_gnsssdr_get_alignment()));
+    grid_ = arma::fmat();
 }
 
 
@@ -145,17 +144,10 @@ pcps_acquisition_cc::~pcps_acquisition_cc()
                 }
             delete[] d_grid_doppler_wipeoffs;
         }
-
     volk_gnsssdr_free(d_fft_codes);
     volk_gnsssdr_free(d_magnitude);
-
     delete d_ifft;
     delete d_fft_if;
-
-    if (d_dump)
-        {
-            d_dump_file.close();
-        }
     volk_gnsssdr_free(d_data_buffer);
 }
 
@@ -217,6 +209,12 @@ void pcps_acquisition_cc::init()
             update_local_carrier(d_grid_doppler_wipeoffs[doppler_index], d_fft_size, d_freq + doppler);
         }
     d_worker_active = false;
+
+    if(d_dump)
+    {
+        unsigned int effective_fft_size = (d_bit_transition_flag ? (d_fft_size / 2) : d_fft_size);
+        grid_ = arma::fmat(effective_fft_size, d_num_doppler_bins, arma::fill::zeros);
+    }
 }
 
 
@@ -348,6 +346,9 @@ void pcps_acquisition_cc::acquisition_core( unsigned long int samp_count )
 {
     gr::thread::scoped_lock lk(d_setlock);
 
+    mat_t* matfp = NULL;
+    matvar_t* matvar = NULL;
+
     // initialize acquisition algorithm
     int doppler;
     uint32_t indext = 0;
@@ -441,24 +442,37 @@ void pcps_acquisition_cc::acquisition_core( unsigned long int samp_count )
             // Record results to file if required
             if (d_dump)
             {
-                    std::stringstream filename;
+                if(doppler_index == 0)
-                    std::streamsize n = 2 * sizeof(float) * (d_fft_size); // complex file write
+                {
-                    filename.str("");
+                    std::string filename = d_dump_filename;
-                    boost::filesystem::path p = d_dump_filename;
+                    filename.append("_");
-                    filename << p.parent_path().string()
+                    filename.append(1, d_gnss_synchro->System);
-                            << boost::filesystem::path::preferred_separator
+                    filename.append("_sat_");
-                            << p.stem().string()
+                    filename.append(std::to_string(d_gnss_synchro->PRN));
-                            << "_" << d_gnss_synchro->System
+                    filename.append(".mat");
-                            <<"_" << d_gnss_synchro->Signal << "_sat_"
-                            << d_gnss_synchro->PRN << "_doppler_"
-                            <<  doppler
-                            << p.extension().string();
 
-                    DLOG(INFO) << "Writing ACQ out to " << filename.str();
+                    matfp = Mat_CreateVer(filename.c_str(), NULL, MAT_FT_MAT73);
+                }
+                memcpy(grid_.colptr(doppler_index), d_magnitude, sizeof(float) * effective_fft_size);
+                if(doppler_index == (d_num_doppler_bins - 1))
+                {
+                    size_t dims[2] = {static_cast<size_t>(effective_fft_size), static_cast<size_t>(d_num_doppler_bins)};
+                    matvar = Mat_VarCreate("grid", MAT_C_SINGLE, MAT_T_SINGLE, 2, dims, grid_.memptr(), 0);
+                    Mat_VarWrite(matfp, matvar, MAT_COMPRESSION_ZLIB); // or MAT_COMPRESSION_NONE
+                    Mat_VarFree(matvar);
 
-                    d_dump_file.open(filename.str().c_str(), std::ios::out | std::ios::binary);
+                    dims[0] = static_cast<size_t>(1);
-                    d_dump_file.write(reinterpret_cast<char*>(d_ifft->get_outbuf()), n); //write directly |abs(x)|^2 in this Doppler bin?
+                    dims[1] = static_cast<size_t>(1);
-                    d_dump_file.close();
+                    matvar = Mat_VarCreate("doppler_max", MAT_C_SINGLE, MAT_T_UINT32, 1, dims, &d_doppler_max, 0);
+                    Mat_VarWrite(matfp, matvar, MAT_COMPRESSION_ZLIB); // or MAT_COMPRESSION_NONE
+                    Mat_VarFree(matvar);
+
+                    matvar = Mat_VarCreate("doppler_step", MAT_C_SINGLE, MAT_T_UINT32, 1, dims, &d_doppler_step, 0);
+                    Mat_VarWrite(matfp, matvar, MAT_COMPRESSION_ZLIB); // or MAT_COMPRESSION_NONE
+                    Mat_VarFree(matvar);
+
+                    Mat_Close(matfp);
+                }
             }
         }
     lk.lock();

src/algorithms/acquisition/gnuradio_blocks/pcps_acquisition_cc.h

@@ -59,6 +59,7 @@
 #include <gnuradio/fft/fft.h>
 #include "gnss_synchro.h"
 #include <glog/logging.h>
+#include <armadillo>
 
 class pcps_acquisition_cc;
 
@@ -81,6 +82,7 @@ pcps_make_acquisition_cc(unsigned int sampled_ms, unsigned int max_dwells,
 class pcps_acquisition_cc: public gr::block
 {
 private:
+
     friend pcps_acquisition_cc_sptr
     pcps_make_acquisition_cc(unsigned int sampled_ms, unsigned int max_dwells,
             unsigned int doppler_max, long freq, long fs_in,
@@ -101,48 +103,46 @@ private:
     void acquisition_core( unsigned long int samp_count );
 
     void send_negative_acquisition();
+
     void send_positive_acquisition();
+
+    bool d_bit_transition_flag;
+    bool d_use_CFAR_algorithm_flag;
+    bool d_active;
+    bool d_dump;
+    bool d_worker_active;
+    bool d_blocking;
+    float d_threshold;
+    float d_mag;
+    float d_input_power;
+    float d_test_statistics;
+    float* d_magnitude;
     long d_fs_in;
     long d_freq;
     int d_samples_per_ms;
     int d_samples_per_code;
-    //unsigned int d_doppler_resolution;
+    int d_state;
-    float d_threshold;
+    unsigned int d_channel;
     unsigned int d_doppler_max;
     unsigned int d_doppler_step;
     unsigned int d_sampled_ms;
     unsigned int d_max_dwells;
     unsigned int d_well_count;
     unsigned int d_fft_size;
+    unsigned int d_num_doppler_bins;
+    unsigned int d_code_phase;
     unsigned long int d_sample_counter;
     gr_complex** d_grid_doppler_wipeoffs;
-    unsigned int d_num_doppler_bins;
     gr_complex* d_fft_codes;
+    gr_complex* d_data_buffer;
     gr::fft::fft_complex* d_fft_if;
     gr::fft::fft_complex* d_ifft;
     Gnss_Synchro* d_gnss_synchro;
-    unsigned int d_code_phase;
-    float d_doppler_freq;
-    float d_mag;
-    float* d_magnitude;
-    float d_input_power;
-    float d_test_statistics;
-    bool d_bit_transition_flag;
-    bool d_use_CFAR_algorithm_flag;
-    std::ofstream d_dump_file;
-    bool d_active;
-    int d_state;
-    bool d_dump;
-    unsigned int d_channel;
     std::string d_dump_filename;
-    bool d_worker_active;
+    arma::fmat grid_;
-    bool d_blocking;
-    gr_complex *d_data_buffer;
 
 public:
-    /*!
+
-     * \brief Default destructor.
-     */
     ~pcps_acquisition_cc();
 
      /*!

src/utils/matlab/plot_acq_grid.m

@@ -0,0 +1,62 @@
+% /*!
+%  * \file plot_acq_grid.m
+%  * \brief Read GNSS-SDR Acquisition dump .mat file using the provided
+%  function and plot acquisition grid of acquisition statistic of PRN sat
+%
+%  
+%  * \author Antonio Ramos, 2017. antonio.ramos(at)cttc.es
+%  * -------------------------------------------------------------------------
+%  *
+%  * Copyright (C) 2010-2017  (see AUTHORS file for a list of contributors)
+%  *
+%  * GNSS-SDR is a software defined Global Navigation
+%  *          Satellite Systems receiver
+%  *
+%  * This file is part of GNSS-SDR.
+%  *
+%  * GNSS-SDR 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.
+%  *
+%  * GNSS-SDR 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 GNSS-SDR. If not, see <http://www.gnu.org/licenses/>.
+%  *
+%  * -------------------------------------------------------------------------
+%  */ 
+
+%%%%%%%%% ¡¡¡ CONFIGURE !!! %%%%%%%%%%%%% 
+sat = 27;
+n_chips = 1023;
+system = 'G'; % GPS = 'G', Galileo = 'E' 
+%%% True for light grid representation
+lite_view = true;
+%%% If lite_view, it sets the number of samples per chip in the graphical representation
+n_samples_per_chip = 4;
+
+
+path='/home/aramos/signals/';
+file=['acq_' system '_sat_' num2str(sat) '.mat'];
+
+load([path file]);
+[n_fft n_dop_bins] = size(grid);
+freq = (0 : n_dop_bins - 1) * doppler_step - doppler_max;
+delay = (0 : n_fft - 1) / n_fft * n_chips;
+figure(1)
+if(lite_view == false)
+    mesh(freq, delay, grid)
+else
+    delay_interp = (0 : n_samples_per_chip * n_chips - 1) / n_samples_per_chip;
+    grid_interp = spline(delay, grid', delay_interp)';
+    mesh(freq, delay_interp, grid_interp)
+end
+xlabel('Doppler shift / Hz')
+ylabel('Code delay / chips')
+zlabel('Test statistics')
+
+