2
* SpanDSP - a series of DSP components for telephony
4
* ec_disable_detector.h - A detector which should eventually meet the
5
* G.164/G.165 requirements for detecting the
6
* 2100Hz echo cancellor disable tone.
8
* Written by Steve Underwood <steveu@coppice.org>
10
* Copyright (C) 2001 Steve Underwood
12
* All rights reserved.
14
* This program is free software; you can redistribute it and/or modify
15
* it under the terms of the GNU General Public License as published by
16
* the Free Software Foundation; either version 2 of the License, or
17
* (at your option) any later version.
19
* This program is distributed in the hope that it will be useful,
20
* but WITHOUT ANY WARRANTY; without even the implied warranty of
21
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
22
* GNU General Public License for more details.
24
* You should have received a copy of the GNU General Public License
25
* along with this program; if not, write to the Free Software
26
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
34
biquad2_state_t notch;
38
int tone_cycle_duration;
41
} echo_can_disable_detector_state_t;
47
static inline void echo_can_disable_detector_init (echo_can_disable_detector_state_t *det)
50
/* This is actually centred at 2095Hz, but gets the balance we want, due
51
to the asymmetric walls of the notch */
52
biquad2_init (&det->notch,
53
(int32_t) (-0.7600000*32768.0),
54
(int32_t) (-0.1183852*32768.0),
55
(int32_t) (-0.5104039*32768.0),
56
(int32_t) ( 0.1567596*32768.0),
57
(int32_t) ( 1.0000000*32768.0));
59
det->channel_level = 0;
61
det->tone_present = FALSE;
62
det->tone_cycle_duration = 0;
66
/*- End of function --------------------------------------------------------*/
68
static inline int echo_can_disable_detector_update (echo_can_disable_detector_state_t *det,
73
notched = biquad2 (&det->notch, amp);
74
/* Estimate the overall energy in the channel, and the energy in
75
the notch (i.e. overall channel energy - tone energy => noise).
76
Use abs instead of multiply for speed (is it really faster?).
77
Damp the overall energy a little more for a stable result.
78
Damp the notch energy a little less, so we don't damp out the
79
blip every time the phase reverses */
80
det->channel_level += ((abs(amp) - det->channel_level) >> 5);
81
det->notch_level += ((abs(notched) - det->notch_level) >> 4);
82
if (det->channel_level > 280)
84
/* There is adequate energy in the channel. Is it mostly at 2100Hz? */
85
if (det->notch_level*6 < det->channel_level)
87
/* The notch says yes, so we have the tone. */
88
if (!det->tone_present)
90
/* Do we get a kick every 450+-25ms? */
91
if (det->tone_cycle_duration >= 425*8
93
det->tone_cycle_duration <= 475*8)
96
if (det->good_cycles > 2)
99
det->tone_cycle_duration = 0;
101
det->tone_present = TRUE;
105
det->tone_present = FALSE;
107
det->tone_cycle_duration++;
111
det->tone_present = FALSE;
112
det->tone_cycle_duration = 0;
113
det->good_cycles = 0;
117
/*- End of function --------------------------------------------------------*/
118
/*- End of file ------------------------------------------------------------*/