SPAN_DECLARE(r2_mf_tx_state_t *) r2_mf_tx_init(r2_mf_tx_state_t *s, int fwd)
{
int i;
const mf_digit_tones_t *tones;
if (s == NULL)
{
if ((s = (r2_mf_tx_state_t *) malloc(sizeof(*s))) == NULL)
return NULL;
}
memset(s, 0, sizeof(*s));
if (!r2_mf_gen_inited)
{
i = 0;
tones = r2_mf_fwd_tones;
while (tones->on_time)
{
tone_gen_descriptor_init(&r2_mf_fwd_digit_tones[i++],
tones->f1,
tones->level1,
tones->f2,
tones->level2,
tones->on_time,
tones->off_time,
0,
0,
(tones->off_time == 0));
tones++;
}
i = 0;
tones = r2_mf_back_tones;
while (tones->on_time)
{
tone_gen_descriptor_init(&r2_mf_back_digit_tones[i++],
tones->f1,
tones->level1,
tones->f2,
tones->level2,
tones->on_time,
tones->off_time,
0,
0,
(tones->off_time == 0));
tones++;
}
r2_mf_gen_inited = TRUE;
}
s->fwd = fwd;
return s;
}
static void my_mf_gen_init(float low_fudge,
int low_level,
float high_fudge,
int high_level,
int duration,
int gap)
{
int i;
/* The fiddle factor on the tone duration is to make KP consistently
50% longer than the other digits, as the digit durations are varied
for the tests. This is an approximation, as the real scaling should
be 100/68 */
for (i = 0; i < 15; i++)
{
tone_gen_descriptor_init(&my_mf_digit_tones[i],
bell_mf_tones[i].f1*(1.0 + low_fudge),
low_level,
bell_mf_tones[i].f2*(1.0 + high_fudge),
high_level,
(i == 12) ? 3*duration/2 : duration,
gap,
0,
0,
false);
}
}
static void bell_mf_gen_init(void)
{
int i;
const mf_digit_tones_t *tones;
if (bell_mf_gen_inited)
return;
i = 0;
tones = bell_mf_tones;
while (tones->on_time)
{
/* Note: The duration of KP is longer than the other signals. */
tone_gen_descriptor_init(&bell_mf_digit_tones[i++],
tones->f1,
tones->level1,
tones->f2,
tones->level2,
tones->on_time,
tones->off_time,
0,
0,
FALSE);
tones++;
}
bell_mf_gen_inited = TRUE;
}
static void dtmf_tx_initialise(void)
{
int row;
int col;
if (dtmf_tx_inited)
return;
for (row = 0; row < 4; row++)
{
for (col = 0; col < 4; col++)
{
tone_gen_descriptor_init(&dtmf_digit_tones[row*4 + col],
(int) dtmf_row[row],
DEFAULT_DTMF_TX_LEVEL,
(int) dtmf_col[col],
DEFAULT_DTMF_TX_LEVEL,
DEFAULT_DTMF_TX_ON_TIME,
DEFAULT_DTMF_TX_OFF_TIME,
0,
0,
FALSE);
}
}
dtmf_tx_inited = TRUE;
}
static int power_meter_tests(void)
{
awgn_state_t noise_source;
power_meter_t meter;
tone_gen_descriptor_t tone_desc;
tone_gen_state_t gen;
int i;
int idum = 1234567;
int16_t amp[1000];
int len;
int32_t level;
power_meter_init(&meter, 7);
printf("Testing with zero in the power register\n");
printf("Power: expected %fdBm0, got %fdBm0\n", -90.169f, power_meter_current_dbm0(&meter));
printf("Power: expected %fdBOv, got %fdBOv\n", -96.329f, power_meter_current_dbov(&meter));
printf("Testing with a square wave 10dB from maximum\n");
for (i = 0; i < 1000; i++)
{
amp[i] = (i & 1) ? 10362 : -10362;
level = power_meter_update(&meter, amp[i]);
//printf("%12d %fdBm0 %fdBov\n", level, power_meter_current_dbm0(&meter), power_meter_current_dbov(&meter));
}
printf("Level: expected %" PRId32 "/%" PRId32 ", got %" PRId32 "\n", power_meter_level_dbov(-10.0f), power_meter_level_dbm0(-10.0f + DBM0_MAX_POWER), level);
printf("Power: expected %fdBm0, got %fdBm0\n", -10.0f + DBM0_MAX_POWER, power_meter_current_dbm0(&meter));
printf("Power: expected %fdBOv, got %fdBOv\n", -10.0f, power_meter_current_dbov(&meter));
if (level < power_meter_level_dbov(-10.0f)*0.99f
||
level > power_meter_level_dbov(-10.0f)*1.01f)
{
printf("Test failed (level)\n");
exit(2);
}
if (0.1f < fabsf(power_meter_current_dbm0(&meter) + 10.0f - DBM0_MAX_POWER))
{
printf("Test failed (dBm0)\n");
exit(2);
}
if (0.1f < fabsf(power_meter_current_dbov(&meter) + 10.0))
{
printf("Test failed (dBOv)\n");
exit(2);
}
printf("Testing with a sine wave tone 10dB from maximum\n");
tone_gen_descriptor_init(&tone_desc,
1000,
-4,
0,
1,
1,
0,
0,
0,
true);
tone_gen_init(&gen, &tone_desc);
len = tone_gen(&gen, amp, 1000);
for (i = 0; i < len; i++)
{
level = power_meter_update(&meter, amp[i]);
//printf("%12d %fdBm0 %fdBov\n", level, power_meter_current_dbm0(&meter), power_meter_current_dbov(&meter));
}
printf("Level: expected %" PRId32 "/%" PRId32 ", got %" PRId32 "\n", power_meter_level_dbov(-10.0f), power_meter_level_dbm0(-10.0f + DBM0_MAX_POWER), level);
printf("Power: expected %fdBm0, got %fdBm0\n", -10.0f + DBM0_MAX_POWER, power_meter_current_dbm0(&meter));
printf("Power: expected %fdBOv, got %fdBOv\n", -10.0f, power_meter_current_dbov(&meter));
if (level < power_meter_level_dbov(-10.0f)*0.95f
||
level > power_meter_level_dbov(-10.0f)*1.05f)
{
printf("Test failed (level)\n");
exit(2);
}
if (0.2f < fabsf(power_meter_current_dbm0(&meter) + 10.0f - DBM0_MAX_POWER))
{
printf("Test failed (dBm0)\n");
exit(2);
}
if (0.2f < fabsf(power_meter_current_dbov(&meter) + 10.0))
{
printf("Test failed (dBOv)\n");
exit(2);
}
printf("Testing with AWGN 10dB from maximum\n");
awgn_init_dbov(&noise_source, idum, -10.0f);
for (i = 0; i < 1000; i++)
amp[i] = awgn(&noise_source);
for (i = 0; i < 1000; i++)
{
level = power_meter_update(&meter, amp[i]);
//printf("%12d %fdBm0 %fdBov\n", level, power_meter_current_dbm0(&meter), power_meter_current_dbov(&meter));
}
printf("Level: expected %" PRId32 "/%" PRId32 ", got %" PRId32 "\n", power_meter_level_dbov(-10.0f), power_meter_level_dbm0(-10.0f + DBM0_MAX_POWER), level);
printf("Power: expected %fdBm0, got %fdBm0\n", -10.0f + DBM0_MAX_POWER, power_meter_current_dbm0(&meter));
printf("Power: expected %fdBOv, got %fdBOv\n", -10.0f, power_meter_current_dbov(&meter));
if (level < power_meter_level_dbov(-10.0f)*0.95f
||
level > power_meter_level_dbov(-10.0f)*1.05f)
{
printf("Test failed (level)\n");
exit(2);
}
if (0.2f < fabsf(power_meter_current_dbm0(&meter) + 10.0f - DBM0_MAX_POWER))
{
printf("Test failed (dBm0)\n");
exit(2);
}
if (0.2f < fabsf(power_meter_current_dbov(&meter) + 10.0f))
{
printf("Test failed (dBOv)\n");
exit(2);
}
return 0;
}
int main(int argc, char *argv[])
{
int f;
int i;
int16_t amp[8000];
int16_t value;
int signal;
float power[10];
tone_gen_descriptor_t tone_desc;
tone_gen_state_t tone_state;
awgn_state_t noise_source;
fir32_state_t line_model_d2;
fir32_state_t line_model_d3;
fir32_state_t line_model_d4;
fir32_state_t line_model_d5;
fir32_state_t line_model_d6;
fir32_state_t line_model_d7;
fir32_state_t line_model_d8;
fir32_state_t line_model_d9;
fir_float_state_t level_measurement_bp;
signal_load(&local_css, "sound_c1_8k.wav");
signal_load(&far_css, "sound_c3_8k.wav");
fir32_create(&line_model_d2,
line_model_d2_coeffs,
sizeof(line_model_d2_coeffs)/sizeof(int32_t));
fir32_create(&line_model_d3,
line_model_d3_coeffs,
sizeof(line_model_d3_coeffs)/sizeof(int32_t));
fir32_create(&line_model_d4,
line_model_d4_coeffs,
sizeof(line_model_d4_coeffs)/sizeof(int32_t));
fir32_create(&line_model_d5,
line_model_d5_coeffs,
sizeof(line_model_d5_coeffs)/sizeof(int32_t));
fir32_create(&line_model_d6,
line_model_d6_coeffs,
sizeof(line_model_d6_coeffs)/sizeof(int32_t));
fir32_create(&line_model_d7,
line_model_d7_coeffs,
sizeof(line_model_d7_coeffs)/sizeof(int32_t));
fir32_create(&line_model_d8,
line_model_d8_coeffs,
sizeof(line_model_d8_coeffs)/sizeof(int32_t));
fir32_create(&line_model_d9,
line_model_d9_coeffs,
sizeof(line_model_d9_coeffs)/sizeof(int32_t));
fir_float_create(&level_measurement_bp,
level_measurement_bp_coeffs,
sizeof(level_measurement_bp_coeffs)/sizeof(float));
for (f = 10; f < 4000; f++)
{
tone_gen_descriptor_init(&tone_desc,
f,
-10,
0,
0,
1,
0,
0,
0,
true);
tone_gen_init(&tone_state, &tone_desc);
tone_gen(&tone_state, amp, 8000);
for (i = 0; i < 10; i++)
power[i] = 0.0f;
for (i = 0; i < 800; i++)
{
signal = fir32(&line_model_d2, amp[i]);
power[0] += ((signal*signal - power[0])/32.0f);
signal = fir32(&line_model_d3, amp[i]);
power[1] += ((signal*signal - power[1])/32.0f);
signal = fir32(&line_model_d4, amp[i]);
power[2] += ((signal*signal - power[2])/32.0f);
signal = fir32(&line_model_d5, amp[i]);
power[3] += ((signal*signal - power[3])/32.0f);
signal = fir32(&line_model_d6, amp[i]);
power[4] += ((signal*signal - power[4])/32.0f);
signal = fir32(&line_model_d7, amp[i]);
power[5] += ((signal*signal - power[5])/32.0f);
signal = fir32(&line_model_d8, amp[i]);
power[6] += ((signal*signal - power[6])/32.0f);
signal = fir32(&line_model_d9, amp[i]);
power[7] += ((signal*signal - power[7])/32.0f);
signal = fir_float(&level_measurement_bp, amp[i]);
power[8] += ((signal*signal - power[8])/32.0f);
signal = amp[i];
power[9] += ((signal*signal - power[9])/32.0f);
}
printf("%d %f %f %f %f %f %f %f %f %f %f\n",
f,
sqrt(power[0])*LINE_MODEL_D2_GAIN,
sqrt(power[1])*LINE_MODEL_D3_GAIN,
sqrt(power[2])*LINE_MODEL_D4_GAIN,
sqrt(power[3])*LINE_MODEL_D5_GAIN,
sqrt(power[4])*LINE_MODEL_D6_GAIN,
sqrt(power[5])*LINE_MODEL_D7_GAIN,
sqrt(power[6])*LINE_MODEL_D8_GAIN,
sqrt(power[7])*LINE_MODEL_D9_GAIN,
sqrt(power[8]),
sqrt(power[9]));
}
awgn_init_dbm0(&noise_source, 1234567, -20.0f);
for (i = 0; i < 10; i++)
power[i] = 0.0f;
signal_restart(&local_css, 0.0f);
signal_restart(&far_css, 0.0f);
for (i = 0; i < SAMPLE_RATE; i++)
{
value = signal_amp(&local_css);
//value = awgn(&noise_source);
signal = fir32(&line_model_d2, value);
power[0] += ((signal*signal - power[0])/32.0f);
signal = fir32(&line_model_d3, value);
power[1] += ((signal*signal - power[1])/32.0f);
signal = fir32(&line_model_d4, value);
power[2] += ((signal*signal - power[2])/32.0f);
signal = fir32(&line_model_d5, value);
power[3] += ((signal*signal - power[3])/32.0f);
signal = fir32(&line_model_d6, value);
power[4] += ((signal*signal - power[4])/32.0f);
signal = fir32(&line_model_d7, value);
power[5] += ((signal*signal - power[5])/32.0f);
signal = fir32(&line_model_d8, value);
power[6] += ((signal*signal - power[6])/32.0f);
signal = fir32(&line_model_d9, value);
power[7] += ((signal*signal - power[7])/32.0f);
signal = fir_float(&level_measurement_bp, value);
power[8] += ((signal*signal - power[8])/32.0f);
signal = value;
power[9] += ((signal*signal - power[9])/32.0f);
}
for (i = 0; i < 10; i++)
power[i] = 0.0f;
for (i = 0; i < SAMPLE_RATE; i++)
{
value = signal_amp(&local_css);
//value = awgn(&noise_source);
signal = fir32(&line_model_d2, value);
power[0] += ((signal*signal - power[0])/32.0f);
signal = fir32(&line_model_d3, value);
power[1] += ((signal*signal - power[1])/32.0f);
signal = fir32(&line_model_d4, value);
power[2] += ((signal*signal - power[2])/32.0f);
signal = fir32(&line_model_d5, value);
power[3] += ((signal*signal - power[3])/32.0f);
signal = fir32(&line_model_d6, value);
power[4] += ((signal*signal - power[4])/32.0f);
signal = fir32(&line_model_d7, value);
power[5] += ((signal*signal - power[5])/32.0f);
signal = fir32(&line_model_d8, value);
power[6] += ((signal*signal - power[6])/32.0f);
signal = fir32(&line_model_d9, value);
power[7] += ((signal*signal - power[7])/32.0f);
signal = fir_float(&level_measurement_bp, value);
power[8] += ((signal*signal - power[8])/32.0f);
signal = value;
power[9] += ((signal*signal - power[9])/32.0f);
}
printf("%d %f %f %f %f %f %f %f %f %f %f\n",
0,
sqrt(power[0])*LINE_MODEL_D2_GAIN,
sqrt(power[1])*LINE_MODEL_D3_GAIN,
sqrt(power[2])*LINE_MODEL_D4_GAIN,
sqrt(power[3])*LINE_MODEL_D5_GAIN,
sqrt(power[4])*LINE_MODEL_D6_GAIN,
sqrt(power[5])*LINE_MODEL_D7_GAIN,
sqrt(power[6])*LINE_MODEL_D8_GAIN,
sqrt(power[7])*LINE_MODEL_D9_GAIN,
sqrt(power[8]),
sqrt(power[9]));
printf("%d %f %f %f %f %f %f %f %f %f %f\n",
0,
sqrt(power[0]),
sqrt(power[1]),
sqrt(power[2]),
sqrt(power[3]),
sqrt(power[4]),
sqrt(power[5]),
sqrt(power[6]),
sqrt(power[7]),
sqrt(power[8]),
sqrt(power[9]));
printf("%d %f %f %f %f %f %f %f %f %f %f\n",
0,
sqrt(power[0])/sqrt(power[9]),
sqrt(power[1])/sqrt(power[9]),
sqrt(power[2])/sqrt(power[9]),
sqrt(power[3])/sqrt(power[9]),
sqrt(power[4])/sqrt(power[9]),
sqrt(power[5])/sqrt(power[9]),
sqrt(power[6])/sqrt(power[9]),
sqrt(power[7])/sqrt(power[9]),
sqrt(power[8]),
sqrt(power[9]));
printf("%d %f %f %f %f %f %f %f %f %f %f\n",
0,
sqrt(power[0])*LINE_MODEL_D2_GAIN/sqrt(power[9]),
sqrt(power[1])*LINE_MODEL_D3_GAIN/sqrt(power[9]),
sqrt(power[2])*LINE_MODEL_D4_GAIN/sqrt(power[9]),
sqrt(power[3])*LINE_MODEL_D5_GAIN/sqrt(power[9]),
sqrt(power[4])*LINE_MODEL_D6_GAIN/sqrt(power[9]),
sqrt(power[5])*LINE_MODEL_D7_GAIN/sqrt(power[9]),
sqrt(power[6])*LINE_MODEL_D8_GAIN/sqrt(power[9]),
sqrt(power[7])*LINE_MODEL_D9_GAIN/sqrt(power[9]),
sqrt(power[8]),
sqrt(power[9]));
for (i = 0; i < (int) (sizeof(css_c1)/sizeof(css_c1[0])); i++)
printf("%d\n", css_c1[i]);
printf("\n");
for (i = 0; i < (int) (sizeof(css_c1)/sizeof(css_c3[0])); i++)
printf("%d\n", css_c3[i]);
signal_free(&local_css);
signal_free(&far_css);
fir32_free(&line_model_d2);
fir32_free(&line_model_d3);
fir32_free(&line_model_d4);
fir32_free(&line_model_d5);
fir32_free(&line_model_d6);
fir32_free(&line_model_d7);
fir32_free(&line_model_d8);
fir32_free(&line_model_d9);
fir_float_free(&level_measurement_bp);
return 0;
}
int main(int argc, char *argv[])
{
tone_gen_descriptor_t tone_desc;
tone_gen_state_t tone_state;
int i;
int16_t amp[16384];
int len;
SNDFILE *outhandle;
int outframes;
if ((outhandle = sf_open_telephony_write(OUTPUT_FILE_NAME, 1)) == NULL)
{
fprintf(stderr, " Cannot open audio file '%s'\n", OUTPUT_FILE_NAME);
exit(2);
}
/* Try a tone pair */
tone_gen_descriptor_init(&tone_desc,
440,
-10,
620,
-15,
100,
200,
300,
400,
FALSE);
tone_gen_init(&tone_state, &tone_desc);
for (i = 0; i < 1000; i++)
{
len = tone_gen(&tone_state, amp, 160);
printf("Generated %d samples\n", len);
if (len <= 0)
break;
outframes = sf_writef_short(outhandle, amp, len);
}
/* Try a different tone pair */
tone_gen_descriptor_init(&tone_desc,
350,
-10,
440,
-15,
400,
300,
200,
100,
TRUE);
tone_gen_init(&tone_state, &tone_desc);
for (i = 0; i < 1000; i++)
{
len = tone_gen(&tone_state, amp, 160);
printf("Generated %d samples\n", len);
if (len <= 0)
break;
outframes = sf_writef_short(outhandle, amp, len);
}
/* Try a different tone pair */
tone_gen_descriptor_init(&tone_desc,
400,
-10,
450,
-10,
100,
200,
300,
400,
TRUE);
tone_gen_init(&tone_state, &tone_desc);
for (i = 0; i < 1000; i++)
{
len = tone_gen(&tone_state, amp, 160);
printf("Generated %d samples\n", len);
if (len <= 0)
break;
outframes = sf_writef_short(outhandle, amp, len);
}
/* Try a single tone */
tone_gen_descriptor_init(&tone_desc,
400,
-10,
0,
0,
100,
200,
300,
400,
TRUE);
tone_gen_init(&tone_state, &tone_desc);
for (i = 0; i < 1000; i++)
{
len = tone_gen(&tone_state, amp, 160);
printf("Generated %d samples\n", len);
if (len <= 0)
break;
outframes = sf_writef_short(outhandle, amp, len);
}
/* Try a single non-repeating tone */
tone_gen_descriptor_init(&tone_desc,
820,
-10,
0,
0,
2000,
0,
0,
0,
FALSE);
tone_gen_init(&tone_state, &tone_desc);
for (i = 0; i < 1000; i++)
{
len = tone_gen(&tone_state, amp, 160);
printf("Generated %d samples\n", len);
if (len <= 0)
break;
outframes = sf_writef_short(outhandle, amp, len);
}
/* Try a single non-repeating tone at 0dBm0 */
tone_gen_descriptor_init(&tone_desc,
820,
0,
0,
0,
2000,
0,
0,
0,
FALSE);
tone_gen_init(&tone_state, &tone_desc);
for (i = 0; i < 1000; i++)
{
len = tone_gen(&tone_state, amp, 160);
printf("Generated %d samples\n", len);
if (len <= 0)
break;
outframes = sf_writef_short(outhandle, amp, len);
}
/* Try an AM modulated tone at a modest modulation level (25%) */
tone_gen_descriptor_init(&tone_desc,
425,
-10,
-50,
25,
100,
200,
300,
400,
TRUE);
tone_gen_init(&tone_state, &tone_desc);
for (i = 0; i < 1000; i++)
{
len = tone_gen(&tone_state, amp, 160);
printf("Generated %d samples\n", len);
if (len <= 0)
break;
outframes = sf_writef_short(outhandle, amp, len);
}
/* Try an AM modulated tone at maximum modulation level (100%) */
tone_gen_descriptor_init(&tone_desc,
425,
-10,
-50,
100,
100,
200,
300,
400,
TRUE);
tone_gen_init(&tone_state, &tone_desc);
for (i = 0; i < 1000; i++)
{
len = tone_gen(&tone_state, amp, 160);
printf("Generated %d samples\n", len);
if (len <= 0)
break;
outframes = sf_writef_short(outhandle, amp, len);
}
if (sf_close(outhandle) != 0)
{
fprintf(stderr, " Cannot close audio file '%s'\n", OUTPUT_FILE_NAME);
exit (2);
}
return 0;
}