/* * Copyright 2008, 2009 Free Software Foundation, Inc. * Copyright 2011, 2012, 2014 Range Networks, Inc. * * This software is distributed under multiple licenses; see the COPYING file in the main directory for licensing information for this specific distribution. * * This use of this software may be subject to additional restrictions. * See the LEGAL file in the main directory for details. 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. */ /* Compilation switches TRANSMIT_LOGGING write every burst on the given slot to a log */ #include #include "Transceiver.h" #include #include #include #include using namespace GSM; extern ConfigurationTable gConfig; extern FactoryCalibration gFactoryCalibration; Transceiver::Transceiver(int wBasePort, const char *TRXAddress, int wSamplesPerSymbol, GSM::Time wTransmitLatency, RadioInterface *wRadioInterface, unsigned int wNumARFCNs, unsigned int wOversamplingRate, bool wLoadTest) :mClockSocket(wBasePort,TRXAddress,wBasePort+100) { //GSM::Time startTime(0,0); //GSM::Time startTime(gHyperframe/2 - 4*216*60,0); GSM::Time startTime = mStartTime = GSM::Time(random() % gHyperframe,0); mFIFOServiceLoopThread = new Thread(2*32768); ///< thread to push bursts into transmit FIFO mRFIFOServiceLoopThread = new Thread(4*32768); for (int j = 0; j< wNumARFCNs; j++) { mControlServiceLoopThread[j] = new Thread(32768); mTransmitPriorityQueueServiceLoopThread[j] = new Thread(32768); if (wNumARFCNs > 1) mDemodServiceLoopThread[j] = new Thread(32768); mDemodFIFO[j] = new VectorFIFO; mDataSocket[j] = new UDPSocket(wBasePort+2*(j+1),TRXAddress,wBasePort+100+2*(j+1)); mControlSocket[j] = new UDPSocket(wBasePort+2*j+1,TRXAddress,wBasePort+100+2*j+1); } mSamplesPerSymbol = wSamplesPerSymbol; mRadioInterface = wRadioInterface; mTransmitLatency = wTransmitLatency; mTransmitDeadlineClock = startTime; mLastClockUpdateTime = startTime; mLatencyUpdateTime = startTime; mRadioInterface->getClock()->set(startTime); mMaxExpectedDelay = 1; mNumARFCNs = wNumARFCNs; mOversamplingRate = wOversamplingRate; mLoadTest = wLoadTest; LOG(INFO) << "running " << mNumARFCNs << " ARFCNs"; // generate pulse and setup up signal processing library gsmPulse = generateGSMPulse(2,mSamplesPerSymbol); LOG(DEBUG) << "gsmPulse: " << *gsmPulse; sigProcLibSetup(mSamplesPerSymbol); txFullScale = mRadioInterface->fullScaleInputValue(); rxFullScale = mRadioInterface->fullScaleOutputValue(); mFreqOffset = 0.0; mMultipleARFCN = (mNumARFCNs > 1); // initialize other per-timeslot variables for (int tn = 0; tn < 8; tn++) { for (int arfcn = 0; arfcn < mNumARFCNs; arfcn++) { mFillerModulus[arfcn][tn] = 26; mChanType[arfcn][tn] = NONE; //fillerActive[arfcn][tn] = (arfcn==0); mHandoverActive[arfcn][tn] = false; } } if (mMultipleARFCN) { // Create the "tones" for sub-band tuning multiple ARFCNs. //mOversamplingRate = mNumARFCNs/2 + mNumARFCNs; //mOversamplingRate = 15; //mOversamplingRate*4; //if (mOversamplingRate % 2) mOversamplingRate++; double beaconFreq = -1.0*(mNumARFCNs-1)*200e3; for (int j = 0; j < mNumARFCNs; j++) { mFrequencyShifter[j] = new signalVector(157*mOversamplingRate); mFrequencyShifter[j]->fill(complex(1.0,0.0)); mFrequencyShifter[j]->isRealOnly(false); frequencyShift(mFrequencyShifter[j],mFrequencyShifter[j],2.0*M_PI*(beaconFreq+j*400e3)/(1625.0e3/6.0*mOversamplingRate)); } int filtLen = 6*mOversamplingRate; decimationFilter = createLPF(0.5/mOversamplingRate,filtLen,1); interpolationFilter = createLPF(0.5/mOversamplingRate,filtLen,1); scaleVector(*interpolationFilter,mOversamplingRate); mFreqOffset = -beaconFreq; mRadioInterface->setSamplesPerSymbol(SAMPSPERSYM*mOversamplingRate); } // if (mMultipleARFCN) // initialize filler tables with dummy bursts. for (int cn = 0; cn < mNumARFCNs; cn++) { for (int tn = 0; tn < 8; tn++) { signalVector* modBurst = modulateBurst(gDummyBurst,*gsmPulse, 8 + (tn % 4 == 0), mSamplesPerSymbol); // Power-scale, resample and frequency-shift. // Note that these are zero-power bursts on cn other than c0. // FIXME -- It would be cleaner to handle cn>0 in a different loop. // Otherwise, we as wasting a lot of computation here. if (cn==0) scaleVector(*modBurst,txFullScale/mNumARFCNs); else scaleVector(*modBurst,0.0); if (mMultipleARFCN) { signalVector *interpVec = polyphaseResampleVector(*modBurst,mOversamplingRate,1,interpolationFilter); //signalVector *interpVec = new signalVector(modBurst->size()*mOversamplingRate); //interpVec->fill(txFullScale); multVector(*interpVec,*mFrequencyShifter[cn]); delete modBurst; modBurst = interpVec; } for (int fn = 0; fn < MAXMODULUS; fn++) { mFillerTable[cn][fn][tn] = new signalVector(*modBurst); } delete modBurst; } } mOn = false; mTxFreq = 0.0; mRxFreq = 0.0; mPower = -10; mControlLock.unlock(); mTransmitPriorityQueueLock.unlock(); } Transceiver::~Transceiver() { delete gsmPulse; sigProcLibDestroy(); mTransmitPriorityQueue.clear(); } radioVector *Transceiver::fixRadioVector(BitVector &burst, int RSSI, GSM::Time &wTime, int ARFCN) { // modulate and stick into queue signalVector* modBurst = modulateBurst(burst,*gsmPulse, 8 + (wTime.TN() % 4 == 0), mSamplesPerSymbol); /*complex rScale = complex(2*M_PI*((float) rand()/(float) RAND_MAX),(2*M_PI*((float) rand()/(float) RAND_MAX))); rScale = rScale/rScale.abs(); scaleVector(*modBurst,rScale);*/ float headRoom = (mNumARFCNs > 1) ? 0.5 : 1.0; scaleVector(*modBurst,txFullScale * headRoom * pow(10,-RSSI/10)/mNumARFCNs); radioVector *newVec = new radioVector(*modBurst,wTime,ARFCN); //fillerActive[ARFCN][wTime.TN()] = (ARFCN==0) || (RSSI != 255); // upsample and filter and freq shift if (mMultipleARFCN) { signalVector *interpVec = polyphaseResampleVector(*((signalVector *)newVec),mOversamplingRate,1,interpolationFilter); //LOG(DEBUG) << "newVec size: " << newVec->size() << ", interpVec: " << interpVec->size(); delete newVec; //if (ARFCN!=0) printf("ARFCN: %d\n",ARFCN); multVector(*interpVec,*mFrequencyShifter[ARFCN]); newVec = new radioVector(*interpVec,wTime,ARFCN); delete interpVec; } delete modBurst; return newVec; } #ifdef TRANSMIT_LOGGING void Transceiver::unModulateVector(signalVector wVector) { SoftVector *burst = demodulateBurst(wVector, *gsmPulse, mSamplesPerSymbol, 1.0,0.0); LOG(DEBUG) << "LOGGED BURST: " << *burst; /* unsigned char burstStr[gSlotLen+1]; SoftVector::iterator burstItr = burst->begin(); for (int i = 0; i < gSlotLen; i++) { // FIXME: Demod bits are inverted! burstStr[i] = (unsigned char) ((*burstItr++)*255.0); } burstStr[gSlotLen]='\0'; LOG(DEBUG) << "LOGGED BURST: " << burstStr; */ delete burst; } #endif // If force, set the mFillerTable regardless of channel. // If allocate, must allocate a copy of the incoming vector. void Transceiver::setFiller(radioVector *rv, bool allocate, bool force) { int CN = rv->ARFCN(); int TN = rv->time().TN() & 0x07; // (pat) Changed to 0x7 from 0x3. if (!force && (IGPRS == mChanType[CN][TN])) { LOG(INFO) << "setFiller ignored"<time().FN() % mFillerModulus[CN][TN]; delete mFillerTable[CN][modFN][TN]; if (allocate) { mFillerTable[CN][modFN][TN] = new signalVector(*rv); } else { mFillerTable[CN][modFN][TN] = rv; } } void Transceiver::pushRadioVector(GSM::Time &nowTime) { // Transmit any enqueued bursts in this timeslot, on all ARFCNs. // dump stale bursts, if any while (radioVector* staleBurst = mTransmitPriorityQueue.getStaleBurst(nowTime)) { // Even if the burst is stale, put it in the filler table. // (It might be an idle pattern.) LOG(NOTICE) << "dumping STALE burst in TRX->USRP interface cn="<ARFCN() <<" at "<time(); setFiller(staleBurst,false,false); } // Everything from this point down operates in one TN period, // across multiple ARFCNs in freq. int TN = nowTime.TN(); // Sum up ARFCNs that are ready to transmit in this FN and TN bool addFiller[mNumARFCNs]; for (int CN=0; CNARFCN(); if (CN >= mNumARFCNs) { LOG(ERR) << "attempt to send burst on illegal ARFCN. C" << CN << "T" << TN << " FN " << nowTime.FN(); delete next; continue; } if (addFiller[CN] == false) { LOG(ERR) << "attempt to send multiple bursts on C" << CN << "T" << TN << " FN " << nowTime.FN(); delete next; continue; } //LOG(DEBUG) << "transmitFIFO: wrote burst " << next << " at time: " << nowTime; LOG(DEBUG) << (sendVec?"adding":"sending")<<" burst " << next << " at time: " << nowTime; setFiller(next,true,false); addFiller[CN] = false; if (!sendVec) { sendVec = next; } else { addVector(*sendVec,*next); delete next; } } // generate filler on ARFCNs where we didn't get anything. for (int CN=0; CNsize(); // What if sendVec is still NULL? // It can't be if there are no NULLs in the filler table. mRadioInterface->driveTransmitRadio(*sendVec,false); delete sendVec; } void Transceiver::setModulus(int arfcn, int timeslot) { switch (mChanType[arfcn][timeslot]) { case NONE: case I: case II: case III: case FILL: case IGPRS: mFillerModulus[arfcn][timeslot] = 26; break; case IV: case VI: case V: mFillerModulus[arfcn][timeslot] = 51; break; //case V: case VII: mFillerModulus[arfcn][timeslot] = 102; break; default: break; } } CorrType Transceiver::expectedCorrType(GSM::Time currTime, int arfcn) { unsigned burstTN = currTime.TN(); unsigned burstFN = currTime.FN(); if (mHandoverActive[arfcn][burstTN]) return RACH; switch (mChanType[arfcn][burstTN]) { case NONE: return OFF; break; case FILL: return IDLE; break; case IGPRS: case I: return TSC; /*if (burstFN % 26 == 25) return IDLE; else return TSC;*/ break; case II: if (burstFN % 2 == 1) return IDLE; else return TSC; 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; case LOOPBACK: if ((burstFN % 51 <= 50) && (burstFN % 51 >=48)) return IDLE; else return TSC; break; default: return OFF; break; } } void Transceiver::pullRadioVector() { radioVector *rxBurst = NULL; rxBurst = (radioVector *) mReceiveFIFO->get(); if (!rxBurst) return; //LOG(DEBUG) << "receiveFIFO: read radio vector " << rxBurst << " at time: " << rxBurst->time() << ", new size: " << mReceiveFIFO->size(); GSM::Time theTime = rxBurst->time(); int timeslot = rxBurst->time().TN() & 0x03; for (int i = 0; i < mNumARFCNs; i++) { CorrType corrType = expectedCorrType(rxBurst->time(),i); if ((corrType == OFF) || (corrType == IDLE)) continue; radioVector *ARFCNVec = new radioVector(*(signalVector *)rxBurst,theTime,i); if (mMultipleARFCN) { multVector(*ARFCNVec,*mFrequencyShifter[mNumARFCNs-1-i]); signalVector *rcvVec = polyphaseResampleVector(*ARFCNVec,1,mOversamplingRate,decimationFilter); delete ARFCNVec; ARFCNVec = new radioVector(*rcvVec,theTime,i); delete rcvVec; } //LOG(INFO) << "putting " << ARFCNVec << " in queue " << i << " at time " << theTime; mDemodFIFO[i]->put(ARFCNVec); } delete rxBurst; } void Transceiver::start() { for(int i = 0; i < mNumARFCNs; i++) { ThreadStruct *cs = new ThreadStruct; cs->trx = this; cs->CN = i; mControlServiceLoopThread[i]->start((void * (*)(void*))ControlServiceLoopAdapter,(void*) cs); } } void Transceiver::reset() { mTransmitPriorityQueue.clear(); //mTransmitFIFO->clear(); //mReceiveFIFO->clear(); } void Transceiver::driveControl(unsigned ARFCN) { int MAX_PACKET_LENGTH = 100; // check control socket char buffer[MAX_PACKET_LENGTH]; int msgLen = -1; buffer[0] = '\0'; msgLen = mControlSocket[ARFCN]->read(buffer, sizeof(buffer)); mControlLock.lock(); if (msgLen < 1) { mControlLock.unlock(); return; } char cmdcheck[4]; char command[MAX_PACKET_LENGTH]; char response[MAX_PACKET_LENGTH]; sscanf(buffer,"%3s %s",cmdcheck,command); writeClockInterface(); if (strcmp(cmdcheck,"CMD")!=0) { LOG(ERR) << "bogus message on control interface"; mControlLock.unlock(); 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"); if (!mOn) { // Prepare for thread start mPower = -20; mRadioInterface->start(); // Start radio interface threads. writeClockInterface(); generateRACHSequence(*gsmPulse,mSamplesPerSymbol); mRFIFOServiceLoopThread->start((void * (*)(void*))RFIFOServiceLoopAdapter,(void*) this); mFIFOServiceLoopThread->start((void * (*)(void*))FIFOServiceLoopAdapter,(void*) this); for (int i = 0; i < mNumARFCNs; i++) { ThreadStruct *cs = new ThreadStruct; cs->trx = this; cs->CN = i; mTransmitPriorityQueueServiceLoopThread[i]->start((void * (*)(void*))TransmitPriorityQueueServiceLoopAdapter,(void*) cs); Demodulator *demod = new Demodulator(i,this,mStartTime); mDemodulators[i] = demod; if (mNumARFCNs > 1) mDemodServiceLoopThread[i]->start((void * (*)(void*))DemodServiceLoopAdapter,(void*) demod); } //mRFIFOServiceLoopThread->start((void * (*)(void*))RFIFOServiceLoopAdapter,(void*) this); //mFIFOServiceLoopThread->start((void * (*)(void*))FIFOServiceLoopAdapter,(void*) this); mOn = true; } } } else if (strcmp(command,"SETMAXDLY")==0) { // FIXME -- Use the configuration table instead. //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) { // FIXME -- Use the configuration table instead. int newGain; sscanf(buffer,"%3s %s %d",cmdcheck,command,&newGain); newGain = mRadioInterface->setRxGain(newGain); sprintf(response,"RSP SETRXGAIN 0 %d",newGain); } else if (strcmp(command,"SETTXATTEN")==0) { // set output power in dB int dbPwr; sscanf(buffer,"%3s %s %d",cmdcheck,command,&dbPwr); if (!mOn) sprintf(response,"RSP SETTXATTEN 1 %d",dbPwr); else { if (ARFCN==0) { mRadioInterface->setPowerAttenuation(mPower + dbPwr); } sprintf(response,"RSP SETTXATTEN 0 %d",dbPwr); } } else if (strcmp(command,"SETFREQOFFSET")==0) { // set output power in dB int tuneVoltage; sscanf(buffer,"%3s %s %d",cmdcheck,command,&tuneVoltage); if (!mOn) sprintf(response,"RSP SETFREQOFFSET 1 %d",tuneVoltage); else { if (ARFCN==0) { mRadioInterface->setVCTCXO(tuneVoltage); } sprintf(response,"RSP SETFREQOFFSET 0 %d",tuneVoltage); } } else if (strcmp(command,"NOISELEV")==0) { // FIXME -- Use the status table instead. if (mOn) { sprintf(response,"RSP NOISELEV 0 %d", (int) mDemodulators[0]->mNoiseFloorRSSI); } else { sprintf(response,"RSP NOISELEV 1 0"); } } else if (strcmp(command,"SETPOWER")==0) { // set output power in dB int dbPwr; sscanf(buffer,"%3s %s %d",cmdcheck,command,&dbPwr); if (!mOn) sprintf(response,"RSP SETPOWER 1 %d",dbPwr); else { if (ARFCN==0) { mPower = dbPwr; mRadioInterface->setPowerAttenuation(dbPwr + gConfig.getNum("TRX.TxAttenOffset")); } sprintf(response,"RSP SETPOWER 0 %d",dbPwr); } } else if (strcmp(command,"ADJPOWER")==0) { // FIXME -- Use the configuration table instead. // adjust power in dB steps int dbStep; sscanf(buffer,"%3s %s %d",cmdcheck,command,&dbStep); if (!mOn) sprintf(response,"RSP ADJPOWER 1 %d",mPower); else { if (ARFCN==0) mPower += dbStep; sprintf(response,"RSP ADJPOWER 0 %d",mPower); } } else if (strcmp(command,"RXTUNE")==0) { // tune receiver int freqKhz; sscanf(buffer,"%3s %s %d",cmdcheck,command,&freqKhz); mRxFreq = freqKhz*1.0e3+mFreqOffset; if ((ARFCN==0) && !mRadioInterface->tuneRx(mRxFreq,gConfig.getNum("TRX.RadioFrequencyOffset"))) { 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+mFreqOffset; if ((ARFCN==0) && !mRadioInterface->tuneTx(mTxFreq,gConfig.getNum("TRX.RadioFrequencyOffset"))) { 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 { if (ARFCN==0) { mTSC = TSC; generateMidamble(*gsmPulse,mSamplesPerSymbol,TSC); } sprintf(response,"RSP SETTSC 0 %d",TSC); } } else if (strcmp(command,"HANDOVER")==0) { int timeslot; sscanf(buffer,"%3s %s %d",cmdcheck,command,×lot); //sscanf(buffer,"%3s %s %d %d %d",cmdcheck,command,×lot,&corrCode,&ARFCN); if ((timeslot < 0) || (timeslot > 7)) { LOG(ERR) << "bogus message on control interface"; sprintf(response,"RSP HANDOVER 1 %d",timeslot); } else if ((ARFCN < 0) || (ARFCN >= MAXARFCN)) { LOG(ERR) << "bogus message on control interface"; sprintf(response,"RSP HANDOVER 1 %d",timeslot); } else { mHandoverActive[ARFCN][timeslot] = true; sprintf(response,"RSP HANDOVER 0 %d",timeslot); } } else if (strcmp(command,"NOHANDOVER")==0) { int timeslot; sscanf(buffer,"%3s %s %d",cmdcheck,command,×lot); //sscanf(buffer,"%3s %s %d %d %d",cmdcheck,command,×lot,&corrCode,&ARFCN); if ((timeslot < 0) || (timeslot > 7)) { LOG(ERR) << "bogus message on control interface"; sprintf(response,"RSP NOHANDOVER 1 %d",timeslot); } else if ((ARFCN < 0) || (ARFCN >= MAXARFCN)) { LOG(ERR) << "bogus message on control interface"; sprintf(response,"RSP NOHANDOVER 1 %d",timeslot); } else { mHandoverActive[ARFCN][timeslot] = false; sprintf(response,"RSP NOHANDOVER 0 %d",timeslot); } } else if (strcmp(command,"SETSLOT")==0) { // set TSC int corrCode; int timeslot; sscanf(buffer,"%3s %s %d %d",cmdcheck,command,×lot,&corrCode); //sscanf(buffer,"%3s %s %d %d %d",cmdcheck,command,×lot,&corrCode,&ARFCN); if ((timeslot < 0) || (timeslot > 7)) { LOG(ERR) << "bogus message on control interface"; sprintf(response,"RSP SETSLOT 1 %d %d",timeslot,corrCode); } else if ((ARFCN < 0) || (ARFCN >= MAXARFCN)) { LOG(ERR) << "bogus message on control interface"; sprintf(response,"RSP SETSLOT 1 %d %d",timeslot,corrCode); } else { mChanType[ARFCN][timeslot] = (ChannelCombination) corrCode; setModulus(ARFCN,timeslot); sprintf(response,"RSP SETSLOT 0 %d %d",timeslot,corrCode); } } else if (strcmp(command,"READFACTORY")==0) { char param[16]; sscanf(buffer,"%3s %s %s",cmdcheck,command,param); // (pat) this was formerly ¶m which was incorrect. int ret = gFactoryCalibration.getValue(std::string(param)); // TODO : this should actually return the param name requested sprintf(response,"RSP READFACTORY 0 %d", ret); } else { LOG(ERR) << "bogus command " << command << " on control interface."; } mControlSocket[ARFCN]->write(response,strlen(response)+1); mControlLock.unlock(); } // (pat) Input is is coming from OpenBTS ARFCNManager::writeHighSideTx bool Transceiver::driveTransmitPriorityQueue(unsigned ARFCN) { char buffer[gSlotLen+50]; // check data socket size_t msgLen = mDataSocket[ARFCN]->read(buffer, sizeof(buffer)); ScopedLock lock(mTransmitPriorityQueueLock); if (msgLen!=gSlotLen+1+4+1) { LOG(ERR) << "badly formatted packet on GSM->TRX interface"; return false; } int timeSlot = (int) buffer[0]; int fillerFlag = timeSlot & SET_FILLER_FRAME; // Magic flag says this is a filler burst. timeSlot = timeSlot & 0x7; 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; if (mTransmitDeadlineClock > mLastClockUpdateTime + GSM::Time(216,0)) writeClockInterface(); LOG(DEBUG) << "rcvd. burst at: " << GSM::Time(frameNum,timeSlot) <driveReceiveRadio(); pullRadioVector(); } void Transceiver::driveTransmitFIFO() { /** 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. if (mRadioInterface->isUnderrun()) { // only do latency update every 10 frames, so we don't over update if (radioClock->get() > mLatencyUpdateTime + GSM::Time(100,0)) { //mTransmitLatency = mTransmitLatency + GSM::Time(1,0); unsigned bumpLatency = gConfig.getNum("TRX.LatencyBumpUp"); mTransmitLatency = mTransmitLatency + GSM::Time(bumpLatency,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 if (mTransmitLatency > GSM::Time(1,1)) { if (radioClock->get() > mLatencyUpdateTime + GSM::Time(216,0)) { mTransmitLatency.decTN(); LOG(INFO) << "reduced latency: " << mTransmitLatency; mLatencyUpdateTime = radioClock->get(); } } } // time to push burst to transmit FIFO pushRadioVector(mTransmitDeadlineClock); mTransmitDeadlineClock.incTN(); } } // FIXME -- This should not be a hard spin. // But any delay here causes us to throw omni_thread_fatal. //else radioClock->wait(); } void Transceiver::writeClockInterface() { char command[50]; // FIME -- See tracker #315. //sprintf(command,"IND CLOCK %llu",(unsigned long long) (mTransmitDeadlineClock.FN()+10)); sprintf(command,"IND CLOCK %llu",(unsigned long long) (mTransmitDeadlineClock.FN()+2)); LOG(INFO) << "ClockInterface: sending " << command; mClockSocket.write(command,strlen(command)+1); mLastClockUpdateTime = mTransmitDeadlineClock; } void *FIFOServiceLoopAdapter(Transceiver *transceiver) { LOG(NOTICE) << "THREAD: FIFOLoopAdapter @ tid " << gettid(); while (1) { //transceiver->driveReceiveFIFO(); transceiver->driveTransmitFIFO(); pthread_testcancel(); } return NULL; } void *RFIFOServiceLoopAdapter(Transceiver *transceiver) { LOG(NOTICE) << "THREAD: RFIFOLoopAdapter @ tid " << gettid(); bool isMulti = transceiver->multiARFCN(); while (1) { transceiver->driveReceiveFIFO(); if (!isMulti) transceiver->mDemodulators[0]->driveDemod(true); //transceiver->driveTransmitFIFO(); pthread_testcancel(); } return NULL; } void *ControlServiceLoopAdapter(ThreadStruct *ts) { LOG(NOTICE) << "THREAD: ControlServiceLoopAdapter @ tid " << gettid(); Transceiver *transceiver = ts->trx; unsigned CN = ts->CN; while (1) { transceiver->driveControl(CN); pthread_testcancel(); } return NULL; } void *DemodServiceLoopAdapter(Demodulator *demodulator) { LOG(NOTICE) << "THREAD: DemodServiceLoopAdapter @ tid " << gettid(); while(1) { demodulator->driveDemod(false); pthread_testcancel(); } return NULL; } void *TransmitPriorityQueueServiceLoopAdapter(ThreadStruct *ts) { Transceiver *transceiver = ts->trx; unsigned CN = ts->CN; LOG(NOTICE) << "THREAD: TransmitServiceLoopAdapter @ tid " << gettid(); while (1) { bool stale = false; // Flush the UDP packets until a successful transfer. while (!transceiver->driveTransmitPriorityQueue(CN)) { stale = true; } if (stale) { // If a packet was stale, remind the GSM stack of the clock. transceiver->writeClockInterface(); LOG(NOTICE) << "dumping STALE bursts at UDP interface cn="<getClock()); //radioClock->wait(); demodBurst = mDemodFIFO->get(); if (!wSingleARFCN) { while (!demodBurst) { RadioClock *radioClock = (mRadioInterface->getClock()); //radioClock->wait(); demodBurst = mDemodFIFO->get(); } } else { if (!demodBurst) return; } mMaxExpectedDelay = mTRX->maxDelay(); rxBurst = demodRadioVector(demodBurst,burstTime,RSSI,TOA); if (rxBurst) { DEMOD_DEBUG << "burst parameters: " << " CN: " << mCN << " 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; mTRXDataSocket->write(burstString,gSlotLen+10); } } SoftVector *Demodulator::demodRadioVector(radioVector *rxBurst, GSM::Time &wTime, int &RSSI, int &timingOffset) { bool needDFE = (mMaxExpectedDelay > 1); int timeslot = rxBurst->time().TN(); CorrType corrType = mTRX->expectedCorrType(rxBurst->time(),mCN); //LOG(INFO) << "Demoding ptr " << rxBurst << " at " << rxBurst->time() << " for CN " << mCN; if ((corrType==OFF) || (corrType==IDLE)) { //DEMOD_DEBUG << "Illegal burst"; delete rxBurst; return NULL; } // check to see if received burst has sufficient signalVector *vectorBurst = rxBurst; //DEMOD_DEBUG << "vectorBurst: " << vectorBurst << " rxBurst: " << rxBurst; complex amplitude = 0.0; float TOA = 0.0; float avgPwr = 0.0; /*if (!energyDetect(*vectorBurst,20*mSamplesPerSymbol,mEnergyThreshold,&avgPwr)) { DEMOD_DEBUG << "Estimated Energy: " << sqrt(avgPwr) << ", at time " << rxBurst->time(); double framesElapsed = rxBurst->time()-prevFalseDetectionTime; if (framesElapsed > 50) { // if we haven't had any false detections for a while, lower threshold //mEnergyThreshold -= 1.0; prevFalseDetectionTime = rxBurst->time(); } //LOG(INFO) << "Low burst energy."; delete rxBurst; LOG(INFO) << "Deleting " << rxBurst; return NULL; }*/ DEMOD_DEBUG << "Estimated Energy: " << sqrt(avgPwr) << ", at time " << rxBurst->time(); // run the proper correlator bool success = false; if (corrType==TSC) { DEMOD_DEBUG << "looking for TSC at time: " << rxBurst->time(); signalVector *channelResp; double framesElapsed = rxBurst->time()-channelEstimateTime[timeslot]; bool estimateChannel = false; //if ((framesElapsed > 50) || (channelResponse[timeslot]==NULL)) { if (channelResponse[timeslot]) delete channelResponse[timeslot]; if (DFEForward[timeslot]) delete DFEForward[timeslot]; if (DFEFeedback[timeslot]) delete DFEFeedback[timeslot]; channelResponse[timeslot] = NULL; DFEForward[timeslot] = NULL; DFEFeedback[timeslot] = NULL; estimateChannel = true; } estimateChannel = true; if (!needDFE) estimateChannel = false; float chanOffset; success = analyzeTrafficBurst(*vectorBurst, mTSC, 3.0, mSamplesPerSymbol, &litude, &TOA, mMaxExpectedDelay, estimateChannel, &channelResp, &chanOffset); if (success) { DEMOD_DEBUG << "FOUND TSC!!!!!! " << amplitude << " " << TOA; //mEnergyThreshold -= 0.1F; if (mEnergyThreshold < 0.0) mEnergyThreshold = 0.0; SNRestimate[timeslot] = amplitude.norm2()/(mEnergyThreshold*mEnergyThreshold+1.0); // this is not highly accurate if (estimateChannel) { DEMOD_DEBUG << "estimating channel..."; channelResponse[timeslot] = channelResp; chanRespOffset[timeslot] = chanOffset; chanRespAmplitude[timeslot] = amplitude; scaleVector(*channelResp, complex(1.0,0.0)/amplitude); designDFE(*channelResp, SNRestimate[timeslot], 7, &DFEForward[timeslot], &DFEFeedback[timeslot]); channelEstimateTime[timeslot] = rxBurst->time(); DEMOD_DEBUG << "SNR: " << SNRestimate[timeslot] << ", DFE forward: " << *DFEForward[timeslot] << ", DFE backward: " << *DFEFeedback[timeslot]; } } else { double framesElapsed = rxBurst->time()-prevFalseDetectionTime; DEMOD_DEBUG << "wTime: " << rxBurst->time() << ", pTime: " << prevFalseDetectionTime << ", fElapsed: " << framesElapsed; //mEnergyThreshold += 0.1F*exp(-framesElapsed); prevFalseDetectionTime = rxBurst->time(); channelResponse[timeslot] = NULL; } } else { // RACH burst success = detectRACHBurst(*vectorBurst, 3.0, // detection threshold mSamplesPerSymbol, &litude, &TOA); if (success) { DEMOD_DEBUG << "FOUND RACH!!!!!! " << amplitude << " " << TOA; //mEnergyThreshold -= 0.1F; if (mEnergyThreshold < 0.0) mEnergyThreshold = 0.0; channelResponse[timeslot] = NULL; } else { double framesElapsed = rxBurst->time()-prevFalseDetectionTime; //mEnergyThreshold += 0.1F*exp(-framesElapsed); prevFalseDetectionTime = rxBurst->time(); float avgPwr; energyDetect(*vectorBurst,20*mSamplesPerSymbol,0.0,&avgPwr); mNoiseFloorRSSI = (int) floor(20.0*log10(rxFullScale/sqrt(avgPwr))); } } DEMOD_DEBUG << "energy Threshold = " << mEnergyThreshold; // demodulate burst SoftVector *burst = NULL; if ((rxBurst) && (success)) { if ((corrType==RACH) || (!needDFE)) { burst = demodulateBurst(*vectorBurst, *gsmPulse, mSamplesPerSymbol, amplitude,TOA); } else { // TSC scaleVector(*vectorBurst,complex(1.0,0.0)/amplitude); burst = equalizeBurst(*vectorBurst, TOA-chanRespOffset[timeslot], mSamplesPerSymbol, *DFEForward[timeslot], *DFEFeedback[timeslot]); } wTime = rxBurst->time(); // FIXME: what is full scale for the USRP? we get more that 12 bits of resolution... RSSI = (int) floor(20.0*log10(rxFullScale/amplitude.abs())); DEMOD_DEBUG << "RSSI: " << RSSI; timingOffset = (int) round(TOA*256.0/mSamplesPerSymbol); } //if (burst) LOG(DEEPDEBUG) << "burst: " << *burst << '\n'; DEMOD_DEBUG << "Deleting rxBurst"; delete rxBurst; return burst; }