mirror of
https://github.com/signalwire/freeswitch.git
synced 2026-11-17 14:58:34 +00:00
inital checkin of spandsp from http://www.soft-switch.org/downloads/snapshots/spandsp/spandsp-20080829.tar.gz
git-svn-id: http://svn.freeswitch.org/svn/freeswitch/trunk@9425 d0543943-73ff-0310-b7d9-9358b9ac24b2
This commit is contained in:
1 parent
c72e353b55
commit
1e177dbd2b
342 files changed
+164474
No files matched your search
@@ -0,0 +1,409 @@
|
||||
/*
|
||||
* SpanDSP - a series of DSP components for telephony
|
||||
*
|
||||
* fsk.c - FSK modem transmit and receive parts
|
||||
*
|
||||
* Written by Steve Underwood <steveu@coppice.org>
|
||||
*
|
||||
* Copyright (C) 2003 Steve Underwood
|
||||
*
|
||||
* All rights reserved.
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU Lesser General Public License version 2.1,
|
||||
* as published by the Free Software Foundation.
|
||||
*
|
||||
* 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 Lesser General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU Lesser General Public
|
||||
* License along with this program; if not, write to the Free Software
|
||||
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||
*
|
||||
* $Id: fsk.c,v 1.44 2008/07/16 17:01:49 steveu Exp $
|
||||
*/
|
||||
|
||||
/*! \file */
|
||||
|
||||
#if defined(HAVE_CONFIG_H)
|
||||
#include <config.h>
|
||||
#endif
|
||||
|
||||
#include <stdlib.h>
|
||||
#include <inttypes.h>
|
||||
#include <string.h>
|
||||
#include "floating_fudge.h"
|
||||
#if defined(HAVE_TGMATH_H)
|
||||
#include <tgmath.h>
|
||||
#endif
|
||||
#if defined(HAVE_MATH_H)
|
||||
#include <math.h>
|
||||
#endif
|
||||
#include <assert.h>
|
||||
|
||||
#include "spandsp/telephony.h"
|
||||
#include "spandsp/complex.h"
|
||||
#include "spandsp/dds.h"
|
||||
#include "spandsp/power_meter.h"
|
||||
#include "spandsp/async.h"
|
||||
#include "spandsp/fsk.h"
|
||||
|
||||
const fsk_spec_t preset_fsk_specs[] =
|
||||
{
|
||||
{
|
||||
"V21 ch 1",
|
||||
1080 + 100,
|
||||
1080 - 100,
|
||||
-14,
|
||||
-30,
|
||||
300*100
|
||||
},
|
||||
{
|
||||
"V21 ch 2",
|
||||
1750 + 100,
|
||||
1750 - 100,
|
||||
-14,
|
||||
-30,
|
||||
300*100
|
||||
},
|
||||
{
|
||||
"V23 ch 1",
|
||||
2100,
|
||||
1300,
|
||||
-14,
|
||||
-30,
|
||||
1200*100
|
||||
},
|
||||
{
|
||||
"V23 ch 2",
|
||||
450,
|
||||
390,
|
||||
-14,
|
||||
-30,
|
||||
75*100
|
||||
},
|
||||
{
|
||||
"Bell103 ch 1",
|
||||
2125 - 100,
|
||||
2125 + 100,
|
||||
-14,
|
||||
-30,
|
||||
300*100
|
||||
},
|
||||
{
|
||||
"Bell103 ch 2",
|
||||
1170 - 100,
|
||||
1170 + 100,
|
||||
-14,
|
||||
-30,
|
||||
300*100
|
||||
},
|
||||
{
|
||||
"Bell202",
|
||||
2200,
|
||||
1200,
|
||||
-14,
|
||||
-30,
|
||||
1200*100
|
||||
},
|
||||
{
|
||||
"Weitbrecht", /* Used for TDD (Telecoms Device for the Deaf) */
|
||||
1800,
|
||||
1400,
|
||||
-14,
|
||||
-30,
|
||||
4545
|
||||
}
|
||||
};
|
||||
|
||||
fsk_tx_state_t *fsk_tx_init(fsk_tx_state_t *s,
|
||||
const fsk_spec_t *spec,
|
||||
get_bit_func_t get_bit,
|
||||
void *user_data)
|
||||
{
|
||||
if (s == NULL)
|
||||
{
|
||||
if ((s = (fsk_tx_state_t *) malloc(sizeof(*s))) == NULL)
|
||||
return NULL;
|
||||
}
|
||||
|
||||
s->baud_rate = spec->baud_rate;
|
||||
s->get_bit = get_bit;
|
||||
s->get_bit_user_data = user_data;
|
||||
|
||||
s->phase_rates[0] = dds_phase_rate((float) spec->freq_zero);
|
||||
s->phase_rates[1] = dds_phase_rate((float) spec->freq_one);
|
||||
s->scaling = dds_scaling_dbm0((float) spec->tx_level);
|
||||
/* Initialise fractional sample baud generation. */
|
||||
s->phase_acc = 0;
|
||||
s->baud_inc = s->baud_rate;
|
||||
s->baud_frac = 0;
|
||||
s->current_phase_rate = s->phase_rates[1];
|
||||
|
||||
s->shutdown = FALSE;
|
||||
return s;
|
||||
}
|
||||
/*- End of function --------------------------------------------------------*/
|
||||
|
||||
int fsk_tx(fsk_tx_state_t *s, int16_t *amp, int len)
|
||||
{
|
||||
int sample;
|
||||
int bit;
|
||||
|
||||
if (s->shutdown)
|
||||
return 0;
|
||||
/* Make the transitions between 0 and 1 phase coherent, but instantaneous
|
||||
jumps. There is currently no interpolation for bauds that end mid-sample.
|
||||
Mainstream users will not care. Some specialist users might have a problem
|
||||
with them, if they care about accurate transition timing. */
|
||||
for (sample = 0; sample < len; sample++)
|
||||
{
|
||||
if ((s->baud_frac += s->baud_inc) >= SAMPLE_RATE*100)
|
||||
{
|
||||
s->baud_frac -= SAMPLE_RATE*100;
|
||||
if ((bit = s->get_bit(s->get_bit_user_data)) == PUTBIT_END_OF_DATA)
|
||||
{
|
||||
if (s->status_handler)
|
||||
s->status_handler(s->status_user_data, MODEM_TX_STATUS_DATA_EXHAUSTED);
|
||||
if (s->status_handler)
|
||||
s->status_handler(s->status_user_data, MODEM_TX_STATUS_SHUTDOWN_COMPLETE);
|
||||
s->shutdown = TRUE;
|
||||
break;
|
||||
}
|
||||
s->current_phase_rate = s->phase_rates[bit & 1];
|
||||
}
|
||||
amp[sample] = dds_mod(&(s->phase_acc), s->current_phase_rate, s->scaling, 0);
|
||||
}
|
||||
return sample;
|
||||
}
|
||||
/*- End of function --------------------------------------------------------*/
|
||||
|
||||
void fsk_tx_power(fsk_tx_state_t *s, float power)
|
||||
{
|
||||
s->scaling = dds_scaling_dbm0(power);
|
||||
}
|
||||
/*- End of function --------------------------------------------------------*/
|
||||
|
||||
void fsk_tx_set_get_bit(fsk_tx_state_t *s, get_bit_func_t get_bit, void *user_data)
|
||||
{
|
||||
s->get_bit = get_bit;
|
||||
s->get_bit_user_data = user_data;
|
||||
}
|
||||
/*- End of function --------------------------------------------------------*/
|
||||
|
||||
void fsk_tx_set_modem_status_handler(fsk_tx_state_t *s, modem_tx_status_func_t handler, void *user_data)
|
||||
{
|
||||
s->status_handler = handler;
|
||||
s->status_user_data = user_data;
|
||||
}
|
||||
/*- End of function --------------------------------------------------------*/
|
||||
|
||||
void fsk_rx_signal_cutoff(fsk_rx_state_t *s, float cutoff)
|
||||
{
|
||||
/* The 6.04 allows for the gain of the DC blocker */
|
||||
s->carrier_on_power = (int32_t) (power_meter_level_dbm0(cutoff + 2.5f - 6.04f));
|
||||
s->carrier_off_power = (int32_t) (power_meter_level_dbm0(cutoff - 2.5f - 6.04f));
|
||||
}
|
||||
/*- End of function --------------------------------------------------------*/
|
||||
|
||||
float fsk_rx_signal_power(fsk_rx_state_t *s)
|
||||
{
|
||||
return power_meter_current_dbm0(&s->power);
|
||||
}
|
||||
/*- End of function --------------------------------------------------------*/
|
||||
|
||||
void fsk_rx_set_put_bit(fsk_rx_state_t *s, put_bit_func_t put_bit, void *user_data)
|
||||
{
|
||||
s->put_bit = put_bit;
|
||||
s->put_bit_user_data = user_data;
|
||||
}
|
||||
/*- End of function --------------------------------------------------------*/
|
||||
|
||||
void fsk_rx_set_modem_status_handler(fsk_rx_state_t *s, modem_tx_status_func_t handler, void *user_data)
|
||||
{
|
||||
s->status_handler = handler;
|
||||
s->status_user_data = user_data;
|
||||
}
|
||||
/*- End of function --------------------------------------------------------*/
|
||||
|
||||
fsk_rx_state_t *fsk_rx_init(fsk_rx_state_t *s,
|
||||
const fsk_spec_t *spec,
|
||||
int sync_mode,
|
||||
put_bit_func_t put_bit,
|
||||
void *user_data)
|
||||
{
|
||||
int chop;
|
||||
|
||||
if (s == NULL)
|
||||
{
|
||||
if ((s = (fsk_rx_state_t *) malloc(sizeof(*s))) == NULL)
|
||||
return NULL;
|
||||
}
|
||||
|
||||
memset(s, 0, sizeof(*s));
|
||||
s->baud_rate = spec->baud_rate;
|
||||
s->sync_mode = sync_mode;
|
||||
fsk_rx_signal_cutoff(s, (float) spec->min_level);
|
||||
s->put_bit = put_bit;
|
||||
s->put_bit_user_data = user_data;
|
||||
|
||||
/* Detect by correlating against the tones we want, over a period
|
||||
of one baud. The correlation must be quadrature. */
|
||||
|
||||
/* First we need the quadrature tone generators to correlate
|
||||
against. */
|
||||
s->phase_rate[0] = dds_phase_rate((float) spec->freq_zero);
|
||||
s->phase_rate[1] = dds_phase_rate((float) spec->freq_one);
|
||||
s->phase_acc[0] = 0;
|
||||
s->phase_acc[1] = 0;
|
||||
s->last_sample = 0;
|
||||
|
||||
/* The correlation should be over one baud. */
|
||||
s->correlation_span = SAMPLE_RATE*100/spec->baud_rate;
|
||||
/* But limit it for very slow baud rates, so we do not overflow our
|
||||
buffer. */
|
||||
if (s->correlation_span > FSK_MAX_WINDOW_LEN)
|
||||
s->correlation_span = FSK_MAX_WINDOW_LEN;
|
||||
|
||||
/* We need to scale, to avoid overflow in the correlation. */
|
||||
s->scaling_shift = 0;
|
||||
chop = s->correlation_span;
|
||||
while (chop != 0)
|
||||
{
|
||||
s->scaling_shift++;
|
||||
chop >>= 1;
|
||||
}
|
||||
|
||||
/* Initialise the baud/bit rate tracking. */
|
||||
s->baud_inc = s->baud_rate;
|
||||
s->baud_pll = 0;
|
||||
|
||||
/* Initialise a power detector, so sense when a signal is present. */
|
||||
power_meter_init(&(s->power), 4);
|
||||
s->signal_present = 0;
|
||||
return s;
|
||||
}
|
||||
/*- End of function --------------------------------------------------------*/
|
||||
|
||||
static void report_status_change(fsk_rx_state_t *s, int status)
|
||||
{
|
||||
if (s->status_handler)
|
||||
s->status_handler(s->status_user_data, status);
|
||||
else if (s->put_bit)
|
||||
s->put_bit(s->put_bit_user_data, status);
|
||||
}
|
||||
/*- End of function --------------------------------------------------------*/
|
||||
|
||||
int fsk_rx(fsk_rx_state_t *s, const int16_t *amp, int len)
|
||||
{
|
||||
int buf_ptr;
|
||||
int baudstate;
|
||||
int i;
|
||||
int j;
|
||||
int16_t x;
|
||||
int32_t dot;
|
||||
int32_t sum[2];
|
||||
int32_t power;
|
||||
complexi_t ph;
|
||||
|
||||
buf_ptr = s->buf_ptr;
|
||||
|
||||
for (i = 0; i < len; i++)
|
||||
{
|
||||
/* If there isn't much signal, don't demodulate - it will only produce
|
||||
useless junk results. */
|
||||
/* There should be no DC in the signal, but sometimes there is.
|
||||
We need to measure the power with the DC blocked, but not using
|
||||
a slow to respond DC blocker. Use the most elementary HPF. */
|
||||
x = amp[i] >> 1;
|
||||
power = power_meter_update(&(s->power), x - s->last_sample);
|
||||
s->last_sample = x;
|
||||
if (s->signal_present)
|
||||
{
|
||||
/* Look for power below turn-off threshold to turn the carrier off */
|
||||
if (power < s->carrier_off_power)
|
||||
{
|
||||
if (--s->signal_present <= 0)
|
||||
{
|
||||
/* Count down a short delay, to ensure we push the last
|
||||
few bits through the filters before stopping. */
|
||||
report_status_change(s, PUTBIT_CARRIER_DOWN);
|
||||
continue;
|
||||
}
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
/* Look for power exceeding turn-on threshold to turn the carrier on */
|
||||
if (power < s->carrier_on_power)
|
||||
continue;
|
||||
s->signal_present = 1;
|
||||
report_status_change(s, PUTBIT_CARRIER_UP);
|
||||
}
|
||||
/* Non-coherent FSK demodulation by correlation with the target tones
|
||||
over a one baud interval. The slow V.xx specs. are too open ended
|
||||
to allow anything fancier to be used. The dot products are calculated
|
||||
using a sliding window approach, so the compute load is not that great. */
|
||||
/* The *totally* asynchronous character to character behaviour of these
|
||||
modems, when carrying async. data, seems to force a sample by sample
|
||||
approach. */
|
||||
for (j = 0; j < 2; j++)
|
||||
{
|
||||
s->dot[j].re -= s->window[j][buf_ptr].re;
|
||||
s->dot[j].im -= s->window[j][buf_ptr].im;
|
||||
|
||||
ph = dds_complexi(&(s->phase_acc[j]), s->phase_rate[j]);
|
||||
s->window[j][buf_ptr].re = (ph.re*amp[i]) >> s->scaling_shift;
|
||||
s->window[j][buf_ptr].im = (ph.im*amp[i]) >> s->scaling_shift;
|
||||
|
||||
s->dot[j].re += s->window[j][buf_ptr].re;
|
||||
s->dot[j].im += s->window[j][buf_ptr].im;
|
||||
|
||||
dot = s->dot[j].re >> 15;
|
||||
sum[j] = dot*dot;
|
||||
dot = s->dot[j].im >> 15;
|
||||
sum[j] += dot*dot;
|
||||
}
|
||||
baudstate = (sum[0] < sum[1]);
|
||||
|
||||
if (s->lastbit != baudstate)
|
||||
{
|
||||
s->lastbit = baudstate;
|
||||
if (s->sync_mode)
|
||||
{
|
||||
/* For synchronous use (e.g. HDLC channels in FAX modems), nudge
|
||||
the baud phase gently, trying to keep it centred on the bauds. */
|
||||
if (s->baud_pll < (SAMPLE_RATE*50))
|
||||
s->baud_pll += (s->baud_inc >> 3);
|
||||
else
|
||||
s->baud_pll -= (s->baud_inc >> 3);
|
||||
}
|
||||
else
|
||||
{
|
||||
/* For async. operation, believe transitions completely, and
|
||||
sample appropriately. This allows instant start on the first
|
||||
transition. */
|
||||
/* We must now be about half way to a sampling point. We do not do
|
||||
any fractional sample estimation of the transitions, so this is
|
||||
the most accurate baud alignment we can do. */
|
||||
s->baud_pll = SAMPLE_RATE*50;
|
||||
}
|
||||
|
||||
}
|
||||
if ((s->baud_pll += s->baud_inc) >= (SAMPLE_RATE*100))
|
||||
{
|
||||
/* We should be in the middle of a baud now, so report the current
|
||||
state as the next bit */
|
||||
s->baud_pll -= (SAMPLE_RATE*100);
|
||||
s->put_bit(s->put_bit_user_data, baudstate);
|
||||
}
|
||||
if (++buf_ptr >= s->correlation_span)
|
||||
buf_ptr = 0;
|
||||
}
|
||||
s->buf_ptr = buf_ptr;
|
||||
return 0;
|
||||
}
|
||||
/*- End of function --------------------------------------------------------*/
|
||||
/*- End of file ------------------------------------------------------------*/
|
||||
Reference in new issue
Block a user