Mercurial > hg > audiostuff
view spandsp-0.0.6pre17/tests/testfax.c @ 6:22a74b01a099 default tip
implement more meaningful test program
author | Peter Meerwald <pmeerw@cosy.sbg.ac.at> |
---|---|
date | Fri, 25 Jun 2010 16:14:50 +0200 |
parents | 26cd8f1ef0b1 |
children |
line wrap: on
line source
/* * SpanDSP - a series of DSP components for telephony * * testfax.c * * 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 General Public License version 2, 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 General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. * * $Id: testfax.c,v 1.33 2009/05/30 15:23:14 steveu Exp $ */ #if defined(HAVE_CONFIG_H) #include <config.h> #endif #include <fcntl.h> #include <stdio.h> #include <string.h> #include <errno.h> #include <sys/ioctl.h> #include <stdlib.h> #include <inttypes.h> #include <sys/signal.h> #include <sys/select.h> #include <sys/wait.h> #include <sys/resource.h> #include <sys/time.h> #if defined(HAVE_LIBUNICALL) #include <linux/zaptel.h> #include <pthread.h> #include <sndfile.h> #include <tiffio.h> #include "unicall.h" //#include "../libmfcr2/libmfcr2.h" //#include "../libpri/libpri.h" //#include "../libpri/libfx.h" #include "spandsp.h" int caller_mode = FALSE; static SNDFILE *rxhandle; static SNDFILE *txhandle; typedef struct { pthread_t thread; int chan; int sig_fd; int fd; uc_call_t *call; uc_crn_t crn; int xxx; int cause; uc_t *uc; dtmf_rx_state_t dtmf_state; char dtmf[101]; int dtmf_ptr; char *tag; char originating_number[32]; char destination_number[32]; t30_state_t fax; } chan_stuff_t; chan_stuff_t chan_stuff[30]; tone_gen_descriptor_t tone_desc; tone_gen_state_t gen; pthread_mutex_t mutex; void channel_read_fax_channel(uc_t *uc, int chan, void *user_data, uint8_t *buf, int len); int channel_write_fax_channel(uc_t *uc, int chan, void *user_data, uint8_t *buf, int max_len); int channel_error(uc_t *uc, int chan, void *user_data, int cause); int signaling_error(uc_t *uc, void *user_data, int cause); void channel_read_fax_channel(uc_t *uc, int chan, void *user_data, uint8_t *buf, int len) { int i; int xlen; char *s; int outframes; #if 0 outframes = sf_writef_short(rxhandle, AF_DEFAULT_TRACK, buf, len >> 1); if (outframes != len) { printf("Failed to write %d samples\n", len); exit(2); } #endif dtmf_rx(&chan_stuff[chan].dtmf_state, (int16_t *) buf, len); xlen = dtmf_rx_get(&chan_stuff[chan].dtmf_state, chan_stuff[chan].dtmf + chan_stuff[chan].dtmf_ptr, 100 - chan_stuff[chan].dtmf_ptr); if (xlen > 0) { s = chan_stuff[chan].dtmf + chan_stuff[chan].dtmf_ptr; while (*s) { if (*s == '#') { uc_set_channel_read_callback(uc, 0, NULL, 0); uc_set_channel_write_callback(uc, 0, NULL, 0); if (uc_call_control(uc, UC_OP_DROPCALL, chan_stuff[chan].crn, (void *) UC_CAUSE_NORMAL_CLEARING)) printf ("A Drop Call failed\n"); /*endif*/ break; } /*endif*/ s++; } /*endwhile*/ printf("Got '%s'\n", chan_stuff[chan].dtmf); chan_stuff[chan].dtmf_ptr += xlen; } /*endif*/ t30_rx(&(chan_stuff[chan].fax), (int16_t *) buf, len); } /*- End of function --------------------------------------------------------*/ int channel_write_fax_channel(uc_t *uc, int chan, void *user_data, uint8_t *buf, int max_len) { int len; len = t30_tx(&(chan_stuff[chan].fax), (int16_t *) buf, max_len >> 1); sf_writef_short(txhandle, AF_DEFAULT_TRACK, buf, len); if (len > 0) len <<= 1; return len; } /*- End of function --------------------------------------------------------*/ int channel_error(uc_t *uc, int chan, void *user_data, int cause) { printf("Error %d\n", cause); return 0; } /*- End of function --------------------------------------------------------*/ int signaling_error(uc_t *uc, void *user_data, int cause) { printf("Error %d\n", cause); return 0; } /*- End of function --------------------------------------------------------*/ static void initiate_call(uc_t *uc, int chan, uc_event_t *e) { uc_makecall_t makecall; uc_callparms_t *callparms; int ret; printf ("Initiating call\n"); pthread_mutex_lock(&mutex); if ((callparms = uc_new_callparms(NULL)) == NULL) return; /*endif*/ pthread_mutex_unlock(&mutex); uc_callparm_originating_number(callparms, chan_stuff[chan].originating_number); uc_callparm_destination_number(callparms, chan_stuff[chan].destination_number); makecall.callparms = callparms; makecall.crn = 0; if (ret = uc_call_control(uc, UC_OP_MAKECALL, 0, (void *) &makecall) != UC_RET_OK) fprintf(stderr, "Make Call failed - %d\n", ret); /*endif*/ chan_stuff[chan].crn = makecall.crn; free(callparms); } /*- End of function --------------------------------------------------------*/ static void phase_b_handler(t30_state_t *s, void *user_data, int msg) { chan_stuff_t *t; t = (chan_stuff_t *) user_data; printf("Phase B - %d\n", msg); } /*- End of function --------------------------------------------------------*/ static void phase_d_handler(t30_state_t *s, void *user_data, int msg) { chan_stuff_t *t; t = (chan_stuff_t *) user_data; printf("Phase D - %d\n", msg); } /*- End of function --------------------------------------------------------*/ static void phase_e_handler(t30_state_t *s, void *user_data, int result) { chan_stuff_t *t; printf("Phase E - %d\n", result); t = (chan_stuff_t *) user_data; if (uc_call_control(t->uc, UC_OP_DROPCALL, t->crn, (void *) UC_CAUSE_NORMAL_CLEARING)) fprintf(stderr, "Phase E Drop Call failed\n"); /*endif*/ } /*- End of function --------------------------------------------------------*/ static void flush_handler(t30_state_t *s, void *user_data, int which) { chan_stuff_t *t; printf("Flush\n"); t = (chan_stuff_t *) user_data; } /*- End of function --------------------------------------------------------*/ static void handle_uc_event(uc_t *uc, void *user_data, uc_event_t *e) { int chan; chan = (int) user_data; printf ("-- %s (%d)\n", uc_event2str(e->e), chan); switch (e->e) { case UC_EVENT_DEVICEFAIL: break; case UC_EVENT_PROTOCOLFAIL: printf("-- Protocol failure on channel %d, cause %d\n", e->gen.channel, e->gen.data); break; case UC_EVENT_SIGCHANSTATUS: printf("-- Signalling channel status - %s\n", e->sigchanstatus.ok ? "Up" : "Down"); break; case UC_EVENT_ALARM: printf("-- Alarm - 0x%X 0x%X\n", e->alarm.raised, e->alarm.cleared); break; case UC_EVENT_FARBLOCKED: printf("-- Channel far end blocked! :-(\n"); chan_stuff[chan].xxx &= ~1; break; case UC_EVENT_FARUNBLOCKED: printf("-- Channel far end unblocked! :-)\n"); chan_stuff[chan].xxx |= 1; if (chan_stuff[chan].xxx == 3) { if (caller_mode) initiate_call(uc, chan, e); /*endif*/ } /*endif*/ break; case UC_EVENT_LOCALBLOCKED: printf("-- Channel local end blocked! :-(\n"); chan_stuff[chan].xxx &= ~2; break; case UC_EVENT_LOCALUNBLOCKED: printf("-- Channel local end unblocked! :-)\n"); chan_stuff[chan].xxx |= 2; if (chan_stuff[chan].xxx == 3) { if (caller_mode) initiate_call(uc, chan, e); /*endif*/ } /*endif*/ break; case UC_EVENT_DIALING: printf("-- Dialing on channel %d\n", e->gen.channel); break; case UC_EVENT_PROCEEDING: printf("-- Proceeding on channel %d\n", e->gen.channel); break; case UC_EVENT_ACCEPTED: printf("-- Accepted on channel %d\n", e->gen.channel); if (uc_call_control(uc, UC_OP_ANSWERCALL, e->gen.crn, (void *) -1)) fprintf(stderr, "Answer Call failed\n"); /*endif*/ break; case UC_EVENT_DETECTED: printf("-- Detected on channel %d\n", e->gen.channel); break; case UC_EVENT_MOREDIGITS: printf("-- More digits on channel %d, CRN %d (ANI: %s, DNIS: %s)\n", e->offered.channel, e->offered.crn, e->offered.parms.originating_number, e->offered.parms.destination_number); break; case UC_EVENT_ALERTING: printf("-- Alerting on channel %d\n", e->gen.channel); /* This is just a notification of call progress. We need take no action at this point. */ break; case UC_EVENT_FARDISCONNECTED: printf("-- Far end disconnected on channel %d\n", e->fardisconnected.channel); /* Kill any outstanding audio processing */ uc_set_channel_read_callback(uc, 0, NULL, 0); uc_set_channel_write_callback(uc, 0, NULL, 0); if (uc_call_control(uc, UC_OP_DROPCALL, e->fardisconnected.crn, (void *) UC_CAUSE_NORMAL_CLEARING)) fprintf(stderr, "C Drop Call failed\n"); /*endif*/ break; case UC_EVENT_DROPCALL: printf("-- Drop call on channel %d\n", e->gen.channel); if (uc_call_control(uc, UC_OP_RELEASECALL, e->gen.crn, NULL)) fprintf(stderr, "uc_ReleaseCall failed\n"); /*endif*/ break; case UC_EVENT_RELEASECALL: printf("-- Released on channel %d\n", e->gen.channel); if (caller_mode) initiate_call(uc, chan, e); /*endif*/ break; case UC_EVENT_OFFERED: printf("-- Offered on channel %d, CRN %d (ANI: %s, DNIS: %s)\n", e->offered.channel, e->offered.crn, e->offered.parms.originating_number, e->offered.parms.destination_number); if (!caller_mode) { switch (chan_stuff[chan].cause) { case 0: if (uc_call_control(uc, UC_OP_ACCEPTCALL, e->offered.crn, (void *) -1)) fprintf(stderr, "uc_AcceptCall failed\n"); /*endif*/ chan_stuff[chan].crn = e->offered.crn; break; case 1: if (uc_call_control(uc, UC_OP_ANSWERCALL, e->offered.crn, (void *) -1)) fprintf(stderr, "uc_AnswerCall failed\n"); /*endif*/ chan_stuff[chan].crn = e->offered.crn; break; case 2: if (uc_call_control(uc, UC_OP_DROPCALL, e->offered.crn, (void *) UC_CAUSE_USER_BUSY)) fprintf(stderr, "E Drop Call failed\n"); /*endif*/ break; case 3: if (uc_call_control(uc, UC_OP_DROPCALL, e->offered.crn, (void *) UC_CAUSE_UNASSIGNED_NUMBER)) fprintf(stderr, "F Drop Call failed\n"); /*endif*/ break; case 4: if (uc_call_control(uc, UC_OP_DROPCALL, e->offered.crn, (void *) UC_CAUSE_NETWORK_CONGESTION)) fprintf(stderr, "G Drop Call failed\n"); /*endif*/ break; case 5: if (uc_call_control(uc, UC_OP_DROPCALL, e->offered.crn, (void *) UC_CAUSE_DEST_OUT_OF_ORDER)) fprintf(stderr, "H Drop Call failed\n"); /*endif*/ break; } /*endswitch*/ if (++chan_stuff[chan].cause > 5) chan_stuff[chan].cause = 0; /*endif*/ } /*endif*/ break; case UC_EVENT_ANSWERED: printf("-- Answered on channel %d\n", e->gen.channel); uc_set_channel_read_callback(uc, 0, channel_read_fax_channel, (void *) chan); printf("XXX read callback set\n"); uc_set_channel_write_callback(uc, 0, channel_write_fax_channel, (void *) chan); printf("XXX write callback set\n"); t30_init(&(chan_stuff[chan].fax), FALSE, uc); t30_set_local_ident(&(chan_stuff[chan].fax), "12345678"); t30_set_tx_file(&(chan_stuff[chan].fax), "tx.tif"); //t30_set_rx_file(&(chan_stuff[chan].fax), "rx.tif"); t30_set_phase_b_handler(&(chan_stuff[chan].fax), phase_b_handler, &(chan_stuff[chan])); t30_set_phase_d_handler(&(chan_stuff[chan].fax), phase_d_handler, &(chan_stuff[chan])); t30_set_phase_e_handler(&(chan_stuff[chan].fax), phase_e_handler, &(chan_stuff[chan])); t30_set_flush_handler(&(chan_stuff[chan].fax), flush_handler, &(chan_stuff[chan])); printf("XXX FAX inited\n"); dtmf_rx_init(&chan_stuff[chan].dtmf_state, NULL, NULL); printf("XXX DTMF inited\n"); break; case UC_EVENT_CONNECTED: printf("-- Connected on channel %d\n", e->gen.channel); uc_set_channel_read_callback(uc, 0, channel_read_fax_channel, (void *) chan); printf("XXX read callback set\n"); uc_set_channel_write_callback(uc, 0, channel_write_fax_channel, (void *) chan); printf("XXX write callback set\n"); t30_init(&(chan_stuff[chan].fax), TRUE, uc); t30_set_local_ident(&(chan_stuff[chan].fax), "87654321"); t30_set_tx_file(&(chan_stuff[chan].fax), "tx.tif"); //t30_set_rx_file(&(chan_stuff[chan].fax), "rx.tif"); t30_set_phase_b_handler(&(chan_stuff[chan].fax), phase_b_handler, &(chan_stuff[chan])); t30_set_phase_d_handler(&(chan_stuff[chan].fax), phase_d_handler, &(chan_stuff[chan])); t30_set_phase_e_handler(&(chan_stuff[chan].fax), phase_e_handler, &(chan_stuff[chan])); printf("XXX FAX inited\n"); #if 0 if (uc_call_control(uc, UC_OP_DROPCALL, e->offered.crn, (void *) UC_CAUSE_NORMAL_CLEARING)) printf ("I Drop Call failed\n"); /*endif*/ #endif break; default: fprintf(stderr, "--!! Unknown signaling event %d\n", e->e); break; } /*endswitch*/ } /*- End of function --------------------------------------------------------*/ static void *run_uc(void *arg) { uc_t *uc; uc_event_t *e; struct timeval tv = {0,0}; struct timeval *next; fd_set rfds; fd_set wfds; fd_set efds; int res; int dfd; int chan; chan = *((int *) arg); dfd = chan_stuff[chan].fd; if (chan < 4) uc = uc_new(dfd, dfd, "fx", "ls,us", UC_MODE_CO, 1); else uc = uc_new(dfd, dfd, "fx", "ls", UC_MODE_CPE, 1); //uc = uc_new(dfd, dfd, "mfcr2", "cn", UC_MODE_CPE, 1); //uc = uc_new(dfd, dfd, "pri", "ctr4", UC_MODE_CPE, 1); if (uc == NULL) { fprintf(stderr, "Unable to create instance\n"); return NULL; } /*endif*/ uc_set_api_codec(uc, 0, UC_CODEC_LINEAR16); chan_stuff[chan].uc = uc; uc_set_signaling_callback(uc, handle_uc_event, (void *) chan); uc_set_signaling_error_callback(uc, signaling_error, (void *) chan); uc_set_channel_error_callback(uc, 0, channel_error, (void *) chan); uc_set_logging(uc, 0x7FFFFFFF, 0, chan_stuff[chan].tag); uc_call_control(uc, UC_OP_UNBLOCK, 0, (void *) -1); for (;;) { FD_ZERO(&rfds); FD_ZERO(&wfds); FD_ZERO(&efds); FD_SET(dfd, &rfds); FD_SET(dfd, &wfds); FD_SET(dfd, &efds); if ((next = uc_schedule_next(uc))) { gettimeofday(&tv, NULL); tv.tv_sec = next->tv_sec - tv.tv_sec; tv.tv_usec = next->tv_usec - tv.tv_usec; if (tv.tv_usec < 0) { tv.tv_usec += 1000000; tv.tv_sec -= 1; } /*endif*/ if (tv.tv_sec < 0) { tv.tv_sec = 0; tv.tv_usec = 0; } /*endif*/ } /*endif*/ res = select(dfd + 1, &rfds, NULL, &efds, next ? &tv : NULL); e = NULL; if (res == 0) { uc_schedule_run(uc); } else if (res > 0) { e = uc_check_event(uc); } else if (errno != EINTR) { fprintf(stderr, "Error (%d) on select: %s\n", errno, strerror(errno)); } /*endif*/ if (e) { printf("Non-callback signaling event\n"); handle_uc_event(uc, (void *) chan, e); } /*endif*/ } /*endfor*/ return NULL; } /*- End of function --------------------------------------------------------*/ int main(int argc, char *argv[]) { pthread_attr_t attr; struct zt_bufferinfo b; struct zt_gains g; int chan; int chanx; char dev_name[20]; AFfilesetup filesetup; int j; filesetup = afNewFileSetup(); if (filesetup == AF_NULL_FILESETUP) { fprintf(stderr, " Failed to create file setup\n"); exit(2); } afInitSampleFormat(filesetup, AF_DEFAULT_TRACK, AF_SAMPFMT_TWOSCOMP, 16); afInitRate(filesetup, AF_DEFAULT_TRACK, (float) SAMPLE_RATE); afInitFileFormat(filesetup, AF_FILE_WAVE); afInitChannels(filesetup, AF_DEFAULT_TRACK, 1); rxhandle = afOpenFile("rxfax.wav", "w", filesetup); if (rxhandle == NULL) { fprintf(stderr, " Failed to open fax audio file\n"); exit(2); } txhandle = afOpenFile("txfax.wav", "w", filesetup); if (txhandle == NULL) { fprintf(stderr, " Failed to open fax audio file\n"); exit(2); } if (argc < 1) { fprintf(stderr, "Usage: testcall [call]\n"); exit(1); } /*endif*/ uc_start(); pthread_attr_init(&attr); pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED); pthread_mutex_init(&mutex, NULL); for (chan = 0; chan < 5/*30*/; chan++) { chan_stuff[chan].sig_fd = open("/dev/zap/channel", O_RDWR | O_NONBLOCK); if (chan_stuff[chan].sig_fd < 0) { fprintf(stderr, "Failed to open channel: %s\n", strerror(errno)); exit(1); } /*endif*/ chan_stuff[chan].fd = chan_stuff[chan].sig_fd; /* Allow for the missing channel at TS16 */ chanx = chan + 1 + (chan + 15)%30; chanx = chan + 125; if (ioctl(chan_stuff[chan].fd, ZT_SPECIFY, &chanx)) { fprintf(stderr, "Failed to specify channel %d: %s\n", chanx, strerror(errno)); exit(1); } /*endif*/ if (ioctl(chan_stuff[chan].fd, ZT_GET_BUFINFO, &b)) { fprintf(stderr, "Unable to get buffer info on channel %d: %s\n", chanx, strerror(errno)); exit(1); } /*endif*/ printf ("%d %d %d %d %d %d\n", b.rxbufpolicy, b.txbufpolicy, b.numbufs, b.bufsize, b.readbufs, b.writebufs); b.rxbufpolicy = ZT_POLICY_IMMEDIATE; b.txbufpolicy = ZT_POLICY_IMMEDIATE; b.numbufs = 4; b.bufsize = 160; if (ioctl(chan_stuff[chan].fd, ZT_SET_BUFINFO, &b)) { fprintf(stderr, "Unable to set buffer info on channel %d: %s\n", chanx, strerror(errno)); exit(1); } /*endif*/ if (ioctl(chan_stuff[chan].fd, ZT_GET_BUFINFO, &b)) { fprintf(stderr, "Unable to get buffer info on channel %d: %s\n", chanx, strerror(errno)); exit(1); } /*endif*/ for (j = 0; j < 256; j++) { g.rxgain[j] = j; g.txgain[j] = j; } /*endif*/ ioctl(chan_stuff[chan].fd, ZT_SETGAINS, &g); printf("%d %d %d %d %d %d\n", b.rxbufpolicy, b.txbufpolicy, b.numbufs, b.bufsize, b.readbufs, b.writebufs); if (argc > 1) caller_mode = TRUE; /*endif*/ chan_stuff[chan].chan = chan; sprintf(dev_name, "Chan %2d:", chanx); chan_stuff[chan].tag = strdup(dev_name); sprintf(chan_stuff[chan].originating_number, "%d", 987654321 + chan); sprintf(chan_stuff[chan].destination_number, "%d", 1234 + chan); printf("Thread for channel %d\n", chan); if (pthread_create(&chan_stuff[chan].thread, &attr, run_uc, &chan_stuff[chan].chan)) exit(2); /*endif*/ } /*endfor*/ for (;;) { sleep(5); printf("Main thread\n"); } /*endfor*/ return 0; } /*- End of function --------------------------------------------------------*/ #else int main(int argc, char *argv[]) { printf("This program was not built with Unicall available\n"); } /*- End of function --------------------------------------------------------*/ #endif /*- End of file ------------------------------------------------------------*/