initial dstar checkin

1 files changed, 162 insertions, 0 deletions

diff --git a/op25/gr-op25_repeater/lib/dstar_tx_sb_impl.cc b/op25/gr-op25_repeater/lib/dstar_tx_sb_impl.cc
new file mode 100644
index 0000000..eea2043
--- /dev/null
+++ b/op25/gr-op25_repeater/lib/dstar_tx_sb_impl.cc
@@ -0,0 +1,162 @@
+/* -*- c++ -*- */
+/* 
+ * DSTAR Encoder (C) Copyright 2017 Max H. Parke KA1RBI
+ * 
+ * This file is part of OP25
+ * 
+ * This 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.
+ * 
+ * This software 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 software; see the file COPYING.  If not, write to
+ * the Free Software Foundation, Inc., 51 Franklin Street,
+ * Boston, MA 02110-1301, USA.
+ */
+
+#ifdef HAVE_CONFIG_H
+#include "config.h"
+#endif
+
+#include <gnuradio/io_signature.h>
+#include "mbelib.h"
+#include "p25p2_vf.h"
+#include "dstar_tx_sb_impl.h"
+// #include "dstar_const.h"
+#include <op25_imbe_frame.h>
+
+#include <vector>
+#include <stdint.h>
+#include <stdio.h>
+#include <string.h>
+#include <errno.h>
+#include <sys/socket.h>
+#include <netinet/in.h>
+#include <arpa/inet.h>
+#include <assert.h>
+
+#if 0
+static inline void print_result(char title[], const uint8_t r[], int len) {
+	uint8_t buf[256];
+	for (int i=0; i<len; i++){
+		buf[i] = r[i] + '0';
+	}
+	buf[len] = 0;
+	printf("%s: %s\n", title, buf);
+}
+#endif
+
+namespace gr {
+  namespace op25_repeater {
+
+    dstar_tx_sb::sptr
+    dstar_tx_sb::make(int verbose_flag, const char * config_file, bool fullrate_mode)
+    {
+      return gnuradio::get_initial_sptr
+        (new dstar_tx_sb_impl(verbose_flag, config_file, fullrate_mode));
+    }
+
+//////////////////////////////////////////////////////////////////////////
+
+static const int MIN_IN = 1;
+static const int MAX_IN = 1;
+
+static const int MIN_OUT = 1;
+static const int MAX_OUT = 1;
+
+    /*
+     * The private constructor
+     */
+    dstar_tx_sb_impl::dstar_tx_sb_impl(int verbose_flag, const char * config_file, bool fullrate_mode)
+      : gr::block("dstar_tx_sb",
+              gr::io_signature::make (MIN_IN, MAX_IN, sizeof(short)),
+              gr::io_signature::make (MIN_OUT, MAX_OUT, sizeof(char))),
+              d_verbose_flag(verbose_flag),
+              d_config_file(config_file)
+    {
+      set_output_multiple(96);
+      d_encoder.set_dstar_mode();
+      config();
+    }
+
+    /*
+     * Our virtual destructor.
+     */
+    dstar_tx_sb_impl::~dstar_tx_sb_impl()
+    {
+    }
+
+void
+dstar_tx_sb_impl::config()
+{
+	FILE * fp1 = fopen(d_config_file, "r");
+	char line[256];
+	char * cp;
+	if (!fp1) {
+		fprintf(stderr, "dstar_tx_sb_impl:config: failed to open %s\n", d_config_file);
+		return;
+	}
+	for (;;) {
+		cp = fgets(line, sizeof(line) - 2, fp1);
+		if (!cp) break;
+		if (line[0] == '#') continue;
+#if 0
+		if (memcmp(line, "ft=", 3) == 0)
+			sscanf(&line[3], "%d", &d_ft);
+#endif
+	}
+	fclose(fp1);
+}
+
+void
+dstar_tx_sb_impl::forecast(int nof_output_items, gr_vector_int &nof_input_items_reqd)
+{
+   // each 96-bit output frame contains one voice code word=160 samples input
+   const size_t nof_inputs = nof_input_items_reqd.size();
+   const int nof_vcw = nof_output_items / 480.0;
+   const int nof_samples_reqd = nof_vcw * 5 * 160;
+   std::fill(&nof_input_items_reqd[0], &nof_input_items_reqd[nof_inputs], nof_samples_reqd);
+}
+
+int 
+dstar_tx_sb_impl::general_work (int noutput_items,
+			       gr_vector_int &ninput_items,
+			       gr_vector_const_void_star &input_items,
+			       gr_vector_void_star &output_items)
+{
+
+  int nconsumed = 0;
+  int16_t *in;
+  in = (int16_t *) input_items[0];
+  uint8_t *out = reinterpret_cast<uint8_t*>(output_items[0]);
+  int nframes=0;
+
+  for (int n=0;n < (noutput_items/96);n++) {
+    // need (at least) one voice codeword worth of samples
+    if (ninput_items[0] - nconsumed < 160)
+      break;
+    d_encoder.encode(in, out);
+    in += 160;
+    nconsumed += 160;
+    nframes += 1;
+    out += 96;
+  }
+
+  // Tell runtime system how many input items we consumed on
+  // each input stream.
+
+  if (nconsumed)
+    consume_each(nconsumed);
+
+  // Tell runtime system how many output items we produced.
+  return (nframes * 96);
+}
+
+  } /* namespace op25_repeater */
+} /* namespace gr */