1 files changed, 124 insertions, 0 deletions
diff --git a/vrt/lib/rx.cc b/vrt/lib/rx.cc
new file mode 100644
index 000000000..2d741e908
--- /dev/null
+++ b/vrt/lib/rx.cc
@@ -0,0 +1,124 @@
+/* -*- c++ -*- */
+/*
+ * Copyright 2009 Free Software Foundation, Inc.
+ * 
+ * This file is part of GNU Radio
+ * 
+ * GNU Radio 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, or (at your option)
+ * any later version.
+ * 
+ * GNU Radio 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, write to the Free Software Foundation, Inc.,
+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
+ */
+#ifdef HAVE_CONFIG_H
+#include <config.h>
+#endif
+#include <vrt/rx.h>
+#include <vrt/expanded_header.h>
+#include "socket_rx_buffer.h"
+#include "data_handler.h"
+#include <unistd.h>
+#include <stdio.h>
+#include <stdexcept>
+
+static void
+print_words(FILE *fp, size_t offset, const uint32_t *buf, size_t n)
+{
+  size_t i;
+  for (i = 0; i < n; i++){
+    if (i % 4 == 0){
+      fprintf(fp, "%04zx:", i);
+    }
+
+    putc(' ', fp);
+    fprintf(fp, "%08x", buf[i]);
+    if (i % 4 == 3)
+      putc('\n', fp);
+  }
+
+  putc('\n', fp);
+}
+
+
+
+namespace vrt {
+  
+  rx::sptr
+  rx::make(int socket_fd, size_t rx_bufsize)
+  {
+    return sptr(new rx(socket_fd, rx_bufsize));
+  }
+
+  rx::rx(int socket_fd, size_t rx_bufsize)
+    : d_socket_fd(socket_fd),
+      d_srb(new socket_rx_buffer(socket_fd, rx_bufsize))
+  {
+  }
+
+  rx::~rx()
+  {
+    delete d_srb;
+    ::close(d_socket_fd);
+  }
+
+
+  class vrt_data_handler : public data_handler
+  {
+    rx_packet_handler	*d_handler;
+
+  public:
+    vrt_data_handler(rx_packet_handler *handler)
+      : d_handler(handler){}
+
+    ~vrt_data_handler();
+
+    result operator()(const void *base, size_t len);
+  };
+
+  vrt_data_handler::~vrt_data_handler(){}
+
+  // N.B., There may be more than 1 VRT packet in a frame (usually IF-Context packets)
+  data_handler::result
+  vrt_data_handler::operator()(const void *base, size_t len)
+  {
+    const uint32_t *word_base = (const uint32_t *) base;
+    size_t word_len = len/(sizeof(uint32_t));
+
+    bool want_more = true;
+    while (word_len > 0 && want_more){
+      const uint32_t *payload;
+      size_t n32_bit_words;
+      expanded_header hdr;
+      if (!expanded_header::parse(word_base, word_len,
+				  &hdr, &payload, &n32_bit_words)){
+	if (1){
+	  fprintf(stderr, "vrt_data_handler: malformed VRT packet!\n");
+	  print_words(stderr, 0, word_base, word_len);
+	}
+	return 0;
+      }
+      want_more = (*d_handler)(payload, n32_bit_words, &hdr);
+      word_base += hdr.pkt_size();
+      word_len -= hdr.pkt_size();
+    }
+    return !want_more ? data_handler::DONE : 0;
+  }
+
+
+  bool
+  rx::rx_packets(rx_packet_handler *handler, bool dont_wait)
+  {
+    vrt_data_handler h(handler);
+    socket_rx_buffer::result r = d_srb->rx_frames(&h, dont_wait ? 0 : -1);
+    return r == socket_rx_buffer::EB_OK || r == socket_rx_buffer::EB_WOULD_BLOCK;
+  }
+
+}; // vrt