mirror of
https://github.com/signalwire/freeswitch.git
synced 2026-11-17 14:58:34 +00:00
A few spandsp tweaks
This commit is contained in:
1 parent
1ce96ce9f5
commit
8396519956
6 files changed
+115
-29
No files matched your search
@@ -363,24 +363,80 @@ static __inline__ int32_t saturated_sub32(int32_t a, int32_t b)
|
||||
|
||||
static __inline__ int16_t saturated_mul16(int16_t a, int16_t b)
|
||||
{
|
||||
int32_t product;
|
||||
int32_t z;
|
||||
|
||||
product = (int32_t) a*b;
|
||||
if (product == 0x40000000)
|
||||
#if defined(__GNUC__) && (defined(__ARM_ARCH_6__) || defined(__ARM_ARCH_7A__))
|
||||
__asm__ __volatile__(
|
||||
" smulbb %[z],%[a],%[b];\n"
|
||||
" qadd %[z],%[z],%[z];\n"
|
||||
: [z] "=r" (z)
|
||||
: [a] "r" (a), [b] "r" (b)
|
||||
);
|
||||
return (int16_t) (z >> 16);
|
||||
#else
|
||||
z = (int32_t) a*b;
|
||||
if (z == 0x40000000)
|
||||
return INT16_MAX;
|
||||
/*endif*/
|
||||
return (int16_t) (product >> 15);
|
||||
return (int16_t) (z >> 15);
|
||||
#endif
|
||||
}
|
||||
/*- End of function --------------------------------------------------------*/
|
||||
|
||||
static __inline__ int32_t saturated_mul16_32(int16_t a, int16_t b)
|
||||
{
|
||||
int32_t z;
|
||||
|
||||
#if defined(__GNUC__) && (defined(__ARM_ARCH_6__) || defined(__ARM_ARCH_7A__))
|
||||
__asm__ __volatile__(
|
||||
" smulbb %[z],%[a],%[b];\n"
|
||||
" qadd %[z],%[z],%[z];\n"
|
||||
: [z] "=r" (z)
|
||||
: [a] "r" (a), [b] "r" (b)
|
||||
);
|
||||
return z;
|
||||
#else
|
||||
z = (int32_t) a*b;
|
||||
if (z == 0x40000000)
|
||||
return INT32_MAX;
|
||||
return z << 1;
|
||||
#endif
|
||||
}
|
||||
/*- End of function --------------------------------------------------------*/
|
||||
|
||||
static __inline__ int32_t saturated_mac16_32(int32_t z, int16_t a, int16_t b)
|
||||
{
|
||||
#if defined(__GNUC__) && (defined(__ARM_ARCH_6__) || defined(__ARM_ARCH_7A__))
|
||||
int32_t product;
|
||||
|
||||
product = (int32_t) a*b;
|
||||
if (product == 0x40000000)
|
||||
return INT32_MAX;
|
||||
return product << 1;
|
||||
__asm__ __volatile__(
|
||||
" smulbb %[p],%[a],%[b];\n"
|
||||
" qdadd %[z],%[z],%[p];\n"
|
||||
: [z] "=r" (z)
|
||||
: "[z]" (z), [a] "r" (a), [b] "r" (b), [p] "r"(product)
|
||||
);
|
||||
return z;
|
||||
#else
|
||||
return saturated_add32(z, saturated_mul16_32(a, b));
|
||||
#endif
|
||||
}
|
||||
/*- End of function --------------------------------------------------------*/
|
||||
|
||||
static __inline__ int32_t saturated_msu16_32(int32_t z, int16_t a, int16_t b)
|
||||
{
|
||||
#if defined(__GNUC__) && (defined(__ARM_ARCH_6__) || defined(__ARM_ARCH_7A__))
|
||||
int32_t product;
|
||||
|
||||
__asm__ __volatile__(
|
||||
" smulbb %[p],%[a],%[b];\n"
|
||||
" qdsub %[z],%[z],%[p];\n"
|
||||
: [z] "=r" (z)
|
||||
: "[z]" (z), [a] "r" (a), [b] "r" (b), [p] "r" (product)
|
||||
);
|
||||
return z;
|
||||
#else
|
||||
return saturated_sub32(z, saturated_mul16_32(a, b));
|
||||
#endif
|
||||
}
|
||||
/*- End of function --------------------------------------------------------*/
|
||||
|
||||
|
||||
@@ -73,8 +73,8 @@
|
||||
#include "spandsp/private/v22bis.h"
|
||||
|
||||
#if defined(SPANDSP_USE_FIXED_POINT)
|
||||
#define FP_SCALE(x) FP_Q_6_10(x)
|
||||
#define FP_SHIFT_FACTOR 10
|
||||
#define FP_SCALE FP_Q_6_10
|
||||
#else
|
||||
#define FP_SCALE(x) (x)
|
||||
#endif
|
||||
@@ -306,9 +306,8 @@ static __inline__ int descramble(v22bis_state_t *s, int bit)
|
||||
{
|
||||
int out_bit;
|
||||
|
||||
bit &= 1;
|
||||
|
||||
/* Descramble the bit */
|
||||
bit &= 1;
|
||||
out_bit = (bit ^ (s->rx.scramble_reg >> 13) ^ (s->rx.scramble_reg >> 16)) & 1;
|
||||
s->rx.scramble_reg = (s->rx.scramble_reg << 1) | bit;
|
||||
|
||||
@@ -856,9 +855,9 @@ SPAN_DECLARE_NONSTD(int) v22bis_rx(v22bis_state_t *s, const int16_t amp[], int l
|
||||
{
|
||||
/* Only AGC during the initial symbol acquisition, and then lock the gain. */
|
||||
#if defined(SPANDSP_USE_FIXED_POINT)
|
||||
s->rx.agc_scaling = saturate16(((int32_t) (1024.0f*1024.0f*0.18f*3.60f))/fixed_sqrt32(power));
|
||||
s->rx.agc_scaling = saturate16(((int32_t) (FP_SCALE(0.18f)*FP_SCALE(3.60f)))/fixed_sqrt32(power));
|
||||
#else
|
||||
s->rx.agc_scaling = 0.18f*3.60f/sqrtf(power);
|
||||
s->rx.agc_scaling = FP_SCALE(0.18f)*FP_SCALE(3.60f)/fixed_sqrt32(power);
|
||||
#endif
|
||||
}
|
||||
/* Pulse shape while still at the carrier frequency, using a quadrature
|
||||
@@ -868,7 +867,6 @@ SPAN_DECLARE_NONSTD(int) v22bis_rx(v22bis_state_t *s, const int16_t amp[], int l
|
||||
step = -s->rx.eq_put_step;
|
||||
if (step > PULSESHAPER_COEFF_SETS - 1)
|
||||
step = PULSESHAPER_COEFF_SETS - 1;
|
||||
s->rx.eq_put_step += PULSESHAPER_COEFF_SETS*40/(3*2);
|
||||
if (s->calling_party)
|
||||
{
|
||||
#if defined(SPANDSP_USE_FIXED_POINT)
|
||||
@@ -905,6 +903,7 @@ SPAN_DECLARE_NONSTD(int) v22bis_rx(v22bis_state_t *s, const int16_t amp[], int l
|
||||
zz.re = sample.re*z.re - sample.im*z.im;
|
||||
zz.im = -sample.re*z.im - sample.im*z.re;
|
||||
#endif
|
||||
s->rx.eq_put_step += PULSESHAPER_COEFF_SETS*40/(3*2);
|
||||
process_half_baud(s, &zz);
|
||||
}
|
||||
#if defined(SPANDSP_USE_FIXED_POINT)
|
||||
|
||||
@@ -63,7 +63,7 @@
|
||||
#include "spandsp/private/v22bis.h"
|
||||
|
||||
#if defined(SPANDSP_USE_FIXED_POINT)
|
||||
#define FP_SCALE FP_Q_6_10
|
||||
#define FP_SCALE(x) FP_Q_6_10(x)
|
||||
#else
|
||||
#define FP_SCALE(x) (x)
|
||||
#endif
|
||||
|
||||
@@ -66,9 +66,8 @@
|
||||
|
||||
#define FP_CONSTELLATION_SCALE(x) FP_SCALE(x)
|
||||
|
||||
#include "v29tx_constellation_maps.h"
|
||||
|
||||
#include "v29tx_rrc.h"
|
||||
#include "v29tx_constellation_maps.h"
|
||||
|
||||
/*! The nominal frequency of the carrier, in Hertz */
|
||||
#define CARRIER_NOMINAL_FREQ 1700.0f
|
||||
|
||||
Reference in new issue
Block a user