/* -*- 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, 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(){}

  data_handler::result
  vrt_data_handler::operator()(const void *base, size_t len)
  {
#if 0
    print_words(0, (uint32_t *)base, len/(sizeof(uint32_t)));
    return 0;
#else
    const uint32_t *payload;
    size_t n32_bit_words;
    expanded_header hdr;
    if (!expanded_header::parse((const uint32_t*) base, len/(sizeof(uint32_t)),
				&hdr, &payload, &n32_bit_words)){
      if (1){
	fprintf(stderr, "vrt_data_handler: malformed VRT packet!\n");
	print_words(stderr, 0, (uint32_t *)base, len/(sizeof(uint32_t)));
      }
      return 0;
    }
    bool want_more = (*d_handler)(payload, n32_bit_words, &hdr);
    return !want_more ? data_handler::DONE : 0;
#endif
  }


  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