freeswitch/libs/spandsp/tests/testfax.c

653 lines
21 KiB
C

/*
* 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.32 2008/05/13 13:17:26 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 <audiofile.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 AFfilehandle rxhandle;
static AFfilehandle 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 = afWriteFrames(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);
afWriteFrames(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 == AF_NULL_FILEHANDLE)
{
fprintf(stderr, " Failed to open fax audio file\n");
exit(2);
}
txhandle = afOpenFile("txfax.wav", "w", filesetup);
if (txhandle == AF_NULL_FILEHANDLE)
{
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 ------------------------------------------------------------*/