Adding in the missing Transceiver52M directory

git-svn-id: http://wush.net/svn/range/software/public/openbts/trunk@2307 19bc5d8c-e614-43d4-8b26-e1612bc8e597

1 files changed, 631 insertions, 0 deletions

diff --git a/Transceiver52M/USRPDevice.cpp b/Transceiver52M/USRPDevice.cpp
new file mode 100644
index 0000000..7644cc7
--- /dev/null
+++ b/Transceiver52M/USRPDevice.cpp
@@ -0,0 +1,631 @@
+/*
+* Copyright 2008, 2009 Free Software Foundation, Inc.
+*
+* This software is distributed under the terms of the GNU Affero 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 Affero 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 Affero General Public License for more details.
+
+	You should have received a copy of the GNU Affero General Public License
+	along with this program.  If not, see <http://www.gnu.org/licenses/>.
+
+*/
+
+
+/*
+	Compilation Flags
+
+	SWLOOPBACK	compile for software loopback testing
+*/ 
+
+
+#include <stdint.h>
+#include <string.h>
+#include <stdlib.h>
+#include "Threads.h"
+#include "USRPDevice.h"
+
+#include <Logger.h>
+
+
+using namespace std;
+
+string write_it(unsigned v) {
+  string s = "   ";
+  s[0] = (v>>16) & 0x0ff;
+  s[1] = (v>>8) & 0x0ff;
+  s[2] = (v) & 0x0ff;
+  return s;
+}
+
+
+const float USRPDevice::LO_OFFSET = 4.0e6;
+const double USRPDevice::masterClockRate = (double) 52.0e6;
+
+bool USRPDevice::compute_regs(double freq,
+			      unsigned *R,
+			      unsigned *control,
+			      unsigned *N,
+			      double *actual_freq) 
+{
+  if (freq < 1.2e9) {
+	DIV2 = 1;
+	freq_mult = 2;
+  }
+  else {
+	DIV2 = 0;
+	freq_mult = 1;
+  }
+
+  float phdet_freq = masterClockRate/R_DIV;
+  int desired_n = (int) round(freq*freq_mult/phdet_freq);
+  *actual_freq = desired_n * phdet_freq/freq_mult;
+  float B = floor(desired_n/16);
+  float A = desired_n - 16*B;
+  unsigned B_DIV = int(B);
+  unsigned A_DIV = int(A);
+  if (B < A) return false;
+  *R = (R_RSV<<22) | 
+    (BSC << 20) | 
+    (TEST << 19) | 
+    (LDP << 18) | 
+    (ABP << 16) | 
+    (R_DIV << 2);
+  *control = (P<<22) | 
+    (PD<<20) | 
+    (CP2 << 17) | 
+    (CP1 << 14) | 
+    (PL << 12) | 
+    (MTLD << 11) | 
+    (CPG << 10) | 
+    (CP3S << 9) | 
+    (PDP << 8) | 
+    (MUXOUT << 5) | 
+    (CR << 4) | 
+    (PC << 2);
+  *N = (DIVSEL<<23) | 
+    (DIV2<<22) | 
+    (CPGAIN<<21) | 
+    (B_DIV<<8) | 
+    (N_RSV<<7) | 
+    (A_DIV<<2);
+  return true;
+}
+
+
+bool USRPDevice::tx_setFreq(double freq, double *actual_freq) 
+{
+  unsigned R, control, N;
+  if (!compute_regs(freq, &R, &control, &N, actual_freq)) return false;
+  if (R==0) return false;
+  
+  writeLock.lock();
+  m_uTx->_write_spi(0,SPI_ENABLE_TX_A,SPI_FMT_MSB | SPI_FMT_HDR_0,
+		    write_it((R & ~0x3) | 1));
+  m_uTx->_write_spi(0,SPI_ENABLE_TX_A,SPI_FMT_MSB | SPI_FMT_HDR_0,
+		    write_it((control & ~0x3) | 0));
+  usleep(10000);
+  m_uTx->_write_spi(0,SPI_ENABLE_TX_A,SPI_FMT_MSB | SPI_FMT_HDR_0,
+		    write_it((N & ~0x3) | 2));
+  writeLock.unlock();
+  
+  if (m_uTx->read_io(0) & PLL_LOCK_DETECT)  return true;
+  if (m_uTx->read_io(0) & PLL_LOCK_DETECT)  return true;
+  return false;
+}
+
+
+bool USRPDevice::rx_setFreq(double freq, double *actual_freq) 
+{
+  unsigned R, control, N;
+  if (!compute_regs(freq, &R, &control, &N, actual_freq)) return false;
+  if (R==0) return false;
+ 
+  writeLock.lock(); 
+  m_uRx->_write_spi(0,SPI_ENABLE_RX_B,SPI_FMT_MSB | SPI_FMT_HDR_0,
+		    write_it((R & ~0x3) | 1));
+  m_uRx->_write_spi(0,SPI_ENABLE_RX_B,SPI_FMT_MSB | SPI_FMT_HDR_0,
+		    write_it((control & ~0x3) | 0));
+  usleep(10000);
+  m_uRx->_write_spi(0,SPI_ENABLE_RX_B,SPI_FMT_MSB | SPI_FMT_HDR_0,
+		    write_it((N & ~0x3) | 2));
+  writeLock.unlock();
+  
+  if (m_uRx->read_io(1) & PLL_LOCK_DETECT)  return true;
+  if (m_uRx->read_io(1) & PLL_LOCK_DETECT)  return true;
+  return false;
+}
+
+
+USRPDevice::USRPDevice (double _desiredSampleRate) 
+{
+  LOG(INFO) << "creating USRP device...";
+  decimRate = (unsigned int) round(masterClockRate/_desiredSampleRate);
+  actualSampleRate = masterClockRate/decimRate;
+  rxGain = 0;
+
+#ifdef SWLOOPBACK 
+  samplePeriod = 1.0e6/actualSampleRate;
+  loopbackBufferSize = 0;
+  gettimeofday(&lastReadTime,NULL);
+  firstRead = false;
+#endif
+}
+
+bool USRPDevice::make(bool wSkipRx) 
+{
+  skipRx = wSkipRx;
+
+  writeLock.unlock();
+
+  LOG(INFO) << "making USRP device..";
+#ifndef SWLOOPBACK 
+  string rbf = "std_inband.rbf";
+  //string rbf = "inband_1rxhb_1tx.rbf"; 
+  m_uRx.reset();
+  if (!skipRx) {
+  try {
+    m_uRx = usrp_standard_rx_sptr(usrp_standard_rx::make(0,decimRate,1,-1,
+                                                         usrp_standard_rx::FPGA_MODE_NORMAL,
+                                                         1024,16*8,rbf));
+#ifdef HAVE_LIBUSRP_3_2
+    m_uRx->set_fpga_master_clock_freq(masterClockRate);
+#endif
+  }
+  
+  catch(...) {
+    LOG(ALERT) << "make failed on Rx";
+    m_uRx.reset();
+    return false;
+  }
+
+  if (m_uRx->fpga_master_clock_freq() != masterClockRate)
+  {
+    LOG(ALERT) << "WRONG FPGA clock freq = " << m_uRx->fpga_master_clock_freq()
+               << ", desired clock freq = " << masterClockRate;
+    m_uRx.reset();
+    return false;
+  }
+  }
+
+  try {
+    m_uTx = usrp_standard_tx_sptr(usrp_standard_tx::make(0,decimRate*2,1,-1,
+                                                         1024,16*8,rbf));
+#ifdef HAVE_LIBUSRP_3_2
+    m_uTx->set_fpga_master_clock_freq(masterClockRate);
+#endif
+  }
+  
+  catch(...) {
+    LOG(ALERT) << "make failed on Tx";
+    m_uTx.reset();
+    return false;
+  }
+
+  if (m_uTx->fpga_master_clock_freq() != masterClockRate)
+  {
+    LOG(ALERT) << "WRONG FPGA clock freq = " << m_uTx->fpga_master_clock_freq()
+               << ", desired clock freq = " << masterClockRate;
+    m_uTx.reset();
+    return false;
+  }
+
+  if (!skipRx) m_uRx->stop();
+  m_uTx->stop();
+  
+#endif
+
+  samplesRead = 0;
+  samplesWritten = 0;
+  started = false;
+  
+  return true;
+}
+
+
+
+bool USRPDevice::start() 
+{
+  LOG(INFO) << "starting USRP...";
+#ifndef SWLOOPBACK 
+  if (!m_uRx && !skipRx) return false;
+  if (!m_uTx) return false;
+  
+  if (!skipRx) m_uRx->stop();
+  m_uTx->stop();
+
+  writeLock.lock();
+  // power up and configure daughterboards
+  m_uTx->_write_oe(0,0,0xffff);
+  m_uTx->_write_oe(0,(POWER_UP|RX_TXN|ENABLE), 0xffff);
+  m_uTx->write_io(0,(~POWER_UP|RX_TXN),(POWER_UP|RX_TXN|ENABLE));
+  m_uTx->write_io(0,ENABLE,(RX_TXN | ENABLE));
+  m_uTx->_write_fpga_reg(FR_ATR_MASK_0 ,0);//RX_TXN|ENABLE);
+  m_uTx->_write_fpga_reg(FR_ATR_TXVAL_0,0);//,0 |ENABLE);
+  m_uTx->_write_fpga_reg(FR_ATR_RXVAL_0,0);//,RX_TXN|0);
+  m_uTx->_write_fpga_reg(40,0);
+  m_uTx->_write_fpga_reg(42,0);
+  m_uTx->set_pga(0,m_uTx->pga_max()); // should be 20dB
+  m_uTx->set_pga(1,m_uTx->pga_max());
+  m_uTx->set_mux(0x00000098);
+  LOG(INFO) << "TX pgas: " << m_uTx->pga(0) << ", " << m_uTx->pga(1);
+  writeLock.unlock();
+
+  if (!skipRx) {
+    writeLock.lock();
+    m_uRx->_write_fpga_reg(FR_ATR_MASK_0  + 3*3,0);
+    m_uRx->_write_fpga_reg(FR_ATR_TXVAL_0 + 3*3,0);
+    m_uRx->_write_fpga_reg(FR_ATR_RXVAL_0 + 3*3,0);
+    m_uRx->_write_fpga_reg(43,0);
+    m_uRx->_write_oe(1,(POWER_UP|RX_TXN|ENABLE), 0xffff);
+    m_uRx->write_io(1,(~POWER_UP|RX_TXN|ENABLE),(POWER_UP|RX_TXN|ENABLE));
+    //m_uRx->write_io(1,0,RX2_RX1N); // using Tx/Rx/
+    m_uRx->write_io(1,RX2_RX1N,RX2_RX1N); // using Rx2
+    m_uRx->set_adc_buffer_bypass(2,true);
+    m_uRx->set_adc_buffer_bypass(3,true);
+    m_uRx->set_mux(0x00000032);
+    writeLock.unlock();
+    // FIXME -- This should be configurable.
+    setRxGain(47); //maxRxGain());
+  }
+
+  data = new short[currDataSize];
+  dataStart = 0;
+  dataEnd = 0;
+  timeStart = 0;
+  timeEnd = 0;
+  timestampOffset = 0;
+  latestWriteTimestamp = 0;
+  lastPktTimestamp = 0;
+  hi32Timestamp = 0;
+  isAligned = false;
+
+ 
+  if (!skipRx) 
+  started = (m_uRx->start() && m_uTx->start());
+  else
+  started = m_uTx->start();
+  return started;
+#else
+  gettimeofday(&lastReadTime,NULL);
+  return true;
+#endif
+}
+
+bool USRPDevice::stop() 
+{
+#ifndef SWLOOPBACK 
+  if (!m_uRx) return false;
+  if (!m_uTx) return false;
+  
+  // power down
+  m_uTx->write_io(0,(~POWER_UP|RX_TXN),(POWER_UP|RX_TXN|ENABLE));
+  m_uRx->write_io(1,~POWER_UP,(POWER_UP|ENABLE));
+  
+  delete[] currData;
+  
+  started = !(m_uRx->stop() && m_uTx->stop());
+  return !started;
+#else
+  return true;
+#endif
+}
+
+double USRPDevice::setTxGain(double dB) {
+ 
+   writeLock.lock();
+   if (dB > maxTxGain()) dB = maxTxGain();
+   if (dB < minTxGain()) dB = minTxGain();
+
+   m_uTx->set_pga(0,dB);
+   m_uTx->set_pga(1,dB);
+
+   LOG(NOTICE) << "Setting TX PGA to " << dB << " dB.";
+
+   writeLock.unlock();
+  
+   return dB;
+}
+
+
+double USRPDevice::setRxGain(double dB) {
+
+   writeLock.lock();
+   if (dB > maxRxGain()) dB = maxRxGain();
+   if (dB < minRxGain()) dB = minRxGain();
+   
+   double dBret = dB;
+
+   dB = dB - minRxGain();
+
+   double rfMax = 70.0;
+   if (dB > rfMax) {
+        m_uRx->set_pga(2,dB-rfMax);
+        m_uRx->set_pga(3,dB-rfMax);
+        dB = rfMax;
+   }
+   else {
+        m_uRx->set_pga(2,0);
+        m_uRx->set_pga(3,0);
+   }
+   m_uRx->write_aux_dac(1,0,
+        (int) ceil((1.2 + 0.02 - (dB/rfMax))*4096.0/3.3));
+
+   LOG(DEBUG) << "Setting DAC voltage to " << (1.2+0.02 - (dB/rfMax)) << " " << (int) ceil((1.2 + 0.02 - (dB/rfMax))*4096.0/3.3);
+
+   rxGain = dBret;
+   
+   writeLock.unlock();
+   
+   return dBret;
+}
+
+
+// NOTE: Assumes sequential reads
+int USRPDevice::readSamples(short *buf, int len, bool *overrun, 
+			    TIMESTAMP timestamp,
+			    bool *underrun,
+			    unsigned *RSSI) 
+{
+#ifndef SWLOOPBACK 
+  if (!m_uRx) return 0;
+  
+  timestamp += timestampOffset;
+  
+  if (timestamp + len < timeStart) {
+    memset(buf,0,len*2*sizeof(short));
+    return len;
+  }
+
+  if (underrun) *underrun = false;
+ 
+  uint32_t readBuf[2000];
+ 
+  while (1) {
+    //guestimate USB read size
+    int readLen=0;
+    {
+      int numSamplesNeeded = timestamp + len - timeEnd;
+      if (numSamplesNeeded <=0) break;
+      readLen = 512 * ((int) ceil((float) numSamplesNeeded/126.0));
+      if (readLen > 8000) readLen= (8000/512)*512;
+    }
+    
+    // read USRP packets, parse and save A/D data as needed
+    readLen = m_uRx->read((void *)readBuf,readLen,overrun);
+    for(int pktNum = 0; pktNum < (readLen/512); pktNum++) {
+      // tmpBuf points to start of a USB packet
+      uint32_t* tmpBuf = (uint32_t *) (readBuf+pktNum*512/4);
+      TIMESTAMP pktTimestamp = usrp_to_host_u32(tmpBuf[1]);
+      uint32_t word0 = usrp_to_host_u32(tmpBuf[0]);
+      uint32_t chan = (word0 >> 16) & 0x1f;
+      unsigned payloadSz = word0 & 0x1ff;
+      LOG(DEBUG) << "first two bytes: " << hex << word0 << " " << dec << pktTimestamp;
+
+      bool incrementHi32 = ((lastPktTimestamp & 0x0ffffffffll) > pktTimestamp);
+      if (incrementHi32 && (timeStart!=0)) {
+           LOG(DEBUG) << "high 32 increment!!!";
+           hi32Timestamp++;
+      }
+      pktTimestamp = (((TIMESTAMP) hi32Timestamp) << 32) | pktTimestamp;
+      lastPktTimestamp = pktTimestamp;
+
+      if (chan == 0x01f) {
+	// control reply, check to see if its ping reply
+        uint32_t word2 = usrp_to_host_u32(tmpBuf[2]);
+	if ((word2 >> 16) == ((0x01 << 8) | 0x02)) {
+          timestamp -= timestampOffset;
+	  timestampOffset = pktTimestamp - pingTimestamp + PINGOFFSET;
+	  LOG(DEBUG) << "updating timestamp offset to: " << timestampOffset;
+          timestamp += timestampOffset;
+	  isAligned = true;
+	}
+	continue;
+      }
+      if (chan != 0) {
+	LOG(DEBUG) << "chan: " << chan << ", timestamp: " << pktTimestamp << ", sz:" << payloadSz;
+	continue;
+      }
+      if ((word0 >> 28) & 0x04) {
+	if (underrun) *underrun = true; 
+	LOG(DEBUG) << "UNDERRUN in TRX->USRP interface";
+      }
+      if (RSSI) *RSSI = (word0 >> 21) & 0x3f;
+      
+      if (!isAligned) continue;
+      
+      unsigned cursorStart = pktTimestamp - timeStart + dataStart;
+      while (cursorStart*2 > currDataSize) {
+	cursorStart -= currDataSize/2;
+      }
+      if (cursorStart*2 + payloadSz/2 > currDataSize) {
+	// need to circle around buffer
+	memcpy(data+cursorStart*2,tmpBuf+2,(currDataSize-cursorStart*2)*sizeof(short));
+	memcpy(data,tmpBuf+2+(currDataSize/2-cursorStart),payloadSz-(currDataSize-cursorStart*2)*sizeof(short));
+      }
+      else {
+	memcpy(data+cursorStart*2,tmpBuf+2,payloadSz);
+      }
+      if (pktTimestamp + payloadSz/2/sizeof(short) > timeEnd) 
+	timeEnd = pktTimestamp+payloadSz/2/sizeof(short);
+
+      LOG(DEBUG) << "timeStart: " << timeStart << ", timeEnd: " << timeEnd << ", pktTimestamp: " << pktTimestamp;
+
+    }	
+  }     
+ 
+  // copy desired data to buf
+  unsigned bufStart = dataStart+(timestamp-timeStart);
+  if (bufStart + len < currDataSize/2) { 
+    LOG(DEBUG) << "bufStart: " << bufStart;
+    memcpy(buf,data+bufStart*2,len*2*sizeof(short));
+    memset(data+bufStart*2,0,len*2*sizeof(short));
+  }
+  else {
+    LOG(DEBUG) << "len: " << len << ", currDataSize/2: " << currDataSize/2 << ", bufStart: " << bufStart;
+    unsigned firstLength = (currDataSize/2-bufStart);
+    LOG(DEBUG) << "firstLength: " << firstLength;
+    memcpy(buf,data+bufStart*2,firstLength*2*sizeof(short));
+    memset(data+bufStart*2,0,firstLength*2*sizeof(short));
+    memcpy(buf+firstLength*2,data,(len-firstLength)*2*sizeof(short));
+    memset(data,0,(len-firstLength)*2*sizeof(short));
+  }
+  dataStart = (bufStart + len) % (currDataSize/2);
+  timeStart = timestamp + len;
+
+  // do IQ swap here
+  for (int i = 0; i < len; i++) {
+    short tmp = usrp_to_host_short(buf[2*i]);
+    buf[2*i] = usrp_to_host_short(buf[2*i+1]);
+    buf[2*i+1] = tmp;
+  } 
+ 
+  return len;
+  
+#else
+  if (loopbackBufferSize < 2) return 0;
+  int numSamples = 0;
+  struct timeval currTime;
+  gettimeofday(&currTime,NULL);
+  double timeElapsed = (currTime.tv_sec - lastReadTime.tv_sec)*1.0e6 + 
+    (currTime.tv_usec - lastReadTime.tv_usec);
+  if (timeElapsed < samplePeriod) {return 0;}
+  int numSamplesToRead = (int) floor(timeElapsed/samplePeriod);
+  if (numSamplesToRead < len) return 0;
+  
+  if (numSamplesToRead > len) numSamplesToRead = len;
+  if (numSamplesToRead > loopbackBufferSize/2) {
+    firstRead =false; 
+    numSamplesToRead = loopbackBufferSize/2;
+  }
+  memcpy(buf,loopbackBuffer,sizeof(short)*2*numSamplesToRead);
+  loopbackBufferSize -= 2*numSamplesToRead;
+  memcpy(loopbackBuffer,loopbackBuffer+2*numSamplesToRead,
+	 sizeof(short)*loopbackBufferSize);
+  numSamples = numSamplesToRead;
+  if (firstRead) {
+    int new_usec = lastReadTime.tv_usec + (int) round((double) numSamplesToRead * samplePeriod);
+    lastReadTime.tv_sec = lastReadTime.tv_sec + new_usec/1000000;
+    lastReadTime.tv_usec = new_usec % 1000000;
+  }
+  else {
+    gettimeofday(&lastReadTime,NULL);
+    firstRead = true;
+  }
+  samplesRead += numSamples;
+  
+  return numSamples;
+#endif
+}
+
+int USRPDevice::writeSamples(short *buf, int len, bool *underrun, 
+			     unsigned long long timestamp,
+			     bool isControl) 
+{
+  writeLock.lock();
+
+#ifndef SWLOOPBACK 
+  if (!m_uTx) return 0;
+ 
+  static uint32_t outData[128*20];
+ 
+  for (int i = 0; i < len*2; i++) {
+	buf[i] = host_to_usrp_short(buf[i]);
+  }
+
+  int numWritten = 0;
+  unsigned isStart = 1;
+  unsigned RSSI = 0;
+  unsigned CHAN = (isControl) ? 0x01f : 0x00;
+  len = len*2*sizeof(short);
+  int numPkts = (int) ceil((float)len/(float)504);
+  unsigned isEnd = (numPkts < 2);
+  uint32_t *outPkt = outData;
+  int pktNum = 0;
+  while (numWritten < len) {
+    // pkt is pointer to start of a USB packet
+    uint32_t *pkt = outPkt + pktNum*128;
+    isEnd = (len - numWritten <= 504);
+    unsigned payloadLen = ((len - numWritten) < 504) ? (len-numWritten) : 504;
+    pkt[0] = (isStart << 12 | isEnd << 11 | (RSSI & 0x3f) << 5 | CHAN) << 16 | payloadLen;
+    pkt[1] = timestamp & 0x0ffffffffll;
+    memcpy(pkt+2,buf+(numWritten/sizeof(short)),payloadLen);
+    numWritten += payloadLen;
+    timestamp += payloadLen/2/sizeof(short);
+    isStart = 0;
+    pkt[0] = host_to_usrp_u32(pkt[0]);
+    pkt[1] = host_to_usrp_u32(pkt[1]);
+    pktNum++;
+  }
+  m_uTx->write((const void*) outPkt,sizeof(uint32_t)*128*numPkts,NULL);
+
+  samplesWritten += len/2/sizeof(short);
+  writeLock.unlock();
+
+  return len/2/sizeof(short);
+#else
+  int retVal = len;
+  memcpy(loopbackBuffer+loopbackBufferSize,buf,sizeof(short)*2*len);
+  samplesWritten += retVal;
+  loopbackBufferSize += retVal*2;
+   
+  return retVal;
+#endif
+}
+
+bool USRPDevice::updateAlignment(TIMESTAMP timestamp) 
+{
+#ifndef SWLOOPBACK 
+  short data[] = {0x00,0x02,0x00,0x00};
+  uint32_t *wordPtr = (uint32_t *) data;
+  *wordPtr = host_to_usrp_u32(*wordPtr);
+  bool tmpUnderrun;
+  if (writeSamples((short *) data,1,&tmpUnderrun,timestamp & 0x0ffffffffll,true)) {
+    pingTimestamp = timestamp;
+    return true;
+  }
+  return false;
+#else
+  return true;
+#endif
+}
+
+#ifndef SWLOOPBACK 
+bool USRPDevice::setTxFreq(double wFreq) {
+  // Tune to wFreq+LO_OFFSET, to prevent LO bleedthrough from interfering with transmitted signal.
+  double actFreq;
+  if (!tx_setFreq(wFreq+1*LO_OFFSET,&actFreq)) return false;
+  bool retVal = m_uTx->set_tx_freq(0,(wFreq-actFreq));
+  LOG(INFO) << "set TX: " << wFreq-actFreq << " actual TX: " << m_uTx->tx_freq(0);
+  return retVal;
+};
+
+bool USRPDevice::setRxFreq(double wFreq) {
+  // Tune to wFreq-2*LO_OFFSET, to
+  //   1) prevent LO bleedthrough (as with the setTxFreq method above)
+  //   2) The extra LO_OFFSET pushes potential transmitter energy (GSM BS->MS transmissions 
+  //        are 45Mhz above MS->BS transmissions) into a notch of the baseband lowpass filter 
+  //        in front of the ADC.  This possibly gives us an extra 10-20dB Tx/Rx isolation.
+  double actFreq;
+  // FIXME -- This should bo configurable.
+  if (!rx_setFreq(wFreq-2*LO_OFFSET,&actFreq)) return false;
+  bool retVal = m_uRx->set_rx_freq(0,(wFreq-actFreq));
+  LOG(DEBUG) << "set RX: " << wFreq-actFreq << " actual RX: " << m_uRx->rx_freq(0);
+  return retVal;
+};
+
+#else
+bool USRPDevice::setTxFreq(double wFreq) { return true;};
+bool USRPDevice::setRxFreq(double wFreq) { return true;};
+#endif