aboutsummaryrefslogtreecommitdiffstats
path: root/src/TimeInterleaver.cpp
diff options
context:
space:
mode:
authorMatthias (think) <matthias@mpb.li>2012-07-11 11:49:12 +0200
committerMatthias (think) <matthias@mpb.li>2012-07-11 11:49:12 +0200
commite92f9c408634810828e75d4ad6da408e1c142195 (patch)
treed4e622617f58a70ed3dd2e57418f73f412e7193b /src/TimeInterleaver.cpp
downloaddabmod-e92f9c408634810828e75d4ad6da408e1c142195.tar.gz
dabmod-e92f9c408634810828e75d4ad6da408e1c142195.tar.bz2
dabmod-e92f9c408634810828e75d4ad6da408e1c142195.zip
added unmodified mmbtools
Diffstat (limited to 'src/TimeInterleaver.cpp')
-rw-r--r--src/TimeInterleaver.cpp92
1 files changed, 92 insertions, 0 deletions
diff --git a/src/TimeInterleaver.cpp b/src/TimeInterleaver.cpp
new file mode 100644
index 0000000..92cba79
--- /dev/null
+++ b/src/TimeInterleaver.cpp
@@ -0,0 +1,92 @@
+/*
+ Copyright (C) 2005, 2006, 2007, 2008, 2009, 2010, 2011 Her Majesty
+ the Queen in Right of Canada (Communications Research Center Canada)
+ */
+/*
+ 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/>.
+ */
+
+#include "TimeInterleaver.h"
+#include "PcDebug.h"
+
+#include <vector>
+#include <stdint.h>
+
+
+TimeInterleaver::TimeInterleaver(size_t framesize)
+ throw (std::invalid_argument) :
+ ModCodec(ModFormat(framesize), ModFormat(framesize)),
+ d_framesize(framesize)
+{
+ PDEBUG("TimeInterleaver::TimeInterleaver(%zu) @ %p\n", framesize, this);
+
+ if (framesize & 1) {
+ throw std::invalid_argument("framesize must be 16 bits multiple");
+ }
+ for (int i = 0; i < 16; ++i) {
+ std::vector<unsigned char> data(framesize, 0);
+ d_history.push_back(data);
+ }
+}
+
+
+TimeInterleaver::~TimeInterleaver()
+{
+ PDEBUG("TimeInterleaver::~TimeInterleaver() @ %p\n", this);
+}
+
+
+int TimeInterleaver::process(Buffer* const dataIn, Buffer* dataOut)
+{
+ PDEBUG("TimeInterleaver::process(dataIn: %p, dataOut: %p)\n",
+ dataIn, dataOut);
+
+ dataOut->setLength(dataIn->getLength());
+ const unsigned char* in = reinterpret_cast<const unsigned char*>(dataIn->getData());
+ unsigned char* out = reinterpret_cast<unsigned char*>(dataOut->getData());
+
+
+ for (size_t i = 0; i < dataOut->getLength();) {
+ d_history.push_front(d_history.back());
+ d_history.pop_back();
+ for (uint_fast16_t j = 0; j < d_framesize;) {
+ d_history[0][j] = in[i];
+ out[i] = d_history[0] [j] & 0x80;
+ out[i] |= d_history[8] [j] & 0x40;
+ out[i] |= d_history[4] [j] & 0x20;
+ out[i] |= d_history[12][j] & 0x10;
+ out[i] |= d_history[2] [j] & 0x08;
+ out[i] |= d_history[10][j] & 0x04;
+ out[i] |= d_history[6] [j] & 0x02;
+ out[i] |= d_history[14][j] & 0x01;
+ ++i;
+ ++j;
+ d_history[0][j] = in[i];
+ out[i] = d_history[1] [j] & 0x80;
+ out[i] |= d_history[9] [j] & 0x40;
+ out[i] |= d_history[5] [j] & 0x20;
+ out[i] |= d_history[13][j] & 0x10;
+ out[i] |= d_history[3] [j] & 0x08;
+ out[i] |= d_history[11][j] & 0x04;
+ out[i] |= d_history[7] [j] & 0x02;
+ out[i] |= d_history[15][j] & 0x01;
+ ++i;
+ ++j;
+ }
+ }
+
+ return dataOut->getLength();
+}