summaryrefslogtreecommitdiff
path: root/gr-pager/lib/pager_slicer_fb.cc
blob: d419db78a19cf06079a033d57d976de7af882df5 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
/*
 * Copyright 2004,2006,2007 Free Software Foundation, Inc.
 * 
 * This file is part of GNU Radio
 * 
 * GNU Radio 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, or (at your option)
 * any later version.
 * 
 * GNU Radio 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 GNU Radio; see the file COPYING.  If not, write to
 * the Free Software Foundation, Inc., 51 Franklin Street,
 * Boston, MA 02110-1301, USA.
 */

#ifdef HAVE_CONFIG_H
#include "config.h"
#endif

#include <pager_slicer_fb.h>
#include <gr_io_signature.h>

pager_slicer_fb_sptr pager_make_slicer_fb(float alpha)
{
    return pager_slicer_fb_sptr(new pager_slicer_fb(alpha));
}

pager_slicer_fb::pager_slicer_fb(float alpha) :
    gr_sync_block ("slicer_fb",
                   gr_make_io_signature (1, 1, sizeof(float)),
                   gr_make_io_signature (1, 1, sizeof(unsigned char)))
{
    d_alpha = alpha;
    d_beta = 1.0-alpha;
    d_avg = 0.0;
}

// Tracks average, minimum, and peak, then converts input into one of:
//
// [0, 1, 2, 3]
unsigned char pager_slicer_fb::slice(float sample)
{
    unsigned char decision;

    // Update DC level and remove
    d_avg = d_avg*d_beta+sample*d_alpha;
    sample -= d_avg;

    if (sample > 0) {
        if (sample > 2.0)          
            decision = 3;
        else
            decision = 2;
    }
    else {
        if (sample < -2.0)
            decision = 0;
        else
            decision = 1;
    }

    return decision;
}

int pager_slicer_fb::work(int noutput_items,
                          gr_vector_const_void_star &input_items,
		                  gr_vector_void_star &output_items)
{
    float *iptr = (float *) input_items[0];
    unsigned char *optr = (unsigned char *) output_items[0];

    int size = noutput_items;

    for (int i = 0; i < size; i++)
        *optr++ = slice(*iptr++);

    return noutput_items;
}