2011-10-12 07:44:40 +00:00
|
|
|
/*
|
|
|
|
* Copyright 2008, 2009, 2010 Free Software Foundation, Inc.
|
|
|
|
*
|
|
|
|
* This software is distributed under the terms of the GNU Public License.
|
|
|
|
* See the COPYING file in the main directory for details.
|
|
|
|
*
|
|
|
|
* This use of this software may be subject to additional restrictions.
|
|
|
|
* See the LEGAL file in the main directory for details.
|
|
|
|
|
|
|
|
This program 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.
|
|
|
|
|
|
|
|
This program 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 this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <stdio.h>
|
|
|
|
#include "Transceiver.h"
|
|
|
|
#include <Logger.h>
|
|
|
|
|
2012-08-08 00:51:31 +00:00
|
|
|
#ifdef HAVE_CONFIG_H
|
|
|
|
#include "config.h"
|
|
|
|
#endif
|
|
|
|
|
2013-06-16 10:30:58 +00:00
|
|
|
using namespace GSM;
|
|
|
|
|
Alexander's patches:
1)I did an experiment and compiled OpenBTS with clang yesterday, which
immediately highlighted two potential bugs in the Transceiver52 code.
I'm not sure they are indeed bugs and not the intended behavior, but
they look very much like that. The first one is below and the second
one is in the following mail.
GSM::Time() arguments are defined like #define USB_LATENCY_INTRVL
(10,0), which means that they are expanded into GSM::Time((10,0)).
This expression is a GSM::Time() with a single parameter where (10,0)
return value of the last argument, 0 in this case. I.e.
GSM::Time((10,0)) is equivalent to GSM::Time(0). I think this was not
the intention.
2) Printing \n after every complex number breaks output when you want to
print it in a single line, e.g. in many debug output.
I do not claim any copyright over this change, as it's very basic.
Looking forward to see it merged into mainline.
git-svn-id: http://wush.net/svn/range/software/public/openbts/trunk@4515 19bc5d8c-e614-43d4-8b26-e1612bc8e597
2012-11-23 08:37:32 +00:00
|
|
|
#define USB_LATENCY_INTRVL 10,0
|
2011-10-12 07:44:40 +00:00
|
|
|
|
2012-08-08 00:51:31 +00:00
|
|
|
#if USE_UHD
|
Alexander's patches:
1)I did an experiment and compiled OpenBTS with clang yesterday, which
immediately highlighted two potential bugs in the Transceiver52 code.
I'm not sure they are indeed bugs and not the intended behavior, but
they look very much like that. The first one is below and the second
one is in the following mail.
GSM::Time() arguments are defined like #define USB_LATENCY_INTRVL
(10,0), which means that they are expanded into GSM::Time((10,0)).
This expression is a GSM::Time() with a single parameter where (10,0)
return value of the last argument, 0 in this case. I.e.
GSM::Time((10,0)) is equivalent to GSM::Time(0). I think this was not
the intention.
2) Printing \n after every complex number breaks output when you want to
print it in a single line, e.g. in many debug output.
I do not claim any copyright over this change, as it's very basic.
Looking forward to see it merged into mainline.
git-svn-id: http://wush.net/svn/range/software/public/openbts/trunk@4515 19bc5d8c-e614-43d4-8b26-e1612bc8e597
2012-11-23 08:37:32 +00:00
|
|
|
# define USB_LATENCY_MIN 6,7
|
2012-08-08 00:51:31 +00:00
|
|
|
#else
|
Alexander's patches:
1)I did an experiment and compiled OpenBTS with clang yesterday, which
immediately highlighted two potential bugs in the Transceiver52 code.
I'm not sure they are indeed bugs and not the intended behavior, but
they look very much like that. The first one is below and the second
one is in the following mail.
GSM::Time() arguments are defined like #define USB_LATENCY_INTRVL
(10,0), which means that they are expanded into GSM::Time((10,0)).
This expression is a GSM::Time() with a single parameter where (10,0)
return value of the last argument, 0 in this case. I.e.
GSM::Time((10,0)) is equivalent to GSM::Time(0). I think this was not
the intention.
2) Printing \n after every complex number breaks output when you want to
print it in a single line, e.g. in many debug output.
I do not claim any copyright over this change, as it's very basic.
Looking forward to see it merged into mainline.
git-svn-id: http://wush.net/svn/range/software/public/openbts/trunk@4515 19bc5d8c-e614-43d4-8b26-e1612bc8e597
2012-11-23 08:37:32 +00:00
|
|
|
# define USB_LATENCY_MIN 1,1
|
2012-08-08 00:51:31 +00:00
|
|
|
#endif
|
2011-10-12 07:44:40 +00:00
|
|
|
|
2013-10-18 01:23:34 +00:00
|
|
|
/* Number of running values use in noise average */
|
|
|
|
#define NOISE_CNT 20
|
2012-12-06 15:43:55 +00:00
|
|
|
|
2013-10-29 19:55:47 +00:00
|
|
|
TransceiverState::TransceiverState()
|
2013-11-14 20:52:04 +00:00
|
|
|
: mNoiseLev(0.0), mNoises(NOISE_CNT)
|
2013-10-29 19:55:47 +00:00
|
|
|
{
|
|
|
|
for (int i = 0; i < 8; i++) {
|
|
|
|
chanType[i] = Transceiver::NONE;
|
|
|
|
fillerModulus[i] = 26;
|
|
|
|
chanResponse[i] = NULL;
|
|
|
|
DFEForward[i] = NULL;
|
|
|
|
DFEFeedback[i] = NULL;
|
|
|
|
|
|
|
|
for (int n = 0; n < 102; n++)
|
|
|
|
fillerTable[n][i] = NULL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
TransceiverState::~TransceiverState()
|
|
|
|
{
|
|
|
|
for (int i = 0; i < 8; i++) {
|
|
|
|
delete chanResponse[i];
|
|
|
|
delete DFEForward[i];
|
|
|
|
delete DFEFeedback[i];
|
|
|
|
|
|
|
|
for (int n = 0; n < 102; n++)
|
|
|
|
delete fillerTable[n][i];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void TransceiverState::init(size_t slot, signalVector *burst)
|
|
|
|
{
|
|
|
|
for (int i = 0; i < 102; i++)
|
|
|
|
fillerTable[i][slot] = new signalVector(*burst);
|
|
|
|
}
|
|
|
|
|
2011-10-12 07:44:40 +00:00
|
|
|
Transceiver::Transceiver(int wBasePort,
|
|
|
|
const char *TRXAddress,
|
2013-10-29 22:34:16 +00:00
|
|
|
size_t wSPS, size_t wChans,
|
2011-10-12 07:44:40 +00:00
|
|
|
GSM::Time wTransmitLatency,
|
|
|
|
RadioInterface *wRadioInterface)
|
2013-10-29 19:17:34 +00:00
|
|
|
: mBasePort(wBasePort), mAddr(TRXAddress),
|
2013-11-14 20:52:04 +00:00
|
|
|
mTransmitLatency(wTransmitLatency), mClockSocket(NULL),
|
|
|
|
mRadioInterface(wRadioInterface), mSPSTx(wSPS), mSPSRx(1), mChans(wChans),
|
2013-10-29 22:34:16 +00:00
|
|
|
mOn(false), mTxFreq(0.0), mRxFreq(0.0), mPower(-10), mMaxExpectedDelay(0)
|
2011-10-12 07:44:40 +00:00
|
|
|
{
|
|
|
|
GSM::Time startTime(random() % gHyperframe,0);
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
mRxLowerLoopThread = new Thread(32768);
|
|
|
|
mTxLowerLoopThread = new Thread(32768);
|
2011-10-12 07:44:40 +00:00
|
|
|
|
|
|
|
mTransmitDeadlineClock = startTime;
|
|
|
|
mLastClockUpdateTime = startTime;
|
|
|
|
mLatencyUpdateTime = startTime;
|
|
|
|
mRadioInterface->getClock()->set(startTime);
|
|
|
|
|
|
|
|
txFullScale = mRadioInterface->fullScaleInputValue();
|
|
|
|
rxFullScale = mRadioInterface->fullScaleOutputValue();
|
2013-08-20 20:10:01 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
Transceiver::~Transceiver()
|
|
|
|
{
|
|
|
|
sigProcLibDestroy();
|
2013-10-29 19:17:34 +00:00
|
|
|
|
|
|
|
delete mClockSocket;
|
2013-10-29 22:34:16 +00:00
|
|
|
|
|
|
|
for (size_t i = 0; i < mChans; i++) {
|
|
|
|
mTxPriorityQueues[i].clear();
|
|
|
|
delete mCtrlSockets[i];
|
|
|
|
delete mDataSockets[i];
|
|
|
|
}
|
2013-08-20 20:10:01 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
bool Transceiver::init()
|
|
|
|
{
|
2013-11-14 03:40:44 +00:00
|
|
|
int d_srcport, d_dstport, c_srcport, c_dstport;
|
2013-10-29 19:55:47 +00:00
|
|
|
signalVector *burst;
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
if (!mChans) {
|
|
|
|
LOG(ALERT) << "No channels assigned";
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2013-10-11 17:49:55 +00:00
|
|
|
if (!sigProcLibSetup(mSPSTx)) {
|
2013-08-20 20:10:01 +00:00
|
|
|
LOG(ALERT) << "Failed to initialize signal processing library";
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
mDataSockets.resize(mChans);
|
|
|
|
mCtrlSockets.resize(mChans);
|
|
|
|
|
|
|
|
mControlServiceLoopThreads.resize(mChans);
|
|
|
|
mTxPriorityQueueServiceLoopThreads.resize(mChans);
|
|
|
|
mRxServiceLoopThreads.resize(mChans);
|
|
|
|
|
|
|
|
mTxPriorityQueues.resize(mChans);
|
|
|
|
mReceiveFIFO.resize(mChans);
|
|
|
|
mStates.resize(mChans);
|
|
|
|
|
2013-10-29 19:17:34 +00:00
|
|
|
mClockSocket = new UDPSocket(mBasePort, mAddr.c_str(), mBasePort + 100);
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
for (size_t i = 0; i < mChans; i++) {
|
2013-11-14 03:40:44 +00:00
|
|
|
c_srcport = mBasePort + 2 * i + 1;
|
|
|
|
c_dstport = mBasePort + 2 * i + 101;
|
|
|
|
d_srcport = mBasePort + 2 * i + 2;
|
|
|
|
d_dstport = mBasePort + 2 * i + 102;
|
|
|
|
|
|
|
|
mCtrlSockets[i] = new UDPSocket(c_srcport, mAddr.c_str(), c_dstport);
|
|
|
|
mDataSockets[i] = new UDPSocket(d_srcport, mAddr.c_str(), d_dstport);
|
2013-10-29 22:34:16 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
for (size_t i = 0; i < mChans; i++) {
|
|
|
|
mControlServiceLoopThreads[i] = new Thread(32768);
|
|
|
|
mTxPriorityQueueServiceLoopThreads[i] = new Thread(32768);
|
|
|
|
mRxServiceLoopThreads[i] = new Thread(32768);
|
2013-08-20 20:10:01 +00:00
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
for (size_t n = 0; n < 8; n++) {
|
|
|
|
burst = modulateBurst(gDummyBurst, 8 + (n % 4 == 0), mSPSTx);
|
|
|
|
scaleVector(*burst, txFullScale);
|
|
|
|
mStates[i].init(n, burst);
|
|
|
|
delete burst;
|
|
|
|
}
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
|
2013-08-20 20:10:01 +00:00
|
|
|
return true;
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
|
2013-11-14 03:48:11 +00:00
|
|
|
void Transceiver::addRadioVector(size_t chan, BitVector &bits,
|
2013-10-29 22:34:16 +00:00
|
|
|
int RSSI, GSM::Time &wTime)
|
2011-10-12 07:44:40 +00:00
|
|
|
{
|
2013-11-14 03:48:11 +00:00
|
|
|
signalVector *burst;
|
|
|
|
radioVector *radio_burst;
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
if (chan >= mTxPriorityQueues.size()) {
|
|
|
|
LOG(ALERT) << "Invalid channel " << chan;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2013-11-14 20:28:23 +00:00
|
|
|
if (wTime.TN() > 7) {
|
|
|
|
LOG(ALERT) << "Received burst with invalid slot " << wTime.TN();
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2013-11-14 03:48:11 +00:00
|
|
|
burst = modulateBurst(bits, 8 + (wTime.TN() % 4 == 0), mSPSTx);
|
|
|
|
scaleVector(*burst, txFullScale * pow(10, -RSSI / 10));
|
|
|
|
|
|
|
|
radio_burst = new radioVector(wTime, burst);
|
2011-10-12 07:44:40 +00:00
|
|
|
|
2013-11-14 03:48:11 +00:00
|
|
|
mTxPriorityQueues[chan].write(radio_burst);
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
void Transceiver::pushRadioVector(GSM::Time &nowTime)
|
|
|
|
{
|
2013-10-29 22:34:16 +00:00
|
|
|
int TN, modFN;
|
|
|
|
radioVector *burst;
|
|
|
|
TransceiverState *state;
|
|
|
|
std::vector<signalVector *> bursts(mChans);
|
|
|
|
std::vector<bool> zeros(mChans);
|
2011-10-12 07:44:40 +00:00
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
for (size_t i = 0; i < mChans; i ++) {
|
|
|
|
state = &mStates[i];
|
|
|
|
|
|
|
|
while ((burst = mTxPriorityQueues[i].getStaleBurst(nowTime))) {
|
|
|
|
LOG(NOTICE) << "dumping STALE burst in TRX->USRP interface";
|
|
|
|
|
|
|
|
TN = burst->getTime().TN();
|
|
|
|
modFN = burst->getTime().FN() % state->fillerModulus[TN];
|
|
|
|
|
|
|
|
delete state->fillerTable[modFN][TN];
|
2013-11-14 03:48:11 +00:00
|
|
|
state->fillerTable[modFN][TN] = burst->getVector();
|
|
|
|
burst->setVector(NULL);
|
|
|
|
delete burst;
|
2013-10-29 22:34:16 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
TN = nowTime.TN();
|
|
|
|
modFN = nowTime.FN() % state->fillerModulus[TN];
|
|
|
|
|
|
|
|
bursts[i] = state->fillerTable[modFN][TN];
|
|
|
|
zeros[i] = state->chanType[TN] == NONE;
|
|
|
|
|
|
|
|
if ((burst = mTxPriorityQueues[i].getCurrentBurst(nowTime))) {
|
|
|
|
delete state->fillerTable[modFN][TN];
|
2013-11-14 03:48:11 +00:00
|
|
|
state->fillerTable[modFN][TN] = burst->getVector();
|
|
|
|
bursts[i] = burst->getVector();
|
|
|
|
burst->setVector(NULL);
|
|
|
|
delete burst;
|
2013-10-29 22:34:16 +00:00
|
|
|
}
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
mRadioInterface->driveTransmitRadio(bursts, zeros);
|
|
|
|
|
|
|
|
return;
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
void Transceiver::setModulus(size_t timeslot, size_t chan)
|
2011-10-12 07:44:40 +00:00
|
|
|
{
|
2013-10-29 22:34:16 +00:00
|
|
|
TransceiverState *state = &mStates[chan];
|
|
|
|
|
|
|
|
switch (state->chanType[timeslot]) {
|
2011-10-12 07:44:40 +00:00
|
|
|
case NONE:
|
|
|
|
case I:
|
|
|
|
case II:
|
|
|
|
case III:
|
|
|
|
case FILL:
|
2013-10-29 22:34:16 +00:00
|
|
|
state->fillerModulus[timeslot] = 26;
|
2011-10-12 07:44:40 +00:00
|
|
|
break;
|
|
|
|
case IV:
|
|
|
|
case VI:
|
|
|
|
case V:
|
2013-10-29 22:34:16 +00:00
|
|
|
state->fillerModulus[timeslot] = 51;
|
2011-10-12 07:44:40 +00:00
|
|
|
break;
|
|
|
|
//case V:
|
|
|
|
case VII:
|
2013-10-29 22:34:16 +00:00
|
|
|
state->fillerModulus[timeslot] = 102;
|
2011-10-12 07:44:40 +00:00
|
|
|
break;
|
2013-06-09 22:38:18 +00:00
|
|
|
case XIII:
|
2013-10-29 22:34:16 +00:00
|
|
|
state->fillerModulus[timeslot] = 52;
|
2013-06-09 22:38:18 +00:00
|
|
|
break;
|
2011-10-12 07:44:40 +00:00
|
|
|
default:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
Transceiver::CorrType Transceiver::expectedCorrType(GSM::Time currTime,
|
|
|
|
size_t chan)
|
2011-10-12 07:44:40 +00:00
|
|
|
{
|
2013-10-29 22:34:16 +00:00
|
|
|
TransceiverState *state = &mStates[chan];
|
2011-10-12 07:44:40 +00:00
|
|
|
unsigned burstTN = currTime.TN();
|
|
|
|
unsigned burstFN = currTime.FN();
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
switch (state->chanType[burstTN]) {
|
2011-10-12 07:44:40 +00:00
|
|
|
case NONE:
|
|
|
|
return OFF;
|
|
|
|
break;
|
|
|
|
case FILL:
|
|
|
|
return IDLE;
|
|
|
|
break;
|
|
|
|
case I:
|
|
|
|
return TSC;
|
|
|
|
/*if (burstFN % 26 == 25)
|
|
|
|
return IDLE;
|
|
|
|
else
|
|
|
|
return TSC;*/
|
|
|
|
break;
|
|
|
|
case II:
|
2013-03-27 22:00:25 +00:00
|
|
|
return TSC;
|
2011-10-12 07:44:40 +00:00
|
|
|
break;
|
|
|
|
case III:
|
|
|
|
return TSC;
|
|
|
|
break;
|
|
|
|
case IV:
|
|
|
|
case VI:
|
|
|
|
return RACH;
|
|
|
|
break;
|
|
|
|
case V: {
|
|
|
|
int mod51 = burstFN % 51;
|
|
|
|
if ((mod51 <= 36) && (mod51 >= 14))
|
|
|
|
return RACH;
|
|
|
|
else if ((mod51 == 4) || (mod51 == 5))
|
|
|
|
return RACH;
|
|
|
|
else if ((mod51 == 45) || (mod51 == 46))
|
|
|
|
return RACH;
|
|
|
|
else
|
|
|
|
return TSC;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
case VII:
|
|
|
|
if ((burstFN % 51 <= 14) && (burstFN % 51 >= 12))
|
|
|
|
return IDLE;
|
|
|
|
else
|
|
|
|
return TSC;
|
|
|
|
break;
|
2013-06-09 22:38:18 +00:00
|
|
|
case XIII: {
|
|
|
|
int mod52 = burstFN % 52;
|
|
|
|
if ((mod52 == 12) || (mod52 == 38))
|
|
|
|
return RACH;
|
|
|
|
else if ((mod52 == 25) || (mod52 == 51))
|
|
|
|
return IDLE;
|
|
|
|
else
|
|
|
|
return TSC;
|
|
|
|
break;
|
|
|
|
}
|
2011-10-12 07:44:40 +00:00
|
|
|
case LOOPBACK:
|
|
|
|
if ((burstFN % 51 <= 50) && (burstFN % 51 >=48))
|
|
|
|
return IDLE;
|
|
|
|
else
|
|
|
|
return TSC;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
return OFF;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
2013-10-18 01:23:34 +00:00
|
|
|
|
2013-11-14 04:14:48 +00:00
|
|
|
/*
|
|
|
|
* Detect RACH synchronization sequence within a burst. No equalization
|
|
|
|
* is used or available on the RACH channel.
|
|
|
|
*/
|
|
|
|
bool Transceiver::detectRACH(TransceiverState *state,
|
|
|
|
signalVector &burst,
|
|
|
|
complex &, float &toa)
|
2011-10-12 07:44:40 +00:00
|
|
|
{
|
2013-11-14 04:14:48 +00:00
|
|
|
float threshold = 6.0;
|
2011-10-12 07:44:40 +00:00
|
|
|
|
2013-11-14 04:14:48 +00:00
|
|
|
return detectRACHBurst(burst, threshold, mSPSRx, &, &toa);
|
|
|
|
}
|
2011-10-12 07:44:40 +00:00
|
|
|
|
2013-11-14 04:14:48 +00:00
|
|
|
/*
|
|
|
|
* Detect normal burst training sequence midamble. Update equalization
|
|
|
|
* state information and channel estimate if necessary. Equalization
|
|
|
|
* is currently disabled.
|
|
|
|
*/
|
2013-11-14 20:52:04 +00:00
|
|
|
bool Transceiver::detectTSC(TransceiverState *state, signalVector &burst,
|
2013-11-14 04:14:48 +00:00
|
|
|
complex &, float &toa, GSM::Time &time)
|
|
|
|
{
|
|
|
|
int tn = time.TN();
|
|
|
|
float chanOffset, threshold = 5.0;
|
2013-11-14 20:52:04 +00:00
|
|
|
bool noise, needDFE = false, estimateChan = false;
|
2013-11-14 04:14:48 +00:00
|
|
|
double elapsed = time - state->chanEstimateTime[tn];
|
|
|
|
signalVector *chanResp;
|
|
|
|
|
|
|
|
/* Check equalization update state */
|
|
|
|
if ((elapsed > 50) || (!state->chanResponse[tn])) {
|
|
|
|
delete state->DFEForward[tn];
|
|
|
|
delete state->DFEFeedback[tn];
|
|
|
|
state->DFEForward[tn] = NULL;
|
|
|
|
state->DFEFeedback[tn] = NULL;
|
|
|
|
|
|
|
|
estimateChan = true;
|
|
|
|
}
|
2011-10-12 07:44:40 +00:00
|
|
|
|
2013-11-14 04:14:48 +00:00
|
|
|
/* Detect normal burst midambles */
|
|
|
|
if (!analyzeTrafficBurst(burst, mTSC, threshold, mSPSRx, &,
|
|
|
|
&toa, mMaxExpectedDelay, estimateChan,
|
|
|
|
&chanResp, &chanOffset)) {
|
|
|
|
return false;
|
|
|
|
}
|
2011-10-12 07:44:40 +00:00
|
|
|
|
2013-11-14 20:52:04 +00:00
|
|
|
noise = state->mNoiseLev;
|
|
|
|
state->SNRestimate[tn] = amp.norm2() / (noise * noise + 1.0);
|
2011-10-12 07:44:40 +00:00
|
|
|
|
2013-11-14 04:14:48 +00:00
|
|
|
/* Set equalizer if unabled */
|
|
|
|
if (needDFE && estimateChan) {
|
|
|
|
state->chanResponse[tn] = chanResp;
|
|
|
|
state->chanRespOffset[tn] = chanOffset;
|
|
|
|
state->chanRespAmplitude[tn] = amp;
|
|
|
|
|
|
|
|
scaleVector(*chanResp, complex(1.0, 0.0) / amp);
|
|
|
|
|
|
|
|
designDFE(*chanResp, state->SNRestimate[tn],
|
|
|
|
7, &state->DFEForward[tn], &state->DFEFeedback[tn]);
|
|
|
|
|
|
|
|
state->chanEstimateTime[tn] = time;
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
2013-10-18 01:23:34 +00:00
|
|
|
|
2013-11-14 04:14:48 +00:00
|
|
|
return true;;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Demodulate GMSK burst using equalization if requested. Otherwise
|
|
|
|
* demodulate by direct rotation and soft slicing.
|
|
|
|
*/
|
|
|
|
SoftVector *Transceiver::demodulate(TransceiverState *state,
|
|
|
|
signalVector &burst, complex amp,
|
|
|
|
float toa, size_t tn, bool equalize)
|
|
|
|
{
|
|
|
|
if (equalize) {
|
|
|
|
scaleVector(burst, complex(1.0, 0.0) / amp);
|
|
|
|
return equalizeBurst(burst,
|
|
|
|
toa - state->chanRespOffset[tn],
|
|
|
|
mSPSRx,
|
|
|
|
*state->DFEForward[tn],
|
|
|
|
*state->DFEFeedback[tn]);
|
|
|
|
}
|
2013-10-18 01:23:34 +00:00
|
|
|
|
2013-11-14 04:14:48 +00:00
|
|
|
return demodulateBurst(burst, mSPSRx, amp, toa);
|
|
|
|
}
|
2013-10-18 01:23:34 +00:00
|
|
|
|
2013-11-14 04:14:48 +00:00
|
|
|
/*
|
|
|
|
* Pull bursts from the FIFO and handle according to the slot
|
|
|
|
* and burst correlation type. Equalzation is currently disabled.
|
|
|
|
*/
|
|
|
|
SoftVector *Transceiver::pullRadioVector(GSM::Time &wTime, int &RSSI,
|
|
|
|
int &timingOffset, size_t chan)
|
|
|
|
{
|
|
|
|
bool success, equalize = false;
|
|
|
|
complex amp;
|
|
|
|
float toa, pow, max = -1.0, avg = 0.0;
|
2013-11-14 04:38:09 +00:00
|
|
|
int max_i = -1;
|
2013-11-14 04:14:48 +00:00
|
|
|
signalVector *burst;
|
2013-11-14 20:31:24 +00:00
|
|
|
SoftVector *bits = NULL;
|
2013-11-14 20:52:04 +00:00
|
|
|
TransceiverState *state = &mStates[chan];
|
2013-11-14 04:14:48 +00:00
|
|
|
|
|
|
|
/* Blocking FIFO read */
|
|
|
|
radioVector *radio_burst = mReceiveFIFO[chan]->read();
|
|
|
|
if (!radio_burst)
|
|
|
|
return NULL;
|
|
|
|
|
|
|
|
/* Set time and determine correlation type */
|
|
|
|
GSM::Time time = radio_burst->getTime();
|
|
|
|
CorrType type = expectedCorrType(time, chan);
|
|
|
|
|
|
|
|
if ((type == OFF) || (type == IDLE)) {
|
|
|
|
delete radio_burst;
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
2013-11-14 04:38:09 +00:00
|
|
|
/* Select the diversity channel with highest energy */
|
|
|
|
for (size_t i = 0; i < radio_burst->chans(); i++) {
|
|
|
|
energyDetect(*radio_burst->getVector(i), 20 * mSPSRx, 0.0, &pow);
|
|
|
|
if (pow > max) {
|
|
|
|
max = pow;
|
|
|
|
max_i = i;
|
|
|
|
}
|
|
|
|
avg += pow;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (max_i < 0) {
|
|
|
|
LOG(ALERT) << "Received empty burst";
|
|
|
|
delete radio_burst;
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
2013-11-14 04:14:48 +00:00
|
|
|
/* Average noise on diversity paths and update global levels */
|
2013-11-14 04:38:09 +00:00
|
|
|
burst = radio_burst->getVector(max_i);
|
2013-11-14 20:31:24 +00:00
|
|
|
avg = sqrt(avg / radio_burst->chans());
|
2013-11-14 20:52:04 +00:00
|
|
|
state->mNoiseLev = state->mNoises.avg();
|
2013-10-18 01:23:34 +00:00
|
|
|
|
2013-11-14 04:14:48 +00:00
|
|
|
/* Detect normal or RACH bursts */
|
|
|
|
if (type == TSC)
|
2013-11-14 20:52:04 +00:00
|
|
|
success = detectTSC(state, *burst, amp, toa, time);
|
2013-11-14 04:14:48 +00:00
|
|
|
else
|
2013-11-14 20:52:04 +00:00
|
|
|
success = detectRACH(state, *burst, amp, toa);
|
2011-10-12 07:44:40 +00:00
|
|
|
|
2013-11-14 04:14:48 +00:00
|
|
|
if (!success) {
|
2013-11-14 20:52:04 +00:00
|
|
|
state->mNoises.insert(avg);
|
2013-11-14 04:14:48 +00:00
|
|
|
delete radio_burst;
|
|
|
|
return NULL;
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
|
2013-11-14 04:14:48 +00:00
|
|
|
/* Demodulate and set output info */
|
|
|
|
if (equalize && (type != TSC))
|
|
|
|
equalize = false;
|
|
|
|
|
2013-11-14 20:52:04 +00:00
|
|
|
if (avg - state->mNoiseLev > 0.0)
|
|
|
|
bits = demodulate(state, *burst, amp, toa, time.TN(), equalize);
|
2013-11-14 20:31:24 +00:00
|
|
|
|
2013-11-14 04:14:48 +00:00
|
|
|
wTime = time;
|
|
|
|
RSSI = (int) floor(20.0 * log10(rxFullScale / avg));
|
|
|
|
timingOffset = (int) round(toa * 256.0 / mSPSRx);
|
|
|
|
|
|
|
|
delete radio_burst;
|
2011-10-12 07:44:40 +00:00
|
|
|
|
2013-11-14 04:14:48 +00:00
|
|
|
return bits;
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
void Transceiver::start()
|
|
|
|
{
|
2013-10-29 22:34:16 +00:00
|
|
|
TransceiverChannel *chan;
|
|
|
|
|
|
|
|
for (size_t i = 0; i < mControlServiceLoopThreads.size(); i++) {
|
|
|
|
chan = new TransceiverChannel(this, i);
|
|
|
|
mControlServiceLoopThreads[i]->start((void * (*)(void*))
|
|
|
|
ControlServiceLoopAdapter, (void*) chan);
|
|
|
|
}
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
void Transceiver::reset()
|
|
|
|
{
|
2013-10-29 22:34:16 +00:00
|
|
|
for (size_t i = 0; i < mTxPriorityQueues.size(); i++)
|
|
|
|
mTxPriorityQueues[i].clear();
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
void Transceiver::driveControl(size_t chan)
|
2011-10-12 07:44:40 +00:00
|
|
|
{
|
|
|
|
int MAX_PACKET_LENGTH = 100;
|
|
|
|
|
|
|
|
// check control socket
|
|
|
|
char buffer[MAX_PACKET_LENGTH];
|
|
|
|
int msgLen = -1;
|
|
|
|
buffer[0] = '\0';
|
2013-10-29 19:17:34 +00:00
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
msgLen = mCtrlSockets[chan]->read(buffer);
|
2011-10-12 07:44:40 +00:00
|
|
|
|
|
|
|
if (msgLen < 1) {
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
char cmdcheck[4];
|
|
|
|
char command[MAX_PACKET_LENGTH];
|
|
|
|
char response[MAX_PACKET_LENGTH];
|
|
|
|
|
|
|
|
sscanf(buffer,"%3s %s",cmdcheck,command);
|
2013-10-29 22:34:16 +00:00
|
|
|
|
|
|
|
if (!chan)
|
|
|
|
writeClockInterface();
|
2011-10-12 07:44:40 +00:00
|
|
|
|
|
|
|
if (strcmp(cmdcheck,"CMD")!=0) {
|
|
|
|
LOG(WARNING) << "bogus message on control interface";
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
LOG(INFO) << "command is " << buffer;
|
|
|
|
|
|
|
|
if (strcmp(command,"POWEROFF")==0) {
|
|
|
|
// turn off transmitter/demod
|
|
|
|
sprintf(response,"RSP POWEROFF 0");
|
|
|
|
}
|
|
|
|
else if (strcmp(command,"POWERON")==0) {
|
|
|
|
// turn on transmitter/demod
|
|
|
|
if (!mTxFreq || !mRxFreq)
|
|
|
|
sprintf(response,"RSP POWERON 1");
|
|
|
|
else {
|
|
|
|
sprintf(response,"RSP POWERON 0");
|
2013-10-29 22:34:16 +00:00
|
|
|
if (!chan && !mOn) {
|
2011-10-12 07:44:40 +00:00
|
|
|
// Prepare for thread start
|
|
|
|
mPower = -20;
|
|
|
|
mRadioInterface->start();
|
|
|
|
|
|
|
|
// Start radio interface threads.
|
2013-10-29 22:34:16 +00:00
|
|
|
mTxLowerLoopThread->start((void * (*)(void*))
|
|
|
|
TxLowerLoopAdapter,(void*) this);
|
|
|
|
mRxLowerLoopThread->start((void * (*)(void*))
|
|
|
|
RxLowerLoopAdapter,(void*) this);
|
|
|
|
|
|
|
|
for (size_t i = 0; i < mChans; i++) {
|
|
|
|
TransceiverChannel *chan = new TransceiverChannel(this, i);
|
|
|
|
mRxServiceLoopThreads[i]->start((void * (*)(void*))
|
|
|
|
RxUpperLoopAdapter, (void*) chan);
|
|
|
|
|
|
|
|
chan = new TransceiverChannel(this, i);
|
|
|
|
mTxPriorityQueueServiceLoopThreads[i]->start((void * (*)(void*))
|
|
|
|
TxUpperLoopAdapter, (void*) chan);
|
|
|
|
}
|
2011-10-12 07:44:40 +00:00
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
writeClockInterface();
|
2011-10-12 07:44:40 +00:00
|
|
|
mOn = true;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
else if (strcmp(command,"SETMAXDLY")==0) {
|
|
|
|
//set expected maximum time-of-arrival
|
|
|
|
int maxDelay;
|
|
|
|
sscanf(buffer,"%3s %s %d",cmdcheck,command,&maxDelay);
|
|
|
|
mMaxExpectedDelay = maxDelay; // 1 GSM symbol is approx. 1 km
|
|
|
|
sprintf(response,"RSP SETMAXDLY 0 %d",maxDelay);
|
|
|
|
}
|
|
|
|
else if (strcmp(command,"SETRXGAIN")==0) {
|
|
|
|
//set expected maximum time-of-arrival
|
|
|
|
int newGain;
|
|
|
|
sscanf(buffer,"%3s %s %d",cmdcheck,command,&newGain);
|
2013-10-29 22:34:16 +00:00
|
|
|
newGain = mRadioInterface->setRxGain(newGain, chan);
|
2011-10-12 07:44:40 +00:00
|
|
|
sprintf(response,"RSP SETRXGAIN 0 %d",newGain);
|
|
|
|
}
|
|
|
|
else if (strcmp(command,"NOISELEV")==0) {
|
|
|
|
if (mOn) {
|
2013-11-14 20:52:04 +00:00
|
|
|
float lev = mStates[chan].mNoiseLev;
|
2011-10-12 07:44:40 +00:00
|
|
|
sprintf(response,"RSP NOISELEV 0 %d",
|
2013-11-14 20:52:04 +00:00
|
|
|
(int) round(20.0 * log10(rxFullScale / lev)));
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
else {
|
|
|
|
sprintf(response,"RSP NOISELEV 1 0");
|
|
|
|
}
|
2013-11-15 19:15:47 +00:00
|
|
|
}
|
|
|
|
else if (!strcmp(command, "SETPOWER")) {
|
2011-10-12 07:44:40 +00:00
|
|
|
// set output power in dB
|
|
|
|
int dbPwr;
|
2013-11-15 19:15:47 +00:00
|
|
|
sscanf(buffer, "%3s %s %d", cmdcheck, command, &dbPwr);
|
|
|
|
if (!mOn)
|
|
|
|
sprintf(response, "RSP SETPOWER 1 %d", dbPwr);
|
2011-10-12 07:44:40 +00:00
|
|
|
else {
|
|
|
|
mPower = dbPwr;
|
2013-11-15 19:15:47 +00:00
|
|
|
mRadioInterface->setPowerAttenuation(mPower, chan);
|
|
|
|
sprintf(response, "RSP SETPOWER 0 %d", dbPwr);
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
}
|
2013-11-15 19:15:47 +00:00
|
|
|
else if (!strcmp(command,"ADJPOWER")) {
|
2011-10-12 07:44:40 +00:00
|
|
|
// adjust power in dB steps
|
|
|
|
int dbStep;
|
2013-11-15 19:15:47 +00:00
|
|
|
sscanf(buffer, "%3s %s %d", cmdcheck, command, &dbStep);
|
|
|
|
if (!mOn)
|
|
|
|
sprintf(response, "RSP ADJPOWER 1 %d", mPower);
|
2011-10-12 07:44:40 +00:00
|
|
|
else {
|
|
|
|
mPower += dbStep;
|
2013-11-15 19:15:47 +00:00
|
|
|
mRadioInterface->setPowerAttenuation(mPower, chan);
|
|
|
|
sprintf(response, "RSP ADJPOWER 0 %d", mPower);
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
#define FREQOFFSET 0//11.2e3
|
|
|
|
else if (strcmp(command,"RXTUNE")==0) {
|
|
|
|
// tune receiver
|
|
|
|
int freqKhz;
|
|
|
|
sscanf(buffer,"%3s %s %d",cmdcheck,command,&freqKhz);
|
|
|
|
mRxFreq = freqKhz*1.0e3+FREQOFFSET;
|
2013-10-29 22:34:16 +00:00
|
|
|
if (!mRadioInterface->tuneRx(mRxFreq, chan)) {
|
2011-10-12 07:44:40 +00:00
|
|
|
LOG(ALERT) << "RX failed to tune";
|
|
|
|
sprintf(response,"RSP RXTUNE 1 %d",freqKhz);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
sprintf(response,"RSP RXTUNE 0 %d",freqKhz);
|
|
|
|
}
|
|
|
|
else if (strcmp(command,"TXTUNE")==0) {
|
|
|
|
// tune txmtr
|
|
|
|
int freqKhz;
|
|
|
|
sscanf(buffer,"%3s %s %d",cmdcheck,command,&freqKhz);
|
|
|
|
//freqKhz = 890e3;
|
|
|
|
mTxFreq = freqKhz*1.0e3+FREQOFFSET;
|
2013-10-29 22:34:16 +00:00
|
|
|
if (!mRadioInterface->tuneTx(mTxFreq, chan)) {
|
2011-10-12 07:44:40 +00:00
|
|
|
LOG(ALERT) << "TX failed to tune";
|
|
|
|
sprintf(response,"RSP TXTUNE 1 %d",freqKhz);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
sprintf(response,"RSP TXTUNE 0 %d",freqKhz);
|
|
|
|
}
|
|
|
|
else if (strcmp(command,"SETTSC")==0) {
|
|
|
|
// set TSC
|
|
|
|
int TSC;
|
|
|
|
sscanf(buffer,"%3s %s %d",cmdcheck,command,&TSC);
|
|
|
|
if (mOn)
|
|
|
|
sprintf(response,"RSP SETTSC 1 %d",TSC);
|
|
|
|
else {
|
|
|
|
mTSC = TSC;
|
2013-10-11 17:49:55 +00:00
|
|
|
generateMidamble(mSPSRx, TSC);
|
2013-08-20 20:10:01 +00:00
|
|
|
sprintf(response,"RSP SETTSC 0 %d", TSC);
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
else if (strcmp(command,"SETSLOT")==0) {
|
|
|
|
// set TSC
|
|
|
|
int corrCode;
|
|
|
|
int timeslot;
|
|
|
|
sscanf(buffer,"%3s %s %d %d",cmdcheck,command,×lot,&corrCode);
|
|
|
|
if ((timeslot < 0) || (timeslot > 7)) {
|
|
|
|
LOG(WARNING) << "bogus message on control interface";
|
|
|
|
sprintf(response,"RSP SETSLOT 1 %d %d",timeslot,corrCode);
|
|
|
|
return;
|
|
|
|
}
|
2013-10-29 22:34:16 +00:00
|
|
|
mStates[chan].chanType[timeslot] = (ChannelCombination) corrCode;
|
|
|
|
setModulus(timeslot, chan);
|
2011-10-12 07:44:40 +00:00
|
|
|
sprintf(response,"RSP SETSLOT 0 %d %d",timeslot,corrCode);
|
|
|
|
|
|
|
|
}
|
|
|
|
else {
|
|
|
|
LOG(WARNING) << "bogus command " << command << " on control interface.";
|
|
|
|
}
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
mCtrlSockets[chan]->write(response, strlen(response) + 1);
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
bool Transceiver::driveTxPriorityQueue(size_t chan)
|
2011-10-12 07:44:40 +00:00
|
|
|
{
|
|
|
|
char buffer[gSlotLen+50];
|
|
|
|
|
|
|
|
// check data socket
|
2013-10-29 22:34:16 +00:00
|
|
|
size_t msgLen = mDataSockets[chan]->read(buffer);
|
2011-10-12 07:44:40 +00:00
|
|
|
|
|
|
|
if (msgLen!=gSlotLen+1+4+1) {
|
|
|
|
LOG(ERR) << "badly formatted packet on GSM->TRX interface";
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
|
|
|
int timeSlot = (int) buffer[0];
|
|
|
|
uint64_t frameNum = 0;
|
|
|
|
for (int i = 0; i < 4; i++)
|
|
|
|
frameNum = (frameNum << 8) | (0x0ff & buffer[i+1]);
|
|
|
|
|
|
|
|
/*
|
|
|
|
if (GSM::Time(frameNum,timeSlot) > mTransmitDeadlineClock + GSM::Time(51,0)) {
|
|
|
|
// stale burst
|
|
|
|
//LOG(DEBUG) << "FAST! "<< GSM::Time(frameNum,timeSlot);
|
|
|
|
//writeClockInterface();
|
|
|
|
}*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
DAB -- Just let these go through the demod.
|
|
|
|
if (GSM::Time(frameNum,timeSlot) < mTransmitDeadlineClock) {
|
|
|
|
// stale burst from GSM core
|
|
|
|
LOG(NOTICE) << "STALE packet on GSM->TRX interface at time "<< GSM::Time(frameNum,timeSlot);
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
*/
|
|
|
|
|
|
|
|
// periodically update GSM core clock
|
|
|
|
LOG(DEBUG) << "mTransmitDeadlineClock " << mTransmitDeadlineClock
|
|
|
|
<< " mLastClockUpdateTime " << mLastClockUpdateTime;
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
if (!chan) {
|
|
|
|
if (mTransmitDeadlineClock > mLastClockUpdateTime + GSM::Time(216,0))
|
|
|
|
writeClockInterface();
|
|
|
|
}
|
2011-10-12 07:44:40 +00:00
|
|
|
|
|
|
|
LOG(DEBUG) << "rcvd. burst at: " << GSM::Time(frameNum,timeSlot);
|
|
|
|
|
|
|
|
int RSSI = (int) buffer[5];
|
|
|
|
static BitVector newBurst(gSlotLen);
|
|
|
|
BitVector::iterator itr = newBurst.begin();
|
|
|
|
char *bufferItr = buffer+6;
|
|
|
|
while (itr < newBurst.end())
|
|
|
|
*itr++ = *bufferItr++;
|
|
|
|
|
|
|
|
GSM::Time currTime = GSM::Time(frameNum,timeSlot);
|
2013-10-29 22:34:16 +00:00
|
|
|
|
|
|
|
addRadioVector(chan, newBurst, RSSI, currTime);
|
2011-10-12 07:44:40 +00:00
|
|
|
|
|
|
|
return true;
|
|
|
|
|
|
|
|
|
|
|
|
}
|
2013-10-29 22:34:16 +00:00
|
|
|
|
|
|
|
void Transceiver::driveReceiveRadio()
|
2011-10-12 07:44:40 +00:00
|
|
|
{
|
2013-10-29 22:34:16 +00:00
|
|
|
if (!mRadioInterface->driveReceiveRadio())
|
|
|
|
usleep(100000);
|
|
|
|
}
|
2011-10-12 07:44:40 +00:00
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
void Transceiver::driveReceiveFIFO(size_t chan)
|
|
|
|
{
|
2011-10-12 07:44:40 +00:00
|
|
|
SoftVector *rxBurst = NULL;
|
|
|
|
int RSSI;
|
|
|
|
int TOA; // in 1/256 of a symbol
|
|
|
|
GSM::Time burstTime;
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
rxBurst = pullRadioVector(burstTime, RSSI, TOA, chan);
|
2011-10-12 07:44:40 +00:00
|
|
|
|
|
|
|
if (rxBurst) {
|
|
|
|
|
|
|
|
LOG(DEBUG) << "burst parameters: "
|
|
|
|
<< " time: " << burstTime
|
|
|
|
<< " RSSI: " << RSSI
|
|
|
|
<< " TOA: " << TOA
|
|
|
|
<< " bits: " << *rxBurst;
|
|
|
|
|
|
|
|
char burstString[gSlotLen+10];
|
|
|
|
burstString[0] = burstTime.TN();
|
|
|
|
for (int i = 0; i < 4; i++)
|
|
|
|
burstString[1+i] = (burstTime.FN() >> ((3-i)*8)) & 0x0ff;
|
|
|
|
burstString[5] = RSSI;
|
|
|
|
burstString[6] = (TOA >> 8) & 0x0ff;
|
|
|
|
burstString[7] = TOA & 0x0ff;
|
|
|
|
SoftVector::iterator burstItr = rxBurst->begin();
|
|
|
|
|
|
|
|
for (unsigned int i = 0; i < gSlotLen; i++) {
|
|
|
|
burstString[8+i] =(char) round((*burstItr++)*255.0);
|
|
|
|
}
|
|
|
|
burstString[gSlotLen+9] = '\0';
|
|
|
|
delete rxBurst;
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
mDataSockets[chan]->write(burstString,gSlotLen+10);
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
void Transceiver::driveTxFIFO()
|
2011-10-12 07:44:40 +00:00
|
|
|
{
|
|
|
|
|
|
|
|
/**
|
|
|
|
Features a carefully controlled latency mechanism, to
|
|
|
|
assure that transmit packets arrive at the radio/USRP
|
|
|
|
before they need to be transmitted.
|
|
|
|
|
|
|
|
Deadline clock indicates the burst that needs to be
|
|
|
|
pushed into the FIFO right NOW. If transmit queue does
|
|
|
|
not have a burst, stick in filler data.
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
|
|
RadioClock *radioClock = (mRadioInterface->getClock());
|
|
|
|
|
|
|
|
if (mOn) {
|
|
|
|
//radioClock->wait(); // wait until clock updates
|
|
|
|
LOG(DEBUG) << "radio clock " << radioClock->get();
|
|
|
|
while (radioClock->get() + mTransmitLatency > mTransmitDeadlineClock) {
|
|
|
|
// if underrun, then we're not providing bursts to radio/USRP fast
|
|
|
|
// enough. Need to increase latency by one GSM frame.
|
2013-04-05 19:36:30 +00:00
|
|
|
if (mRadioInterface->getWindowType() == RadioDevice::TX_WINDOW_USRP1) {
|
2011-11-26 03:18:55 +00:00
|
|
|
if (mRadioInterface->isUnderrun()) {
|
2012-08-08 00:51:31 +00:00
|
|
|
// only update latency at the defined frame interval
|
|
|
|
if (radioClock->get() > mLatencyUpdateTime + GSM::Time(USB_LATENCY_INTRVL)) {
|
2011-11-26 03:18:55 +00:00
|
|
|
mTransmitLatency = mTransmitLatency + GSM::Time(1,0);
|
|
|
|
LOG(INFO) << "new latency: " << mTransmitLatency;
|
|
|
|
mLatencyUpdateTime = radioClock->get();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
else {
|
|
|
|
// if underrun hasn't occurred in the last sec (216 frames) drop
|
|
|
|
// transmit latency by a timeslot
|
2012-08-08 00:51:31 +00:00
|
|
|
if (mTransmitLatency > GSM::Time(USB_LATENCY_MIN)) {
|
2011-11-26 03:18:55 +00:00
|
|
|
if (radioClock->get() > mLatencyUpdateTime + GSM::Time(216,0)) {
|
|
|
|
mTransmitLatency.decTN();
|
|
|
|
LOG(INFO) << "reduced latency: " << mTransmitLatency;
|
|
|
|
mLatencyUpdateTime = radioClock->get();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
// time to push burst to transmit FIFO
|
|
|
|
pushRadioVector(mTransmitDeadlineClock);
|
|
|
|
mTransmitDeadlineClock.incTN();
|
|
|
|
}
|
|
|
|
}
|
2013-09-28 22:04:19 +00:00
|
|
|
|
|
|
|
radioClock->wait();
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void Transceiver::writeClockInterface()
|
|
|
|
{
|
|
|
|
char command[50];
|
|
|
|
// FIXME -- This should be adaptive.
|
|
|
|
sprintf(command,"IND CLOCK %llu",(unsigned long long) (mTransmitDeadlineClock.FN()+2));
|
|
|
|
|
|
|
|
LOG(INFO) << "ClockInterface: sending " << command;
|
|
|
|
|
2013-10-29 19:17:34 +00:00
|
|
|
mClockSocket->write(command, strlen(command) + 1);
|
2011-10-12 07:44:40 +00:00
|
|
|
|
|
|
|
mLastClockUpdateTime = mTransmitDeadlineClock;
|
|
|
|
|
2013-09-28 22:04:19 +00:00
|
|
|
}
|
2011-10-12 07:44:40 +00:00
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
void *RxUpperLoopAdapter(TransceiverChannel *chan)
|
|
|
|
{
|
|
|
|
Transceiver *trx = chan->trx;
|
|
|
|
size_t num = chan->num;
|
|
|
|
|
|
|
|
delete chan;
|
|
|
|
|
2013-11-08 17:50:03 +00:00
|
|
|
trx->setPriority(0.42);
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
while (1) {
|
|
|
|
trx->driveReceiveFIFO(num);
|
|
|
|
pthread_testcancel();
|
|
|
|
}
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
void *RxLowerLoopAdapter(Transceiver *transceiver)
|
2011-10-12 07:44:40 +00:00
|
|
|
{
|
2013-11-08 17:50:03 +00:00
|
|
|
transceiver->setPriority(0.45);
|
2011-11-26 03:17:21 +00:00
|
|
|
|
2011-10-12 07:44:40 +00:00
|
|
|
while (1) {
|
2013-10-29 22:34:16 +00:00
|
|
|
transceiver->driveReceiveRadio();
|
2013-09-28 22:04:19 +00:00
|
|
|
pthread_testcancel();
|
|
|
|
}
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
void *TxLowerLoopAdapter(Transceiver *transceiver)
|
2013-09-28 22:04:19 +00:00
|
|
|
{
|
2013-11-08 17:50:03 +00:00
|
|
|
transceiver->setPriority(0.44);
|
|
|
|
|
2013-09-28 22:04:19 +00:00
|
|
|
while (1) {
|
2013-10-29 22:34:16 +00:00
|
|
|
transceiver->driveTxFIFO();
|
2011-10-12 07:44:40 +00:00
|
|
|
pthread_testcancel();
|
|
|
|
}
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
void *ControlServiceLoopAdapter(TransceiverChannel *chan)
|
2011-10-12 07:44:40 +00:00
|
|
|
{
|
2013-10-29 22:34:16 +00:00
|
|
|
Transceiver *trx = chan->trx;
|
|
|
|
size_t num = chan->num;
|
|
|
|
|
|
|
|
delete chan;
|
|
|
|
|
2011-10-12 07:44:40 +00:00
|
|
|
while (1) {
|
2013-10-29 22:34:16 +00:00
|
|
|
trx->driveControl(num);
|
2011-10-12 07:44:40 +00:00
|
|
|
pthread_testcancel();
|
|
|
|
}
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
2013-10-29 22:34:16 +00:00
|
|
|
void *TxUpperLoopAdapter(TransceiverChannel *chan)
|
2011-10-12 07:44:40 +00:00
|
|
|
{
|
2013-10-29 22:34:16 +00:00
|
|
|
Transceiver *trx = chan->trx;
|
|
|
|
size_t num = chan->num;
|
|
|
|
|
|
|
|
delete chan;
|
|
|
|
|
2013-11-10 02:44:26 +00:00
|
|
|
trx->setPriority(0.40);
|
|
|
|
|
2011-10-12 07:44:40 +00:00
|
|
|
while (1) {
|
|
|
|
bool stale = false;
|
|
|
|
// Flush the UDP packets until a successful transfer.
|
2013-10-29 22:34:16 +00:00
|
|
|
while (!trx->driveTxPriorityQueue(num)) {
|
|
|
|
stale = true;
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
2013-10-29 22:34:16 +00:00
|
|
|
if (!num && stale) {
|
2011-10-12 07:44:40 +00:00
|
|
|
// If a packet was stale, remind the GSM stack of the clock.
|
2013-10-29 22:34:16 +00:00
|
|
|
trx->writeClockInterface();
|
2011-10-12 07:44:40 +00:00
|
|
|
}
|
|
|
|
pthread_testcancel();
|
|
|
|
}
|
|
|
|
return NULL;
|
|
|
|
}
|