You cannot select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

593 lines
15 KiB
C++

3 years ago
/*
Copyright (C) 2019-2021 Doug McLain
This program 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 of the License, or
(at your option) any later version.
This program 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, see <https://www.gnu.org/licenses/>.
*/
#include <iostream>
#include <cstring>
#include "dcs.h"
3 years ago
#include "CRCenc.h"
#include "MMDVMDefines.h"
3 years ago
DCS::DCS()
3 years ago
{
m_mode = "DCS";
m_attenuation = 5;
3 years ago
}
DCS::~DCS()
3 years ago
{
}
void DCS::process_udp()
3 years ago
{
QByteArray buf;
QHostAddress sender;
quint16 senderPort;
static bool sd_sync = 0;
static int sd_seq = 0;
static char user_data[21];
buf.resize(200);
int size = m_udp->readDatagram(buf.data(), buf.size(), &sender, &senderPort);
if(m_debug){
QDebug debug = qDebug();
debug.noquote();
QString s = "RECV:";
for(int i = 0; i < buf.size(); ++i){
s += " " + QString("%1").arg((uint8_t)buf.data()[i], 2, 16, QChar('0'));
}
debug << s;
}
3 years ago
if(size == 22){ //2 way keep alive ping
m_modeinfo.count++;
m_modeinfo.netmsg.clear();
if( (m_modeinfo.stream_state == STREAM_LOST) || (m_modeinfo.stream_state == STREAM_END) ){
m_modeinfo.stream_state = STREAM_IDLE;
}
}
if( (m_modeinfo.status == CONNECTING) && (size == 14) && (!memcmp(buf.data()+10, "ACK", 3)) ){
qDebug() << "Connected to DCS";
m_modeinfo.status = CONNECTED_RW;
m_modeinfo.sw_vocoder_loaded = load_vocoder_plugin();
3 years ago
m_rxtimer = new QTimer();
connect(m_rxtimer, SIGNAL(timeout()), this, SLOT(process_rx_data()));
m_txtimer = new QTimer();
connect(m_txtimer, SIGNAL(timeout()), this, SLOT(transmit()));
m_ping_timer = new QTimer();
connect(m_ping_timer, SIGNAL(timeout()), this, SLOT(send_ping()));
m_ping_timer->start(2000);
m_audio = new AudioEngine(m_audioin, m_audioout);
m_audio->init();
}
if(m_modeinfo.status != CONNECTED_RW) return;
if(size == 35){
m_modeinfo.ts = QDateTime::currentMSecsSinceEpoch();
m_modeinfo.netmsg = QString(buf.data());
}
if((size == 100) && (!memcmp(buf.data(), "0001", 4)) ){
m_rxwatchdog = 0;
uint16_t streamid = (buf.data()[43] << 8) | (buf.data()[44] & 0xff);
if(!m_tx && (m_modeinfo.streamid == 0)){
m_modeinfo.streamid = streamid;
m_modeinfo.stream_state = STREAM_NEW;
m_modeinfo.ts = QDateTime::currentMSecsSinceEpoch();
if(!m_rxtimer->isActive()){
m_audio->start_playback();
m_rxtimer->start(m_rxtimerint);
m_rxcodecq.clear();
}
char temp[9];
memcpy(temp, buf.data() + 7, 8); temp[8] = '\0';
m_modeinfo.gw2 = QString(temp);
memcpy(temp, buf.data() + 15, 8); temp[8] = '\0';
m_modeinfo.gw = QString(temp);
memcpy(temp, buf.data() + 23, 8); temp[8] = '\0';
m_modeinfo.dst = QString(temp);
memcpy(temp, buf.data() + 31, 8); temp[8] = '\0';
m_modeinfo.src = QString(temp);
QString h = m_refname + " " + m_module;
3 years ago
if(m_modem){
uint8_t out[44];
out[0] = MMDVM_FRAME_START;
3 years ago
out[1] = 44;
out[2] = MMDVM_DSTAR_HEADER;
out[3] = 0x40;
out[4] = 0;
out[5] = 0;
memcpy(out + 6, m_modeinfo.gw2.toLocal8Bit().data(), 8);
memcpy(out + 14, m_modeinfo.gw.toLocal8Bit().data(), 8);
memcpy(out + 22, m_modeinfo.dst.toLocal8Bit().data(), 8);
memcpy(out + 30, m_modeinfo.src.toLocal8Bit().data(), 8);
memcpy(out + 38, buf.data() + 52, 4);
CCRC::addCCITT161((uint8_t *)out + 3, 41);
for(int i = 0; i < 44; ++i){
m_rxmodemq.append(out[i]);
}
//m_modem->write(out);
}
qDebug() << "New stream from " << m_modeinfo.src << " to " << m_modeinfo.dst << " id == " << QString::number(m_modeinfo.streamid, 16);
}
else{
m_modeinfo.stream_state = STREAMING;
}
m_modeinfo.frame_number = (uint8_t)buf.data()[0x2d];
3 years ago
if((buf.data()[45] == 0) && (buf.data()[55] == 0x55) && (buf.data()[56] == 0x2d) && (buf.data()[57] == 0x16)){
sd_sync = 1;
sd_seq = 1;
}
if(sd_sync && (sd_seq == 1) && (buf.data()[45] == 1) && (buf.data()[55] == 0x30)){
user_data[0] = buf.data()[56] ^ 0x4f;
user_data[1] = buf.data()[57] ^ 0x93;
++sd_seq;
}
if(sd_sync && (sd_seq == 2) && (buf.data()[45] == 2)){
user_data[2] = buf.data()[55] ^ 0x70;
user_data[3] = buf.data()[56] ^ 0x4f;
user_data[4] = buf.data()[57] ^ 0x93;
++sd_seq;
}
if(sd_sync && (sd_seq == 3) && (buf.data()[45] == 3) && (buf.data()[55] == 0x31)){
user_data[5] = buf.data()[56] ^ 0x4f;
user_data[6] = buf.data()[57] ^ 0x93;
++sd_seq;
}
if(sd_sync && (sd_seq == 4) && (buf.data()[45] == 4)){
user_data[7] = buf.data()[55] ^ 0x70;
user_data[8] = buf.data()[56] ^ 0x4f;
user_data[9] = buf.data()[57] ^ 0x93;
++sd_seq;
}
if(sd_sync && (sd_seq == 5) && (buf.data()[45] == 5) && (buf.data()[55] == 0x32)){
user_data[10] = buf.data()[56] ^ 0x4f;
user_data[11] = buf.data()[57] ^ 0x93;
++sd_seq;
}
if(sd_sync && (sd_seq == 6) && (buf.data()[45] == 6)){
user_data[12] = buf.data()[55] ^ 0x70;
user_data[13] = buf.data()[56] ^ 0x4f;
user_data[14] = buf.data()[57] ^ 0x93;
++sd_seq;
}
if(sd_sync && (sd_seq == 7) && (buf.data()[45] == 7) && (buf.data()[55] == 0x33)){
user_data[15] = buf.data()[56] ^ 0x4f;
user_data[16] = buf.data()[57] ^ 0x93;
++sd_seq;
}
if(sd_sync && (sd_seq == 8) && (buf.data()[45] == 8)){
user_data[17] = buf.data()[55] ^ 0x70;
user_data[18] = buf.data()[56] ^ 0x4f;
user_data[19] = buf.data()[57] ^ 0x93;
user_data[20] = '\0';
sd_sync = 0;
sd_seq = 0;
m_modeinfo.usertxt = QString(user_data);
}
if(buf.data()[45] & 0x40){
qDebug() << "DCS RX stream ended ";
m_rxwatchdog = 0;
m_modeinfo.stream_state = STREAM_END;
m_modeinfo.ts = QDateTime::currentMSecsSinceEpoch();
emit update(m_modeinfo);
m_modeinfo.streamid = 0;
if(m_modem){
m_rxmodemq.append(MMDVM_FRAME_START);
3 years ago
m_rxmodemq.append(3);
m_rxmodemq.append(MMDVM_DSTAR_EOT);
}
}
else if(m_modeinfo.stream_state == STREAMING){
if(m_modem){
m_rxmodemq.append(MMDVM_FRAME_START);
3 years ago
m_rxmodemq.append(15);
m_rxmodemq.append(MMDVM_DSTAR_DATA);
for(int i = 0; i < 12; ++i){
m_rxmodemq.append(buf.data()[46+i]);
}
}
}
for(int i = 0; i < 9; ++i){
m_rxcodecq.append(buf.data()[46+i]);
}
}
emit update(m_modeinfo);
}
void DCS::hostname_lookup(QHostInfo i)
3 years ago
{
if (!i.addresses().isEmpty()) {
QByteArray out;
out.resize(519);
memcpy(out.data(), m_modeinfo.callsign.toStdString().c_str(), m_modeinfo.callsign.size());
memset(out.data() + m_modeinfo.callsign.size(), ' ', 8 - m_modeinfo.callsign.size());
out[8] = m_module;
out[9] = m_module;
out[10] = 11;
m_address = i.addresses().first();
m_udp = new QUdpSocket(this);
connect(m_udp, SIGNAL(readyRead()), this, SLOT(process_udp()));
m_udp->writeDatagram(out, m_address, m_modeinfo.port);
if(m_debug){
QDebug debug = qDebug();
debug.noquote();
QString s = "CONN:";
for(int i = 0; i < out.size(); ++i){
s += " " + QString("%1").arg((uint8_t)out.data()[i], 2, 16, QChar('0'));
}
debug << s;
}
3 years ago
}
}
void DCS::send_ping()
3 years ago
{
static QByteArray out;
out.clear();
out.append(m_modeinfo.callsign.toUtf8());
out.append(7 - m_modeinfo.callsign.size(), ' ');
out.append(m_module);
out.append('\x00');
out.append(m_refname.toUtf8());
3 years ago
out.append('\x00');
out.append(m_module);
m_udp->writeDatagram(out, m_address, m_modeinfo.port);
if(m_debug){
QDebug debug = qDebug();
debug.noquote();
QString s = "PING:";
for(int i = 0; i < out.size(); ++i){
s += " " + QString("%1").arg((uint8_t)out.data()[i], 2, 16, QChar('0'));
}
debug << s;
}
3 years ago
}
void DCS::send_disconnect()
3 years ago
{
QByteArray out;
out.append(m_modeinfo.callsign.toUtf8());
out.append(8 - m_modeinfo.callsign.size(), ' ');
out.append(m_module);
out.append(' ');
out.append('\x00');
m_udp->writeDatagram(out, m_address, m_modeinfo.port);
if(m_debug){
QDebug debug = qDebug();
debug.noquote();
QString s = "DISC:";
for(int i = 0; i < out.size(); ++i){
s += " " + QString("%1").arg((uint8_t)out.data()[i], 2, 16, QChar('0'));
}
debug << s;
}
3 years ago
}
void DCS::format_callsign(QString &s)
3 years ago
{
QStringList l = s.simplified().split(' ');
if(l.size() > 1){
s = l.at(0).simplified();
while(s.size() < 7){
s.append(' ');
}
s += l.at(1).simplified();
}
else{
while(s.size() < 8){
s.append(' ');
}
}
}
void DCS::process_modem_data(QByteArray d)
3 years ago
{
QByteArray txdata;
char cs[9];
uint8_t ambe[9];
uint8_t *p_frame = (uint8_t *)(d.data());
if(p_frame[2] == MMDVM_DSTAR_HEADER){
format_callsign(m_txrptr1);
format_callsign(m_txrptr2);
cs[8] = 0;
memcpy(cs, p_frame + 22, 8);
m_txurcall = QString(cs);
memcpy(cs, p_frame + 30, 8);
m_txmycall = QString(cs);
m_modeinfo.stream_state = TRANSMITTING_MODEM;
m_tx = true;
}
else if( (p_frame[2] == MMDVM_DSTAR_EOT) || (p_frame[2] == MMDVM_DSTAR_LOST) ){
m_tx = false;
}
else if(p_frame[2] == MMDVM_DSTAR_DATA){
memcpy(ambe, p_frame + 3, 9);
}
send_frame(ambe);
}
void DCS::toggle_tx(bool tx)
3 years ago
{
tx ? start_tx() : stop_tx();
}
void DCS::start_tx()
3 years ago
{
format_callsign(m_txmycall);
format_callsign(m_txurcall);
format_callsign(m_txrptr1);
format_callsign(m_txrptr2);
Mode::start_tx();
3 years ago
}
void DCS::transmit()
3 years ago
{
uint8_t ambe[9];
3 years ago
int16_t pcm[160];
memset(ambe, 0, 9);
#ifdef USE_FLITE
if(m_ttsid > 0){
for(int i = 0; i < 160; ++i){
if(m_ttscnt >= tts_audio->num_samples/2){
pcm[i] = 0;
}
else{
2 years ago
pcm[i] = tts_audio->samples[m_ttscnt*2] / 8;
3 years ago
m_ttscnt++;
}
}
}
#endif
if(m_ttsid == 0){
if(m_audio->read(pcm, 160)){
}
else{
return;
}
}
if(m_hwtx){
#if !defined(Q_OS_IOS)
3 years ago
m_ambedev->encode(pcm);
#endif
3 years ago
if(m_tx && (m_txcodecq.size() >= 9)){
for(int i = 0; i < 9; ++i){
ambe[i] = m_txcodecq.dequeue();
}
send_frame(ambe);
}
else if(!m_tx){
send_frame(ambe);
}
}
else{
if(m_modeinfo.sw_vocoder_loaded){
3 years ago
m_mbevocoder->encode_2400x1200(pcm, ambe);
}
send_frame(ambe);
}
}
void DCS::send_frame(uint8_t *ambe)
3 years ago
{
QByteArray txdata;
static uint16_t txstreamid = 0;
txdata.clear();
txdata.append(100, 0);
if(txstreamid == 0){
txstreamid = static_cast<uint16_t>((::rand() & 0xFFFF));
}
txdata.replace(0, 4, "0001");
txdata.replace(7, 8, m_txrptr2.toLocal8Bit().data());
txdata.replace(15, 8, m_txrptr1.toLocal8Bit().data());
txdata.replace(23, 8, m_txurcall.toLocal8Bit().data());
txdata.replace(31, 8, m_txmycall.toLocal8Bit().data());
txdata.replace(39, 4, "AMBE");
txdata[43] = (txstreamid >> 8) & 0xff;
txdata[44] = txstreamid & 0xff;
3 years ago
txdata[45] = (m_txcnt % 21) & 0xff;
memcpy(txdata.data() + 46, ambe, 9);
switch(txdata.data()[45]){
case 0:
txdata[55] = 0x55;
txdata[56] = 0x2d;
txdata[57] = 0x16;
break;
case 1:
txdata[55] = 0x40 ^ 0x70;
txdata[56] = m_txusrtxt.toLocal8Bit().data()[0] ^ 0x4f;
txdata[57] = m_txusrtxt.toLocal8Bit().data()[1] ^ 0x93;
break;
case 2:
txdata[55] = m_txusrtxt.toLocal8Bit().data()[2] ^ 0x70;
txdata[56] = m_txusrtxt.toLocal8Bit().data()[3] ^ 0x4f;
txdata[57] = m_txusrtxt.toLocal8Bit().data()[4] ^ 0x93;
break;
case 3:
txdata[55] = 0x41 ^ 0x70;
txdata[56] = m_txusrtxt.toLocal8Bit().data()[5] ^ 0x4f;
txdata[57] = m_txusrtxt.toLocal8Bit().data()[6] ^ 0x93;
break;
case 4:
txdata[55] = m_txusrtxt.toLocal8Bit().data()[7] ^ 0x70;
txdata[56] = m_txusrtxt.toLocal8Bit().data()[8] ^ 0x4f;
txdata[57] = m_txusrtxt.toLocal8Bit().data()[9] ^ 0x93;
break;
case 5:
txdata[55] = 0x42 ^ 0x70;
txdata[56] = m_txusrtxt.toLocal8Bit().data()[10] ^ 0x4f;
txdata[57] = m_txusrtxt.toLocal8Bit().data()[11] ^ 0x93;
break;
case 6:
txdata[55] = m_txusrtxt.toLocal8Bit().data()[12] ^ 0x70;
txdata[56] = m_txusrtxt.toLocal8Bit().data()[13] ^ 0x4f;
txdata[57] = m_txusrtxt.toLocal8Bit().data()[14] ^ 0x93;
break;
case 7:
txdata[55] = 0x43 ^ 0x70;
txdata[56] = m_txusrtxt.toLocal8Bit().data()[15] ^ 0x4f;
txdata[57] = m_txusrtxt.toLocal8Bit().data()[16] ^ 0x93;
break;
case 8:
txdata[55] = m_txusrtxt.toLocal8Bit().data()[17] ^ 0x70;
txdata[56] = m_txusrtxt.toLocal8Bit().data()[18] ^ 0x4f;
txdata[57] = m_txusrtxt.toLocal8Bit().data()[19] ^ 0x93;
break;
default:
txdata[55] = 0x16;
txdata[56] = 0x29;
txdata[57] = 0xf5;
break;
}
txdata[58] = m_txcnt & 0xff;
txdata[59] = (m_txcnt >> 8) & 0xff;
txdata[60] = (m_txcnt >> 16) & 0xff;
txdata[61] = 0x01;
m_modeinfo.src = m_txmycall;
m_modeinfo.dst = m_txurcall;
m_modeinfo.gw = m_txrptr1;
m_modeinfo.gw2 = m_txrptr2;
m_modeinfo.streamid = txstreamid;
m_modeinfo.frame_number = m_txcnt;
if(m_tx){
m_txcnt++;
}
else{
uint8_t last_frame[9] = {0xdc, 0x8e, 0x0a, 0x40, 0xad, 0xed, 0xad, 0x39, 0x6e};
txdata[45] = (txdata[45] | 0x40);
txdata.replace(46, 9, (char *)last_frame);
m_txcnt = 0;
txstreamid = 0;
m_modeinfo.streamid = 0;
m_txtimer->stop();
if((m_ttsid == 0) && (m_modeinfo.stream_state == TRANSMITTING) ){
m_audio->stop_capture();
}
m_ttscnt = 0;
}
m_udp->writeDatagram(txdata, m_address, m_modeinfo.port);
emit update_output_level(m_audio->level() * 2);
3 years ago
update(m_modeinfo);
if(m_debug){
QDebug debug = qDebug();
debug.noquote();
QString s = "SEND:";
for(int i = 0; i < txdata.size(); ++i){
s += " " + QString("%1").arg((uint8_t)txdata.data()[i], 2, 16, QChar('0'));
}
debug << s;
}
3 years ago
}
void DCS::get_ambe()
3 years ago
{
#if !defined(Q_OS_IOS)
3 years ago
uint8_t ambe[9];
if(m_ambedev->get_ambe(ambe)){
for(int i = 0; i < 9; ++i){
m_txcodecq.append(ambe[i]);
}
}
#endif
3 years ago
}
void DCS::process_rx_data()
3 years ago
{
int16_t pcm[160];
uint8_t ambe[9];
if(m_rxwatchdog++ > 100){
qDebug() << "DCS RX stream timeout ";
m_rxwatchdog = 0;
m_modeinfo.stream_state = STREAM_LOST;
m_modeinfo.ts = QDateTime::currentMSecsSinceEpoch();
emit update(m_modeinfo);
m_modeinfo.streamid = 0;
}
if(m_rxmodemq.size() > 2){
QByteArray out;
int s = m_rxmodemq[1];
if((m_rxmodemq[0] == MMDVM_FRAME_START) && (m_rxmodemq.size() >= s)){
3 years ago
for(int i = 0; i < s; ++i){
out.append(m_rxmodemq.dequeue());
}
#if !defined(Q_OS_IOS)
3 years ago
m_modem->write(out);
#endif
3 years ago
}
}
if((!m_tx) && (m_rxcodecq.size() > 8) ){
for(int i = 0; i < 9; ++i){
ambe[i] = m_rxcodecq.dequeue();
}
if(m_hwrx){
#if !defined(Q_OS_IOS)
3 years ago
m_ambedev->decode(ambe);
if(m_ambedev->get_audio(pcm)){
m_audio->write(pcm, 160);
emit update_output_level(m_audio->level());
}
#endif
3 years ago
}
else{
if(m_modeinfo.sw_vocoder_loaded){
3 years ago
m_mbevocoder->decode_2400x1200(pcm, ambe);
}
else{
memset(pcm, 0, 160 * sizeof(int16_t));
}
m_audio->write(pcm, 160);
emit update_output_level(m_audio->level());
}
}
else if ( (m_modeinfo.stream_state == STREAM_END) || (m_modeinfo.stream_state == STREAM_LOST) ){
m_rxtimer->stop();
m_audio->stop_playback();
m_rxwatchdog = 0;
m_modeinfo.streamid = 0;
m_rxcodecq.clear();
qDebug() << "DCS playback stopped";
m_modeinfo.stream_state = STREAM_IDLE;
3 years ago
return;
}
}