git.gag.com Git - debian/gnuradio/blob - gnuradio-core/src/lib/general/gr_dpll_bb.cc

   1 /* -*- c++ -*- */
   2 /*
   3  * Copyright 2007,2009 Free Software Foundation, Inc.
   4  *
   5  * This file is part of GNU Radio
   6  *
   7  * GNU Radio is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License as published by
   9  * the Free Software Foundation; either version 3, or (at your option)
  10  * any later version.
  11  *
  12  * GNU Radio is distributed in the hope that it will be useful,
  13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  * GNU General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License
  18  * along with GNU Radio; see the file COPYING.  If not, write to
  19  * the Free Software Foundation, Inc., 51 Franklin Street,
  20  * Boston, MA 02110-1301, USA.
  21  */
  22
  23 #ifdef HAVE_CONFIG_H
  24 #include "config.h"
  25 #endif
  26
  27 #include <gr_dpll_bb.h>
  28 #include <gr_io_signature.h>
  29 #include <cstdio>
  30
  31 gr_dpll_bb_sptr
  32 gr_make_dpll_bb (float period, float gain)
  33 {
  34   return gr_dpll_bb_sptr (new gr_dpll_bb (period, gain));
  35 }
  36
  37 gr_dpll_bb::gr_dpll_bb (float period, float gain)
  38   : gr_sync_block ("dpll_bb",
  39                    gr_make_io_signature (1, 1, sizeof (char)),
  40                    gr_make_io_signature (1, 1, sizeof (char))),
  41     d_restart(0),d_pulse_phase(0)
  42 {
  43   d_pulse_frequency = 1.0/period;
  44   d_gain = gain;
  45   d_decision_threshold = 1.0 - 0.5*d_pulse_frequency;
  46 #if 1
  47   fprintf(stderr,"frequency = %f period = %f gain = %f threshold = %f\n",
  48           d_pulse_frequency,
  49           period,
  50           d_gain,
  51           d_decision_threshold);
  52 #endif
  53 }
  54
  55 int
  56 gr_dpll_bb::work (int noutput_items,
  57               gr_vector_const_void_star &input_items,
  58               gr_vector_void_star &output_items)
  59 {
  60   const char *iptr = (const char *) input_items[0];
  61   char *optr = (char *) output_items[0];
  62
  63   for (int i = 0; i < noutput_items; i++){
  64     optr[i]= 0;
  65     if(iptr[i] == 1) {
  66       if (d_restart == 0) {
  67         d_pulse_phase = 1;
  68       } else {
  69         if (d_pulse_phase > 0.5) d_pulse_phase += d_gain*(1.0-d_pulse_phase);
  70         else d_pulse_phase -= d_gain*d_pulse_phase;
  71       }
  72       d_restart = 3;
  73     }
  74     if (d_pulse_phase > d_decision_threshold) {
  75       d_pulse_phase -= 1.0;
  76       if (d_restart > 0) {
  77         d_restart -= 1;
  78         optr[i] = 1;
  79       }
  80     }
  81     d_pulse_phase += d_pulse_frequency;
  82   }
  83   return noutput_items;
  84 }