132 lines
3.3 KiB
C++
132 lines
3.3 KiB
C++
/* -*- c++ -*- */
|
|
/*
|
|
* GNU Radio interface for Pavel Yazev's Project 25 IMBE Encoder/Decoder
|
|
*
|
|
* Copyright 2009 Pavel Yazev E-mail: pyazev@gmail.com
|
|
* Copyright 2009, 2010, 2011, 2012, 2013, 2014 KA1RBI
|
|
*
|
|
* 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 "p25p1_voice_decode.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 "imbe_vocoder/imbe_vocoder.h"
|
|
#include "p25_frame.h"
|
|
#include "op25_imbe_frame.h"
|
|
|
|
namespace gr {
|
|
namespace op25_repeater {
|
|
|
|
static void clear_bits(bit_vector& v) {
|
|
for (size_t i=0; i<v.size(); i++) {
|
|
v[i]=0;
|
|
}
|
|
}
|
|
|
|
p25p1_voice_decode::p25p1_voice_decode(bool verbose_flag, const op25_audio& udp, std::deque<int16_t> &_output_queue) :
|
|
op25audio(udp),
|
|
write_bufp(0),
|
|
rxbufp(0),
|
|
output_queue(_output_queue),
|
|
opt_verbose(verbose_flag)
|
|
{
|
|
const char *p = getenv("IMBE");
|
|
if (p && strcasecmp(p, "soft") == 0)
|
|
d_software_imbe_decoder = true;
|
|
else
|
|
d_software_imbe_decoder = false;
|
|
}
|
|
|
|
/*
|
|
* Our virtual destructor.
|
|
*/
|
|
p25p1_voice_decode::~p25p1_voice_decode()
|
|
{
|
|
}
|
|
|
|
void p25p1_voice_decode::rxframe(const uint32_t u[])
|
|
{
|
|
int16_t snd[FRAME];
|
|
int16_t frame_vector[8];
|
|
// decode 88 bits, outputs 160 sound samples (8000 rate)
|
|
if (d_software_imbe_decoder) {
|
|
voice_codeword cw(voice_codeword_sz);
|
|
imbe_header_encode(cw, u[0], u[1], u[2], u[3], u[4], u[5], u[6], u[7]);
|
|
software_decoder.decode(cw);
|
|
audio_samples *samples = software_decoder.audio();
|
|
for (int i=0; i < FRAME; i++) {
|
|
if (samples->size() > 0) {
|
|
snd[i] = (int16_t)(samples->front() * 32768.0);
|
|
samples->pop_front();
|
|
} else {
|
|
snd[i] = 0;
|
|
}
|
|
}
|
|
} else {
|
|
for (int i=0; i < 8; i++) {
|
|
frame_vector[i] = u[i];
|
|
}
|
|
/* TEST*/ frame_vector[7] >>= 1;
|
|
vocoder.imbe_decode(frame_vector, snd);
|
|
}
|
|
if (op25audio.enabled()) {
|
|
op25audio.send_audio(snd, FRAME * sizeof(int16_t));
|
|
} else {
|
|
// add generated samples to output queue
|
|
for (int i = 0; i < FRAME; i++) {
|
|
output_queue.push_back(snd[i]);
|
|
}
|
|
}
|
|
}
|
|
|
|
void p25p1_voice_decode::rxchar(const char* c, int len)
|
|
{
|
|
uint32_t u[8];
|
|
|
|
for (int i = 0; i < len; i++ ) {
|
|
if (c[i] < ' ') {
|
|
if (c[i] == '\n') {
|
|
rxbuf[rxbufp] = 0;
|
|
sscanf(rxbuf, "%x %x %x %x %x %x %x %x", &u[0], &u[1], &u[2], &u[3], &u[4], &u[5], &u[6], &u[7]);
|
|
rxbufp = 0;
|
|
rxframe(u);
|
|
}
|
|
continue;
|
|
}
|
|
rxbuf[rxbufp++] = c[i];
|
|
if (rxbufp >= RXBUF_MAX) {
|
|
rxbufp = RXBUF_MAX - 1;
|
|
}
|
|
} /* end of for() */
|
|
}
|
|
|
|
} /* namespace op25_repeater */
|
|
} /* namespace gr */
|