[Commit-gnuradio] r10640 - gnuradio/branches/developers/eb/t348/usrp/host/apps

[eb]

Author: eb
Date: 2009-03-18 22:50:05 -0600 (Wed, 18 Mar 2009)
New Revision: 10640

Modified:
   gnuradio/branches/developers/eb/t348/usrp/host/apps/Makefile.am
   gnuradio/branches/developers/eb/t348/usrp/host/apps/test_usrp_standard_tx.cc
Log:
Updated test_usrp_standard_tx to support daughterboard control.


Modified: gnuradio/branches/developers/eb/t348/usrp/host/apps/Makefile.am
===================================================================
--- gnuradio/branches/developers/eb/t348/usrp/host/apps/Makefile.am     
2009-03-19 04:48:30 UTC (rev 10639)
+++ gnuradio/branches/developers/eb/t348/usrp/host/apps/Makefile.am     
2009-03-19 04:50:05 UTC (rev 10640)
@@ -47,7 +47,7 @@
 test_usrp_standard_rx_LDADD    = $(USRP_LA)
 
 test_usrp_standard_tx_SOURCES  = test_usrp_standard_tx.cc time_stuff.c
-test_usrp_standard_tx_LDADD    = $(USRP_LA)
+test_usrp_standard_tx_LDADD    = $(USRP_LA) $(BOOST_LDFLAGS) 
$(BOOST_PROGRAM_OPTIONS_LIB)
 
 usrper_SOURCES                 = usrper.cc
 usrper_LDADD                   = $(USRP_LA)

Modified: 
gnuradio/branches/developers/eb/t348/usrp/host/apps/test_usrp_standard_tx.cc
===================================================================
--- 
gnuradio/branches/developers/eb/t348/usrp/host/apps/test_usrp_standard_tx.cc    
    2009-03-19 04:48:30 UTC (rev 10639)
+++ 
gnuradio/branches/developers/eb/t348/usrp/host/apps/test_usrp_standard_tx.cc    
    2009-03-19 04:50:05 UTC (rev 10640)
