drivers/isdn/hardware/eicon/capidtmf.c

   1
   2 /*
   3  *
   4   Copyright (c) Eicon Networks, 2002.
   5  *
   6   This source file is supplied for the use with
   7   Eicon Networks range of DIVA Server Adapters.
   8  *
   9   Eicon File Revision :    2.1
  10  *
  11   This program is free software; you can redistribute it and/or modify
  12   it under the terms of the GNU General Public License as published by
  13   the Free Software Foundation; either version 2, or (at your option)
  14   any later version.
  15  *
  16   This program is distributed in the hope that it will be useful,
  17   but WITHOUT ANY WARRANTY OF ANY KIND WHATSOEVER INCLUDING ANY
  18   implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
  19   See the GNU General Public License for more details.
  20  *
  21   You should have received a copy of the GNU General Public License
  22   along with this program; if not, write to the Free Software
  23   Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  24  *
  25  */
  26
  27 #include "platform.h"
  28
  29
  30
  31
  32
  33
  34
  35
  36
  37 #include "capidtmf.h"
  38
  39 /* #define TRACE_ */
  40
  41 #define FILE_ "CAPIDTMF.C"
  42
  43 /*---------------------------------------------------------------------------*/
  44
  45
  46 #define trace(a)
  47
  48
  49
  50 /*---------------------------------------------------------------------------*/
  51
  52 static short capidtmf_expand_table_alaw[0x0100] =
  53 {
  54    -5504,   5504,   -344,    344, -22016,  22016,  -1376,   1376,
  55    -2752,   2752,    -88,     88, -11008,  11008,   -688,    688,
  56    -7552,   7552,   -472,    472, -30208,  30208,  -1888,   1888,
  57    -3776,   3776,   -216,    216, -15104,  15104,   -944,    944,
  58    -4480,   4480,   -280,    280, -17920,  17920,  -1120,   1120,
  59    -2240,   2240,    -24,     24,  -8960,   8960,   -560,    560,
  60    -6528,   6528,   -408,    408, -26112,  26112,  -1632,   1632,
  61    -3264,   3264,   -152,    152, -13056,  13056,   -816,    816,
  62    -6016,   6016,   -376,    376, -24064,  24064,  -1504,   1504,
  63    -3008,   3008,   -120,    120, -12032,  12032,   -752,    752,
  64    -8064,   8064,   -504,    504, -32256,  32256,  -2016,   2016,
  65    -4032,   4032,   -248,    248, -16128,  16128,  -1008,   1008,
  66    -4992,   4992,   -312,    312, -19968,  19968,  -1248,   1248,
  67    -2496,   2496,    -56,     56,  -9984,   9984,   -624,    624,
  68    -7040,   7040,   -440,    440, -28160,  28160,  -1760,   1760,
  69    -3520,   3520,   -184,    184, -14080,  14080,   -880,    880,
  70    -5248,   5248,   -328,    328, -20992,  20992,  -1312,   1312,
  71    -2624,   2624,    -72,     72, -10496,  10496,   -656,    656,
  72    -7296,   7296,   -456,    456, -29184,  29184,  -1824,   1824,
  73    -3648,   3648,   -200,    200, -14592,  14592,   -912,    912,
  74    -4224,   4224,   -264,    264, -16896,  16896,  -1056,   1056,
  75    -2112,   2112,     -8,      8,  -8448,   8448,   -528,    528,
  76    -6272,   6272,   -392,    392, -25088,  25088,  -1568,   1568,
  77    -3136,   3136,   -136,    136, -12544,  12544,   -784,    784,
  78    -5760,   5760,   -360,    360, -23040,  23040,  -1440,   1440,
  79    -2880,   2880,   -104,    104, -11520,  11520,   -720,    720,
  80    -7808,   7808,   -488,    488, -31232,  31232,  -1952,   1952,
  81    -3904,   3904,   -232,    232, -15616,  15616,   -976,    976,
  82    -4736,   4736,   -296,    296, -18944,  18944,  -1184,   1184,
  83    -2368,   2368,    -40,     40,  -9472,   9472,   -592,    592,
  84    -6784,   6784,   -424,    424, -27136,  27136,  -1696,   1696,
  85    -3392,   3392,   -168,    168, -13568,  13568,   -848,    848
  86 };
  87
  88 static short capidtmf_expand_table_ulaw[0x0100] =
  89 {
  90   -32124,  32124,  -1884,   1884,  -7932,   7932,   -372,    372,
  91   -15996,  15996,   -876,    876,  -3900,   3900,   -120,    120,
  92   -23932,  23932,  -1372,   1372,  -5884,   5884,   -244,    244,
  93   -11900,  11900,   -620,    620,  -2876,   2876,    -56,     56,
  94   -28028,  28028,  -1628,   1628,  -6908,   6908,   -308,    308,
  95   -13948,  13948,   -748,    748,  -3388,   3388,    -88,     88,
  96   -19836,  19836,  -1116,   1116,  -4860,   4860,   -180,    180,
  97    -9852,   9852,   -492,    492,  -2364,   2364,    -24,     24,
  98   -30076,  30076,  -1756,   1756,  -7420,   7420,   -340,    340,
  99   -14972,  14972,   -812,    812,  -3644,   3644,   -104,    104,
 100   -21884,  21884,  -1244,   1244,  -5372,   5372,   -212,    212,
 101   -10876,  10876,   -556,    556,  -2620,   2620,    -40,     40,
 102   -25980,  25980,  -1500,   1500,  -6396,   6396,   -276,    276,
 103   -12924,  12924,   -684,    684,  -3132,   3132,    -72,     72,
 104   -17788,  17788,   -988,    988,  -4348,   4348,   -148,    148,
 105    -8828,   8828,   -428,    428,  -2108,   2108,     -8,      8,
 106   -31100,  31100,  -1820,   1820,  -7676,   7676,   -356,    356,
 107   -15484,  15484,   -844,    844,  -3772,   3772,   -112,    112,
 108   -22908,  22908,  -1308,   1308,  -5628,   5628,   -228,    228,
 109   -11388,  11388,   -588,    588,  -2748,   2748,    -48,     48,
 110   -27004,  27004,  -1564,   1564,  -6652,   6652,   -292,    292,
 111   -13436,  13436,   -716,    716,  -3260,   3260,    -80,     80,
 112   -18812,  18812,  -1052,   1052,  -4604,   4604,   -164,    164,
 113    -9340,   9340,   -460,    460,  -2236,   2236,    -16,     16,
 114   -29052,  29052,  -1692,   1692,  -7164,   7164,   -324,    324,
 115   -14460,  14460,   -780,    780,  -3516,   3516,    -96,     96,
 116   -20860,  20860,  -1180,   1180,  -5116,   5116,   -196,    196,
 117   -10364,  10364,   -524,    524,  -2492,   2492,    -32,     32,
 118   -24956,  24956,  -1436,   1436,  -6140,   6140,   -260,    260,
 119   -12412,  12412,   -652,    652,  -3004,   3004,    -64,     64,
 120   -16764,  16764,   -924,    924,  -4092,   4092,   -132,    132,
 121    -8316,   8316,   -396,    396,  -1980,   1980,      0,      0
 122 };
 123
 124
 125 /*---------------------------------------------------------------------------*/
 126
 127 static short capidtmf_recv_window_function[CAPIDTMF_RECV_ACCUMULATE_CYCLES] =
 128 {
 129     -500L,   -999L,  -1499L,  -1998L,  -2496L,  -2994L,  -3491L,  -3988L,
 130    -4483L,  -4978L,  -5471L,  -5963L,  -6454L,  -6943L,  -7431L,  -7917L,
 131    -8401L,  -8883L,  -9363L,  -9840L, -10316L, -10789L, -11259L, -11727L,
 132   -12193L, -12655L, -13115L, -13571L, -14024L, -14474L, -14921L, -15364L,
 133   -15804L, -16240L, -16672L, -17100L, -17524L, -17944L, -18360L, -18772L,
 134   -19180L, -19583L, -19981L, -20375L, -20764L, -21148L, -21527L, -21901L,
 135   -22270L, -22634L, -22993L, -23346L, -23694L, -24037L, -24374L, -24705L,
 136   -25030L, -25350L, -25664L, -25971L, -26273L, -26568L, -26858L, -27141L,
 137   -27418L, -27688L, -27952L, -28210L, -28461L, -28705L, -28943L, -29174L,
 138   -29398L, -29615L, -29826L, -30029L, -30226L, -30415L, -30598L, -30773L,
 139   -30941L, -31102L, -31256L, -31402L, -31541L, -31673L, -31797L, -31914L,
 140   -32024L, -32126L, -32221L, -32308L, -32388L, -32460L, -32524L, -32581L,
 141   -32631L, -32673L, -32707L, -32734L, -32753L, -32764L, -32768L, -32764L,
 142   -32753L, -32734L, -32707L, -32673L, -32631L, -32581L, -32524L, -32460L,
 143   -32388L, -32308L, -32221L, -32126L, -32024L, -31914L, -31797L, -31673L,
 144   -31541L, -31402L, -31256L, -31102L, -30941L, -30773L, -30598L, -30415L,
 145   -30226L, -30029L, -29826L, -29615L, -29398L, -29174L, -28943L, -28705L,
 146   -28461L, -28210L, -27952L, -27688L, -27418L, -27141L, -26858L, -26568L,
 147   -26273L, -25971L, -25664L, -25350L, -25030L, -24705L, -24374L, -24037L,
 148   -23694L, -23346L, -22993L, -22634L, -22270L, -21901L, -21527L, -21148L,
 149   -20764L, -20375L, -19981L, -19583L, -19180L, -18772L, -18360L, -17944L,
 150   -17524L, -17100L, -16672L, -16240L, -15804L, -15364L, -14921L, -14474L,
 151   -14024L, -13571L, -13115L, -12655L, -12193L, -11727L, -11259L, -10789L,
 152   -10316L,  -9840L,  -9363L,  -8883L,  -8401L,  -7917L,  -7431L,  -6943L,
 153    -6454L,  -5963L,  -5471L,  -4978L,  -4483L,  -3988L,  -3491L,  -2994L,
 154    -2496L,  -1998L,  -1499L,   -999L,   -500L,
 155 };
 156
 157 static byte capidtmf_leading_zeroes_table[0x100] =
 158 {
 159   8, 7, 6, 6, 5, 5, 5, 5, 4, 4, 4, 4, 4, 4, 4, 4,
 160   3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3,
 161   2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
 162   2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
 163   1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
 164   1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
 165   1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
 166   1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
 167   0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
 168   0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
 169   0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
 170   0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
 171   0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
 172   0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
 173   0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
 174   0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
 175 };
 176
 177 #define capidtmf_byte_leading_zeroes(b)  (capidtmf_leading_zeroes_table[(BYTE)(b)])
 178 #define capidtmf_word_leading_zeroes(w)  (((w) & 0xff00) ? capidtmf_leading_zeroes_table[(w) >> 8] : 8 + capidtmf_leading_zeroes_table[(w)])
 179 #define capidtmf_dword_leading_zeroes(d)  (((d) & 0xffff0000L) ?    (((d) & 0xff000000L) ? capidtmf_leading_zeroes_table[(d) >> 24] : 8 + capidtmf_leading_zeroes_table[(d) >> 16]) :    (((d) & 0xff00) ? 16 + capidtmf_leading_zeroes_table[(d) >> 8] : 24 + capidtmf_leading_zeroes_table[(d)]))
 180
 181
 182 /*---------------------------------------------------------------------------*/
 183
 184
 185 static void capidtmf_goertzel_loop (long *buffer, long *coeffs, short *sample, long count)
 186 {
 187   int i, j;
 188   long c, d, q0, q1, q2;
 189
 190   for (i = 0; i < CAPIDTMF_RECV_TOTAL_FREQUENCY_COUNT - 1; i++)
 191   {
 192     q1 = buffer[i];
 193     q2 = buffer[i + CAPIDTMF_RECV_TOTAL_FREQUENCY_COUNT];
 194     d = coeffs[i] >> 1;
 195     c = d << 1;
 196     if (c >= 0)
 197     {
 198       for (j = 0; j < count; j++)
 199       {
 200         q0 = sample[j] - q2 + (c * (q1 >> 16)) + (((dword)(((dword) d) * ((dword)(q1 & 0xffff)))) >> 15);
 201         q2 = q1;
 202         q1 = q0;
 203       }
 204     }
 205     else
 206     {
 207       c = -c;
 208       d = -d;
 209       for (j = 0; j < count; j++)
 210       {
 211         q0 = sample[j] - q2 - ((c * (q1 >> 16)) + (((dword)(((dword) d) * ((dword)(q1 & 0xffff)))) >> 15));
 212         q2 = q1;
 213         q1 = q0;
 214       }
 215     }
 216     buffer[i] = q1;
 217     buffer[i + CAPIDTMF_RECV_TOTAL_FREQUENCY_COUNT] = q2;
 218   }
 219   q1 = buffer[i];
 220   q2 = buffer[i + CAPIDTMF_RECV_TOTAL_FREQUENCY_COUNT];
 221   c = (coeffs[i] >> 1) << 1;
 222   if (c >= 0)
 223   {
 224     for (j = 0; j < count; j++)
 225     {
 226       q0 = sample[j] - q2 + (c * (q1 >> 16)) + (((dword)(((dword)(c >> 1)) * ((dword)(q1 & 0xffff)))) >> 15);
 227       q2 = q1;
 228       q1 = q0;
 229       c -= CAPIDTMF_RECV_FUNDAMENTAL_DECREMENT;
 230     }
 231   }
 232   else
 233   {
 234     c = -c;
 235     for (j = 0; j < count; j++)
 236     {
 237       q0 = sample[j] - q2 - ((c * (q1 >> 16)) + (((dword)(((dword)(c >> 1)) * ((dword)(q1 & 0xffff)))) >> 15));
 238       q2 = q1;
 239       q1 = q0;
 240       c += CAPIDTMF_RECV_FUNDAMENTAL_DECREMENT;
 241     }
 242   }
 243   coeffs[i] = c;
 244   buffer[i] = q1;
 245   buffer[i + CAPIDTMF_RECV_TOTAL_FREQUENCY_COUNT] = q2;
 246 }
 247
 248
 249 static void capidtmf_goertzel_result (long *buffer, long *coeffs)
 250 {
 251   int i;
 252   long d, e, q1, q2, lo, mid, hi;
 253   dword k;
 254
 255   for (i = 0; i < CAPIDTMF_RECV_TOTAL_FREQUENCY_COUNT; i++)
 256   {
 257     q1 = buffer[i];
 258     q2 = buffer[i + CAPIDTMF_RECV_TOTAL_FREQUENCY_COUNT];
 259     d = coeffs[i] >> 1;
 260     if (d >= 0)
 261       d = ((d << 1) * (-q1 >> 16)) + (((dword)(((dword) d) * ((dword)(-q1 & 0xffff)))) >> 15);
 262     else
 263       d = ((-d << 1) * (-q1 >> 16)) + (((dword)(((dword) -d) * ((dword)(-q1 & 0xffff)))) >> 15);
 264     e = (q2 >= 0) ? q2 : -q2;
 265     if (d >= 0)
 266     {
 267       k = ((dword)(d & 0xffff)) * ((dword)(e & 0xffff));
 268       lo = k & 0xffff;
 269       mid = k >> 16;
 270       k = ((dword)(d >> 16)) * ((dword)(e & 0xffff));
 271       mid += k & 0xffff;
 272       hi = k >> 16;
 273       k = ((dword)(d & 0xffff)) * ((dword)(e >> 16));
 274       mid += k & 0xffff;
 275       hi += k >> 16;
 276       hi += ((dword)(d >> 16)) * ((dword)(e >> 16));
 277     }
 278     else
 279     {
 280       d = -d;
 281       k = ((dword)(d & 0xffff)) * ((dword)(e & 0xffff));
 282       lo = -((long)(k & 0xffff));
 283       mid = -((long)(k >> 16));
 284       k = ((dword)(d >> 16)) * ((dword)(e & 0xffff));
 285       mid -= k & 0xffff;
 286       hi = -((long)(k >> 16));
 287       k = ((dword)(d & 0xffff)) * ((dword)(e >> 16));
 288       mid -= k & 0xffff;
 289       hi -= k >> 16;
 290       hi -= ((dword)(d >> 16)) * ((dword)(e >> 16));
 291     }
 292     if (q2 < 0)
 293     {
 294       lo = -lo;
 295       mid = -mid;
 296       hi = -hi;
 297     }
 298     d = (q1 >= 0) ? q1 : -q1;
 299     k = ((dword)(d & 0xffff)) * ((dword)(d & 0xffff));
 300     lo += k & 0xffff;
 301     mid += k >> 16;
 302     k = ((dword)(d >> 16)) * ((dword)(d & 0xffff));
 303     mid += (k & 0xffff) << 1;
 304     hi += (k >> 16) << 1;
 305     hi += ((dword)(d >> 16)) * ((dword)(d >> 16));
 306     d = (q2 >= 0) ? q2 : -q2;
 307     k = ((dword)(d & 0xffff)) * ((dword)(d & 0xffff));
 308     lo += k & 0xffff;
 309     mid += k >> 16;
 310     k = ((dword)(d >> 16)) * ((dword)(d & 0xffff));
 311     mid += (k & 0xffff) << 1;
 312     hi += (k >> 16) << 1;
 313     hi += ((dword)(d >> 16)) * ((dword)(d >> 16));
 314     mid += lo >> 16;
 315     hi += mid >> 16;
 316     buffer[i] = (lo & 0xffff) | (mid << 16);
 317     buffer[i + CAPIDTMF_RECV_TOTAL_FREQUENCY_COUNT] = hi;
 318   }
 319 }
 320
 321
 322 /*---------------------------------------------------------------------------*/
 323
 324 #define CAPIDTMF_RECV_GUARD_SNR_INDEX_697     0
 325 #define CAPIDTMF_RECV_GUARD_SNR_INDEX_770     1
 326 #define CAPIDTMF_RECV_GUARD_SNR_INDEX_852     2
 327 #define CAPIDTMF_RECV_GUARD_SNR_INDEX_941     3
 328 #define CAPIDTMF_RECV_GUARD_SNR_INDEX_1209    4
 329 #define CAPIDTMF_RECV_GUARD_SNR_INDEX_1336    5
 330 #define CAPIDTMF_RECV_GUARD_SNR_INDEX_1477    6
 331 #define CAPIDTMF_RECV_GUARD_SNR_INDEX_1633    7
 332 #define CAPIDTMF_RECV_GUARD_SNR_INDEX_635     8
 333 #define CAPIDTMF_RECV_GUARD_SNR_INDEX_1010    9
 334 #define CAPIDTMF_RECV_GUARD_SNR_INDEX_1140    10
 335 #define CAPIDTMF_RECV_GUARD_SNR_INDEX_1272    11
 336 #define CAPIDTMF_RECV_GUARD_SNR_INDEX_1405    12
 337 #define CAPIDTMF_RECV_GUARD_SNR_INDEX_1555    13
 338 #define CAPIDTMF_RECV_GUARD_SNR_INDEX_1715    14
 339 #define CAPIDTMF_RECV_GUARD_SNR_INDEX_1875    15
 340
 341 #define CAPIDTMF_RECV_GUARD_SNR_DONTCARE      0xc000
 342 #define CAPIDTMF_RECV_NO_DIGIT                0xff
 343 #define CAPIDTMF_RECV_TIME_GRANULARITY        (CAPIDTMF_RECV_ACCUMULATE_CYCLES + 1)
 344
 345 #define CAPIDTMF_RECV_INDICATION_DIGIT        0x0001
 346
 347 static long capidtmf_recv_goertzel_coef_table[CAPIDTMF_RECV_TOTAL_FREQUENCY_COUNT] =
 348 {
 349   0xda97L * 2,  /* 697 Hz (Low group 697 Hz) */
 350   0xd299L * 2,  /* 770 Hz (Low group 770 Hz) */
 351   0xc8cbL * 2,  /* 852 Hz (Low group 852 Hz) */
 352   0xbd36L * 2,  /* 941 Hz (Low group 941 Hz) */
 353   0x9501L * 2,  /* 1209 Hz (High group 1209 Hz) */
 354   0x7f89L * 2,  /* 1336 Hz (High group 1336 Hz) */
 355   0x6639L * 2,  /* 1477 Hz (High group 1477 Hz) */
 356   0x48c6L * 2,  /* 1633 Hz (High group 1633 Hz) */
 357   0xe14cL * 2,  /* 630 Hz (Lower guard of low group 631 Hz) */
 358   0xb2e0L * 2,  /* 1015 Hz (Upper guard of low group 1039 Hz) */
 359   0xa1a0L * 2,  /* 1130 Hz (Lower guard of high group 1140 Hz) */
 360   0x8a87L * 2,  /* 1272 Hz (Guard between 1209 Hz and 1336 Hz: 1271 Hz) */
 361   0x7353L * 2,  /* 1405 Hz (2nd harmonics of 697 Hz and guard between 1336 Hz and 1477 Hz: 1405 Hz) */
 362   0x583bL * 2,  /* 1552 Hz (2nd harmonics of 770 Hz and guard between 1477 Hz and 1633 Hz: 1553 Hz) */
 363   0x37d8L * 2,  /* 1720 Hz (2nd harmonics of 852 Hz and upper guard of high group: 1715 Hz) */
 364   0x0000L * 2   /* 100-630 Hz (fundamentals) */
 365 };
 366
 367
 368 static word capidtmf_recv_guard_snr_low_table[CAPIDTMF_RECV_TOTAL_FREQUENCY_COUNT] =
 369 {
 370   14,                                    /* Low group peak versus 697 Hz */
 371   14,                                    /* Low group peak versus 770 Hz */
 372   16,                                    /* Low group peak versus 852 Hz */
 373   16,                                    /* Low group peak versus 941 Hz */
 374   CAPIDTMF_RECV_GUARD_SNR_DONTCARE,      /* Low group peak versus 1209 Hz */
 375   CAPIDTMF_RECV_GUARD_SNR_DONTCARE,      /* Low group peak versus 1336 Hz */
 376   CAPIDTMF_RECV_GUARD_SNR_DONTCARE,      /* Low group peak versus 1477 Hz */
 377   CAPIDTMF_RECV_GUARD_SNR_DONTCARE,      /* Low group peak versus 1633 Hz */
 378   14,                                    /* Low group peak versus 635 Hz */
 379   16,                                    /* Low group peak versus 1010 Hz */
 380   CAPIDTMF_RECV_GUARD_SNR_DONTCARE,      /* Low group peak versus 1140 Hz */
 381   CAPIDTMF_RECV_GUARD_SNR_DONTCARE,      /* Low group peak versus 1272 Hz */
 382   DSPDTMF_RX_HARMONICS_SEL_DEFAULT - 8,  /* Low group peak versus 1405 Hz */
 383   DSPDTMF_RX_HARMONICS_SEL_DEFAULT - 4,  /* Low group peak versus 1555 Hz */
 384   DSPDTMF_RX_HARMONICS_SEL_DEFAULT - 4,  /* Low group peak versus 1715 Hz */
 385   12                                     /* Low group peak versus 100-630 Hz */
 386 };
 387
 388
 389 static word capidtmf_recv_guard_snr_high_table[CAPIDTMF_RECV_TOTAL_FREQUENCY_COUNT] =
 390 {
 391   CAPIDTMF_RECV_GUARD_SNR_DONTCARE,      /* High group peak versus 697 Hz */
 392   CAPIDTMF_RECV_GUARD_SNR_DONTCARE,      /* High group peak versus 770 Hz */
 393   CAPIDTMF_RECV_GUARD_SNR_DONTCARE,      /* High group peak versus 852 Hz */
 394   CAPIDTMF_RECV_GUARD_SNR_DONTCARE,      /* High group peak versus 941 Hz */
 395   20,                                    /* High group peak versus 1209 Hz */
 396   20,                                    /* High group peak versus 1336 Hz */
 397   20,                                    /* High group peak versus 1477 Hz */
 398   20,                                    /* High group peak versus 1633 Hz */
 399   CAPIDTMF_RECV_GUARD_SNR_DONTCARE,      /* High group peak versus 635 Hz */
 400   CAPIDTMF_RECV_GUARD_SNR_DONTCARE,      /* High group peak versus 1010 Hz */
 401   16,                                    /* High group peak versus 1140 Hz */
 402   4,                                     /* High group peak versus 1272 Hz */
 403   6,                                     /* High group peak versus 1405 Hz */
 404   8,                                     /* High group peak versus 1555 Hz */
 405   16,                                    /* High group peak versus 1715 Hz */
 406   12                                     /* High group peak versus 100-630 Hz */
 407 };
 408
 409
 410 /*---------------------------------------------------------------------------*/
 411
 412 static void capidtmf_recv_init (t_capidtmf_state   *p_state)
 413 {
 414   p_state->recv.min_gap_duration = 1;
 415   p_state->recv.min_digit_duration = 1;
 416
 417   p_state->recv.cycle_counter = 0;
 418   p_state->recv.current_digit_on_time = 0;
 419   p_state->recv.current_digit_off_time = 0;
 420   p_state->recv.current_digit_value = CAPIDTMF_RECV_NO_DIGIT;
 421
 422   p_state->recv.digit_write_pos = 0;
 423   p_state->recv.digit_read_pos = 0;
 424   p_state->recv.indication_state = 0;
 425   p_state->recv.indication_state_ack = 0;
 426   p_state->recv.state = CAPIDTMF_RECV_STATE_IDLE;
 427 }
 428
 429
 430 void capidtmf_recv_enable (t_capidtmf_state   *p_state, word min_digit_duration, word min_gap_duration)
 431 {
 432   p_state->recv.indication_state_ack &= CAPIDTMF_RECV_INDICATION_DIGIT;
 433   p_state->recv.min_digit_duration = (word)(((((dword) min_digit_duration) * 8) +
 434     ((dword)(CAPIDTMF_RECV_TIME_GRANULARITY / 2))) / ((dword) CAPIDTMF_RECV_TIME_GRANULARITY));
 435   if (p_state->recv.min_digit_duration <= 1)
 436     p_state->recv.min_digit_duration = 1;
 437   else
 438     (p_state->recv.min_digit_duration)--;
 439   p_state->recv.min_gap_duration =
 440     (word)((((dword) min_gap_duration) * 8) / ((dword) CAPIDTMF_RECV_TIME_GRANULARITY));
 441   if (p_state->recv.min_gap_duration <= 1)
 442     p_state->recv.min_gap_duration = 1;
 443   else
 444     (p_state->recv.min_gap_duration)--;
 445   p_state->recv.state |= CAPIDTMF_RECV_STATE_DTMF_ACTIVE;
 446 }
 447
 448
 449 void capidtmf_recv_disable (t_capidtmf_state   *p_state)
 450 {
 451   p_state->recv.state &= ~CAPIDTMF_RECV_STATE_DTMF_ACTIVE;
 452   if (p_state->recv.state == CAPIDTMF_RECV_STATE_IDLE)
 453     capidtmf_recv_init (p_state);
 454   else
 455   {
 456     p_state->recv.cycle_counter = 0;
 457     p_state->recv.current_digit_on_time = 0;
 458     p_state->recv.current_digit_off_time = 0;
 459     p_state->recv.current_digit_value = CAPIDTMF_RECV_NO_DIGIT;
 460   }
 461 }
 462
 463
 464 word capidtmf_recv_indication (t_capidtmf_state   *p_state, byte *buffer)
 465 {
 466   word i, j, k, flags;
 467
 468   flags = p_state->recv.indication_state ^ p_state->recv.indication_state_ack;
 469   p_state->recv.indication_state_ack ^= flags & CAPIDTMF_RECV_INDICATION_DIGIT;
 470   if (p_state->recv.digit_write_pos != p_state->recv.digit_read_pos)
 471   {
 472     i = 0;
 473     k = p_state->recv.digit_write_pos;
 474     j = p_state->recv.digit_read_pos;
 475     do
 476     {
 477       buffer[i++] = p_state->recv.digit_buffer[j];
 478       j = (j == CAPIDTMF_RECV_DIGIT_BUFFER_SIZE - 1) ? 0 : j + 1;
 479     } while (j != k);
 480     p_state->recv.digit_read_pos = k;
 481     return (i);
 482   }
 483   p_state->recv.indication_state_ack ^= flags;
 484   return (0);
 485 }
 486
 487
 488 #define CAPIDTMF_RECV_WINDOWED_SAMPLES  32
 489
 490 void capidtmf_recv_block (t_capidtmf_state   *p_state, byte   *buffer, word length)
 491 {
 492   byte result_digit;
 493   word sample_number, cycle_counter, n, i;
 494   word low_peak, high_peak;
 495   dword lo, hi;
 496   byte   *p;
 497   short *q;
 498   byte goertzel_result_buffer[CAPIDTMF_RECV_TOTAL_FREQUENCY_COUNT];
 499     short windowed_sample_buffer[CAPIDTMF_RECV_WINDOWED_SAMPLES];
 500
 501
 502   if (p_state->recv.state & CAPIDTMF_RECV_STATE_DTMF_ACTIVE)
 503   {
 504     cycle_counter = p_state->recv.cycle_counter;
 505     sample_number = 0;
 506     while (sample_number < length)
 507     {
 508       if (cycle_counter < CAPIDTMF_RECV_ACCUMULATE_CYCLES)
 509       {
 510         if (cycle_counter == 0)
 511         {
 512           for (i = 0; i < CAPIDTMF_RECV_TOTAL_FREQUENCY_COUNT; i++)
 513           {
 514             p_state->recv.goertzel_buffer[0][i] = 0;
 515             p_state->recv.goertzel_buffer[1][i] = 0;
 516           }
 517         }
 518         n = CAPIDTMF_RECV_ACCUMULATE_CYCLES - cycle_counter;
 519         if (n > length - sample_number)
 520           n = length - sample_number;
 521         if (n > CAPIDTMF_RECV_WINDOWED_SAMPLES)
 522           n = CAPIDTMF_RECV_WINDOWED_SAMPLES;
 523         p = buffer + sample_number;
 524         q = capidtmf_recv_window_function + cycle_counter;
 525         if (p_state->ulaw)
 526         {
 527           for (i = 0; i < n; i++)
 528           {
 529             windowed_sample_buffer[i] =
 530               (short)((capidtmf_expand_table_ulaw[p[i]] * ((long)(q[i]))) >> 15);
 531           }
 532         }
 533         else
 534         {
 535           for (i = 0; i < n; i++)
 536           {
 537             windowed_sample_buffer[i] =
 538               (short)((capidtmf_expand_table_alaw[p[i]] * ((long)(q[i]))) >> 15);
 539           }
 540         }
 541         capidtmf_recv_goertzel_coef_table[CAPIDTMF_RECV_TOTAL_FREQUENCY_COUNT - 1] = CAPIDTMF_RECV_FUNDAMENTAL_OFFSET;
 542         capidtmf_goertzel_loop (p_state->recv.goertzel_buffer[0],
 543           capidtmf_recv_goertzel_coef_table, windowed_sample_buffer, n);
 544         cycle_counter += n;
 545         sample_number += n;
 546       }
 547       else
 548       {
 549         capidtmf_goertzel_result (p_state->recv.goertzel_buffer[0],
 550           capidtmf_recv_goertzel_coef_table);
 551         for (i = 0; i < CAPIDTMF_RECV_TOTAL_FREQUENCY_COUNT; i++)
 552         {
 553           lo = (dword)(p_state->recv.goertzel_buffer[0][i]);
 554           hi = (dword)(p_state->recv.goertzel_buffer[1][i]);
 555           if (hi != 0)
 556           {
 557             n = capidtmf_dword_leading_zeroes (hi);
 558             hi = (hi << n) | (lo >> (32 - n));
 559           }
 560           else
 561           {
 562             n = capidtmf_dword_leading_zeroes (lo);
 563             hi = lo << n;
 564             n += 32;
 565           }
 566           n = 195 - 3 * n;
 567           if (hi >= 0xcb300000L)
 568             n += 2;
 569           else if (hi >= 0xa1450000L)
 570             n++;
 571           goertzel_result_buffer[i] = (byte) n;
 572         }
 573         low_peak = DSPDTMF_RX_SENSITIVITY_LOW_DEFAULT;
 574         result_digit = CAPIDTMF_RECV_NO_DIGIT;
 575         for (i = 0; i < CAPIDTMF_LOW_GROUP_FREQUENCIES; i++)
 576         {
 577           if (goertzel_result_buffer[i] > low_peak)
 578           {
 579             low_peak = goertzel_result_buffer[i];
 580             result_digit = (byte) i;
 581           }
 582         }
 583         high_peak = DSPDTMF_RX_SENSITIVITY_HIGH_DEFAULT;
 584         n = CAPIDTMF_RECV_NO_DIGIT;
 585         for (i = CAPIDTMF_LOW_GROUP_FREQUENCIES; i < CAPIDTMF_RECV_BASE_FREQUENCY_COUNT; i++)
 586         {
 587           if (goertzel_result_buffer[i] > high_peak)
 588           {
 589             high_peak = goertzel_result_buffer[i];
 590             n = (i - CAPIDTMF_LOW_GROUP_FREQUENCIES) << 2;
 591           }
 592         }
 593         result_digit |= (byte) n;
 594         if (low_peak + DSPDTMF_RX_HIGH_EXCEEDING_LOW_DEFAULT < high_peak)
 595           result_digit = CAPIDTMF_RECV_NO_DIGIT;
 596         if (high_peak + DSPDTMF_RX_LOW_EXCEEDING_HIGH_DEFAULT < low_peak)
 597           result_digit = CAPIDTMF_RECV_NO_DIGIT;
 598         n = 0;
 599         for (i = 0; i < CAPIDTMF_RECV_TOTAL_FREQUENCY_COUNT; i++)
 600         {
 601           if ((((short)(low_peak - goertzel_result_buffer[i] - capidtmf_recv_guard_snr_low_table[i])) < 0)
 602            || (((short)(high_peak - goertzel_result_buffer[i] - capidtmf_recv_guard_snr_high_table[i])) < 0))
 603           {
 604             n++;
 605           }
 606         }
 607         if (n != 2)
 608           result_digit = CAPIDTMF_RECV_NO_DIGIT;
 609
 610         if (result_digit == CAPIDTMF_RECV_NO_DIGIT)
 611         {
 612           if (p_state->recv.current_digit_on_time != 0)
 613           {
 614             if (++(p_state->recv.current_digit_off_time) >= p_state->recv.min_gap_duration)
 615             {
 616               p_state->recv.current_digit_on_time = 0;
 617               p_state->recv.current_digit_off_time = 0;
 618             }
 619           }
 620           else
 621           {
 622             if (p_state->recv.current_digit_off_time != 0)
 623               (p_state->recv.current_digit_off_time)--;
 624           }
 625         }
 626         else
 627         {
 628           if ((p_state->recv.current_digit_on_time == 0)
 629            && (p_state->recv.current_digit_off_time != 0))
 630           {
 631             (p_state->recv.current_digit_off_time)--;
 632           }
 633           else
 634           {
 635             n = p_state->recv.current_digit_off_time;
 636             if ((p_state->recv.current_digit_on_time != 0)
 637              && (result_digit != p_state->recv.current_digit_value))
 638             {
 639               p_state->recv.current_digit_on_time = 0;
 640               n = 0;
 641             }
 642             p_state->recv.current_digit_value = result_digit;
 643             p_state->recv.current_digit_off_time = 0;
 644             if (p_state->recv.current_digit_on_time != 0xffff)
 645             {
 646               p_state->recv.current_digit_on_time += n + 1;
 647               if (p_state->recv.current_digit_on_time >= p_state->recv.min_digit_duration)
 648               {
 649                 p_state->recv.current_digit_on_time = 0xffff;
 650                 i = (p_state->recv.digit_write_pos == CAPIDTMF_RECV_DIGIT_BUFFER_SIZE - 1) ?
 651                   0 : p_state->recv.digit_write_pos + 1;
 652                 if (i == p_state->recv.digit_read_pos)
 653                 {
 654                   trace (dprintf ("%s,%d: Receive digit overrun",
 655                     (char   *)(FILE_), __LINE__));
 656                 }
 657                 else
 658                 {
 659                   p_state->recv.digit_buffer[p_state->recv.digit_write_pos] = result_digit;
 660                   p_state->recv.digit_write_pos = i;
 661                   p_state->recv.indication_state =
 662                     (p_state->recv.indication_state & ~CAPIDTMF_RECV_INDICATION_DIGIT) |
 663                     (~p_state->recv.indication_state_ack & CAPIDTMF_RECV_INDICATION_DIGIT);
 664                 }
 665               }
 666             }
 667           }
 668         }
 669         cycle_counter = 0;
 670         sample_number++;
 671       }
 672     }
 673     p_state->recv.cycle_counter = cycle_counter;
 674   }
 675 }
 676
 677
 678 void capidtmf_init (t_capidtmf_state   *p_state, byte ulaw)
 679 {
 680   p_state->ulaw = ulaw;
 681   capidtmf_recv_init (p_state);
 682 }
 683
 684
 685 /*---------------------------------------------------------------------------*/