summaryrefslogtreecommitdiffstats
path: root/src/FrameMultiplexer.cpp
diff options
context:
space:
mode:
Diffstat (limited to 'src/FrameMultiplexer.cpp')
-rw-r--r--src/FrameMultiplexer.cpp90
1 files changed, 90 insertions, 0 deletions
diff --git a/src/FrameMultiplexer.cpp b/src/FrameMultiplexer.cpp
new file mode 100644
index 0000000..4eb72b2
--- /dev/null
+++ b/src/FrameMultiplexer.cpp
@@ -0,0 +1,90 @@
+/*
+ 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 "FrameMultiplexer.h"
+#include "PcDebug.h"
+
+#include <stdio.h>
+#include <stdexcept>
+#include <complex>
+#include <assert.h>
+#include <string.h>
+
+typedef std::complex<float> complexf;
+
+
+FrameMultiplexer::FrameMultiplexer(size_t framesize, const std::vector<SubchannelSource*>* subchannels) :
+ ModMux(ModFormat(framesize), ModFormat(framesize)),
+ d_frameSize(framesize),
+ mySubchannels(subchannels)
+{
+ PDEBUG("FrameMultiplexer::FrameMultiplexer(%zu) @ %p\n", framesize, this);
+
+}
+
+
+FrameMultiplexer::~FrameMultiplexer()
+{
+ PDEBUG("FrameMultiplexer::~FrameMultiplexer() @ %p\n", this);
+
+}
+
+
+// dataIn[0] -> PRBS
+// dataIn[1+] -> subchannels
+int FrameMultiplexer::process(std::vector<Buffer*> dataIn, Buffer* dataOut)
+{
+ assert(dataIn.size() >= 1);
+ assert(dataIn[0]->getLength() == 864 * 8);
+ dataOut->setLength(dataIn[0]->getLength());
+
+#ifdef DEBUG
+ fprintf(stderr, "FrameMultiplexer::process(dataIn:");
+ for (unsigned i = 0; i < dataIn.size(); ++i) {
+ fprintf(stderr, " %p", dataIn[i]);
+ }
+ fprintf(stderr, ", sizeIn:");
+ for (unsigned i = 0; i < dataIn.size(); ++i) {
+ fprintf(stderr, " %zu", dataIn[i]->getLength());
+ }
+ fprintf(stderr, ", dataOut: %p, sizeOut: %zu)\n", dataOut, dataOut->getLength());
+#endif
+
+ unsigned char* out = reinterpret_cast<unsigned char*>(dataOut->getData());
+ std::vector<Buffer*>::const_iterator in = dataIn.begin();
+
+ // Write PRBS
+ memcpy(out, (*in)->getData(), (*in)->getLength());
+ ++in;
+ // Write subchannel
+ assert(mySubchannels->size() == dataIn.size() - 1);
+ std::vector<SubchannelSource*>::const_iterator subchannel =
+ mySubchannels->begin();
+ while (in != dataIn.end()) {
+ assert((*subchannel)->framesizeCu() * 8 == (*in)->getLength());
+ size_t offset = (*subchannel)->startAddress() * 8;
+ memcpy(&out[offset], (*in)->getData(), (*in)->getLength());
+ ++in;
+ ++subchannel;
+ }
+
+ return dataOut->getLength();
+}