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

   1 /* -*- c++ -*- */
   2 /*
   3  * Copyright 2007 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 2, 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 // WARNING: this file is machine generated.  Edits will be over written
  24
  25 #ifdef HAVE_CONFIG_H
  26 #include "config.h"
  27 #endif
  28
  29 #include <gr_dpll_ff.h>
  30 #include <gr_io_signature.h>
  31
  32 gr_dpll_ff_sptr
  33 gr_make_dpll_ff (float period, float gain)
  34 {
  35   return gr_dpll_ff_sptr (new gr_dpll_ff (period, gain));
  36 }
  37
  38 gr_dpll_ff::gr_dpll_ff (float period, float gain)
  39   : gr_sync_block ("dpll_ff",
  40                    gr_make_io_signature (1, 1, sizeof (float)),
  41                    gr_make_io_signature (1, 1, sizeof (float))),
  42     d_restart(0),d_pulse_phase(0)
  43 {
  44   d_pulse_frequency = 1.0/period;
  45   d_gain = gain;
  46   d_decision_threshold = 1.0 - 0.5*d_pulse_frequency;
  47 #if 1
  48   fprintf(stderr,"frequency = %f period = %f gain = %f threshold = %f\n",
  49           d_pulse_frequency,
  50           period,
  51           d_gain,
  52           d_decision_threshold);
  53 #endif
  54   set_history(1); // so we can look behind us
  55 }
  56
  57 int
  58 gr_dpll_ff::work (int noutput_items,
  59               gr_vector_const_void_star &input_items,
  60               gr_vector_void_star &output_items)
  61 {
  62   float *iptr = (float *) input_items[0];
  63   float *optr = (float *) output_items[0];
  64
  65   for (int i = 0; i < noutput_items; i++){
  66     optr[i]= (float)0;
  67     if(iptr[i] ==(float)1) {
  68       if (d_restart == 0) {
  69         d_pulse_phase = 1;
  70       } else {
  71         if (d_pulse_phase > 0.5) d_pulse_phase += d_gain*(1.0-d_pulse_phase);
  72         else d_pulse_phase -= d_gain*d_pulse_phase;
  73       }
  74       d_restart = 3;
  75     }
  76     if (d_pulse_phase > d_decision_threshold) {
  77       d_pulse_phase -= 1.0;
  78       if (d_restart > 0) {
  79         d_restart -= 1;
  80         optr[i] = (float)1;
  81       }
  82     }
  83     d_pulse_phase += d_pulse_frequency;
  84   }
  85   return noutput_items;
  86 }