[hamradio-commits] [gnss-sdr] 65/126: Added two Carrier_rotate correlator utilities

[Carles Fernandez]

This is an automated email from the git hooks/post-receive script.

carles_fernandez-guest pushed a commit to branch next
in repository gnss-sdr.

commit b95219dbc6144dd23ee9cda66616990b6291ee19
Author: Cillian O'Driscoll <cillian.odriscoll at gmail.com>
Date:   Thu Nov 26 13:15:56 2015 +0000

    Added two Carrier_rotate correlator utilities
    
    1) Carrier_rotate_and_EPL_volk
    
    This is a very efficient VOLK based carrier wipeoff and
    Early/Prompt/Late correlation. The carrier wipe off is done using the
    VOLK rotator functions, which means there is no need to generate a local
    replica sinusoid.
    
    2) Carrier_rotate_and_VEPL_Volk
    
    This adds Very Early/Early/Prompt/Late/Very Late correlation with the
    VOLK rotator implementation of carrier wipe-off
---
 src/algorithms/tracking/libs/correlator.cc | 47 ++++++++++++++++++++++++++++++
 src/algorithms/tracking/libs/correlator.h  | 26 +++++++++++++++++
 2 files changed, 73 insertions(+)

diff --git a/src/algorithms/tracking/libs/correlator.cc b/src/algorithms/tracking/libs/correlator.cc
index e44b450..0f920a9 100644
--- a/src/algorithms/tracking/libs/correlator.cc
+++ b/src/algorithms/tracking/libs/correlator.cc
@@ -151,3 +151,50 @@ void Correlator::Carrier_wipeoff_and_EPL_volk_custom(int signal_length_samples,
     volk_cw_epl_corr_u(input, carrier, E_code, P_code, L_code, E_out, P_out, L_out, signal_length_samples);
 }
 #endif
+void Correlator::Carrier_rotate_and_EPL_volk(int signal_length_samples,
+                                             const gr_complex* input,
+                                             gr_complex *phase_as_complex,
+                                             gr_complex phase_inc_as_complex,
+                                             const gr_complex* E_code,
+                                             const gr_complex* P_code,
+                                             const gr_complex* L_code,
+                                             gr_complex* E_out,
+                                             gr_complex* P_out,
+                                             gr_complex* L_out )
+{
+    gr_complex* bb_signal = static_cast<gr_complex*>(volk_malloc(signal_length_samples * sizeof(gr_complex), volk_get_alignment()));
+
+    volk_32fc_s32fc_x2_rotator_32fc(bb_signal, input, phase_inc_as_complex, phase_as_complex, signal_length_samples);
+    volk_32fc_x2_dot_prod_32fc(E_out, bb_signal, E_code, signal_length_samples);
+    volk_32fc_x2_dot_prod_32fc(P_out, bb_signal, P_code, signal_length_samples);
+    volk_32fc_x2_dot_prod_32fc(L_out, bb_signal, L_code, signal_length_samples);
+
+    volk_free(bb_signal);
+}
+
+void Correlator::Carrier_rotate_and_VEPL_volk(int signal_length_samples,
+                                              const gr_complex* input,
+                                              gr_complex *phase_as_complex,
+                                              gr_complex phase_inc_as_complex,
+                                              const gr_complex* VE_code,
+                                              const gr_complex* E_code,
+                                              const gr_complex* P_code,
+                                              const gr_complex* L_code,
+                                              const gr_complex* VL_code,
+                                              gr_complex* VE_out,
+                                              gr_complex* E_out,
+                                              gr_complex* P_out,
+                                              gr_complex* L_out,
+                                              gr_complex* VL_out )
+{
+    gr_complex* bb_signal = static_cast<gr_complex*>(volk_malloc(signal_length_samples * sizeof(gr_complex), volk_get_alignment()));
+
+    volk_32fc_s32fc_x2_rotator_32fc(bb_signal, input, phase_inc_as_complex, phase_as_complex, signal_length_samples);
+    volk_32fc_x2_dot_prod_32fc(VE_out, bb_signal, VE_code, signal_length_samples);
+    volk_32fc_x2_dot_prod_32fc(E_out, bb_signal, E_code, signal_length_samples);
+    volk_32fc_x2_dot_prod_32fc(P_out, bb_signal, P_code, signal_length_samples);
+    volk_32fc_x2_dot_prod_32fc(L_out, bb_signal, L_code, signal_length_samples);
+    volk_32fc_x2_dot_prod_32fc(VL_out, bb_signal, VL_code, signal_length_samples);
+
+    volk_free(bb_signal);
+}
diff --git a/src/algorithms/tracking/libs/correlator.h b/src/algorithms/tracking/libs/correlator.h
index 38d2d9b..a5f2f66 100644
--- a/src/algorithms/tracking/libs/correlator.h
+++ b/src/algorithms/tracking/libs/correlator.h
@@ -67,6 +67,32 @@ public:
     void Carrier_wipeoff_and_EPL_volk_custom(int signal_length_samples, const gr_complex* input, gr_complex* carrier, gr_complex* E_code, gr_complex* P_code, gr_complex* L_code, gr_complex* E_out, gr_complex* P_out, gr_complex* L_out);
 #endif
 
+    void Carrier_rotate_and_EPL_volk(int signal_length_samples,
+            const gr_complex* input,
+            gr_complex *phase_as_complex,
+            gr_complex phase_inc_as_complex,
+            const gr_complex* E_code,
+            const gr_complex* P_code,
+            const gr_complex* L_code,
+            gr_complex* E_out,
+            gr_complex* P_out,
+            gr_complex* L_out );
+
+    void Carrier_rotate_and_VEPL_volk(int signal_length_samples,
+            const gr_complex* input,
+            gr_complex *phase_as_complex,
+            gr_complex phase_inc_as_complex,
+            const gr_complex* VE_code,
+            const gr_complex* E_code,
+            const gr_complex* P_code,
+            const gr_complex* L_code,
+            const gr_complex* VL_code,
+            gr_complex* VE_out,
+            gr_complex* E_out,
+            gr_complex* P_out,
+            gr_complex* L_out,
+            gr_complex* VL_out );
+
 private:
     unsigned long next_power_2(unsigned long v);
 };

-- 
Alioth's /usr/local/bin/git-commit-notice on /srv/git.debian.org/git/pkg-hamradio/gnss-sdr.git