1 files changed, 157 insertions, 0 deletions
diff --git a/src/FIRFilter.h b/src/FIRFilter.h
new file mode 100644
index 0000000..397301d
--- /dev/null
+++ b/src/FIRFilter.h
@@ -0,0 +1,157 @@
+/*
+   Copyright (C) 2007, 2008, 2009, 2010, 2011 Her Majesty the Queen in
+   Right of Canada (Communications Research Center Canada)
+
+   Written by
+   2012, Matthias P. Braendli, matthias.braendli@mpb.li
+ */
+/*
+   This file is part of CRC-DADMOD.
+
+   CRC-DADMOD 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.
+
+   CRC-DADMOD 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 CRC-DADMOD.  If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#ifndef FIRFILTER_H
+#define FIRFILTER_H
+
+#ifdef HAVE_CONFIG_H
+#   include <config.h>
+#endif
+
+#include <boost/thread.hpp>
+#include <queue>
+
+#include "ModCodec.h"
+
+#include <sys/types.h>
+#include <complex>
+
+#include <time.h>
+#include <cstdio>
+
+//#define MDEBUG(fmt, args...) fprintf (stderr, fmt , ## args) 
+#define MDEBUG(fmt, args...) 
+
+typedef std::complex<float> complexf;
+
+template<typename T>
+class ThreadsafeQueue
+{
+private:
+    std::queue<T> the_queue;
+    mutable boost::mutex the_mutex;
+    boost::condition_variable the_condition_variable;
+public:
+    void push(T const& val)
+    {
+        boost::mutex::scoped_lock lock(the_mutex);
+        the_queue.push(val);
+        lock.unlock();
+        the_condition_variable.notify_one();
+    }
+
+    bool empty() const
+    {
+        boost::mutex::scoped_lock lock(the_mutex);
+        return the_queue.empty();
+    }
+
+    bool try_pop(T& popped_value)
+    {
+        boost::mutex::scoped_lock lock(the_mutex);
+        if(the_queue.empty())
+        {
+            return false;
+        }
+
+        popped_value = the_queue.front();
+        the_queue.pop();
+        return true;
+    }
+
+    void wait_and_pop(T& popped_value)
+    {
+        boost::mutex::scoped_lock lock(the_mutex);
+        while(the_queue.empty())
+        {
+            the_condition_variable.wait(lock);
+        }
+        
+        popped_value = the_queue.front();
+        the_queue.pop();
+    }
+};
+
+struct FIRFilterWorkerData {
+    ThreadsafeQueue<Buffer*> input_queue;
+    ThreadsafeQueue<Buffer*> output_queue;
+    float* taps;
+    int n_taps;
+};
+
+class FIRFilterWorker {
+    public:
+        FIRFilterWorker () {
+            running = false;
+            calculationTime = 0;
+        }
+
+        ~FIRFilterWorker() {
+            MDEBUG("~FIRFilterWorker: Total elapsed thread time filtering: %zu\n", calculationTime);
+        }
+
+        void start(struct FIRFilterWorkerData *firworkerdata) {
+            running = true;
+            fir_thread = boost::thread(&FIRFilterWorker::process, this, firworkerdata);
+        }
+
+        void stop() {
+            running = false;
+            fir_thread.interrupt();
+            fir_thread.join();
+        }
+
+        void process(struct FIRFilterWorkerData *fwd);
+
+
+    private:
+        time_t calculationTime; 
+        struct FIRFilterWorkerData *workerdata;
+        bool running;
+        boost::thread fir_thread;
+};
+
+
+class FIRFilter : public ModCodec
+{
+public:
+    FIRFilter(char* taps_file);
+    virtual ~FIRFilter();
+    FIRFilter(const FIRFilter&);
+    FIRFilter& operator=(const FIRFilter&);
+
+    int process(Buffer* const dataIn, Buffer* dataOut);
+    const char* name() { return "FIRFilter"; }
+
+protected:
+    int my_Ntaps;
+    float* myFilter;
+
+    FIRFilterWorker worker;
+    int number_of_runs;
+    struct FIRFilterWorkerData firwd;
+};
+
+
+#endif //FIRFILTER_H