Digital_Voice_Modem_Project
/
dvmvocoder
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

confirmed working with P/invoke on windows .NET Core C#

Browse Source
main
Patrick W3AXL 1 year ago
parent d6c59be715
commit a9a2a17d23
6 changed files with 899 additions and 826 deletions
Show Stats Download Patch File Download Diff File

3
.gitignore vendored
Unescape View File

@ -33,3 +33,6 @@
# Build directory
build/
# VS stuff
.vs/

5
CMakeLists.txt
Unescape View File

@ -16,6 +16,11 @@ project(dvmvocoder)
set(CMAKE_STATIC_LIBRARY_PREFIX "")
set(CMAKE_SHARED_LIBRARY_PREFIX "")
# Set up export symbols (Windows only)
if(WIN32)
set(CMAKE_WINDOWS_EXPORT_ALL_SYMBOLS ON)
endif()
#
# Build Vocoder as a Shared Library (dll or so)
#

517
vocoder/MBEDecoder.cpp
Unescape View File

@ -16,301 +16,328 @@
#include "MBEDecoder.h"
using namespace edac;
using namespace vocoder;
// ---------------------------------------------------------------------------
// Constants
// ---------------------------------------------------------------------------
const int MBEDecoder::dW[72] = { 0,0,3,2,1,1,0,0,1,1,0,0,3,2,1,1,3,2,1,1,0,0,3,2,0,0,3,2,1,1,0,0,1,1,0,0,3,2,1,1,3,2,1,1,0,0,3,2,0,0,3,2,1,1,0,0,1,1,0,0,3,2,1,1,3,3,2,1,0,0,3,3, };
const int MBEDecoder::dX[72] = { 10,22,11,9,10,22,11,23,8,20,9,21,10,8,9,21,8,6,7,19,8,20,9,7,6,18,7,5,6,18,7,19,4,16,5,17,6,4,5,17,4,2,3,15,4,16,5,3,2,14,3,1,2,14,3,15,0,12,1,13,2,0,1,13,0,12,10,11,0,12,1,13, };
const int MBEDecoder::rW[36] = {
0, 1, 0, 1, 0, 1,
0, 1, 0, 1, 0, 1,
0, 1, 0, 1, 0, 1,
0, 1, 0, 1, 0, 2,
0, 2, 0, 2, 0, 2,
0, 2, 0, 2, 0, 2
};
const int MBEDecoder::rX[36] = {
23, 10, 22, 9, 21, 8,
20, 7, 19, 6, 18, 5,
17, 4, 16, 3, 15, 2,
14, 1, 13, 0, 12, 10,
11, 9, 10, 8, 9, 7,
8, 6, 7, 5, 6, 4
};
// bit 0
const int MBEDecoder::rY[36] = {
0, 2, 0, 2, 0, 2,
0, 2, 0, 3, 0, 3,
1, 3, 1, 3, 1, 3,
1, 3, 1, 3, 1, 3,
1, 3, 1, 3, 1, 3,
1, 3, 1, 3, 1, 3
};
const int MBEDecoder::rZ[36] = {
5, 3, 4, 2, 3, 1,
2, 0, 1, 13, 0, 12,
22, 11, 21, 10, 20, 9,
19, 8, 18, 7, 17, 6,
16, 5, 15, 4, 14, 3,
13, 2, 12, 1, 11, 0
};
// ---------------------------------------------------------------------------
// Public Class Members
// ---------------------------------------------------------------------------
/* Initializes a new instance of the MBEDecoder class. */
MBEDecoder::MBEDecoder(MBE_DECODER_MODE mode) :
m_mbelibParms(NULL),
m_mbeMode(mode),
m_gainAdjust(1.0f)
{
m_mbelibParms = new mbelibParms();
mbe_initMbeParms(m_mbelibParms->m_cur_mp, m_mbelibParms->m_prev_mp, m_mbelibParms->m_prev_mp_enhanced);
::memset(gainMaxBuf, 0, sizeof(float) * 200);
gainMaxBufPtr = gainMaxBuf;
gainMaxIdx = 0;
}
/* Finalizes a instance of the MBEDecoder class. */
MBEDecoder::~MBEDecoder()
{
delete m_mbelibParms;
}
/* Decodes the given MBE codewords to deinterleaved MBE bits using the decoder mode. */
int32_t MBEDecoder::decodeBits(uint8_t* codeword, char* mbeBits)
{
int32_t errs = 0;
float samples[160U];
::memset(samples, 0x00U, 160U * sizeof(float));
switch (m_mbeMode)
{
case DECODE_DMR_AMBE:
namespace vocoder {
// ---------------------------------------------------------------------------
// Constants
// ---------------------------------------------------------------------------
const int MBEDecoder::dW[72] = { 0,0,3,2,1,1,0,0,1,1,0,0,3,2,1,1,3,2,1,1,0,0,3,2,0,0,3,2,1,1,0,0,1,1,0,0,3,2,1,1,3,2,1,1,0,0,3,2,0,0,3,2,1,1,0,0,1,1,0,0,3,2,1,1,3,3,2,1,0,0,3,3, };
const int MBEDecoder::dX[72] = { 10,22,11,9,10,22,11,23,8,20,9,21,10,8,9,21,8,6,7,19,8,20,9,7,6,18,7,5,6,18,7,19,4,16,5,17,6,4,5,17,4,2,3,15,4,16,5,3,2,14,3,1,2,14,3,15,0,12,1,13,2,0,1,13,0,12,10,11,0,12,1,13, };
const int MBEDecoder::rW[36] = {
0, 1, 0, 1, 0, 1,
0, 1, 0, 1, 0, 1,
0, 1, 0, 1, 0, 1,
0, 1, 0, 1, 0, 2,
0, 2, 0, 2, 0, 2,
0, 2, 0, 2, 0, 2
};
const int MBEDecoder::rX[36] = {
23, 10, 22, 9, 21, 8,
20, 7, 19, 6, 18, 5,
17, 4, 16, 3, 15, 2,
14, 1, 13, 0, 12, 10,
11, 9, 10, 8, 9, 7,
8, 6, 7, 5, 6, 4
};
// bit 0
const int MBEDecoder::rY[36] = {
0, 2, 0, 2, 0, 2,
0, 2, 0, 3, 0, 3,
1, 3, 1, 3, 1, 3,
1, 3, 1, 3, 1, 3,
1, 3, 1, 3, 1, 3,
1, 3, 1, 3, 1, 3
};
const int MBEDecoder::rZ[36] = {
5, 3, 4, 2, 3, 1,
2, 0, 1, 13, 0, 12,
22, 11, 21, 10, 20, 9,
19, 8, 18, 7, 17, 6,
16, 5, 15, 4, 14, 3,
13, 2, 12, 1, 11, 0
};
// ---------------------------------------------------------------------------
// Public Class Members
// ---------------------------------------------------------------------------
/* Initializes a new instance of the MBEDecoder class. */
MBEDecoder::MBEDecoder(MBE_DECODER_MODE mode) :
m_mbelibParms(NULL),
m_mbeMode(mode),
m_gainAdjust(1.0f)
{
char ambe_d[49U];
char ambe_fr[4][24];
::memset(ambe_d, 0x00U, 49U);
::memset(ambe_fr, 0x00U, 96U);
const int* w, *x, *y, *z;
w = rW;
x = rX;
y = rY;
z = rZ;
for (int i = 0; i < 9; ++i) {
for (int j = 0; j < 8; j += 2) {
ambe_fr[*y][*z] = (1 & (codeword[i] >> (7 - (j + 1))));
ambe_fr[*w][*x] = (1 & (codeword[i] >> (7 - j)));
w++;
x++;
y++;
z++;
}
}
m_mbelibParms = new mbelibParms();
mbe_initMbeParms(m_mbelibParms->m_cur_mp, m_mbelibParms->m_prev_mp, m_mbelibParms->m_prev_mp_enhanced);
errs = mbe_eccAmbe3600x2450C0(ambe_fr);
mbe_demodulateAmbe3600x2450Data(ambe_fr);
::memset(gainMaxBuf, 0, sizeof(float) * 200);
gainMaxBufPtr = gainMaxBuf;
gainMaxIdx = 0;
}
errs += mbe_eccAmbe3600x2450Data(ambe_fr, ambe_d);
/* Finalizes a instance of the MBEDecoder class. */
::memcpy(mbeBits, ambe_d, 49U);
MBEDecoder::~MBEDecoder()
{
delete m_mbelibParms;
}
break;
case DECODE_88BIT_IMBE:
/* Decodes the given MBE codewords to deinterleaved MBE bits using the decoder mode. */
int32_t MBEDecoder::decodeBits(uint8_t* codeword, char* mbeBits)
{
char imbe_d[88U];
::memset(imbe_d, 0x00U, 88U);
int32_t errs = 0;
float samples[160U];
::memset(samples, 0x00U, 160U * sizeof(float));
switch (m_mbeMode)
{
case DECODE_DMR_AMBE:
{
char ambe_d[49U];
char ambe_fr[4][24];
::memset(ambe_d, 0x00U, 49U);
::memset(ambe_fr, 0x00U, 96U);
const int* w, *x, *y, *z;
w = rW;
x = rX;
y = rY;
z = rZ;
for (int i = 0; i < 9; ++i) {
for (int j = 0; j < 8; j += 2) {
ambe_fr[*y][*z] = (1 & (codeword[i] >> (7 - (j + 1))));
ambe_fr[*w][*x] = (1 & (codeword[i] >> (7 - j)));
w++;
x++;
y++;
z++;
}
}
for (int i = 0; i < 11; ++i) {
for (int j = 0; j < 8; j++) {
imbe_d[j + (8 * i)] = (1 & (codeword[i] >> (7 - j)));
errs = mbe_eccAmbe3600x2450C0(ambe_fr);
mbe_demodulateAmbe3600x2450Data(ambe_fr);
errs += mbe_eccAmbe3600x2450Data(ambe_fr, ambe_d);
::memcpy(mbeBits, ambe_d, 49U);
}
break;
case DECODE_88BIT_IMBE:
{
char imbe_d[88U];
::memset(imbe_d, 0x00U, 88U);
for (int i = 0; i < 11; ++i) {
for (int j = 0; j < 8; j++) {
imbe_d[j + (8 * i)] = (1 & (codeword[i] >> (7 - j)));
}
}
::memcpy(mbeBits, imbe_d, 88U);
}
break;
}
::memcpy(mbeBits, imbe_d, 88U);
return errs;
}
break;
}
return errs;
}
/* Decodes the given MBE codewords to PCM samples using the decoder mode. */
/* Decodes the given MBE codewords to PCM samples using the decoder mode. */
int32_t MBEDecoder::decodeF(uint8_t* codeword, float samples[])
{
int32_t errs = 0;
switch (m_mbeMode)
int32_t MBEDecoder::decodeF(uint8_t* codeword, float samples[])
{
case DECODE_DMR_AMBE:
{
char ambe_d[49U];
char ambe_fr[4][24];
::memset(ambe_d, 0x00U, 49U);
::memset(ambe_fr, 0x00U, 96U);
const int* w, *x, *y, *z;
w = rW;
x = rX;
y = rY;
z = rZ;
for (int i = 0; i < 9; ++i) {
for (int j = 0; j < 8; j += 2) {
ambe_fr[*y][*z] = (1 & (codeword[i] >> (7 - (j + 1))));
ambe_fr[*w][*x] = (1 & (codeword[i] >> (7 - j)));
w++;
x++;
y++;
z++;
int32_t errs = 0;
switch (m_mbeMode)
{
case DECODE_DMR_AMBE:
{
char ambe_d[49U];
char ambe_fr[4][24];
::memset(ambe_d, 0x00U, 49U);
::memset(ambe_fr, 0x00U, 96U);
const int* w, *x, *y, *z;
w = rW;
x = rX;
y = rY;
z = rZ;
for (int i = 0; i < 9; ++i) {
for (int j = 0; j < 8; j += 2) {
ambe_fr[*y][*z] = (1 & (codeword[i] >> (7 - (j + 1))));
ambe_fr[*w][*x] = (1 & (codeword[i] >> (7 - j)));
w++;
x++;
y++;
z++;
}
}
}
int ambeErrs;
char ambeErrStr[64U];
::memset(ambeErrStr, 0x20U, 64U);
int ambeErrs;
char ambeErrStr[64U];
::memset(ambeErrStr, 0x20U, 64U);
mbe_processAmbe3600x2450FrameF(samples, &ambeErrs, &errs, ambeErrStr, ambe_fr, ambe_d, m_mbelibParms->m_cur_mp, m_mbelibParms->m_prev_mp, m_mbelibParms->m_prev_mp_enhanced, 3);
}
break;
mbe_processAmbe3600x2450FrameF(samples, &ambeErrs, &errs, ambeErrStr, ambe_fr, ambe_d, m_mbelibParms->m_cur_mp, m_mbelibParms->m_prev_mp, m_mbelibParms->m_prev_mp_enhanced, 3);
}
break;
case DECODE_88BIT_IMBE:
{
char imbe_d[88U];
::memset(imbe_d, 0x00U, 88U);
case DECODE_88BIT_IMBE:
{
char imbe_d[88U];
::memset(imbe_d, 0x00U, 88U);
for (int i = 0; i < 11; ++i) {
for (int j = 0; j < 8; j++) {
imbe_d[j + (8 * i)] = (1 & (codeword[i] >> (7 - j)));
for (int i = 0; i < 11; ++i) {
for (int j = 0; j < 8; j++) {
imbe_d[j + (8 * i)] = (1 & (codeword[i] >> (7 - j)));
}
}
}
int ambeErrs;
char ambeErrStr[64U];
::memset(ambeErrStr, 0x20U, 64U);
int ambeErrs;
char ambeErrStr[64U];
::memset(ambeErrStr, 0x20U, 64U);
mbe_processImbe4400DataF(samples, &ambeErrs, &errs, ambeErrStr, imbe_d, m_mbelibParms->m_cur_mp, m_mbelibParms->m_prev_mp, m_mbelibParms->m_prev_mp_enhanced, 3);
}
break;
mbe_processImbe4400DataF(samples, &ambeErrs, &errs, ambeErrStr, imbe_d, m_mbelibParms->m_cur_mp, m_mbelibParms->m_prev_mp, m_mbelibParms->m_prev_mp_enhanced, 3);
}
break;
}
return errs;
}
return errs;
}
/* Decodes the given MBE codewords to PCM samples using the decoder mode. */
/* Decodes the given MBE codewords to PCM samples using the decoder mode. */
int32_t MBEDecoder::decode(uint8_t* codeword, int16_t samples[])
{
float samplesF[160U];
::memset(samplesF, 0x00U, 160U * sizeof(float));
int32_t errs = decodeF(codeword, samplesF);
float* sampleFPtr = samplesF;
if (m_autoGain) {
// detect max level
float max = 0.0f;
for (int n = 0; n < 160; n++) {
float out = fabsf(*sampleFPtr);
if (out > max) {
max = out;
}
sampleFPtr++;
}
int32_t MBEDecoder::decode(uint8_t* codeword, int16_t samples[])
{
float samplesF[160U];
::memset(samplesF, 0x00U, 160U * sizeof(float));
int32_t errs = decodeF(codeword, samplesF);
*gainMaxBufPtr = max;
gainMaxBufPtr++;
gainMaxIdx++;
float* sampleFPtr = samplesF;
if (m_autoGain) {
// detect max level
float max = 0.0f;
for (int n = 0; n < 160; n++) {
float out = fabsf(*sampleFPtr);
if (out > max) {
max = out;
if (gainMaxIdx > 24) {
gainMaxIdx = 0;
gainMaxBufPtr = gainMaxBuf;
}
sampleFPtr++;
}
*gainMaxBufPtr = max;
gainMaxBufPtr++;
gainMaxIdx++;
// lookup max history
for (int i = 0; i < 25; i++) {
float a = gainMaxBuf[i];
if (a > max) {
max = a;
}
}
if (gainMaxIdx > 24) {
gainMaxIdx = 0;
gainMaxBufPtr = gainMaxBuf;
}
// determine optimal gain level
float gainFactor = 0.0f, gainDelta = 0.0f;
if (max > static_cast<float>(0)) {
gainFactor = (static_cast<float>(30000) / max);
}
else {
gainFactor = static_cast<float>(50);
}
// lookup max history
for (int i = 0; i < 25; i++) {
float a = gainMaxBuf[i];
if (a > max) {
max = a;
if (gainFactor < m_gainAdjust) {
m_gainAdjust = gainFactor;
gainDelta = static_cast<float>(0);
}
}
else {
if (gainFactor > static_cast<float>(50)) {
gainFactor = static_cast<float>(50);
}
// determine optimal gain level
float gainFactor = 0.0f, gainDelta = 0.0f;
if (max > static_cast<float>(0)) {
gainFactor = (static_cast<float>(30000) / max);
}
else {
gainFactor = static_cast<float>(50);
}
gainDelta = gainFactor - m_gainAdjust;
if (gainFactor < m_gainAdjust) {
m_gainAdjust = gainFactor;
gainDelta = static_cast<float>(0);
}
else {
if (gainFactor > static_cast<float>(50)) {
gainFactor = static_cast<float>(50);
if (gainDelta > (static_cast<float>(0.05) * m_gainAdjust)) {
gainDelta = (static_cast<float>(0.05) * m_gainAdjust);
}
}
gainDelta = gainFactor - m_gainAdjust;
gainDelta /= static_cast<float>(160);
if (gainDelta > (static_cast<float>(0.05) * m_gainAdjust)) {
gainDelta = (static_cast<float>(0.05) * m_gainAdjust);
// adjust output gain
sampleFPtr = samplesF;
for (int n = 0; n < 160; n++) {
*sampleFPtr = (m_gainAdjust + (static_cast<float>(n) * gainDelta)) * (*sampleFPtr);
sampleFPtr++;
}
}
gainDelta /= static_cast<float>(160);
m_gainAdjust += (static_cast<float>(160) * gainDelta);
}
// adjust output gain
int16_t* samplePtr = samples;
sampleFPtr = samplesF;
for (int n = 0; n < 160; n++) {
*sampleFPtr = (m_gainAdjust + (static_cast<float>(n) * gainDelta)) * (*sampleFPtr);
float smp = *sampleFPtr;
if (!m_autoGain) {
smp *= m_gainAdjust;
}
// audio clipping
if (smp > 32760) {
smp = 32760;
}
else if (smp < -32760) {
smp = -32760;
}
*samplePtr = (int16_t)(smp);
samplePtr++;
sampleFPtr++;
}
m_gainAdjust += (static_cast<float>(160) * gainDelta);
return errs;
}
int16_t* samplePtr = samples;
sampleFPtr = samplesF;
for (int n = 0; n < 160; n++) {
float smp = *sampleFPtr;
if (!m_autoGain) {
smp *= m_gainAdjust;
}
// Extern methods for C#/C++ interop
MBEDecoder* MBEDecoder_Create(MBE_DECODER_MODE mode)
{
return new MBEDecoder(mode);
}
// audio clipping
if (smp > 32760) {
smp = 32760;
}
else if (smp < -32760) {
smp = -32760;
int32_t MBEDecoder_Decode(MBEDecoder* pDecoder, uint8_t* codeword, int16_t* samples)
{
if (pDecoder != NULL)
{
return pDecoder->decode(codeword, samples);
}
return -1;
}
*samplePtr = (int16_t)(smp);
samplePtr++;
sampleFPtr++;
void MBEDecoder_Delete(MBEDecoder* pDecoder)
{
if (pDecoder != NULL)
{
delete pDecoder;
pDecoder = NULL;
}
}
return errs;
}
} // namespace vocoder

14
vocoder/MBEDecoder.h
Unescape View File

@ -138,9 +138,17 @@ namespace vocoder
};
// Extern methods for C#/C++ interop
extern "C" MBEDecoder* MBEDecoder_Create(MBE_DECODER_MODE mode) { return new MBEDecoder(mode); }
extern "C" int32_t MBEDecoder_Decode(MBEDecoder* pDecoder, uint8_t* codeword, int16_t* samples) { return pDecoder->decode(codeword, samples); }
extern "C" void MBEDecoder_Delete(MBEDecoder* pDecoder) { delete pDecoder; }
extern "C" {
#ifdef _WIN32
extern __declspec(dllexport) MBEDecoder* MBEDecoder_Create(MBE_DECODER_MODE mode);
extern __declspec(dllexport) int32_t MBEDecoder_Decode(MBEDecoder* pDecoder, uint8_t* codeword, int16_t* samples);
extern __declspec(dllexport) void MBEDecoder_Delete(MBEDecoder* pDecoder);
#else
extern MBEDecoder* MBEDecoder_Create(MBE_DECODER_MODE mode);
extern int32_t MBEDecoder_Decode(MBEDecoder* pDecoder, uint8_t* codeword, int16_t* samples);
extern void MBEDecoder_Delete(MBEDecoder* pDecoder);
#endif
}
} // namespace vocoder

1170
vocoder/MBEEncoder.cpp
View File

File diff suppressed because it is too large Load Diff

14
vocoder/MBEEncoder.h
Unescape View File

@ -81,9 +81,17 @@ namespace vocoder
};
// Extern methods for C#/C++ interop
extern "C" MBEEncoder* MBEEncoder_Create(MBE_ENCODER_MODE mode) { return new MBEEncoder(mode); }
extern "C" void MBEEncoder_Encode(MBEEncoder* pEncoder, int16_t* samples, uint8_t* codeword) { pEncoder->encode(samples, codeword); }
extern "C" void MBEEncoder_Delete(MBEEncoder* pEncoder) { delete pEncoder; }
extern "C" {
#ifdef _WIN32
__declspec(dllexport) MBEEncoder* MBEEncoder_Create(MBE_ENCODER_MODE mode);
__declspec(dllexport) void MBEEncoder_Encode(MBEEncoder* pEncoder, int16_t* samples, uint8_t* codeword);
__declspec(dllexport) void MBEEncoder_Delete(MBEEncoder* pEncoder);
#else
MBEEncoder* MBEEncoder_Create(MBE_ENCODER_MODE mode);
void MBEEncoder_Encode(MBEEncoder* pEncoder, int16_t* samples, uint8_t* codeword);
void MBEEncoder_Delete(MBEEncoder* pEncoder);
#endif
}
} // namespace vocoder

Write Preview
Loading…
Cancel
Save

Powered by TurnKey Linux.