163 lines
4.2 KiB
C++
163 lines
4.2 KiB
C++
/* -*- 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 */
|