@@ -1,6 +1,6 @@
 /* -*- c++ -*- */
 /*
- * Copyright 2003,2004,2008 Free Software Foundation, Inc.
+ * Copyright 2003,2004,2008,2009 Free Software Foundation, Inc.
  * 
  * This file is part of GNU Radio
  * 
@@ -24,6 +24,7 @@
 #include "config.h"
 #endif
 
+#include <iostream>
 #include <stdio.h>
 #include <stdlib.h>
 #include <string.h>
@@ -35,16 +36,45 @@
 #include "time_stuff.h"
 #include "usrp_standard.h"
 #include "usrp_bytesex.h"
+#include <boost/program_options.hpp>
 
-#ifdef HAVE_SCHED_H
-#include <sched.h>
-#endif
+enum {
+  GR_SIN_WAVE,
+  GR_CONST_WAVE
+};
 
+namespace po = boost::program_options;
+
 char *prog_name;
 
-static bool test_output (usrp_standard_tx_sptr utx, int max_bytes, double ampl,
-                        bool dc_p, bool counting_p);
+usrp_subdev_spec
+str_to_subdev(std::string spec_str)
+{
+  usrp_subdev_spec spec;
+  if(spec_str == "A" || spec_str == "A:0" || spec_str == "0:0") {
+    spec.side = 0;
+    spec.subdev = 0;
+  }
+  else if(spec_str == "A:1" || spec_str == "0:1") {
+    spec.side = 0;
+    spec.subdev = 1;
+  }
+  else if(spec_str == "B" || spec_str == "B:0" || spec_str == "1:0") {
+    spec.side = 1;
+    spec.subdev = 0;
+  }
+  else if(spec_str == "B:1" || spec_str == "1:1") {
+    spec.side = 1;
+    spec.subdev = 1;
+  }
+  else {
+    throw std::range_error("Incorrect subdevice specifications.\n");
+  }
 
+  return spec;
+}
+
+
 static void
 set_progname (char *path)
 {
@@ -56,163 +86,168 @@
 }
 
 static void
-usage ()
-{
-  fprintf (stderr, 
-          "usage: %s [-f] [-v] [-d] [-c] [-a <ampl>][-I <interp>] [-F freq] 
[-D]\n", prog_name);
-  fprintf (stderr, "  [-f] loop forever\n");
-  fprintf (stderr, "  [-M] how many Megabytes to transfer (default 128)\n");
-  fprintf (stderr, "  [-v] verbose\n");
-  fprintf (stderr, "  [-d] dump registers\n");
-  // fprintf (stderr, "  [-l] digital loopback in FPGA\n");
-  fprintf (stderr, "  [-c] Tx counting sequence\n");
-  fprintf (stderr, "  [-D] DC output\n");
-
-  fprintf (stderr, "  [-B <fusb_block_size>] set fast usb block_size\n");
-  fprintf (stderr, "  [-N <fusb_nblocks>] set fast usb nblocks\n");
-  fprintf (stderr, "  [-R] set real time scheduling: SCHED_FIFO; pri = 
midpoint\n");
-
-  exit (1);
-}
-
-static void
 die (const char *msg)
 {
   fprintf (stderr, "die: %s: %s\n", prog_name, msg);
   exit (1);
 }
 
-static void
-dump_codec_regs (usrp_basic *u, int which_codec, FILE *fp)
+
+static bool
+test_output (usrp_standard_tx_sptr utx, long long max_bytes, double ampl, int 
waveform)
 {
-  for (int i = 0; i < 64; i++){
-    unsigned char v;
-    u->_read_9862 (which_codec, i, &v);
-    fprintf (fp, "%2d:  0x%02x\n", i, v); 
+  const int BUFSIZE = utx->block_size();
+  const int N = BUFSIZE/sizeof (short);
+
+  short        buf[N];
+  long long    nbytes = 0;
+
+  // ----------------------------------------------------------------
+  // one time initialization of the pattern we're going to transmit
+
+  const int    PERIOD = 65;            // any value is valid
+  const int            PATLEN = 2 * PERIOD;    
+  short                pattern[PATLEN];
+
+  for (int i = 0; i < PERIOD; i++){
+    if (waveform == GR_CONST_WAVE){
+      pattern[2*i+0] = host_to_usrp_short((short) ampl);
+      pattern[2*i+1] = host_to_usrp_short((short) 0);
+    }
+    else {
+      pattern[2*i+0] = host_to_usrp_short((short) (ampl * cos(2*M_PI * i / 
PERIOD)));
+      pattern[2*i+1] = host_to_usrp_short((short) (ampl * sin(2*M_PI * i / 
PERIOD)));
+    }
   }
-  fflush (fp);
-}
 
-static void
-do_dump_codec_regs (usrp_basic *u)
-{
-  char name[100];
-  strcpy (name, "regsXXXXXX");
-  int fd = mkstemp (name);
-  if (fd == -1){
-    perror (name);
+  // ----------------------------------------------------------------
+
+  double start_wall_time = get_elapsed_time ();
+  double start_cpu_time  = get_cpu_usage ();
+
+  bool         underrun;
+  int  nunderruns = 0;
+  int  pi = 0;
+
+  for (nbytes = 0; max_bytes == 0 || nbytes < max_bytes; nbytes += BUFSIZE){
+
+    for (int i = 0; i < N; i++){
+      buf[i] = pattern[pi];
+      pi++;
+      if (pi >= PATLEN)
+       pi = 0;
+    }
+
+    int        ret = utx->write (buf, sizeof (buf), &underrun);
+    if ((unsigned) ret != sizeof (buf)){
+      fprintf (stderr, "test_output: error, ret = %d\n", ret);
+    }
+
+    if (underrun){
+      nunderruns++;
+      printf ("tx_underrun\n");
+      //printf ("tx_underrun %9d %6d\n", nbytes, nbytes/BUFSIZE);
+    }
   }
-  else {
-    FILE *fp = fdopen (fd, "w");
-    dump_codec_regs (u, 0, fp);
-    fclose (fp);
-  }
+
+  utx->wait_for_completion ();
+
+  double stop_wall_time = get_elapsed_time ();
+  double stop_cpu_time  = get_cpu_usage ();
+
+  double delta_wall = stop_wall_time - start_wall_time;
+  double delta_cpu  = stop_cpu_time  - start_cpu_time;
+
+  printf ("xfered %.3g bytes in %.3g seconds.  %.4g bytes/sec.  cpu time = 
%.3g\n",
+         (double) max_bytes, delta_wall, max_bytes / delta_wall, delta_cpu);
+
+  printf ("%d underruns\n", nunderruns);
+
+  return true;
 }
 
 int
 main (int argc, char **argv)
 {
-  bool         verbose_p = false;
-  bool  dump_regs_p = false;
-  bool dc_p = false;
-  // bool  loopback_p = false;
-  bool  counting_p = false;
-  int   max_bytes = 128 * (1L << 20);
-  int  ch;
-  int  which_board = 0;
-  int  interp = 16;                    // 32.0 MB/sec 
-  double       center_freq = 0;
-  double       ampl = 10000;
+  int which = 0;                       // specify which USRP board
+  usrp_subdev_spec spec(0,0);          // specify the d'board side
+  int interp = 16;                     // set the interpolation rate
+  double rf_freq = 0;                  // set the frequency
+  float amp = 10000;                   // set the amplitude of the output
+  float gain = -1;                     // set the d'board PGA gain
+  int waveform;
   int  fusb_block_size = 0;
   int  fusb_nblocks = 0;
   bool realtime_p = false;
+  double nsamples = 32e6;
 
-
   set_progname (argv[0]);
 
-  while ((ch = getopt (argc, argv, "vfdcI:F:a:DM:B:N:R")) != EOF){
-    switch (ch){
-    case 'f':
-      max_bytes = 0;
-      break;
+  po::options_description cmdconfig("Program options");
+  cmdconfig.add_options()
+    ("help,h", "produce help message")
+    ("which,W", po::value<int>(&which), "select which USRP board")
+    ("tx-subdev-spec,T", po::value<std::string>(), "select USRP Tx side A or 
B")
+    ("rf-freq,f", po::value<double>(), "set RF center frequency to FREQ")
+    ("interp,i", po::value<int>(&interp), "set fgpa interpolation rate to 
INTERP")
 
-    case 'v':
-      verbose_p = true;
-      break;
+    ("sine", "generate a complex sinusoid [default]")
+    ("const", "generate a constant output")
 
-    case 'd':
-      dump_regs_p = true;
-      break;
-      
-    case 'D':
-      dc_p = true;
-      break;
-      
-#if 0
-    case 'l':
-      loopback_p = true;
-      break;
-#endif
-      
-    case 'c':
-      counting_p = true;
-      break;
-      
-    case 'I':
-      interp = strtol (optarg, 0, 0);
-      break;
-                     
-    case 'F':
-      center_freq = strtod (optarg, 0);
-      break;
-      
-    case 'a':
-      ampl = strtod (optarg, 0);
-      break;
+    //("waveform-freq,w", po::value<double>(&wfreq), "set waveform frequency 
to FREQ")
+    ("amplitude,a", po::value<float>(&amp), "set amplitude")
+    ("gain,g", po::value<float>(&gain), "set output gain to GAIN 
[default=MAX]")
+    //("offset,o", po::value<float>(&offset), "set waveform offset to OFFSET")
+    ("nsamples,N", po::value<double>(&nsamples), "number of samples to send 
[default=32M]")
+    ;
+  
+  po::variables_map vm;
+  po::store(po::command_line_parser(argc, argv).
+           options(cmdconfig).run(), vm);
+  po::notify(vm);
+  
+  if (vm.count("help")) {
+    std::cout << cmdconfig << "\n";
+    return 1;
+  }
+  
+  if(vm.count("rf-freq")) {
+    rf_freq = vm["rf-freq"].as<double>();
+  }
 
-    case 'M':
-      max_bytes = strtol (optarg, 0, 0) * (1L << 20);
-      if (max_bytes < 0) max_bytes = 0;
-      break;
+  if(vm.count("nsamples")) {
+    nsamples = vm["nsamples"].as<double>();
+  }
 
-    case 'B':
-      fusb_block_size = strtol (optarg, 0, 0);
-      break;
+  if(vm.count("tx-subdev-spec")) {
+    std::string s = vm["tx-subdev-spec"].as<std::string>();
+    spec = str_to_subdev(s);
+  }
 
-    case 'N':
-      fusb_nblocks = strtol (optarg, 0, 0);
-      break;
+  if(vm.count("sine")) {
+    waveform = GR_SIN_WAVE;
+  }
+  else if(vm.count("const")) {
+    waveform = GR_CONST_WAVE;
+  }
+  else {
+    waveform = GR_SIN_WAVE;
+  }
 
-    case 'R':
-      realtime_p = true;
-      break;
+  printf("which:    %d\n", which);
+  printf("interp:   %d\n", interp);
+  printf("rf_freq:  %g\n", rf_freq);
+  printf("amp:      %f\n", amp);
+  printf("nsamples: %g\n", nsamples);
 
-    default:
-      usage ();
-    }
-  }
 
-#ifdef HAVE_SCHED_SETSCHEDULER
   if (realtime_p){
-    int policy = SCHED_FIFO;
-    int pri = (sched_get_priority_max (policy) - sched_get_priority_min 
(policy)) / 2;
-    int pid = 0;  // this process
-
-    struct sched_param param;
-    memset(&param, 0, sizeof(param));
-    param.sched_priority = pri;
-    int result = sched_setscheduler(pid, policy, &param);
-    if (result != 0){
-      perror ("sched_setscheduler: failed to set real time priority");
-    }
-    else
-      printf("SCHED_FIFO enabled with priority = %d\n", pri);
+    // FIXME
   }
-#endif
 
   usrp_standard_tx_sptr utx;
 
-  utx = usrp_standard_tx::make (which_board,
+  utx = usrp_standard_tx::make (which,
                                interp,
                                1,      // nchan
                                -1,     // mux
@@ -221,97 +256,67 @@
 
   if (utx == 0)
     die ("usrp_standard_tx::make");
-    
-  if (!utx->set_tx_freq (0, center_freq))
-    die ("utx->set_tx_freq");
-    
-  if (dump_regs_p)
-    do_dump_codec_regs (utx.get());
-  
-  
-  fflush (stdout);
-  fflush (stderr);
 
-  utx->start();                // start data xfers
+  // FIXME
 
-  test_output (utx, max_bytes, ampl, dc_p, counting_p);
+  db_base_sptr subdev = utx->selected_subdev(spec);
+  printf("Subdevice name is %s\n", subdev->name().c_str());
+  printf("Subdevice freq range: (%g, %g)\n", 
+        subdev->freq_min(), subdev->freq_max());
 
-  return 0;
-}
+  unsigned int mux = utx->determine_tx_mux_value(spec);
+  printf("mux: %#08x\n",  mux);
+  utx->set_mux(mux);
 
+  if(gain == -1) {
+    gain = subdev->gain_max();
+  }
+  subdev->set_gain(gain);
 
-static bool
-test_output (usrp_standard_tx_sptr utx, int max_bytes, double ampl,
-            bool dc_p, bool counting_p)
-{
-  static const int BUFSIZE = utx->block_size();
-  static const int N = BUFSIZE/sizeof (short);
 
-  short           buf[N];
-  int             nbytes = 0;
-  int             counter = 0;
+  float input_rate = utx->dac_rate() / utx->interp_rate();
+  printf("baseband rate: %g\n",  input_rate);
 
-  static const int    PERIOD = 65;             // any value is valid
-  static const int    PATLEN = 2 * PERIOD;     
-  short                      pattern[PATLEN];
+  usrp_tune_result r;
+  double target_freq = rf_freq;
+  bool ok = utx->tune(subdev->which(), subdev, target_freq, &r);
 
-  for (int i = 0; i < PERIOD; i++){
-    if (dc_p){
-      pattern[2*i+0] = host_to_usrp_short ((short) ampl);
-      pattern[2*i+1] = host_to_usrp_short ((short) 0);
-    }
-    else {
-      pattern[2*i+0] = host_to_usrp_short ((short) (ampl * cos (2*M_PI * i / 
PERIOD)));
-      pattern[2*i+1] = host_to_usrp_short ((short) (ampl * sin (2*M_PI * i / 
PERIOD)));
-    }
+  if(!ok) {
+    throw std::runtime_error("Could not set frequency.");
   }
 
-  double          start_wall_time = get_elapsed_time ();
-  double          start_cpu_time  = get_cpu_usage ();
+  subdev->set_enable(true);
+  
+  printf("target_freq:     %f\n", target_freq);
+  printf("ok:              %s\n", ok ? "true" : "false");
+  printf("r.baseband_freq: %f\n", r.baseband_freq);
+  printf("r.dxc_freq:      %f\n", r.dxc_freq);
+  printf("r.residual_freq: %f\n", r.residual_freq);
+  printf("r.inverted:      %d\n", r.inverted);
 
-  bool         underrun;
-  int  nunderruns = 0;
-  int  pi = 0;
 
-  for (nbytes = 0; max_bytes == 0 || nbytes < max_bytes; nbytes += BUFSIZE){
+  fflush (stdout);
+  fflush (stderr);
 
-    if (counting_p){
-      for (int i = 0; i < N; i++)
-       buf[i] = host_to_usrp_short (counter++ & 0xffff);
-    }
-    else {
-      for (int i = 0; i < N; i++){
-       buf[i] = pattern[pi];
-       pi++;
-       if (pi >= PATLEN)
-         pi = 0;
-      }
-    }
+  utx->start();                // start data xfers
 
-    int        ret = utx->write (buf, sizeof (buf), &underrun);
-    if ((unsigned) ret != sizeof (buf)){
-      fprintf (stderr, "test_output: error, ret = %d\n", ret);
-    }
+  test_output (utx, (long long) nsamples, amp, waveform);
 
-    if (underrun){
-      nunderruns++;
-      printf ("tx_underrun\n");
-      //printf ("tx_underrun %9d %6d\n", nbytes, nbytes/BUFSIZE);
-    }
-  }
+  return 0;
+}  
 
-  utx->wait_for_completion ();
 
-  double stop_wall_time = get_elapsed_time ();
-  double stop_cpu_time  = get_cpu_usage ();
+#if 0
+    case 'B':
+      fusb_block_size = strtol (optarg, 0, 0);
+      break;
 
-  double delta_wall = stop_wall_time - start_wall_time;
-  double delta_cpu  = stop_cpu_time  - start_cpu_time;
+    case 'N':
+      fusb_nblocks = strtol (optarg, 0, 0);
+      break;
 
-  printf ("xfered %.3g bytes in %.3g seconds.  %.4g bytes/sec.  cpu time = 
%.3g\n",
-         (double) max_bytes, delta_wall, max_bytes / delta_wall, delta_cpu);
+    case 'R':
+      realtime_p = true;
+      break;
 
-  printf ("%d underruns\n", nunderruns);
-
-  return true;
-}
+#endif