Mercurial > hg > audiostuff
diff spandsp-0.0.6pre17/tests/testfax.c @ 4:26cd8f1ef0b1
import spandsp-0.0.6pre17
author | Peter Meerwald <pmeerw@cosy.sbg.ac.at> |
---|---|
date | Fri, 25 Jun 2010 15:50:58 +0200 |
parents | |
children |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/spandsp-0.0.6pre17/tests/testfax.c Fri Jun 25 15:50:58 2010 +0200 @@ -0,0 +1,652 @@ +/* + * 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 ------------------------------------------------------------*/