8932f0a4c0b145fd184292ddb04ce98628a420f4
[asterisk/asterisk.git] / channels / chan_zap.c
1 /*
2  * Asterisk -- A telephony toolkit for Linux.
3  *
4  * Zaptel Pseudo TDM interface 
5  * 
6  * Copyright (C) 2003 Digium
7  *
8  * Mark Spencer <markster@digium.com>
9  *
10  * This program is free software, distributed under the terms of
11  * the GNU General Public License
12  */
13
14 #include <stdio.h>
15 #include <string.h>
16 #include <asterisk/lock.h>
17 #include <asterisk/channel.h>
18 #include <asterisk/channel_pvt.h>
19 #include <asterisk/config.h>
20 #include <asterisk/logger.h>
21 #include <asterisk/module.h>
22 #include <asterisk/pbx.h>
23 #include <asterisk/options.h>
24 #include <asterisk/file.h>
25 #include <asterisk/ulaw.h>
26 #include <asterisk/alaw.h>
27 #include <asterisk/callerid.h>
28 #include <asterisk/adsi.h>
29 #include <asterisk/cli.h>
30 #include <asterisk/cdr.h>
31 #include <asterisk/parking.h>
32 #include <asterisk/musiconhold.h>
33 #include <asterisk/say.h>
34 #include <asterisk/tdd.h>
35 #include <asterisk/app.h>
36 #include <asterisk/dsp.h>
37 #include <asterisk/astdb.h>
38 #include <sys/signal.h>
39 #include <sys/select.h>
40 #include <errno.h>
41 #include <stdlib.h>
42 #include <stdint.h>
43 #include <unistd.h>
44 #include <sys/ioctl.h>
45 #include <linux/zaptel.h>
46 #include <math.h>
47 #include <tonezone.h>
48 #include <ctype.h>
49 #ifdef ZAPATA_PRI
50 #include <libpri.h>
51 #endif
52 #ifdef ZAPATA_R2
53 #include <libmfcr2.h>
54 #endif
55
56 #include "../asterisk.h"
57
58 /* 
59    XXX 
60    XXX   We definitely need to lock the private structure in zt_read and such 
61    XXX  
62  */
63
64
65 /*
66  * Define ZHONE_HACK to cause us to go off hook and then back on hook when
67  * the user hangs up to reset the state machine so ring works properly.
68  * This is used to be able to support kewlstart by putting the zhone in
69  * groundstart mode since their forward disconnect supervision is entirely
70  * broken even though their documentation says it isn't and their support
71  * is entirely unwilling to provide any assistance with their channel banks
72  * even though their web site says they support their products for life.
73  */
74
75 /* #define ZHONE_HACK */
76
77 /* Typically, how many rings before we should send Caller*ID */
78 #define DEFAULT_CIDRINGS 1
79
80 #define CHANNEL_PSEUDO -12
81
82 #define AST_LAW(p) (((p)->law == ZT_LAW_ALAW) ? AST_FORMAT_ALAW : AST_FORMAT_ULAW)
83
84 static char *desc = "Zapata Telephony"
85 #ifdef ZAPATA_PRI
86                " w/PRI"
87 #endif
88 #ifdef ZAPATA_R2
89                " w/R2"
90 #endif
91 ;
92
93 static char *tdesc = "Zapata Telephony Driver"
94 #ifdef ZAPATA_PRI
95                " w/PRI"
96 #endif
97 #ifdef ZAPATA_R2
98                " w/R2"
99 #endif
100 ;
101
102 static char *type = "Zap";
103 static char *typecompat = "Tor";        /* Retain compatibility with chan_tor */
104 static char *config = "zapata.conf";
105
106 #define SIG_EM          ZT_SIG_EM
107 #define SIG_EMWINK      (0x10000 | ZT_SIG_EM)
108 #define SIG_FEATD       (0x20000 | ZT_SIG_EM)
109 #define SIG_FEATDMF     (0x40000 | ZT_SIG_EM)
110 #define SIG_FEATB       (0x80000 | ZT_SIG_EM)
111 #define SIG_FXSLS       ZT_SIG_FXSLS
112 #define SIG_FXSGS       ZT_SIG_FXSGS
113 #define SIG_FXSKS       ZT_SIG_FXSKS
114 #define SIG_FXOLS       ZT_SIG_FXOLS
115 #define SIG_FXOGS       ZT_SIG_FXOGS
116 #define SIG_FXOKS       ZT_SIG_FXOKS
117 #define SIG_PRI         ZT_SIG_CLEAR
118 #define SIG_R2          ZT_SIG_CAS
119 #define SIG_SF          ZT_SIG_SF
120 #define SIG_SFWINK      (0x10000 | ZT_SIG_SF)
121 #define SIG_SF_FEATD    (0x20000 | ZT_SIG_SF)
122 #define SIG_SF_FEATDMF  (0x40000 | ZT_SIG_SF)
123 #define SIG_SF_FEATB    (0x80000 | ZT_SIG_SF)
124
125 #define NUM_SPANS       32
126 #define RESET_INTERVAL  3600    /* How often (in seconds) to reset unused channels */
127
128 #define CHAN_PSEUDO     -2
129
130 static char context[AST_MAX_EXTENSION] = "default";
131 static char callerid[256] = "";
132
133 static char language[MAX_LANGUAGE] = "";
134 static char musicclass[MAX_LANGUAGE] = "";
135
136 static int use_callerid = 1;
137
138 static int cur_signalling = -1;
139
140 static unsigned int cur_group = 0;
141 static unsigned int cur_callergroup = 0;
142 static unsigned int cur_pickupgroup = 0;
143 static int relaxdtmf = 0;
144
145 static int immediate = 0;
146
147 static int stripmsd = 0;
148
149 static int callwaiting = 0;
150
151 static int callwaitingcallerid = 0;
152
153 static int hidecallerid = 0;
154
155 static int callreturn = 0;
156
157 static int threewaycalling = 0;
158
159 static int transfer = 0;
160
161 static int cancallforward = 0;
162
163 static float rxgain = 0.0;
164
165 static float txgain = 0.0;
166
167 static int echocancel;
168
169 static int echocanbridged = 0;
170
171 static int busydetect = 0;
172
173 static int busycount = 3;
174
175 static int callprogress = 0;
176
177 static char accountcode[20] = "";
178
179 static char mailbox[AST_MAX_EXTENSION];
180
181 static int amaflags = 0;
182
183 static int adsi = 0;
184
185 #ifdef ZAPATA_PRI
186 static int minunused = 2;
187 static int minidle = 0;
188 static char idleext[AST_MAX_EXTENSION];
189 static char idledial[AST_MAX_EXTENSION];
190 #endif
191
192 /* Wait up to 16 seconds for first digit (FXO logic) */
193 static int firstdigittimeout = 16000;
194
195 /* How long to wait for following digits (FXO logic) */
196 static int gendigittimeout = 8000;
197
198 /* How long to wait for an extra digit, if there is an ambiguous match */
199 static int matchdigittimeout = 3000;
200
201 static int usecnt =0;
202 static pthread_mutex_t usecnt_lock = AST_MUTEX_INITIALIZER;
203
204 /* Protect the interface list (of zt_pvt's) */
205 static pthread_mutex_t iflock = AST_MUTEX_INITIALIZER;
206
207 /* Protect the monitoring thread, so only one process can kill or start it, and not
208    when it's doing something critical. */
209 static pthread_mutex_t monlock = AST_MUTEX_INITIALIZER;
210
211 /* This is the thread for the monitor which checks for input on the channels
212    which are not currently in use.  */
213 static pthread_t monitor_thread = 0;
214
215 static int restart_monitor(void);
216
217 static int zt_bridge(struct ast_channel *c0, struct ast_channel *c1, int flags, struct ast_frame **fo, struct ast_channel **rc);
218
219 static int zt_sendtext(struct ast_channel *c, char *text);
220
221 static inline int zt_get_event(int fd)
222 {
223         /* Avoid the silly zt_getevent which ignores a bunch of events */
224         int j;
225         if (ioctl(fd, ZT_GETEVENT, &j) == -1) return -1;
226         return j;
227 }
228
229 static inline int zt_wait_event(int fd)
230 {
231         /* Avoid the silly zt_waitevent which ignores a bunch of events */
232         int i,j=0;
233         i = ZT_IOMUX_SIGEVENT;
234         if (ioctl(fd, ZT_IOMUX, &i) == -1) return -1;
235         if (ioctl(fd, ZT_GETEVENT, &j) == -1) return -1;
236         return j;
237 }
238
239 /* Chunk size to read -- we use 20ms chunks to make things happy.  */   
240 #define READ_SIZE 160
241
242 #define MASK_AVAIL              (1 << 0)                /* Channel available for PRI use */
243 #define MASK_INUSE              (1 << 1)                /* Channel currently in use */
244
245 #define CALLWAITING_SILENT_SAMPLES      ( (300 * 8) / READ_SIZE) /* 300 ms */
246 #define CALLWAITING_REPEAT_SAMPLES      ( (10000 * 8) / READ_SIZE) /* 300 ms */
247 #define CIDCW_EXPIRE_SAMPLES            ( (500 * 8) / READ_SIZE) /* 500 ms */
248 #define MIN_MS_SINCE_FLASH                      ( (2000) )      /* 2000 ms */
249 #define RINGT                                           ( (8000 * 8) / READ_SIZE)
250
251 struct zt_pvt;
252
253
254 #ifdef ZAPATA_R2
255 static int r2prot = -1;
256 #endif
257
258
259 #ifdef ZAPATA_PRI
260 struct zt_pri {
261         pthread_t master;                       /* Thread of master */
262         pthread_mutex_t lock;           /* Mutex */
263         char idleext[AST_MAX_EXTENSION];                /* Where to idle extra calls */
264         char idlecontext[AST_MAX_EXTENSION];            /* What context to use for idle */
265         char idledial[AST_MAX_EXTENSION];               /* What to dial before dumping */
266         int minunused;                          /* Min # of channels to keep empty */
267         int minidle;                            /* Min # of "idling" calls to keep active */
268         int nodetype;                           /* Node type */
269         int switchtype;                         /* Type of switch to emulate */
270         int dialplan;                   /* Dialing plan */
271         int dchannel;                   /* What channel the dchannel is on */
272         int channels;                   /* Num of chans in span (31 or 24) */
273         struct pri *pri;
274         int debug;
275         int fd;
276         int up;
277         int offset;
278         int span;
279         int chanmask[32];                       /* Channel status */
280         int resetting;
281         int resetchannel;
282         time_t lastreset;
283         struct zt_pvt *pvt[32]; /* Member channel pvt structs */
284         struct zt_channel *chan[32];    /* Channels on each line */
285 };
286
287
288 static struct zt_pri pris[NUM_SPANS];
289
290 static int pritype = PRI_CPE;
291
292 #if 0
293 #define DEFAULT_PRI_DEBUG (PRI_DEBUG_Q931_DUMP | PRI_DEBUG_Q921_DUMP | PRI_DEBUG_Q921_RAW | PRI_DEBUG_Q921_STATE)
294 #else
295 #define DEFAULT_PRI_DEBUG 0
296 #endif
297
298 static inline void pri_rel(struct zt_pri *pri)
299 {
300         ast_pthread_mutex_unlock(&pri->lock);
301 }
302
303 static int switchtype = PRI_SWITCH_NI2;
304 static int dialplan = PRI_NATIONAL_ISDN + 1;
305
306 #endif
307
308 #define SUB_REAL                0                       /* Active call */
309 #define SUB_CALLWAIT    1                       /* Call-Waiting call on hold */
310 #define SUB_THREEWAY    2                       /* Three-way call */
311
312 static char *subnames[] = {
313         "Real",
314         "Callwait",
315         "Threeway"
316 };
317
318 struct zt_subchannel {
319         int zfd;
320         struct ast_channel *owner;
321         int chan;
322         short buffer[AST_FRIENDLY_OFFSET/2 + READ_SIZE];
323         struct ast_frame f;             /* One frame for each channel.  How did this ever work before? */
324         int needringing;
325         int needcallerid;
326         int needanswer;
327         int linear;
328         int inthreeway;
329         int curconfno;                  /* What conference we're currently in */
330 };
331
332 #define CONF_USER_REAL          (1 << 0)
333 #define CONF_USER_THIRDCALL     (1 << 1)
334
335 #define MAX_SLAVES      4
336
337 static struct zt_pvt {
338         pthread_mutex_t lock;
339         struct ast_channel *owner;      /* Our current active owner (if applicable) */
340                 /* Up to three channels can be associated with this call */
341                 
342         struct zt_subchannel sub_unused;        /* Just a safety precaution */
343         struct zt_subchannel subs[3];   /* Sub-channels */
344         struct zt_confinfo saveconf;    /* Saved conference info */
345
346         struct zt_pvt *slaves[MAX_SLAVES];      /* Slave to us (follows our conferencing) */
347         struct zt_pvt *master;  /* Master to us (we follow their conferencing) */
348         int inconference;               /* If our real should be in the conference */
349         
350         int sig;                                        /* Signalling style */
351         int radio;                              /* radio type */
352         int firstradio;                         /* first radio flag */
353         float rxgain;
354         float txgain;
355         struct zt_pvt *next;                    /* Next channel in list */
356         char context[AST_MAX_EXTENSION];
357         char exten[AST_MAX_EXTENSION];
358         char language[MAX_LANGUAGE];
359         char musicclass[MAX_LANGUAGE];
360         char callerid[AST_MAX_EXTENSION];
361         char lastcallerid[AST_MAX_EXTENSION];
362         char callwaitcid[AST_MAX_EXTENSION];
363         char rdnis[AST_MAX_EXTENSION];
364         unsigned int group;
365         int law;
366         int confno;                                     /* Our conference */
367         int confusers;                          /* Who is using our conference */
368         int propconfno;                         /* Propagated conference number */
369         unsigned int callgroup;
370         unsigned int pickupgroup;
371         int immediate;                          /* Answer before getting digits? */
372         int channel;                            /* Channel Number */
373         int span;                                       /* Span number */
374         int dialing;
375         int dialednone;
376         int use_callerid;                       /* Whether or not to use caller id on this channel */
377         int hidecallerid;
378         int callreturn;
379         int permhidecallerid;           /* Whether to hide our outgoing caller ID or not */
380         int callwaitingrepeat;          /* How many samples to wait before repeating call waiting */
381         int cidcwexpire;                        /* When to expire our muting for CID/CW */
382         unsigned char *cidspill;
383         int cidpos;
384         int cidlen;
385         int ringt;
386         int stripmsd;
387         int callwaiting;
388         int callwaitcas;
389         int callwaitrings;
390         int echocancel;
391         int echocanbridged;
392         int echocanon;
393         int permcallwaiting;
394         int callwaitingcallerid;
395         int threewaycalling;
396         int transfer;
397         int digital;
398         int outgoing;
399         int dnd;
400         int busydetect;
401         int busycount;
402         int callprogress;
403         struct timeval flashtime;       /* Last flash-hook time */
404         struct ast_dsp *dsp;
405         int cref;                                       /* Call reference number */
406         ZT_DIAL_OPERATION dop;
407         int destroy;
408         int ignoredtmf;                         
409         int inalarm;
410         char accountcode[20];           /* Account code */
411         int amaflags;                           /* AMA Flags */
412         char didtdd;                    /* flag to say its done it once */
413         struct tdd_state *tdd;          /* TDD flag */
414         int adsi;
415         int cancallforward;
416         char call_forward[AST_MAX_EXTENSION];
417         char mailbox[AST_MAX_EXTENSION];
418         int onhooktime;
419         int msgstate;
420         
421         int confirmanswer;              /* Wait for '#' to confirm answer */
422         int distinctivering;    /* Which distinctivering to use */
423         int cidrings;                   /* Which ring to deliver CID on */
424         
425         int faxhandled;                 /* Has a fax tone already been handled? */
426         
427         char mate;                      /* flag to say its in MATE mode */
428         int pulsedial;          /* whether a pulse dial phone is detected */
429         int dtmfrelax;          /* whether to run in relaxed DTMF mode */
430 #ifdef ZAPATA_PRI
431         struct zt_pri *pri;
432         q931_call *call;
433         int isidlecall;
434         int resetting;
435         int prioffset;
436         int alreadyhungup;
437 #ifdef PRI_EVENT_PROCEEDING
438         int proceeding;
439 #endif
440 #endif  
441 #ifdef ZAPATA_R2
442         int r2prot;
443         mfcr2_t *r2;
444         int hasr2call;
445         int r2blocked;
446         int sigchecked;
447 #endif  
448 } *iflist = NULL;
449
450 #ifdef ZAPATA_PRI
451 static inline int pri_grab(struct zt_pvt *pvt, struct zt_pri *pri)
452 {
453         int res;
454         /* Grab the lock first */
455         do {
456             res = pthread_mutex_trylock(&pri->lock);
457                 if (res) {
458                         ast_pthread_mutex_unlock(&pvt->lock);
459                         /* Release the lock and try again */
460                         usleep(1);
461                         ast_pthread_mutex_lock(&pvt->lock);
462                 }
463         } while(res);
464         /* Then break the select */
465         pthread_kill(pri->master, SIGURG);
466         return 0;
467 }
468 #endif
469
470 static struct zt_ring_cadence cadences[] = {
471         { { 125, 125, 2000, 4000 } },                   /* Quick chirp followed by normal ring */
472         { { 250, 250, 500, 1000, 250, 250, 500, 4000 } }, /* British style ring */
473         { { 125, 125, 125, 125, 125, 4000 } },  /* Three short bursts */
474         { { 1000, 500, 2500, 5000 } },  /* Long ring */
475 };
476
477 static int cidrings[] = {
478         2,                                                                              /* Right after first long ring */
479         4,                                                                              /* Right after long part */
480         3,                                                                              /* After third chirp */
481         2,                                                                              /* Second spell */
482 };
483
484 #define NUM_CADENCE (sizeof(cadences) / sizeof(cadences[0]))
485
486 #define ISTRUNK(p) ((p->sig == SIG_FXSLS) || (p->sig == SIG_FXSKS) || \
487                         (p->sig == SIG_FXSGS) || (p->sig == SIG_PRI))
488
489 #define CANBUSYDETECT(p) (ISTRUNK(p) || (p->sig & (SIG_EM | SIG_SF)) /* || (p->sig & __ZT_SIG_FXO) */)
490 #define CANPROGRESSDETECT(p) (ISTRUNK(p) || (p->sig & (SIG_EM | SIG_SF)) /* || (p->sig & __ZT_SIG_FXO) */)
491
492 static int zt_get_index(struct ast_channel *ast, struct zt_pvt *p, int nullok)
493 {
494         int res;
495         if (p->subs[0].owner == ast)
496                 res = 0;
497         else if (p->subs[1].owner == ast)
498                 res = 1;
499         else if (p->subs[2].owner == ast)
500                 res = 2;
501         else {
502                 res = -1;
503                 if (!nullok)
504                         ast_log(LOG_WARNING, "Unable to get index, and nullok is not asserted\n");
505         }
506         return res;
507 }
508
509 static void swap_subs(struct zt_pvt *p, int a, int b)
510 {
511         int tchan;
512         int tinthreeway;
513         struct ast_channel *towner;
514         struct ast_frame null = { AST_FRAME_NULL, };
515
516         ast_log(LOG_DEBUG, "Swapping %d and %d\n", a, b);
517
518         tchan = p->subs[a].chan;
519         towner = p->subs[a].owner;
520         tinthreeway = p->subs[a].inthreeway;
521
522         p->subs[a].chan = p->subs[b].chan;
523         p->subs[a].owner = p->subs[b].owner;
524         p->subs[a].inthreeway = p->subs[b].inthreeway;
525
526         p->subs[b].chan = tchan;
527         p->subs[b].owner = towner;
528         p->subs[b].inthreeway = tinthreeway;
529
530         if (p->subs[a].owner) {
531                 p->subs[a].owner->fds[0] = p->subs[a].zfd;
532                 ast_queue_frame(p->subs[a].owner, &null, 0);
533         }
534         if (p->subs[b].owner) {
535                 p->subs[b].owner->fds[0] = p->subs[b].zfd;
536                 ast_queue_frame(p->subs[b].owner, &null, 0);
537         }
538         
539 }
540
541 static int zt_open(char *fn)
542 {
543         int fd;
544         int isnum;
545         int chan = 0;
546         int bs;
547         int x;
548         isnum = 1;
549         for (x=0;x<strlen(fn);x++) {
550                 if (!isdigit(fn[x])) {
551                         isnum = 0;
552                         break;
553                 }
554         }
555         if (isnum) {
556                 chan = atoi(fn);
557                 if (chan < 1) {
558                         ast_log(LOG_WARNING, "Invalid channel number '%s'\n", fn);
559                         return -1;
560                 }
561                 fn = "/dev/zap/channel";
562         }
563         fd = open(fn, O_RDWR | O_NONBLOCK);
564         if (fd < 0) {
565                 ast_log(LOG_WARNING, "Unable to open '%s': %s\n", fn, strerror(errno));
566                 return -1;
567         }
568         if (chan) {
569                 if (ioctl(fd, ZT_SPECIFY, &chan)) {
570                         x = errno;
571                         close(fd);
572                         errno = x;
573                         ast_log(LOG_WARNING, "Unable to specify channel %d: %s\n", chan, strerror(errno));
574                         return -1;
575                 }
576         }
577         bs = READ_SIZE;
578         if (ioctl(fd, ZT_SET_BLOCKSIZE, &bs) == -1) return -1;
579         return fd;
580 }
581
582 static void zt_close(int fd)
583 {
584         close(fd);
585 }
586
587 int zt_setlinear(int zfd, int linear)
588 {
589         int res;
590         res = ioctl(zfd, ZT_SETLINEAR, &linear);
591         if (res)
592                 return res;
593         return 0;
594 }
595
596
597 int zt_setlaw(int zfd, int law)
598 {
599         int res;
600         res = ioctl(zfd, ZT_SETLAW, &law);
601         if (res)
602                 return res;
603         return 0;
604 }
605
606 static int alloc_sub(struct zt_pvt *p, int x)
607 {
608         ZT_BUFFERINFO bi;
609         int res;
610         if (p->subs[x].zfd < 0) {
611                 p->subs[x].zfd = zt_open("/dev/zap/pseudo");
612                 if (p->subs[x].zfd > -1) {
613                         res = ioctl(p->subs[x].zfd, ZT_GET_BUFINFO, &bi);
614                         if (!res) {
615                                 bi.txbufpolicy = ZT_POLICY_IMMEDIATE;
616                                 bi.rxbufpolicy = ZT_POLICY_IMMEDIATE;
617                                 bi.numbufs = 4;
618                                 res = ioctl(p->subs[x].zfd, ZT_SET_BUFINFO, &bi);
619                                 if (res < 0) {
620                                         ast_log(LOG_WARNING, "Unable to set buffer policy on channel %d\n", x);
621                                 }
622                         } else 
623                                 ast_log(LOG_WARNING, "Unable to check buffer policy on channel %d\n", x);
624                         if (ioctl(p->subs[x].zfd, ZT_CHANNO, &p->subs[x].chan) == 1) {
625                                 ast_log(LOG_WARNING,"Unable to get channel number for pseudo channel on FD %d\n",p->subs[x].zfd);
626                                 zt_close(p->subs[x].zfd);
627                                 p->subs[x].zfd = -1;
628                                 return -1;
629                         }
630                         if (option_debug)
631                                 ast_log(LOG_DEBUG, "Allocated %s subchannel on FD %d channel %d\n", subnames[x], p->subs[x].zfd, p->subs[x].chan);
632                         return 0;
633                 } else
634                         ast_log(LOG_WARNING, "Unable to open pseudo channel: %s\n", strerror(errno));
635                 return -1;
636         }
637         ast_log(LOG_WARNING, "%s subchannel of %d already in use\n", subnames[x], p->channel);
638         return -1;
639 }
640
641 static int unalloc_sub(struct zt_pvt *p, int x)
642 {
643         if (!x) {
644                 ast_log(LOG_WARNING, "Trying to unalloc the real channel %d?!?\n", p->channel);
645                 return -1;
646         }
647         ast_log(LOG_DEBUG, "Released sub %d of channel %d\n", x, p->channel);
648         if (p->subs[x].zfd > -1) {
649                 zt_close(p->subs[x].zfd);
650         }
651         p->subs[x].zfd = -1;
652         p->subs[x].linear = 0;
653         p->subs[x].chan = 0;
654         p->subs[x].owner = NULL;
655         p->subs[x].inthreeway = 0;
656         p->subs[x].curconfno = -1;
657         return 0;
658 }
659
660 static int zt_digit(struct ast_channel *ast, char digit)
661 {
662         ZT_DIAL_OPERATION zo;
663         struct zt_pvt *p;
664         int res = 0;
665         int index;
666         p = ast->pvt->pvt;
667         index = zt_get_index(ast, p, 0);
668         if (index == SUB_REAL) {
669 #ifdef ZAPATA_PRI
670 #ifdef PRI_EVENT_PROCEEDING
671                 if (p->sig == SIG_PRI && ast->_state == AST_STATE_DIALING && !p->proceeding) {
672 #else
673                 if (p->sig == SIG_PRI && ast->_state == AST_STATE_DIALING) {
674 #endif
675                         pri_information(p->pri->pri,p->call,digit);
676                 } else {
677 #else
678                 {
679 #endif
680                         zo.op = ZT_DIAL_OP_APPEND;
681                         zo.dialstr[0] = 'T';
682                         zo.dialstr[1] = digit;
683                         zo.dialstr[2] = 0;
684                         if ((res = ioctl(p->subs[SUB_REAL].zfd, ZT_DIAL, &zo)))
685                                 ast_log(LOG_WARNING, "Couldn't dial digit %c\n", digit);
686                         else
687                                 p->dialing = 1;
688                 }
689         }
690         
691         return res;
692 }
693
694 static char *events[] = {
695         "No event",
696         "On hook",
697         "Ring/Answered",
698         "Wink/Flash",
699         "Alarm",
700         "No more alarm",
701                 "HDLC Abort",
702                 "HDLC Overrun",
703                 "HDLC Bad FCS",
704                 "Dial Complete",
705                 "Ringer On",
706                 "Ringer Off",
707                 "Hook Transition Complete",
708                 "Bits Changed",
709                 "Pulse Start"
710 };
711
712 static struct {
713         int alarm;
714         char *name;
715 } alarms[] = {
716         { ZT_ALARM_RED, "Red Alarm" },
717         { ZT_ALARM_YELLOW, "Yellow Alarm" },
718         { ZT_ALARM_BLUE, "Blue Alarm" },
719         { ZT_ALARM_RECOVER, "Recovering" },
720         { ZT_ALARM_LOOPBACK, "Loopback" },
721         { ZT_ALARM_NOTOPEN, "Not Open" },
722         { ZT_ALARM_NONE, "None" },
723 };
724
725 static char *alarm2str(int alarm)
726 {
727         int x;
728         for (x=0;x<sizeof(alarms) / sizeof(alarms[0]); x++) {
729                 if (alarms[x].alarm & alarm)
730                         return alarms[x].name;
731         }
732         return alarm ? "Unknown Alarm" : "No Alarm";
733 }
734
735 static char *event2str(int event)
736 {
737         static char buf[256];
738         if ((event < 15) && (event > -1))
739                 return events[event];
740         sprintf(buf, "Event %d", event);
741         return buf;
742 }
743
744 #ifdef ZAPATA_R2
745 static int str2r2prot(char *swtype)
746 {
747     if (!strcasecmp(swtype, "ar"))
748         return MFCR2_PROT_ARGENTINA;
749     /*endif*/
750     if (!strcasecmp(swtype, "cn"))
751         return MFCR2_PROT_CHINA;
752     /*endif*/
753     if (!strcasecmp(swtype, "kr"))
754         return MFCR2_PROT_KOREA;
755     /*endif*/
756     return -1;
757 }
758 #endif
759
760 static char *sig2str(int sig)
761 {
762         static char buf[256];
763         switch(sig) {
764         case SIG_EM:
765                 return "E & M Immediate";
766         case SIG_EMWINK:
767                 return "E & M Wink";
768         case SIG_FEATD:
769                 return "Feature Group D (DTMF)";
770         case SIG_FEATDMF:
771                 return "Feature Group D (MF)";
772         case SIG_FEATB:
773                 return "Feature Group B (MF)";
774         case SIG_FXSLS:
775                 return "FXS Loopstart";
776         case SIG_FXSGS:
777                 return "FXS Groundstart";
778         case SIG_FXSKS:
779                 return "FXS Kewlstart";
780         case SIG_FXOLS:
781                 return "FXO Loopstart";
782         case SIG_FXOGS:
783                 return "FXO Groundstart";
784         case SIG_FXOKS:
785                 return "FXO Kewlstart";
786         case SIG_PRI:
787                 return "PRI Signalling";
788         case SIG_R2:
789                 return "R2 Signalling";
790         case SIG_SF:
791                 return "SF (Tone) Signalling Immediate";
792         case SIG_SFWINK:
793                 return "SF (Tone) Signalling Wink";
794         case SIG_SF_FEATD:
795                 return "SF (Tone) Signalling with Feature Group D (DTMF)";
796         case SIG_SF_FEATDMF:
797                 return "SF (Tone) Signallong with Feature Group D (MF)";
798         case SIG_SF_FEATB:
799                 return "SF (Tone) Signalling with Feature Group B (MF)";
800         case 0:
801                 return "Pseudo Signalling";
802         default:
803                 snprintf(buf, sizeof(buf), "Unknown signalling %d", sig);
804                 return buf;
805         }
806 }
807
808 static int conf_add(int *confno, struct zt_subchannel *c, int index)
809 {
810         /* If the conference already exists, and we're already in it
811            don't bother doing anything */
812         ZT_CONFINFO zi;
813         if ((*confno > 0) && (c->curconfno == *confno))
814                 return 0; 
815         if (c->curconfno > 0) {
816                 ast_log(LOG_WARNING, "Subchannel %d is already in conference %d, moving to %d\n", c->zfd, c->curconfno, *confno);
817         }
818         if (c->zfd < 0)
819                 return 0;
820         memset(&zi, 0, sizeof(zi));
821         zi.chan = 0;
822         zi.confno = *confno;
823         if (!index) {
824                 /* Real-side and pseudo-side both participate in conference */
825                 zi.confmode = ZT_CONF_REALANDPSEUDO | ZT_CONF_TALKER | ZT_CONF_LISTENER |
826                                                         ZT_CONF_PSEUDO_TALKER | ZT_CONF_PSEUDO_LISTENER;
827         } else
828                 zi.confmode = ZT_CONF_CONF | ZT_CONF_TALKER | ZT_CONF_LISTENER;
829         if (ioctl(c->zfd, ZT_SETCONF, &zi)) {
830                 ast_log(LOG_WARNING, "Failed to add %d to conference %d\n", c->zfd, *confno);
831                 return -1;
832         }
833         c->curconfno = zi.confno;
834         *confno = zi.confno;
835         ast_log(LOG_DEBUG, "Added %d to conference %d\n", c->zfd, *confno);
836         return 0;
837 }
838
839 static int conf_del(int *confno, struct zt_subchannel *c, int index)
840 {
841         ZT_CONFINFO zi;
842                 /* Can't delete from this conference if it's not 0 */
843         if ((*confno < 1) ||
844                 /* Can't delete if there's no zfd */
845                 (c->zfd < 0) ||
846                 /* Don't delete from the conference if it's not our conference */
847                 (*confno != c->curconfno) 
848                 /* Don't delete if we don't think it's conferenced at all (implied) */
849                 ) return 0;
850         memset(&zi, 0, sizeof(zi));
851         zi.chan = 0;
852         zi.confno = 0;
853         zi.confmode = 0;
854         if (ioctl(c->zfd, ZT_SETCONF, &zi)) {
855                 ast_log(LOG_WARNING, "Failed to drop %d from conference %d\n", c->zfd, *confno);
856                 return -1;
857         }
858         c->curconfno = -1;
859         ast_log(LOG_DEBUG, "Removed %d from conference %d\n", c->zfd, *confno);
860         return 0;
861 }
862
863 static int update_conf(struct zt_pvt *p)
864 {
865         int needconf = 0;
866         int x;
867         /* Update conference state in a stateless fashion */
868         /* Start with the obvious, general stuff */
869         for (x=0;x<3;x++) {
870                 if ((p->subs[x].zfd > -1) && p->subs[x].inthreeway) {
871                         conf_add(&p->confno, &p->subs[x], x);
872                         needconf++;
873                 } else {
874                         conf_del(&p->confno, &p->subs[x], x);
875                 }
876         }
877         /* If we have a slave, add him to our conference now */
878         for (x=0;x<MAX_SLAVES;x++) {
879                 if (p->slaves[x]) {
880                         conf_add(&p->confno, &p->slaves[x]->subs[SUB_REAL], SUB_REAL);
881                         needconf++;
882                 }
883         }
884         /* If we're supposed to be in there, do so now */
885         if (p->inconference && !p->subs[SUB_REAL].inthreeway) {
886                 conf_add(&p->confno, &p->subs[SUB_REAL], SUB_REAL);
887                 needconf++;
888         }
889         /* If we have a master, add ourselves to his conference */
890         if (p->master) 
891                 conf_add(&p->master->confno, &p->subs[SUB_REAL], SUB_REAL);
892         if (!needconf) {
893                 /* Nobody is left (or should be left) in our conference.  
894                    Kill it.  */
895                 p->confno = -1;
896         }
897         ast_log(LOG_DEBUG, "Updated conferencing on %d, with %d conference users\n", p->channel, needconf);
898         return 0;
899 }
900
901 static void zt_enable_ec(struct zt_pvt *p)
902 {
903         int x;
904         int res;
905         if (p->echocanon) {
906                 ast_log(LOG_DEBUG, "Echo cancellation already on\n");
907                 return;
908         }
909         if (p && p->echocancel) {
910                 if (p->sig == SIG_PRI) {
911                         x = 1;
912                         res = ioctl(p->subs[SUB_REAL].zfd, ZT_AUDIOMODE, &x);
913                         if (res)
914                                 ast_log(LOG_WARNING, "Unable to enable echo cancellation on channel %d\n", p->channel);
915                 }
916                 x = p->echocancel;
917                 res = ioctl(p->subs[SUB_REAL].zfd, ZT_ECHOCANCEL, &x);
918                 if (res) 
919                         ast_log(LOG_WARNING, "Unable to enable echo cancellation on channel %d\n", p->channel);
920                 else {
921                         p->echocanon = 1;
922                         ast_log(LOG_DEBUG, "Enabled echo cancellation on channel %d\n", p->channel);
923                 }
924         } else
925                 ast_log(LOG_DEBUG, "No echocancellation requested\n");
926 }
927
928 static void zt_disable_ec(struct zt_pvt *p)
929 {
930         int x;
931         int res;
932         if (p->echocancel) {
933                 x = 0;
934                 res = ioctl(p->subs[SUB_REAL].zfd, ZT_ECHOCANCEL, &x);
935                 if (res) 
936                         ast_log(LOG_WARNING, "Unable to disable echo cancellation on channel %d\n", p->channel);
937                 else
938                         ast_log(LOG_DEBUG, "disabled echo cancellation on channel %d\n", p->channel);
939         }
940         p->echocanon = 0;
941 }
942
943 int set_actual_gain(int fd, int chan, float rxgain, float txgain, int law)
944 {
945         struct  zt_gains g;
946         float ltxgain;
947         float lrxgain;
948         int j,k;
949         g.chan = chan;
950         if ((rxgain != 0.0)  || (txgain != 0.0)) {
951                 /* caluculate linear value of tx gain */
952                 ltxgain = pow(10.0,txgain / 20.0);
953                 /* caluculate linear value of rx gain */
954                 lrxgain = pow(10.0,rxgain / 20.0);
955                 if (law == ZT_LAW_ALAW) {
956                         for (j=0;j<256;j++) {
957                                 k = (int)(((float)AST_ALAW(j)) * lrxgain);
958                                 if (k > 32767) k = 32767;
959                                 if (k < -32767) k = -32767;
960                                 g.rxgain[j] = AST_LIN2A(k);
961                                 k = (int)(((float)AST_ALAW(j)) * ltxgain);
962                                 if (k > 32767) k = 32767;
963                                 if (k < -32767) k = -32767;
964                                 g.txgain[j] = AST_LIN2A(k);
965                         }
966                 } else {
967                         for (j=0;j<256;j++) {
968                                 k = (int)(((float)AST_MULAW(j)) * lrxgain);
969                                 if (k > 32767) k = 32767;
970                                 if (k < -32767) k = -32767;
971                                 g.rxgain[j] = AST_LIN2MU(k);
972                                 k = (int)(((float)AST_MULAW(j)) * ltxgain);
973                                 if (k > 32767) k = 32767;
974                                 if (k < -32767) k = -32767;
975                                 g.txgain[j] = AST_LIN2MU(k);
976                         }
977                 }
978         } else {
979                 for (j=0;j<256;j++) {
980                         g.rxgain[j] = j;
981                         g.txgain[j] = j;
982                 }
983         }
984                 
985           /* set 'em */
986         return(ioctl(fd,ZT_SETGAINS,&g));
987 }
988
989 static inline int zt_set_hook(int fd, int hs)
990 {
991         int x, res;
992         x = hs;
993         res = ioctl(fd, ZT_HOOK, &x);
994         if (res < 0) 
995         {
996                 if (errno == EINPROGRESS) return 0;
997                 ast_log(LOG_WARNING, "zt hook failed: %s\n", strerror(errno));
998         }
999         return res;
1000 }
1001
1002 static inline int zt_confmute(struct zt_pvt *p, int muted)
1003 {
1004         int x, res;
1005         x = muted;
1006         res = ioctl(p->subs[SUB_REAL].zfd, ZT_CONFMUTE, &x);
1007         if (res < 0) 
1008                 ast_log(LOG_WARNING, "zt confmute(%d) failed on channel %d: %s\n", muted, p->channel, strerror(errno));
1009         return res;
1010 }
1011
1012 static int save_conference(struct zt_pvt *p)
1013 {
1014         struct zt_confinfo c;
1015         int res;
1016         if (p->saveconf.confmode) {
1017                 ast_log(LOG_WARNING, "Can't save conference -- already in use\n");
1018                 return -1;
1019         }
1020         p->saveconf.chan = 0;
1021         res = ioctl(p->subs[SUB_REAL].zfd, ZT_GETCONF, &p->saveconf);
1022         if (res) {
1023                 ast_log(LOG_WARNING, "Unable to get conference info: %s\n", strerror(errno));
1024                 p->saveconf.confmode = 0;
1025                 return -1;
1026         }
1027         c.chan = 0;
1028         c.confno = 0;
1029         c.confmode = ZT_CONF_NORMAL;
1030         res = ioctl(p->subs[SUB_REAL].zfd, ZT_SETCONF, &c);
1031         if (res) {
1032                 ast_log(LOG_WARNING, "Unable to set conference info: %s\n", strerror(errno));
1033                 return -1;
1034         }
1035         if (option_debug)
1036                 ast_log(LOG_DEBUG, "Disabled conferencing\n");
1037         return 0;
1038 }
1039
1040 static int restore_conference(struct zt_pvt *p)
1041 {
1042         int res;
1043         if (p->saveconf.confmode) {
1044                 res = ioctl(p->subs[SUB_REAL].zfd, ZT_SETCONF, &p->saveconf);
1045                 p->saveconf.confmode = 0;
1046                 if (res) {
1047                         ast_log(LOG_WARNING, "Unable to restore conference info: %s\n", strerror(errno));
1048                         return -1;
1049                 }
1050         }
1051         if (option_debug)
1052                 ast_log(LOG_DEBUG, "Restored conferencing\n");
1053         return 0;
1054 }
1055
1056 static int send_callerid(struct zt_pvt *p);
1057
1058 int send_cwcidspill(struct zt_pvt *p)
1059 {
1060         p->callwaitcas = 0;
1061         p->cidcwexpire = 0;
1062         p->cidspill = malloc(MAX_CALLERID_SIZE);
1063         if (p->cidspill) {
1064                 memset(p->cidspill, 0x7f, MAX_CALLERID_SIZE);
1065                 p->cidlen = ast_callerid_callwaiting_generate(p->cidspill, p->callwaitcid, AST_LAW(p));
1066                 /* Make sure we account for the end */
1067                 p->cidlen += READ_SIZE * 4;
1068                 p->cidpos = 0;
1069                 send_callerid(p);
1070                 if (option_verbose > 2)
1071                         ast_verbose(VERBOSE_PREFIX_3 "CPE supports Call Waiting Caller*ID.  Sending '%s'\n", p->callwaitcid);
1072         } else return -1;
1073         return 0;
1074 }
1075
1076 static int has_voicemail(struct zt_pvt *p)
1077 {
1078
1079         return ast_app_has_voicemail(p->mailbox);
1080 }
1081
1082 static int send_callerid(struct zt_pvt *p)
1083 {
1084         /* Assumes spill in p->cidspill, p->cidlen in length and we're p->cidpos into it */
1085         int res;
1086         /* Take out of linear mode if necessary */
1087         if (p->subs[SUB_REAL].linear) {
1088                 p->subs[SUB_REAL].linear = 0;
1089                 zt_setlinear(p->subs[SUB_REAL].zfd, 0);
1090         }
1091         while(p->cidpos < p->cidlen) {
1092                 res = write(p->subs[SUB_REAL].zfd, p->cidspill + p->cidpos, p->cidlen - p->cidpos);
1093                 if (res < 0) {
1094                         if (errno == EAGAIN)
1095                                 return 0;
1096                         else {
1097                                 ast_log(LOG_WARNING, "write failed: %s\n", strerror(errno));
1098                                 return -1;
1099                         }
1100                 }
1101                 if (!res)
1102                         return 0;
1103                 p->cidpos += res;
1104         }
1105         free(p->cidspill);
1106         p->cidspill = NULL;
1107         if (p->callwaitcas) {
1108                 /* Wait for CID/CW to expire */
1109                 p->cidcwexpire = CIDCW_EXPIRE_SAMPLES;
1110         } else
1111                 restore_conference(p);
1112         return 0;
1113 }
1114
1115 static int zt_callwait(struct ast_channel *ast)
1116 {
1117         struct zt_pvt *p = ast->pvt->pvt;
1118         p->callwaitingrepeat = CALLWAITING_REPEAT_SAMPLES;
1119         if (p->cidspill) {
1120                 ast_log(LOG_WARNING, "Spill already exists?!?\n");
1121                 free(p->cidspill);
1122         }
1123         p->cidspill = malloc(2400 /* SAS */ + 680 /* CAS */ + READ_SIZE * 4);
1124         if (p->cidspill) {
1125                 save_conference(p);
1126                 /* Silence */
1127                 memset(p->cidspill, 0x7f, 2400 + 600 + READ_SIZE * 4);
1128                 if (!p->callwaitrings && p->callwaitingcallerid) {
1129                         ast_gen_cas(p->cidspill, 1, 2400 + 680, AST_LAW(p));
1130                         p->callwaitcas = 1;
1131                         p->cidlen = 2400 + 680 + READ_SIZE * 4;
1132                 } else {
1133                         ast_gen_cas(p->cidspill, 1, 2400, AST_LAW(p));
1134                         p->callwaitcas = 0;
1135                         p->cidlen = 2400 + READ_SIZE * 4;
1136                 }
1137                 p->cidpos = 0;
1138                 send_callerid(p);
1139         } else {
1140                 ast_log(LOG_WARNING, "Unable to create SAS/CAS spill\n");
1141                 return -1;
1142         }
1143         return 0;
1144 }
1145
1146 static int zt_call(struct ast_channel *ast, char *rdest, int timeout)
1147 {
1148         struct zt_pvt *p = ast->pvt->pvt;
1149         int x, res, index;
1150         char *c, *n, *l;
1151         char *s;
1152         char callerid[256];
1153         char dest[256];
1154         strncpy(dest, rdest, sizeof(dest) - 1);
1155         if ((ast->_state != AST_STATE_DOWN) && (ast->_state != AST_STATE_RESERVED)) {
1156                 ast_log(LOG_WARNING, "zt_call called on %s, neither down nor reserved\n", ast->name);
1157                 return -1;
1158         }
1159         p->dialednone = 0;
1160         if (p->radio)  /* if a radio channel, up immediately */
1161         {
1162                 /* Special pseudo -- automatically up */
1163                 ast_setstate(ast, AST_STATE_UP); 
1164                 return 0;
1165         }
1166         x = ZT_FLUSH_READ | ZT_FLUSH_WRITE;
1167         res = ioctl(p->subs[SUB_REAL].zfd, ZT_FLUSH, &x);
1168         if (res)
1169                 ast_log(LOG_WARNING, "Unable to flush input on channel %d\n", p->channel);
1170         p->outgoing = 1;
1171
1172         switch(p->sig) {
1173         case SIG_FXOLS:
1174         case SIG_FXOGS:
1175         case SIG_FXOKS:
1176                 if (p->owner == ast) {
1177                         /* Normal ring, on hook */
1178                         
1179                         /* Don't send audio while on hook, until the call is answered */
1180                         p->dialing = 1;
1181                         if (p->use_callerid) {
1182                                 /* Generate the Caller-ID spill if desired */
1183                                 if (p->cidspill) {
1184                                         ast_log(LOG_WARNING, "cidspill already exists??\n");
1185                                         free(p->cidspill);
1186                                 }
1187                                 p->cidspill = malloc(MAX_CALLERID_SIZE);
1188                                 p->callwaitcas = 0;
1189                                 if (p->cidspill) {
1190                                         p->cidlen = ast_callerid_generate(p->cidspill, ast->callerid, AST_LAW(p));
1191                                         p->cidpos = 0;
1192                                         send_callerid(p);
1193                                 } else
1194                                         ast_log(LOG_WARNING, "Unable to generate CallerID spill\n");
1195                         }
1196                         /* Select proper cadence */
1197                         if ((p->distinctivering > 0) && (p->distinctivering <= NUM_CADENCE)) {
1198                                 if (ioctl(p->subs[SUB_REAL].zfd, ZT_SETCADENCE, &cadences[p->distinctivering-1]))
1199                                         ast_log(LOG_WARNING, "Unable to set distinctive ring cadence %d on '%s'\n", p->distinctivering, ast->name);
1200                                 p->cidrings = cidrings[p->distinctivering - 1];
1201                         } else {
1202                                 if (ioctl(p->subs[SUB_REAL].zfd, ZT_SETCADENCE, NULL))
1203                                         ast_log(LOG_WARNING, "Unable to reset default ring on '%s'\n", ast->name);
1204                                 p->cidrings = DEFAULT_CIDRINGS;
1205                         }
1206
1207
1208                         /* nick@dccinc.com 4/3/03 mods to allow for deferred dialing */
1209                         c = strchr(dest, '/');
1210                         if (c)
1211                           c++;
1212                         if (c && (strlen(c) < p->stripmsd)) {
1213                           ast_log(LOG_WARNING, "Number '%s' is shorter than stripmsd (%d)\n", c, p->stripmsd);
1214                           c = NULL;
1215                         }
1216                         if (c) {
1217                                 p->dop.op = ZT_DIAL_OP_REPLACE;
1218                                 snprintf(p->dop.dialstr, sizeof(p->dop.dialstr), "Tw%s", c);
1219                                 ast_log(LOG_DEBUG, "FXO: setup deferred dialstring: %s\n", c);
1220                         } else {
1221                                 strcpy(p->dop.dialstr, "");
1222                         }
1223                         x = ZT_RING;
1224                         if (ioctl(p->subs[SUB_REAL].zfd, ZT_HOOK, &x) && (errno != EINPROGRESS)) {
1225                                 ast_log(LOG_WARNING, "Unable to ring phone: %s\n", strerror(errno));
1226                                 return -1;
1227                         }
1228                         p->dialing = 1;
1229                 } else {
1230                         /* Call waiting call */
1231                         p->callwaitrings = 0;
1232                         if (ast->callerid)
1233                                 strncpy(p->callwaitcid, ast->callerid, sizeof(p->callwaitcid)-1);
1234                         else
1235                                 strcpy(p->callwaitcid, "");
1236                         /* Call waiting tone instead */
1237                         if (zt_callwait(ast))
1238                                 return -1;
1239                         /* Make ring-back */
1240                         if (tone_zone_play_tone(p->subs[SUB_CALLWAIT].zfd, ZT_TONE_RINGTONE))
1241                                 ast_log(LOG_WARNING, "Unable to generate call-wait ring-back on channel %s\n", ast->name);
1242                                 
1243                 }
1244                 if (ast->callerid) 
1245                         strncpy(callerid, ast->callerid, sizeof(callerid)-1);
1246                 else
1247                         strcpy(callerid, "");
1248                 ast_callerid_parse(callerid, &n, &l);
1249                 if (l) {
1250                         ast_shrink_phone_number(l);
1251                         if (!ast_isphonenumber(l))
1252                                 l = NULL;
1253                 }
1254                 if (l)
1255                         strcpy(p->lastcallerid, l);
1256                 else
1257                         strcpy(p->lastcallerid, "");
1258                 ast_setstate(ast, AST_STATE_RINGING);
1259                 index = zt_get_index(ast, p, 0);
1260                 if (index > -1) {
1261                         p->subs[index].needringing = 1;
1262                 }
1263                 break;
1264         case SIG_FXSLS:
1265         case SIG_FXSGS:
1266         case SIG_FXSKS:
1267         case SIG_EMWINK:
1268         case SIG_EM:
1269         case SIG_FEATD:
1270         case SIG_FEATDMF:
1271         case SIG_FEATB:
1272         case SIG_SFWINK:
1273         case SIG_SF:
1274         case SIG_SF_FEATD:
1275         case SIG_SF_FEATDMF:
1276         case SIG_SF_FEATB:
1277                 c = strchr(dest, '/');
1278                 if (c)
1279                         c++;
1280                 else
1281                         c = dest;
1282                 if (strlen(c) < p->stripmsd) {
1283                         ast_log(LOG_WARNING, "Number '%s' is shorter than stripmsd (%d)\n", c, p->stripmsd);
1284                         return -1;
1285                 }
1286                 x = ZT_START;
1287                 /* Start the trunk */
1288                 res = ioctl(p->subs[SUB_REAL].zfd, ZT_HOOK, &x);
1289                 if (res < 0) {
1290                         if (errno != EINPROGRESS) {
1291                                 ast_log(LOG_WARNING, "Unable to start channel: %s\n", strerror(errno));
1292                                 return -1;
1293                         }
1294                 }
1295                 ast_log(LOG_DEBUG, "Dialing '%s'\n", c);
1296                 p->dop.op = ZT_DIAL_OP_REPLACE;
1297                 if (p->sig == SIG_FEATD) {
1298                         if (ast->callerid) {
1299                                 strncpy(callerid, ast->callerid, sizeof(callerid)-1);
1300                                 ast_callerid_parse(callerid, &n, &l);
1301                                 if (l) {
1302                                         ast_shrink_phone_number(l);
1303                                         if (!ast_isphonenumber(l))
1304                                                 l = NULL;
1305                                 }
1306                         } else
1307                                 l = NULL;
1308                         if (l) 
1309                                 snprintf(p->dop.dialstr, sizeof(p->dop.dialstr), "T*%s*%s*", l, c + p->stripmsd);
1310                         else
1311                                 snprintf(p->dop.dialstr, sizeof(p->dop.dialstr), "T**%s*", c + p->stripmsd);
1312                 } else 
1313                 if (p->sig == SIG_FEATDMF) {
1314                         if (ast->callerid) {
1315                                 strncpy(callerid, ast->callerid, sizeof(callerid)-1);
1316                                 ast_callerid_parse(callerid, &n, &l);
1317                                 if (l) {
1318                                         ast_shrink_phone_number(l);
1319                                         if (!ast_isphonenumber(l))
1320                                                 l = NULL;
1321                                 }
1322                         } else
1323                                 l = NULL;
1324                         if (l) 
1325                                 snprintf(p->dop.dialstr, sizeof(p->dop.dialstr), "M*00%s#*%s#", l, c + p->stripmsd);
1326                         else
1327                                 snprintf(p->dop.dialstr, sizeof(p->dop.dialstr), "M*02#*%s#", c + p->stripmsd);
1328                 } else 
1329                 if (p->sig == SIG_FEATB) {
1330                         snprintf(p->dop.dialstr, sizeof(p->dop.dialstr), "M*%s#", c + p->stripmsd);
1331                 } else 
1332                         snprintf(p->dop.dialstr, sizeof(p->dop.dialstr), "T%s", c + p->stripmsd);
1333                 if (!res) {
1334                         if (ioctl(p->subs[SUB_REAL].zfd, ZT_DIAL, &p->dop)) {
1335                                 x = ZT_ONHOOK;
1336                                 ioctl(p->subs[SUB_REAL].zfd, ZT_HOOK, &x);
1337                                 ast_log(LOG_WARNING, "Dialing failed on channel %d: %s\n", p->channel, strerror(errno));
1338                                 return -1;
1339                         }
1340                 } else
1341                         ast_log(LOG_DEBUG, "Deferring dialing...\n");
1342                 p->dialing = 1;
1343                 if (strlen(c + p->stripmsd) < 1) p->dialednone = 1;
1344                 ast_setstate(ast, AST_STATE_DIALING);
1345                 break;
1346 #ifdef ZAPATA_PRI
1347         case SIG_PRI:
1348                 c = strchr(dest, '/');
1349                 if (c)
1350                         c++;
1351                 else
1352                         c = dest;
1353                 if (ast->callerid) {
1354                         strncpy(callerid, ast->callerid, sizeof(callerid)-1);
1355                         ast_callerid_parse(callerid, &n, &l);
1356                         if (l) {
1357                                 ast_shrink_phone_number(l);
1358                                 if (!ast_isphonenumber(l))
1359                                         l = NULL;
1360                         }
1361                 } else
1362                         l = NULL;
1363                 if (strlen(c) < p->stripmsd) {
1364                         ast_log(LOG_WARNING, "Number '%s' is shorter than stripmsd (%d)\n", c, p->stripmsd);
1365                         return -1;
1366                 }
1367                 p->dop.op = ZT_DIAL_OP_REPLACE;
1368                 s = strchr(c + p->stripmsd, 'w');
1369                 if (s) {
1370                         snprintf(p->dop.dialstr, sizeof(p->dop.dialstr), "T%s", s);
1371                         *s = '\0';
1372                 } else {
1373                         strcpy(p->dop.dialstr, "");
1374                 }
1375                 if (!(p->call = pri_new_call(p->pri->pri))) {
1376                         ast_log(LOG_WARNING, "Unable to create call on channel %d\n", p->channel);
1377                         return -1;
1378                 }
1379                 if (pri_call(p->pri->pri, p->call, p->digital ? PRI_TRANS_CAP_DIGITAL : PRI_TRANS_CAP_SPEECH, 
1380                         p->prioffset, p->pri->nodetype == PRI_NETWORK ? 0 : 1, 1, l, p->pri->dialplan - 1, n,
1381                         l ? PRES_ALLOWED_USER_NUMBER_PASSED_SCREEN : PRES_NUMBER_NOT_AVAILABLE,
1382                         c + p->stripmsd, p->pri->dialplan - 1, 
1383                         ((p->law == ZT_LAW_ALAW) ? PRI_LAYER_1_ALAW : PRI_LAYER_1_ULAW))) {
1384                         ast_log(LOG_WARNING, "Unable to setup call to %s\n", c + p->stripmsd);
1385                         return -1;
1386                 }
1387                 ast_setstate(ast, AST_STATE_DIALING);
1388                 break;
1389 #endif          
1390         case 0:
1391                 /* Special pseudo -- automatically up*/
1392                 ast_setstate(ast, AST_STATE_UP);
1393                 break;          
1394         default:
1395                 ast_log(LOG_DEBUG, "not yet implemented\n");
1396                 return -1;
1397         }
1398         return 0;
1399 }
1400
1401 static int destroy_channel(struct zt_pvt *prev, struct zt_pvt *cur, int now)
1402 {
1403         int owned = 0;
1404         int i = 0;
1405
1406         if (!now) {
1407                 if (cur->owner) {
1408                         owned = 1;
1409                 }
1410
1411                 for (i = 0; i < 3; i++) {
1412                         if (cur->subs[i].owner) {
1413                                 owned = 1;
1414                         }
1415                 }
1416                 if (!owned) {
1417                         if (prev) {
1418                                 prev->next = cur->next;
1419                         } else {
1420                                 iflist = cur->next;
1421                         }
1422                         if (cur->subs[SUB_REAL].zfd > -1) {
1423                                 zt_close(cur->subs[SUB_REAL].zfd);
1424                         }
1425                         free(cur);
1426                 }
1427         } else {
1428                 if (prev) {
1429                         prev->next = cur->next;
1430                 } else {
1431                         iflist = cur->next;
1432                 }
1433                 if (cur->subs[SUB_REAL].zfd > -1) {
1434                         zt_close(cur->subs[SUB_REAL].zfd);
1435                 }
1436                 free(cur);
1437         }
1438         return 0;
1439 }
1440
1441
1442 static int zt_hangup(struct ast_channel *ast)
1443 {
1444         int res;
1445         int index,x, law;
1446         static int restore_gains(struct zt_pvt *p);
1447         struct zt_pvt *p = ast->pvt->pvt;
1448         struct zt_pvt *tmp = NULL;
1449         struct zt_pvt *prev = NULL;
1450         ZT_PARAMS par;
1451
1452         if (option_debug)
1453                 ast_log(LOG_DEBUG, "zt_hangup(%s)\n", ast->name);
1454         if (!ast->pvt->pvt) {
1455                 ast_log(LOG_WARNING, "Asked to hangup channel not connected\n");
1456                 return 0;
1457         }
1458         
1459         ast_pthread_mutex_lock(&p->lock);
1460         
1461         index = zt_get_index(ast, p, 1);
1462
1463         if (p->sig == SIG_PRI) {
1464                 x = 1;
1465                 ast_channel_setoption(ast,AST_OPTION_AUDIO_MODE,&x,sizeof(char),0);
1466         }
1467
1468         x = 0;
1469         zt_confmute(p, 0);
1470         restore_gains(p);
1471         
1472         ast_dsp_digitmode(p->dsp,DSP_DIGITMODE_DTMF | p->dtmfrelax);
1473
1474
1475         ast_log(LOG_DEBUG, "Hangup: channel: %d index = %d, normal = %d, callwait = %d, thirdcall = %d\n",
1476                 p->channel, index, p->subs[SUB_REAL].zfd, p->subs[SUB_CALLWAIT].zfd, p->subs[SUB_THREEWAY].zfd);
1477         p->ignoredtmf = 0;
1478         
1479         if (index > -1) {
1480                 /* Real channel, do some fixup */
1481                 p->subs[index].owner = NULL;
1482                 p->subs[index].needanswer = 0;
1483                 p->subs[index].needringing = 0;
1484                 p->subs[index].linear = 0;
1485                 p->subs[index].needcallerid = 0;
1486                 zt_setlinear(p->subs[index].zfd, 0);
1487                 if (index == SUB_REAL) {
1488                         if ((p->subs[SUB_CALLWAIT].zfd > -1) && (p->subs[SUB_THREEWAY].zfd > -1)) {
1489                                 ast_log(LOG_DEBUG, "Normal call hung up with both three way call and a call waiting call in place?\n");
1490                                 if (p->subs[SUB_CALLWAIT].inthreeway) {
1491                                         /* We had flipped over to answer a callwait and now it's gone */
1492                                         ast_log(LOG_DEBUG, "We were flipped over to the callwait, moving back and unowning.\n");
1493                                         /* Move to the call-wait, but un-own us until they flip back. */
1494                                         swap_subs(p, SUB_CALLWAIT, SUB_REAL);
1495                                         unalloc_sub(p, SUB_CALLWAIT);
1496                                         p->owner = NULL;
1497                                 } else {
1498                                         /* The three way hung up, but we still have a call wait */
1499                                         ast_log(LOG_DEBUG, "We were in the threeway and have a callwait still.  Ditching the threeway.\n");
1500                                         swap_subs(p, SUB_THREEWAY, SUB_REAL);
1501                                         unalloc_sub(p, SUB_THREEWAY);
1502                                         if (p->subs[SUB_REAL].inthreeway) {
1503                                                 /* This was part of a three way call.  Immediately make way for
1504                                                    another call */
1505                                                 ast_log(LOG_DEBUG, "Call was complete, setting owner to former third call\n");
1506                                                 p->owner = p->subs[SUB_REAL].owner;
1507                                         } else {
1508                                                 /* This call hasn't been completed yet...  Set owner to NULL */
1509                                                 ast_log(LOG_DEBUG, "Call was incomplete, setting owner to NULL\n");
1510                                                 p->owner = NULL;
1511                                         }
1512                                         p->subs[SUB_REAL].inthreeway = 0;
1513                                 }
1514                         } else if (p->subs[SUB_CALLWAIT].zfd > -1) {
1515                                 /* Move to the call-wait and switch back to them. */
1516                                 swap_subs(p, SUB_CALLWAIT, SUB_REAL);
1517                                 unalloc_sub(p, SUB_CALLWAIT);
1518                                 p->owner = p->subs[SUB_REAL].owner;
1519                                 if (p->subs[SUB_REAL].owner->bridge)
1520                                         ast_moh_stop(p->subs[SUB_REAL].owner->bridge);
1521                         } else if (p->subs[SUB_THREEWAY].zfd > -1) {
1522                                 swap_subs(p, SUB_THREEWAY, SUB_REAL);
1523                                 unalloc_sub(p, SUB_THREEWAY);
1524                                 if (p->subs[SUB_REAL].inthreeway) {
1525                                         /* This was part of a three way call.  Immediately make way for
1526                                            another call */
1527                                         ast_log(LOG_DEBUG, "Call was complete, setting owner to former third call\n");
1528                                         p->owner = p->subs[SUB_REAL].owner;
1529                                 } else {
1530                                         /* This call hasn't been completed yet...  Set owner to NULL */
1531                                         ast_log(LOG_DEBUG, "Call was incomplete, setting owner to NULL\n");
1532                                         p->owner = NULL;
1533                                 }
1534                                 p->subs[SUB_REAL].inthreeway = 0;
1535                         }
1536                 } else if (index == SUB_CALLWAIT) {
1537                         /* Ditch the holding callwait call, and immediately make it availabe */
1538                         if (p->subs[SUB_CALLWAIT].inthreeway) {
1539                                 /* This is actually part of a three way, placed on hold.  Place the third part
1540                                    on music on hold now */
1541                                 if (p->subs[SUB_THREEWAY].owner && p->subs[SUB_THREEWAY].owner->bridge)
1542                                         ast_moh_start(p->subs[SUB_THREEWAY].owner->bridge, NULL);
1543                                 p->subs[SUB_THREEWAY].inthreeway = 0;
1544                                 /* Make it the call wait now */
1545                                 swap_subs(p, SUB_CALLWAIT, SUB_THREEWAY);
1546                                 unalloc_sub(p, SUB_THREEWAY);
1547                         } else
1548                                 unalloc_sub(p, SUB_CALLWAIT);
1549                 } else if (index == SUB_THREEWAY) {
1550                         if (p->subs[SUB_CALLWAIT].inthreeway) {
1551                                 /* The other party of the three way call is currently in a call-wait state.
1552                                    Start music on hold for them, and take the main guy out of the third call */
1553                                 if (p->subs[SUB_CALLWAIT].owner && p->subs[SUB_CALLWAIT].owner->bridge)
1554                                         ast_moh_start(p->subs[SUB_CALLWAIT].owner->bridge, NULL);
1555                                 p->subs[SUB_CALLWAIT].inthreeway = 0;
1556                         }
1557                         p->subs[SUB_REAL].inthreeway = 0;
1558                         /* If this was part of a three way call index, let us make
1559                            another three way call */
1560                         unalloc_sub(p, SUB_THREEWAY);
1561                 } else {
1562                         /* This wasn't any sort of call, but how are we an index? */
1563                         ast_log(LOG_WARNING, "Index found but not any type of call?\n");
1564                 }
1565         }
1566
1567
1568         if (!p->subs[SUB_REAL].owner && !p->subs[SUB_CALLWAIT].owner && !p->subs[SUB_THREEWAY].owner) {
1569                 p->owner = NULL;
1570                 p->ringt = 0;
1571                 p->distinctivering = 0;
1572                 p->confirmanswer = 0;
1573                 p->cidrings = 1;
1574                 p->outgoing = 0;
1575                 p->digital = 0;
1576                 p->faxhandled = 0;
1577                 p->pulsedial = 0;
1578                 p->onhooktime = time(NULL);
1579 #ifdef PRI_EVENT_PROCEEDING
1580                 p->proceeding = 0;
1581 #endif
1582                 if (p->dsp) {
1583                         ast_dsp_free(p->dsp);
1584                         p->dsp = NULL;
1585                 }
1586                 law = ZT_LAW_DEFAULT;
1587                 res = ioctl(p->subs[SUB_REAL].zfd, ZT_SETLAW, &law);
1588                 if (res < 0) 
1589                         ast_log(LOG_WARNING, "Unable to set law on channel %d to default\n", p->channel);
1590                 /* Perform low level hangup if no owner left */
1591 #ifdef ZAPATA_PRI
1592                 if (p->sig == SIG_PRI) {
1593                         if (p->call) {
1594                                 if (!pri_grab(p, p->pri)) {
1595                                         res = pri_disconnect(p->pri->pri, p->call, PRI_CAUSE_NORMAL_CLEARING);
1596                                         if (p->alreadyhungup) {
1597                                                 p->call = NULL;
1598                                                 p->alreadyhungup = 0;
1599                                         }
1600                                         if (res < 0) 
1601                                                 ast_log(LOG_WARNING, "pri_disconnect failed\n");
1602                                         pri_rel(p->pri);                        
1603                                 } else {
1604                                         ast_log(LOG_WARNING, "Unable to grab PRI on span %d\n", p->span);
1605                                         res = -1;
1606                                 }
1607                         } else
1608                                 res = 0;
1609
1610                 } else 
1611 #endif
1612 #ifdef ZAPATA_R2
1613                 if (p->sig == SIG_R2) {
1614                         if (p->hasr2call) {
1615                                 mfcr2_DropCall(p->r2, NULL, UC_NORMAL_CLEARING);
1616                                 p->hasr2call = 0;
1617                                 res = 0;
1618                         } else
1619                                 res = 0;
1620
1621                 } else 
1622 #endif
1623                 if (p->sig)
1624                         res = zt_set_hook(p->subs[SUB_REAL].zfd, ZT_ONHOOK);
1625                 if (res < 0) {
1626                         ast_log(LOG_WARNING, "Unable to hangup line %s\n", ast->name);
1627                 }
1628                 switch(p->sig) {
1629                 case SIG_FXOGS:
1630                 case SIG_FXOLS:
1631                 case SIG_FXOKS:
1632                         res = ioctl(p->subs[SUB_REAL].zfd, ZT_GET_PARAMS, &par);
1633                         if (!res) {
1634 #if 0
1635                                 ast_log(LOG_DEBUG, "Hanging up channel %d, offhook = %d\n", p->channel, par.rxisoffhook);
1636 #endif
1637                                 /* If they're off hook, try playing congestion */
1638                                 if (par.rxisoffhook)
1639                                         tone_zone_play_tone(p->subs[SUB_REAL].zfd, ZT_TONE_CONGESTION);
1640                                 else
1641                                         tone_zone_play_tone(p->subs[SUB_REAL].zfd, -1);
1642                         }
1643                         break;
1644                 default:
1645                         tone_zone_play_tone(p->subs[SUB_REAL].zfd, -1);
1646                 }
1647                 if (p->cidspill)
1648                         free(p->cidspill);
1649                 if (p->sig)
1650                         zt_disable_ec(p);
1651                 x = 0;
1652                 ast_channel_setoption(ast,AST_OPTION_TONE_VERIFY,&x,sizeof(char),0);
1653                 ast_channel_setoption(ast,AST_OPTION_TDD,&x,sizeof(char),0);
1654                 p->didtdd = 0;
1655                 p->cidspill = NULL;
1656                 p->callwaitcas = 0;
1657                 p->callwaiting = p->permcallwaiting;
1658                 p->hidecallerid = p->permhidecallerid;
1659                 p->dialing = 0;
1660                 strcpy(p->rdnis, "");
1661                 update_conf(p);
1662                 /* Restore data mode */
1663                 if (p->sig == SIG_PRI) {
1664                         x = 0;
1665                         ast_channel_setoption(ast,AST_OPTION_AUDIO_MODE,&x,sizeof(char),0);
1666                 }
1667
1668         if (p->dsp)
1669                 restart_monitor();
1670         }
1671
1672
1673         p->callwaitingrepeat = 0;
1674         p->cidcwexpire = 0;
1675         ast->pvt->pvt = NULL;
1676         ast_pthread_mutex_unlock(&p->lock);
1677         ast_pthread_mutex_lock(&usecnt_lock);
1678         usecnt--;
1679         if (usecnt < 0) 
1680                 ast_log(LOG_WARNING, "Usecnt < 0???\n");
1681         ast_pthread_mutex_unlock(&usecnt_lock);
1682         ast_update_use_count();
1683         if (option_verbose > 2) 
1684                 ast_verbose( VERBOSE_PREFIX_3 "Hungup '%s'\n", ast->name);
1685
1686         ast_pthread_mutex_lock(&iflock);
1687         tmp = iflist;
1688         prev = NULL;
1689         if (p->destroy) {
1690                 while (tmp) {
1691                         if (tmp == p) {
1692                                 destroy_channel(prev, tmp, 0);
1693                                 break;
1694                         } else {
1695                                 prev = tmp;
1696                                 tmp = tmp->next;
1697                         }
1698                 }
1699         }
1700         ast_pthread_mutex_unlock(&iflock);
1701         return 0;
1702 }
1703
1704 static int zt_answer(struct ast_channel *ast)
1705 {
1706         struct zt_pvt *p = ast->pvt->pvt;
1707         int res=0;
1708         int index;
1709         int oldstate = ast->_state;
1710         ast_setstate(ast, AST_STATE_UP);
1711         ast_pthread_mutex_lock(&p->lock);
1712         index = zt_get_index(ast, p, 0);
1713         if (index < 0)
1714                 index = SUB_REAL;
1715         /* nothing to do if a radio channel */
1716         if (p->radio) {
1717                 ast_pthread_mutex_unlock(&p->lock);
1718                 return 0;
1719         }
1720         switch(p->sig) {
1721         case SIG_FXSLS:
1722         case SIG_FXSGS:
1723         case SIG_FXSKS:
1724                 p->ringt = 0;
1725                 /* Fall through */
1726         case SIG_EM:
1727         case SIG_EMWINK:
1728         case SIG_FEATD:
1729         case SIG_FEATDMF:
1730         case SIG_FEATB:
1731         case SIG_SF:
1732         case SIG_SFWINK:
1733         case SIG_SF_FEATD:
1734         case SIG_SF_FEATDMF:
1735         case SIG_SF_FEATB:
1736         case SIG_FXOLS:
1737         case SIG_FXOGS:
1738         case SIG_FXOKS:
1739                 /* Pick up the line */
1740                 ast_log(LOG_DEBUG, "Took %s off hook\n", ast->name);
1741                 res =  zt_set_hook(p->subs[SUB_REAL].zfd, ZT_OFFHOOK);
1742                 tone_zone_play_tone(p->subs[index].zfd, -1);
1743                 p->dialing = 0;
1744                 if ((index == SUB_REAL) && p->subs[SUB_THREEWAY].inthreeway) {
1745                         if (oldstate == AST_STATE_RINGING) {
1746                                 ast_log(LOG_DEBUG, "Finally swapping real and threeway\n");
1747                                 tone_zone_play_tone(p->subs[SUB_THREEWAY].zfd, -1);
1748                                 swap_subs(p, SUB_THREEWAY, SUB_REAL);
1749                                 p->owner = p->subs[SUB_REAL].owner;
1750                         }
1751                 }
1752                 break;
1753 #ifdef ZAPATA_PRI
1754         case SIG_PRI:
1755                 /* Send a pri acknowledge */
1756                 if (!pri_grab(p, p->pri)) {
1757                         res = pri_answer(p->pri->pri, p->call, 0, 1);
1758                         pri_rel(p->pri);
1759                 } else {
1760                         ast_log(LOG_WARNING, "Unable to grab PRI on span %d\n", p->span);
1761                         res= -1;
1762                 }
1763                 break;
1764 #endif
1765 #ifdef ZAPATA_R2
1766         case SIG_R2:
1767                 res = mfcr2_AnswerCall(p->r2, NULL);
1768                 if (res)
1769                         ast_log(LOG_WARNING, "R2 Answer call failed :( on %s\n", ast->name);
1770                 break;
1771 #endif                  
1772         case 0:
1773                 return 0;
1774         default:
1775                 ast_log(LOG_WARNING, "Don't know how to answer signalling %d (channel %d)\n", p->sig, p->channel);
1776                 res = -1;
1777         }
1778         ast_pthread_mutex_unlock(&p->lock);
1779         return res;
1780 }
1781
1782 static int zt_setoption(struct ast_channel *chan, int option, void *data, int datalen)
1783 {
1784 char    *cp;
1785 int     x;
1786
1787         struct zt_pvt *p = chan->pvt->pvt;
1788
1789         
1790         if ((option != AST_OPTION_TONE_VERIFY) && (option != AST_OPTION_AUDIO_MODE) &&
1791                 (option != AST_OPTION_TDD) && (option != AST_OPTION_RELAXDTMF))
1792            {
1793                 errno = ENOSYS;
1794                 return -1;
1795            }
1796         cp = (char *)data;
1797         if ((!cp) || (datalen < 1))
1798            {
1799                 errno = EINVAL;
1800                 return -1;
1801            }
1802         switch(option) {
1803             case AST_OPTION_TONE_VERIFY:
1804                 if (!p->dsp)
1805                         break;
1806                 switch(*cp) {
1807                     case 1:
1808                                 ast_log(LOG_DEBUG, "Set option TONE VERIFY, mode: MUTECONF(1) on %s\n",chan->name);
1809                                 ast_dsp_digitmode(p->dsp,DSP_DIGITMODE_MUTECONF | p->dtmfrelax);  /* set mute mode if desired */
1810                         break;
1811                     case 2:
1812                                 ast_log(LOG_DEBUG, "Set option TONE VERIFY, mode: MUTECONF/MAX(2) on %s\n",chan->name);
1813                                 ast_dsp_digitmode(p->dsp,DSP_DIGITMODE_MUTECONF | DSP_DIGITMODE_MUTEMAX | p->dtmfrelax);  /* set mute mode if desired */
1814                         break;
1815                     default:
1816                                 ast_log(LOG_DEBUG, "Set option TONE VERIFY, mode: OFF(0) on %s\n",chan->name);
1817                                 ast_dsp_digitmode(p->dsp,DSP_DIGITMODE_DTMF | p->dtmfrelax);  /* set mute mode if desired */
1818                         break;
1819                 }
1820                 break;
1821             case AST_OPTION_TDD:  /* turn on or off TDD */
1822                 if (!*cp) { /* turn it off */
1823                         ast_log(LOG_DEBUG, "Set option TDD MODE, value: OFF(0) on %s\n",chan->name);
1824                         if (p->tdd) tdd_free(p->tdd);
1825                         p->tdd = 0;
1826                         p->mate = 0;
1827                         break;
1828                 }
1829                 if (*cp == 2)
1830                         ast_log(LOG_DEBUG, "Set option TDD MODE, value: MATE(2) on %s\n",chan->name);
1831                 else ast_log(LOG_DEBUG, "Set option TDD MODE, value: ON(1) on %s\n",chan->name);
1832                 p->mate = 0;
1833                 zt_disable_ec(p);
1834                 /* otherwise, turn it on */
1835                 if (!p->didtdd) { /* if havent done it yet */
1836                         unsigned char mybuf[41000],*buf;
1837                         int size,res,fd,len;
1838                         int index;
1839                         fd_set wfds,efds;
1840                         buf = mybuf;
1841                         memset(buf,0x7f,sizeof(mybuf)); /* set to silence */
1842                         ast_tdd_gen_ecdisa(buf + 16000,16000);  /* put in tone */
1843                         len = 40000;
1844                         index = zt_get_index(chan, p, 0);
1845                         if (index < 0) {
1846                                 ast_log(LOG_WARNING, "No index in TDD?\n");
1847                                 return -1;
1848                         }
1849                         fd = p->subs[index].zfd;
1850                         while(len) {
1851                                 if (ast_check_hangup(chan)) return -1;
1852                                 size = len;
1853                                 if (size > READ_SIZE)
1854                                         size = READ_SIZE;
1855                                 FD_ZERO(&wfds);
1856                                 FD_ZERO(&efds);
1857                                 FD_SET(fd,&wfds);
1858                                 FD_SET(fd,&efds);                       
1859                                 res = select(fd + 1,NULL,&wfds,&efds,NULL);
1860                                 if (!res) {
1861                                         ast_log(LOG_DEBUG, "select (for write) ret. 0 on channel %d\n", p->channel);
1862                                         continue;
1863                                 }
1864                                   /* if got exception */
1865                                 if (FD_ISSET(fd,&efds)) return -1;
1866                                 if (!FD_ISSET(fd,&wfds)) {
1867                                         ast_log(LOG_DEBUG, "write fd not ready on channel %d\n", p->channel);
1868                                         continue;
1869                                 }
1870                                 res = write(fd, buf, size);
1871                                 if (res != size) {
1872                                         if (res == -1) return -1;
1873                                         ast_log(LOG_DEBUG, "Write returned %d (%s) on channel %d\n", res, strerror(errno), p->channel);
1874                                         break;
1875                                 }
1876                                 len -= size;
1877                                 buf += size;
1878                         }
1879                         p->didtdd = 1; /* set to have done it now */            
1880                 }
1881                 if (*cp == 2) { /* Mate mode */
1882                         if (p->tdd) tdd_free(p->tdd);
1883                         p->tdd = 0;
1884                         p->mate = 1;
1885                         break;
1886                         }               
1887                 if (!p->tdd) { /* if we dont have one yet */
1888                         p->tdd = tdd_new(); /* allocate one */
1889                 }               
1890                 break;
1891             case AST_OPTION_RELAXDTMF:  /* Relax DTMF decoding (or not) */
1892                 if (!*cp)
1893                 {               
1894                         ast_log(LOG_DEBUG, "Set option RELAX DTMF, value: OFF(0) on %s\n",chan->name);
1895                         x = 0;
1896                 }
1897                 else
1898                 {               
1899                         ast_log(LOG_DEBUG, "Set option RELAX DTMF, value: ON(1) on %s\n",chan->name);
1900                         x = 1;
1901                 }
1902                 ast_dsp_digitmode(p->dsp,x ? DSP_DIGITMODE_RELAXDTMF : DSP_DIGITMODE_DTMF | p->dtmfrelax);
1903                 break;
1904             case AST_OPTION_AUDIO_MODE:  /* Set AUDIO mode (or not) */
1905                 if (!*cp)
1906                 {               
1907                         ast_log(LOG_DEBUG, "Set option AUDIO MODE, value: OFF(0) on %s\n",chan->name);
1908                         x = 0;
1909                         zt_disable_ec(p);
1910                 }
1911                 else
1912                 {               
1913                         ast_log(LOG_DEBUG, "Set option AUDIO MODE, value: ON(1) on %s\n",chan->name);
1914                         x = 1;
1915                 }
1916                 if (ioctl(p->subs[SUB_REAL].zfd, ZT_AUDIOMODE, &x) == -1)
1917                         ast_log(LOG_WARNING, "Unable to set audio mode on channel %d to %d\n", p->channel, x);
1918                 break;
1919         }
1920         errno = 0;
1921         return 0;
1922 }
1923
1924 static void zt_unlink(struct zt_pvt *slave, struct zt_pvt *master)
1925 {
1926         /* Unlink a specific slave or all slaves/masters from a given master */
1927         int x;
1928         int hasslaves;
1929         if (!master)
1930                 return;
1931         hasslaves = 0;
1932         for (x=0;x<MAX_SLAVES;x++) {
1933                 if (master->slaves[x]) {
1934                         if (!slave || (master->slaves[x] == slave)) {
1935                                 /* Take slave out of the conference */
1936                                 ast_log(LOG_DEBUG, "Unlinking slave %d from %d\n", master->slaves[x]->channel, master->channel);
1937                                 conf_del(&master->confno, &master->slaves[x]->subs[SUB_REAL], SUB_REAL);
1938                                 master->slaves[x]->master = NULL;
1939                                 master->slaves[x] = NULL;
1940                         } else
1941                                 hasslaves = 1;
1942                 }
1943                 if (!hasslaves)
1944                         master->inconference = 0;
1945         }
1946         if (!slave) {
1947                 if (master->master) {
1948                         /* Take master out of the conference */
1949                         conf_del(&master->master->confno, &master->subs[SUB_REAL], SUB_REAL);
1950                         hasslaves = 0;
1951                         for (x=0;x<MAX_SLAVES;x++) {
1952                                 if (master->master->slaves[x] == master)
1953                                         master->master->slaves[x] = NULL;
1954                                 else if (master->master->slaves[x])
1955                                         hasslaves = 1;
1956                         }
1957                         if (!hasslaves)
1958                                 master->master->inconference = 0;
1959                 }
1960                 master->master = NULL;
1961         }
1962         update_conf(master);
1963 }
1964
1965 static void zt_link(struct zt_pvt *slave, struct zt_pvt *master) {
1966         int x;
1967         if (!slave || !master) {
1968                 ast_log(LOG_WARNING, "Tried to link to/from NULL??\n");
1969                 return;
1970         }
1971         for (x=0;x<MAX_SLAVES;x++) {
1972                 if (!master->slaves[x]) {
1973                         master->slaves[x] = slave;
1974                         break;
1975                 }
1976         }
1977         if (x >= MAX_SLAVES) {
1978                 ast_log(LOG_WARNING, "Replacing slave %d with new slave, %d\n", master->slaves[MAX_SLAVES - 1]->channel, slave->channel);
1979                 master->slaves[MAX_SLAVES - 1] = slave;
1980         }
1981         if (slave->master) 
1982                 ast_log(LOG_WARNING, "Replacing master %d with new master, %d\n", slave->master->channel, master->channel);
1983         slave->master = master;
1984         
1985         ast_log(LOG_DEBUG, "Making %d slave to master %d at %d\n", slave->channel, master->channel, x);
1986 }
1987
1988 static int zt_bridge(struct ast_channel *c0, struct ast_channel *c1, int flags, struct ast_frame **fo, struct ast_channel **rc)
1989 {
1990         struct ast_channel *who = NULL, *cs[3];
1991         struct zt_pvt *p0, *p1, *op0, *op1;
1992         struct zt_pvt *master=NULL, *slave=NULL;
1993         struct ast_frame *f;
1994         int to;
1995         int inconf = 0;
1996         int nothingok = 0;
1997         int ofd1, ofd2;
1998         int oi1, oi2, i1 = -1, i2 = -1, t1, t2;
1999         int os1 = -1, os2 = -1;
2000         struct ast_channel *oc1, *oc2;
2001
2002         /* if need DTMF, cant native bridge */
2003         if (flags & (AST_BRIDGE_DTMF_CHANNEL_0 | AST_BRIDGE_DTMF_CHANNEL_1))
2004                 return -2;
2005         p0 = c0->pvt->pvt;
2006         p1 = c1->pvt->pvt;
2007         /* cant do pseudo-channels here */
2008         if ((!p0->sig) || (!p1->sig)) return -2;
2009
2010         ast_pthread_mutex_lock(&c0->lock);
2011         ast_pthread_mutex_lock(&c1->lock);
2012         op0 = p0 = c0->pvt->pvt;
2013         op1 = p1 = c1->pvt->pvt;
2014         ofd1 = c0->fds[0];
2015         ofd2 = c1->fds[0];
2016         oi1 = zt_get_index(c0, p0, 0);
2017         oi2 = zt_get_index(c1, p1, 0);
2018         oc1 = p0->owner;
2019         oc2 = p1->owner;
2020         if ((oi1 < 0) || (oi2 < 0))
2021                 return -1;
2022
2023
2024
2025         ast_pthread_mutex_lock(&p0->lock);
2026         if (pthread_mutex_trylock(&p1->lock)) {
2027                 /* Don't block, due to potential for deadlock */
2028                 ast_pthread_mutex_unlock(&p0->lock);
2029                 ast_pthread_mutex_unlock(&c0->lock);
2030                 ast_pthread_mutex_unlock(&c1->lock);
2031                 ast_log(LOG_NOTICE, "Avoiding deadlock...\n");
2032                 return -3;
2033         }
2034         if ((oi1 == SUB_REAL) && (oi2 == SUB_REAL)) {
2035                 if (!p0->owner || !p1->owner) {
2036                         /* Currently unowned -- Do nothing.  */
2037                         nothingok = 1;
2038                 } else {
2039                         /* If we don't have a call-wait in a 3-way, and we aren't in a 3-way, we can be master */
2040                         if (!p0->subs[SUB_CALLWAIT].inthreeway && !p1->subs[SUB_REAL].inthreeway) {
2041                                 master = p0;
2042                                 slave = p1;
2043                                 inconf = 1;
2044                         } else if (!p1->subs[SUB_CALLWAIT].inthreeway && !p0->subs[SUB_REAL].inthreeway) {
2045                                 master = p1;
2046                                 slave = p0;
2047                                 inconf = 1;
2048                         } else {
2049                                 ast_log(LOG_WARNING, "Huh?  Both calls are callwaits or 3-ways?  That's clever...?\n");
2050                                 ast_log(LOG_WARNING, "p0: chan %d/%d/CW%d/3W%d, p1: chan %d/%d/CW%d/3W%d\n", p0->channel, oi1, (p0->subs[SUB_CALLWAIT].zfd > -1) ? 1 : 0, p0->subs[SUB_REAL].inthreeway,
2051                                                 p0->channel, oi1, (p1->subs[SUB_CALLWAIT].zfd > -1) ? 1 : 0, p1->subs[SUB_REAL].inthreeway);
2052                         }
2053                 }
2054         } else if ((oi1 == SUB_REAL) && (oi2 == SUB_THREEWAY)) {
2055                 if (p1->subs[SUB_THREEWAY].inthreeway) {
2056                         master = p1;
2057                         slave = p0;
2058                 } else {
2059                         nothingok = 1;
2060                 }
2061         } else if ((oi1 == SUB_THREEWAY) && (oi2 == SUB_REAL)) {
2062                 if (p0->subs[SUB_THREEWAY].inthreeway) {
2063                         master = p0;
2064                         slave = p1;
2065                 } else {
2066                         nothingok  = 1;
2067                 }
2068         } else if ((oi1 == SUB_REAL) && (oi2 == SUB_CALLWAIT)) {
2069                 /* We have a real and a call wait.  If we're in a three way call, put us in it, otherwise, 
2070                    don't put us in anything */
2071                 if (p1->subs[SUB_CALLWAIT].inthreeway) {
2072                         master = p1;
2073                         slave = p0;
2074                 } else {
2075                         nothingok = 1;
2076                 }
2077         } else if ((oi1 == SUB_CALLWAIT) && (oi2 == SUB_REAL)) {
2078                 /* Same as previous */
2079                 if (p0->subs[SUB_CALLWAIT].inthreeway) {
2080                         master = p0;
2081                         slave = p1;
2082                 } else {
2083                         nothingok = 1;
2084                 }
2085         }
2086         ast_log(LOG_DEBUG, "master: %d, slave: %d, nothingok: %d\n",
2087                 master ? master->channel : 0, slave ? slave->channel : 0, nothingok);
2088         if (master && slave) {
2089                 /* Stop any tones, or play ringtone as appropriate.  If they're bridged
2090                    in an active threeway call with a channel that is ringing, we should
2091                    indicate ringing. */
2092                 if ((oi2 == SUB_THREEWAY) && 
2093                         p1->subs[SUB_THREEWAY].inthreeway && 
2094                         p1->subs[SUB_REAL].owner && 
2095                         p1->subs[SUB_REAL].inthreeway && 
2096                         (p1->subs[SUB_REAL].owner->_state == AST_STATE_RINGING)) {
2097                                 ast_log(LOG_DEBUG, "Playing ringback on %s since %s is in a ringing three-way\n", c0->name, c1->name);
2098                                 tone_zone_play_tone(p0->subs[oi1].zfd, ZT_TONE_RINGTONE);
2099                                 os2 = p1->subs[SUB_REAL].owner->_state;
2100                 } else {
2101                                 ast_log(LOG_DEBUG, "Stoping tones on %d/%d talking to %d/%d\n", p0->channel, oi1, p1->channel, oi2);
2102                                 tone_zone_play_tone(p0->subs[oi1].zfd, -1);
2103                 }
2104                 if ((oi1 == SUB_THREEWAY) && 
2105                         p0->subs[SUB_THREEWAY].inthreeway && 
2106                         p0->subs[SUB_REAL].owner && 
2107                         p0->subs[SUB_REAL].inthreeway && 
2108                         (p0->subs[SUB_REAL].owner->_state == AST_STATE_RINGING)) {
2109                                 ast_log(LOG_DEBUG, "Playing ringback on %s since %s is in a ringing three-way\n", c1->name, c0->name);
2110                                 tone_zone_play_tone(p1->subs[oi2].zfd, ZT_TONE_RINGTONE);
2111                                 os1 = p0->subs[SUB_REAL].owner->_state;
2112                 } else {
2113                                 ast_log(LOG_DEBUG, "Stoping tones on %d/%d talking to %d/%d\n", p1->channel, oi2, p0->channel, oi1);
2114                                 tone_zone_play_tone(p1->subs[oi1].zfd, -1);
2115                 }
2116                 if ((oi1 == SUB_REAL) && (oi2 == SUB_REAL)) {
2117                         if (!p0->echocanbridged || !p1->echocanbridged) {
2118                                 /* Disable echo cancellation if appropriate */
2119                                 zt_disable_ec(p0);
2120                                 zt_disable_ec(p1);
2121                         }
2122                 }
2123                 zt_link(slave, master);
2124                 master->inconference = inconf;
2125         } else if (!nothingok)
2126                 ast_log(LOG_WARNING, "Can't link %d/%s with %d/%s\n", p0->channel, subnames[oi1], p1->channel, subnames[oi2]);
2127
2128         update_conf(p0);
2129         update_conf(p1);
2130         t1 = p0->subs[SUB_REAL].inthreeway;
2131         t2 = p1->subs[SUB_REAL].inthreeway;
2132
2133         ast_pthread_mutex_unlock(&p0->lock);
2134         ast_pthread_mutex_unlock(&p1->lock);
2135
2136         ast_pthread_mutex_unlock(&c0->lock);
2137         ast_pthread_mutex_unlock(&c1->lock);
2138
2139         /* Native bridge failed */
2140         if ((!master || !slave) && !nothingok) {
2141                 if (op0 == p0)
2142                         zt_enable_ec(p0);
2143                 if (op1 == p1)
2144                         zt_enable_ec(p1);
2145                 return -1;
2146         }
2147         
2148         cs[0] = c0;
2149         cs[1] = c1;
2150         cs[2] = NULL;
2151         for (;;) {
2152                 /* Here's our main loop...  Start by locking things, looking for private parts, 
2153                    and then balking if anything is wrong */
2154                 ast_pthread_mutex_lock(&c0->lock);
2155                 ast_pthread_mutex_lock(&c1->lock);
2156                 p0 = c0->pvt->pvt;
2157                 p1 = c1->pvt->pvt;
2158                 if (op0 == p0)
2159                         i1 = zt_get_index(c0, p0, 1);
2160                 if (op1 == p1)
2161                         i2 = zt_get_index(c1, p1, 1);
2162                 ast_pthread_mutex_unlock(&c0->lock);
2163                 ast_pthread_mutex_unlock(&c1->lock);
2164                 if ((op0 != p0) || (op1 != p1) || 
2165                     (ofd1 != c0->fds[0]) || 
2166                         (ofd2 != c1->fds[0]) ||
2167                     (p0->subs[SUB_REAL].owner && (os1 > -1) && (os1 != p0->subs[SUB_REAL].owner->_state)) || 
2168                     (p1->subs[SUB_REAL].owner && (os2 > -1) && (os2 != p1->subs[SUB_REAL].owner->_state)) || 
2169                     (oc1 != p0->owner) || 
2170                         (oc2 != p1->owner) ||
2171                         (t1 != p0->subs[SUB_REAL].inthreeway) ||
2172                         (t2 != p1->subs[SUB_REAL].inthreeway) ||
2173                         (oi1 != i1) ||
2174                         (oi2 != i2)) {
2175                         if (slave && master)
2176                                 zt_unlink(slave, master);
2177                         ast_log(LOG_DEBUG, "Something changed out on %d/%d to %d/%d, returning -3 to restart\n",
2178                                                                         op0->channel, oi1, op1->channel, oi2);
2179                         if (op0 == p0)
2180                                 zt_enable_ec(p0);
2181                         if (op1 == p1)
2182                                 zt_enable_ec(p1);
2183                         return -3;
2184                 }
2185                 to = -1;
2186                 who = ast_waitfor_n(cs, 2, &to);
2187                 if (!who) {
2188                         ast_log(LOG_DEBUG, "Ooh, empty read...\n");
2189                         continue;
2190                 }
2191                 if (who->pvt->pvt == op0) 
2192                         op0->ignoredtmf = 1;
2193                 else if (who->pvt->pvt == op1)
2194                         op1->ignoredtmf = 1;
2195                 f = ast_read(who);
2196                 if (who->pvt->pvt == op0) 
2197                         op0->ignoredtmf = 0;
2198                 else if (who->pvt->pvt == op1)
2199                         op1->ignoredtmf = 0;
2200                 if (!f) {
2201                         *fo = NULL;
2202                         *rc = who;
2203                         if (slave && master)
2204                                 zt_unlink(slave, master);
2205                         if (op0 == p0)
2206                                 zt_enable_ec(p0);
2207                         if (op1 == p1)
2208                                 zt_enable_ec(p1);
2209                         return 0;
2210                 }
2211                 if (f->frametype == AST_FRAME_DTMF) {
2212                         if (((who == c0) && (flags & AST_BRIDGE_DTMF_CHANNEL_0)) || 
2213                             ((who == c1) && (flags & AST_BRIDGE_DTMF_CHANNEL_1))) {
2214                                 *fo = f;
2215                                 *rc = who;
2216                                 if (slave && master)
2217                                         zt_unlink(slave, master);
2218                                 return 0;
2219                         } else if ((who == c0) && p0->pulsedial) {
2220                                 ast_write(c1, f);
2221                         } else if ((who == c1) && p1->pulsedial) {
2222                                 ast_write(c0, f);
2223                         }
2224                 }
2225                 ast_frfree(f);
2226
2227                 /* Swap who gets priority */
2228                 cs[2] = cs[0];
2229                 cs[0] = cs[1];
2230                 cs[1] = cs[2];
2231         }
2232 }
2233
2234 static int zt_indicate(struct ast_channel *chan, int condition);
2235
2236 static int zt_fixup(struct ast_channel *oldchan, struct ast_channel *newchan)
2237 {
2238         struct zt_pvt *p = newchan->pvt->pvt;
2239         int x;
2240         ast_log(LOG_DEBUG, "New owner for channel %d is %s\n", p->channel, newchan->name);
2241         if (p->owner == oldchan)
2242                 p->owner = newchan;
2243         for (x=0;x<3;x++)
2244                 if (p->subs[x].owner == oldchan) {
2245                         if (!x)
2246                                 zt_unlink(NULL, p);
2247                         p->subs[x].owner = newchan;
2248                 }
2249         if (newchan->_state == AST_STATE_RINGING) 
2250                 zt_indicate(newchan, AST_CONTROL_RINGING);
2251         update_conf(p);
2252         return 0;
2253 }
2254
2255 static int zt_ring_phone(struct zt_pvt *p)
2256 {
2257         int x;
2258         int res;
2259         /* Make sure our transmit state is on hook */
2260         x = 0;
2261         x = ZT_ONHOOK;
2262         res = ioctl(p->subs[SUB_REAL].zfd, ZT_HOOK, &x);
2263         do {
2264                 x = ZT_RING;
2265                 res = ioctl(p->subs[SUB_REAL].zfd, ZT_HOOK, &x);
2266 #if 0
2267                 printf("Res: %d, error: %s\n", res, strerror(errno));
2268 #endif                                          
2269                 if (res) {
2270                         switch(errno) {
2271                         case EBUSY:
2272                         case EINTR:
2273                                 /* Wait just in case */
2274                                 usleep(10000);
2275                                 continue;
2276                         case EINPROGRESS:
2277                                 res = 0;
2278                                 break;
2279                         default:
2280                                 ast_log(LOG_WARNING, "Couldn't ring the phone: %s\n", strerror(errno));
2281                                 res = 0;
2282                         }
2283                 }
2284         } while (res);
2285         return res;
2286 }
2287
2288 static void *ss_thread(void *data);
2289
2290 static struct ast_channel *zt_new(struct zt_pvt *, int, int, int, int);
2291
2292 static int attempt_transfer(struct zt_pvt *p)
2293 {
2294         /* In order to transfer, we need at least one of the channels to
2295            actually be in a call bridge.  We can't conference two applications
2296            together (but then, why would we want to?) */
2297         if (p->subs[SUB_REAL].owner->bridge) {
2298                 /* The three-way person we're about to transfer to could still be in MOH, so
2299                    stop if now if appropriate */
2300                 if (p->subs[SUB_THREEWAY].owner->bridge)
2301                         ast_moh_stop(p->subs[SUB_THREEWAY].owner->bridge);
2302                 if (p->subs[SUB_THREEWAY].owner->_state == AST_STATE_RINGING) {
2303                         ast_indicate(p->subs[SUB_REAL].owner->bridge, AST_CONTROL_RINGING);
2304                 }
2305                 if (ast_channel_masquerade(p->subs[SUB_THREEWAY].owner, p->subs[SUB_REAL].owner->bridge)) {
2306                         ast_log(LOG_WARNING, "Unable to masquerade %s as %s\n",
2307                                         p->subs[SUB_REAL].owner->bridge->name, p->subs[SUB_THREEWAY].owner->name);
2308                         return -1;
2309                 }
2310                 /* Orphan the channel */
2311                 unalloc_sub(p, SUB_THREEWAY);
2312         } else if (p->subs[SUB_THREEWAY].owner->bridge) {
2313                 if (p->subs[SUB_REAL].owner->_state == AST_STATE_RINGING) {
2314                         ast_indicate(p->subs[SUB_THREEWAY].owner->bridge, AST_CONTROL_RINGING);
2315                 }
2316                 ast_moh_stop(p->subs[SUB_THREEWAY].owner->bridge);
2317                 if (ast_channel_masquerade(p->subs[SUB_REAL].owner, p->subs[SUB_THREEWAY].owner->bridge)) {
2318                         ast_log(LOG_WARNING, "Unable to masquerade %s as %s\n",
2319                                         p->subs[SUB_THREEWAY].owner->bridge->name, p->subs[SUB_REAL].owner->name);
2320                         return -1;
2321                 }
2322                 swap_subs(p, SUB_THREEWAY, SUB_REAL);
2323                 unalloc_sub(p, SUB_THREEWAY);
2324                 /* Tell the caller not to hangup */
2325                 return 1;
2326         } else {
2327                 ast_log(LOG_DEBUG, "Neither %s nor %s are in a bridge, nothing to transfer\n",
2328                                         p->subs[SUB_REAL].owner->name, p->subs[SUB_THREEWAY].owner->name);
2329                 p->subs[SUB_THREEWAY].owner->_softhangup |= AST_SOFTHANGUP_DEV;
2330         }
2331         return 0;
2332 }
2333
2334 #ifdef ZAPATA_R2
2335 static struct ast_frame *handle_r2_event(struct zt_pvt *p, mfcr2_event_t *e, int index)
2336 {
2337         struct ast_frame *f;
2338         f = &p->subs[index].f;
2339         if (!p->r2) {
2340                 ast_log(LOG_WARNING, "Huh?  No R2 structure :(\n");
2341                 return NULL;
2342         }
2343         switch(e->e) {
2344         case MFCR2_EVENT_BLOCKED:
2345                 if (option_verbose > 2)
2346                         ast_verbose(VERBOSE_PREFIX_3 "Channel %d blocked\n", p->channel);
2347                 break;
2348         case MFCR2_EVENT_UNBLOCKED:
2349                 if (option_verbose > 2)
2350                         ast_verbose(VERBOSE_PREFIX_3 "Channel %d unblocked\n", p->channel);
2351                 break;
2352         case MFCR2_EVENT_CONFIG_ERR:
2353                 if (option_verbose > 2)
2354                         ast_verbose(VERBOSE_PREFIX_3 "Config error on channel %d\n", p->channel);
2355                 break;
2356         case MFCR2_EVENT_RING:
2357                 if (option_verbose > 2)
2358                         ast_verbose(VERBOSE_PREFIX_3 "Ring on channel %d\n", p->channel);
2359                 break;
2360         case MFCR2_EVENT_HANGUP:
2361                 if (option_verbose > 2)
2362                         ast_verbose(VERBOSE_PREFIX_3 "Hangup on channel %d\n", p->channel);
2363                 break;
2364         case MFCR2_EVENT_RINGING:
2365                 if (option_verbose > 2)
2366                         ast_verbose(VERBOSE_PREFIX_3 "Ringing on channel %d\n", p->channel);
2367                 break;
2368         case MFCR2_EVENT_ANSWER:
2369                 if (option_verbose > 2)
2370                         ast_verbose(VERBOSE_PREFIX_3 "Answer on channel %d\n", p->channel);
2371                 break;
2372         case MFCR2_EVENT_HANGUP_ACK:
2373                 if (option_verbose > 2)
2374                         ast_verbose(VERBOSE_PREFIX_3 "Hangup ACK on channel %d\n", p->channel);
2375                 break;
2376         case MFCR2_EVENT_IDLE:
2377                 if (option_verbose > 2)
2378                         ast_verbose(VERBOSE_PREFIX_3 "Idle on channel %d\n", p->channel);
2379                 break;
2380         default:
2381                 ast_log(LOG_WARNING, "Unknown MFC/R2 event %d\n", e->e);
2382                 break;
2383         }
2384         return f;
2385 }
2386
2387 static mfcr2_event_t *r2_get_event_bits(struct zt_pvt *p)
2388 {
2389         int x;
2390         int res;
2391         mfcr2_event_t *e;
2392         res = ioctl(p->subs[SUB_REAL].zfd, ZT_GETRXBITS, &x);
2393         if (res) {
2394                 ast_log(LOG_WARNING, "Unable to check received bits\n");
2395                 return NULL;
2396         }
2397         if (!p->r2) {
2398                 ast_log(LOG_WARNING, "Odd, no R2 structure on channel %d\n", p->channel);
2399                 return NULL;
2400         }
2401         e = mfcr2_cas_signaling_event(p->r2, x);
2402         return e;
2403 }
2404 #endif
2405
2406 static int check_for_conference(struct zt_pvt *p)
2407 {
2408         ZT_CONFINFO ci;
2409         /* Fine if we already have a master, etc */
2410         if (p->master || (p->confno > -1))
2411                 return 0;
2412         memset(&ci, 0, sizeof(ci));
2413         if (ioctl(p->subs[SUB_REAL].zfd, ZT_GETCONF, &ci)) {
2414                 ast_log(LOG_WARNING, "Failed to get conference info on channel %d\n", p->channel);
2415                 return 0;
2416         }
2417         /* If we have no master and don't have a confno, then 
2418            if we're in a conference, it's probably a MeetMe room or
2419            some such, so don't let us 3-way out! */
2420         if (ci.confno) {
2421                 if (option_verbose > 2) 
2422                         ast_verbose(VERBOSE_PREFIX_3 "Avoiding 3-way call when in an external conference\n");
2423                 return 1;
2424         }
2425         return 0;
2426 }
2427
2428 static int get_alarms(struct zt_pvt *p)
2429 {
2430         int res;
2431         ZT_SPANINFO zi;
2432         memset(&zi, 0, sizeof(zi));
2433         zi.spanno = p->span;
2434         res = ioctl(p->subs[SUB_REAL].zfd, ZT_SPANSTAT, &zi);
2435         if (res < 0) {
2436                 ast_log(LOG_WARNING, "Unable to determine alarm on channel %d\n", p->channel);
2437                 return 0;
2438         }
2439         return zi.alarms;
2440 }
2441                         
2442 static struct ast_frame *zt_handle_event(struct ast_channel *ast)
2443 {
2444         int res,x;
2445         int index;
2446         struct zt_pvt *p = ast->pvt->pvt;
2447         pthread_t threadid;
2448         pthread_attr_t attr;
2449         struct ast_channel *chan;
2450         pthread_attr_init(&attr);
2451         pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
2452         index = zt_get_index(ast, p, 0);
2453         p->subs[index].f.frametype = AST_FRAME_NULL;
2454         p->subs[index].f.datalen = 0;
2455         p->subs[index].f.samples = 0;
2456         p->subs[index].f.mallocd = 0;
2457         p->subs[index].f.offset = 0;
2458         p->subs[index].f.src = "zt_handle_event";
2459         p->subs[index].f.data = NULL;
2460         if (index < 0)
2461                 return &p->subs[index].f;
2462         res = zt_get_event(p->subs[index].zfd);
2463         ast_log(LOG_DEBUG, "Got event %s(%d) on channel %d (index %d)\n", event2str(res), res, p->channel, index);
2464         if (res & (ZT_EVENT_PULSEDIGIT | ZT_EVENT_DTMFDIGIT)) {
2465                 if (res & ZT_EVENT_PULSEDIGIT)
2466                         p->pulsedial = 1;
2467                 else
2468                         p->pulsedial = 0;
2469                 ast_log(LOG_DEBUG, "Pulse dial '%c'\n", res & 0xff);
2470                 p->subs[index].f.frametype = AST_FRAME_DTMF;
2471                 p->subs[index].f.subclass = res & 0xff;
2472                 /* Return the captured digit */
2473                 return &p->subs[index].f;
2474         }
2475         switch(res) {
2476                 case ZT_EVENT_BITSCHANGED:
2477                         if (p->sig == SIG_R2) {
2478 #ifdef ZAPATA_R2
2479                                 struct ast_frame  *f = &p->subs[index].f;
2480                                 mfcr2_event_t *e;
2481                                 e = r2_get_event_bits(p);
2482                                 if (e)
2483                                         f = handle_r2_event(p, e, index);
2484                                 return f;
2485 #else                           
2486                                 break;
2487 #endif
2488                         }
2489                         ast_log(LOG_WARNING, "Recieved bits changed on %s signalling?\n", sig2str(p->sig));
2490                 case ZT_EVENT_PULSE_START:
2491                         /* Stop tone if there's a pulse start and the PBX isn't started */
2492                         if (!ast->pbx)
2493                                 tone_zone_play_tone(p->subs[index].zfd, -1);
2494                         break;  
2495                 case ZT_EVENT_DIALCOMPLETE:
2496                         if (p->inalarm) break;
2497                         if (p->radio) break;
2498                         if (ioctl(p->subs[index].zfd,ZT_DIALING,&x) == -1) {
2499                                 ast_log(LOG_DEBUG, "ZT_DIALING ioctl failed on %s\n",ast->name);
2500                                 return NULL;
2501                         }
2502                         if (!x) { /* if not still dialing in driver */
2503                                 zt_enable_ec(p);
2504                                 p->dialing = 0;
2505                                 if (ast->_state == AST_STATE_DIALING) {
2506                                         if (p->callprogress && CANPROGRESSDETECT(p) && p->dsp) {
2507                                                 ast_log(LOG_DEBUG, "Done dialing, but waiting for progress detection before doing more...\n");
2508                                         } else if (p->confirmanswer || (!p->dialednone && ((p->sig == SIG_EM) || (p->sig == SIG_EMWINK) || (p->sig == SIG_FEATD) || (p->sig == SIG_FEATDMF) || (p->sig == SIG_FEATB) || (p->sig == SIG_SF) || (p->sig == SIG_SFWINK) || (p->sig == SIG_SF_FEATD) || (p->sig == SIG_SF_FEATDMF) || (p->sig == SIG_SF_FEATB)))) {
2509                                                 ast_setstate(ast, AST_STATE_RINGING);
2510                                         } else {
2511                                                 ast_setstate(ast, AST_STATE_UP);
2512                                                 p->subs[index].f.frametype = AST_FRAME_CONTROL;
2513                                                 p->subs[index].f.subclass = AST_CONTROL_ANSWER;
2514                                         }
2515                                 }
2516                         }
2517                         break;
2518                 case ZT_EVENT_ALARM:
2519                         p->inalarm = 1;
2520                         res = get_alarms(p);
2521                         ast_log(LOG_WARNING, "Detected alarm on channel %d: %s\n", p->channel, alarm2str(res));
2522                         /* fall through intentionally */
2523                 case ZT_EVENT_ONHOOK:
2524                         if (p->radio)
2525                         {
2526                                 p->subs[index].f.frametype = AST_FRAME_CONTROL;
2527                                 p->subs[index].f.subclass = AST_CONTROL_RADIO_UNKEY;
2528                                 break;
2529                         }
2530                         switch(p->sig) {
2531                         case SIG_FXOLS:
2532                         case SIG_FXOGS:
2533                         case SIG_FXOKS:
2534                                 p->onhooktime = time(NULL);
2535                                 p->msgstate = -1;
2536                                 /* Check for some special conditions regarding call waiting */
2537                                 if (index == SUB_REAL) {
2538                                         /* The normal line was hung up */
2539                                         if (p->subs[SUB_CALLWAIT].owner) {
2540                                                 /* There's a call waiting call, so ring the phone, but make it unowned in the mean time */
2541                                                 swap_subs(p, SUB_CALLWAIT, SUB_REAL);
2542                                                 if (option_verbose > 2) 
2543                                                         ast_verbose(VERBOSE_PREFIX_3 "Channel %d still has (callwait) call, ringing phone\n", p->channel);
2544                                                 unalloc_sub(p, SUB_CALLWAIT);   
2545 #if 0
2546                                                 p->subs[index].needanswer = 0;
2547                                                 p->subs[index].needringing = 0;
2548 #endif                                          
2549                                                 p->callwaitingrepeat = 0;
2550                                                 p->cidcwexpire = 0;
2551                                                 p->owner = NULL;
2552                                                 zt_ring_phone(p);
2553                                         } else if (p->subs[SUB_THREEWAY].owner) {
2554                                                 struct timeval tv;
2555                                                 unsigned int mssinceflash;
2556                                                 gettimeofday(&tv, NULL);
2557                                                 mssinceflash = (tv.tv_sec - p->flashtime.tv_sec) * 1000 + (tv.tv_usec - p->flashtime.tv_usec) / 1000;
2558                                                 ast_log(LOG_DEBUG, "Last flash was %d ms ago\n", mssinceflash);
2559                                                 if (mssinceflash < MIN_MS_SINCE_FLASH) {
2560                                                         /* It hasn't been long enough since the last flashook.  This is probably a bounce on 
2561                                                            hanging up.  Hangup both channels now */
2562                                                         if (p->subs[SUB_THREEWAY].owner)
2563                                                                 ast_queue_hangup(p->subs[SUB_THREEWAY].owner, 0);
2564                                                         p->subs[SUB_THREEWAY].owner->_softhangup |= AST_SOFTHANGUP_DEV;
2565                                                         ast_log(LOG_DEBUG, "Looks like a bounced flash, hanging up both calls on %d\n", p->channel);
2566                                                 } else if ((ast->pbx) ||
2567                                                         (ast->_state == AST_STATE_UP)) {
2568                                                         if (p->transfer) {
2569                                                                 /* In any case this isn't a threeway call anymore */
2570                                                                 p->subs[SUB_REAL].inthreeway = 0;
2571                                                                 p->subs[SUB_THREEWAY].inthreeway = 0;
2572                                                                 if ((res = attempt_transfer(p)) < 0)
2573                                                                         p->subs[SUB_THREEWAY].owner->_softhangup |= AST_SOFTHANGUP_DEV;
2574                                                                 else if (res) {
2575                                                                         /* Don't actually hang up at this point */
2576                                                                         break;
2577                                                                 }
2578                                                         } else
2579                                                                 p->subs[SUB_THREEWAY].owner->_softhangup |= AST_SOFTHANGUP_DEV;
2580                                                 } else {
2581                                                         /* Swap subs and dis-own channel */
2582                                                         swap_subs(p, SUB_THREEWAY, SUB_REAL);
2583                                                         p->owner = NULL;
2584                                                         /* Ring the phone */
2585                                                         zt_ring_phone(p);
2586                                                 }
2587                                         }
2588                                 } else {
2589                                         ast_log(LOG_WARNING, "Got a hangup and my index is %d?\n", index);
2590                                 }
2591                                 /* Fall through */
2592                         default:
2593                                 zt_disable_ec(p);
2594                                 return NULL;
2595                         }
2596                         break;
2597                 case ZT_EVENT_RINGOFFHOOK:
2598                         if (p->inalarm) break;
2599                         if (p->radio)
2600                         {
2601                                 p->subs[index].f.frametype = AST_FRAME_CONTROL;
2602                                 p->subs[index].f.subclass = AST_CONTROL_RADIO_KEY;
2603                                 break;
2604                         }
2605                         switch(p->sig) {
2606                         case SIG_FXOLS:
2607                         case SIG_FXOGS:
2608                         case SIG_FXOKS:
2609                                 switch(ast->_state) {
2610                                 case AST_STATE_RINGING:
2611                                         zt_enable_ec(p);
2612                                         p->subs[index].f.frametype = AST_FRAME_CONTROL;
2613                                         p->subs[index].f.subclass = AST_CONTROL_ANSWER;
2614                                         /* Make sure it stops ringing */
2615                                         zt_set_hook(p->subs[index].zfd, ZT_OFFHOOK);
2616                                         ast_log(LOG_DEBUG, "channel %d answered\n", p->channel);
2617                                         if (p->cidspill) {
2618                                                 /* Cancel any running CallerID spill */
2619                                                 free(p->cidspill);
2620                                                 p->cidspill = NULL;
2621                                         }
2622                                         p->dialing = 0;
2623                                         p->callwaitcas = 0;
2624                                         if (p->confirmanswer) {
2625                                                 /* Ignore answer if "confirm answer" is selected */
2626                                                 p->subs[index].f.frametype = AST_FRAME_NULL;
2627                                                 p->subs[index].f.subclass = 0;
2628                                         } else if (strlen(p->dop.dialstr)) {
2629                                                 /* nick@dccinc.com 4/3/03 - fxo should be able to do deferred dialing */
2630                                                 res = ioctl(p->subs[SUB_REAL].zfd, ZT_DIAL, &p->dop);
2631                                                 if (res < 0) {
2632                                                   ast_log(LOG_WARNING, "Unable to initiate dialing on trunk channel %d\n", p->channel);
2633                                                   p->dop.dialstr[0] = '\0';
2634                                                   return NULL;
2635                                                 } else {
2636                                                   ast_log(LOG_DEBUG, "Sent FXO deferred digit string: %s\n", p->dop.dialstr);
2637                                                   p->subs[index].f.frametype = AST_FRAME_NULL;
2638                                                   p->subs[index].f.subclass = 0;
2639                                                   p->dialing = 1;
2640                                                 }
2641                                                 p->dop.dialstr[0] = '\0';
2642                                            ast_setstate(ast, AST_STATE_DIALING);
2643                                         } else
2644                                            ast_setstate(ast, AST_STATE_UP);
2645                                         return &p->subs[index].f;
2646                                 case AST_STATE_DOWN:
2647                                         ast_setstate(ast, AST_STATE_RING);
2648                                         ast->rings = 1;
2649                                         p->subs[index].f.frametype = AST_FRAME_CONTROL;
2650                                         p->subs[index].f.subclass = AST_CONTROL_OFFHOOK;
2651                                         ast_log(LOG_DEBUG, "channel %d picked up\n", p->channel);
2652                                         return &p->subs[index].f;
2653                                 case AST_STATE_UP:
2654                                         /* Make sure it stops ringing */
2655                                         zt_set_hook(p->subs[index].zfd, ZT_OFFHOOK);
2656                                         /* Okay -- probably call waiting*/
2657                                         if (p->owner->bridge)
2658                                                         ast_moh_stop(p->owner->bridge);
2659                                         break;
2660                                 default:
2661                                         ast_log(LOG_WARNING, "FXO phone off hook in weird state %d??\n", ast->_state);
2662                                 }
2663                                 break;
2664                         case SIG_FXSLS:
2665                         case SIG_FXSGS:
2666                         case SIG_FXSKS:
2667                                 if (ast->_state == AST_STATE_RING) {
2668                                         p->ringt = RINGT;
2669                                 }
2670                                 /* Fall through */
2671                         case SIG_EM:
2672                         case SIG_EMWINK:
2673                         case SIG_FEATD:
2674                         case SIG_FEATDMF:
2675                         case SIG_FEATB:
2676                         case SIG_SF:
2677                         case SIG_SFWINK:
2678                         case SIG_SF_FEATD:
2679                         case SIG_SF_FEATDMF:
2680                         case SIG_SF_FEATB:
2681                                 if (ast->_state == AST_STATE_DOWN) {
2682                                         if (option_debug)
2683                                                 ast_log(LOG_DEBUG, "Ring detected\n");
2684                                         p->subs[index].f.frametype = AST_FRAME_CONTROL;
2685                                         p->subs[index].f.subclass = AST_CONTROL_RING;
2686                                 } else if (p->outgoing && ((ast->_state == AST_STATE_RINGING) || (ast->_state == AST_STATE_DIALING))) {
2687                                         if (option_debug)
2688                                                 ast_log(LOG_DEBUG, "Line answered\n");
2689                                         if (p->confirmanswer) {
2690                                                 p->subs[index].f.frametype = AST_FRAME_NULL;
2691                                                 p->subs[index].f.subclass = 0;
2692                                         } else {
2693                                                 p->subs[index].f.frametype = AST_FRAME_CONTROL;
2694                                                 p->subs[index].f.subclass = AST_CONTROL_ANSWER;
2695                                                 ast_setstate(ast, AST_STATE_UP);
2696                                         }
2697                                 } else if (ast->_state != AST_STATE_RING)
2698                                         ast_log(LOG_WARNING, "Ring/Off-hook in strange state %d on channel %d\n", ast->_state, p->channel);
2699                                 break;
2700                         default:
2701                                 ast_log(LOG_WARNING, "Don't know how to handle ring/off hoook for signalling %d\n", p->sig);
2702                         }
2703                         break;
2704                 case ZT_EVENT_RINGEROFF:
2705                         if (p->inalarm) break;
2706                         if (p->radio) break;
2707                         ast->rings++;
2708                         if ((ast->rings > p->cidrings) && (p->cidspill)) {
2709                                 ast_log(LOG_WARNING, "Didn't finish Caller-ID spill.  Cancelling.\n");
2710                                 free(p->cidspill);
2711                                 p->cidspill = NULL;
2712                                 p->callwaitcas = 0;
2713                         }
2714                         p->subs[index].f.frametype = AST_FRAME_CONTROL;
2715                         p->subs[index].f.subclass = AST_CONTROL_RINGING;
2716                         break;
2717                 case ZT_EVENT_RINGERON:
2718                         break;
2719                 case ZT_EVENT_NOALARM:
2720                         p->inalarm = 0;
2721                         ast_log(LOG_NOTICE, "Alarm cleared on channel %d\n", p->channel);
2722                         break;
2723                 case ZT_EVENT_WINKFLASH:
2724                         if (p->inalarm) break;
2725                         if (p->radio) break;
2726                         /* Remember last time we got a flash-hook */
2727                         gettimeofday(&p->flashtime, NULL);
2728                         switch(p->sig) {
2729                         case SIG_FXOLS:
2730                         case SIG_FXOGS:
2731                         case SIG_FXOKS:
2732                                 ast_log(LOG_DEBUG, "Winkflash, index: %d, normal: %d, callwait: %d, thirdcall: %d\n",
2733                                         index, p->subs[SUB_REAL].zfd, p->subs[SUB_CALLWAIT].zfd, p->subs[SUB_THREEWAY].zfd);
2734                                 p->callwaitcas = 0;
2735                                 if (index == SUB_REAL) {
2736                                         if (p->subs[SUB_CALLWAIT].owner) {
2737                                                 /* Swap to call-wait */
2738                                                 swap_subs(p, SUB_REAL, SUB_CALLWAIT);
2739                                                 tone_zone_play_tone(p->subs[SUB_REAL].zfd, -1);
2740                                                 p->owner = p->subs[SUB_REAL].owner;
2741                                                 ast_log(LOG_DEBUG, "Making %s the new owner\n", p->owner->name);
2742                                                 if (p->owner->_state == AST_STATE_RINGING) {
2743                                                         ast_setstate(p->owner, AST_STATE_UP);
2744                                                         p->subs[SUB_REAL].needanswer = 1;
2745                                                 }
2746                                                 p->callwaitingrepeat = 0;
2747                                                 p->cidcwexpire = 0;
2748                                                 /* Start music on hold if appropriate */
2749                                                 if (!p->subs[SUB_CALLWAIT].inthreeway && p->subs[SUB_CALLWAIT].owner->bridge)
2750                                                                 ast_moh_start(p->subs[SUB_CALLWAIT].owner->bridge, NULL);
2751                                                 if (p->subs[SUB_REAL].owner->bridge)
2752                                                                 ast_moh_stop(p->subs[SUB_REAL].owner->bridge);
2753                                         } else if (!p->subs[SUB_THREEWAY].owner) {
2754                                                 if (p->threewaycalling && !check_for_conference(p)) {
2755                                                         /* XXX This section needs much more error checking!!! XXX */
2756                                                         /* Start a 3-way call if feasible */
2757                                                         if ((ast->pbx) ||
2758                                                                         (ast->_state == AST_STATE_UP) ||
2759                                                                         (ast->_state == AST_STATE_RING)) {
2760                                                                 if (!alloc_sub(p, SUB_THREEWAY)) {
2761                                                                         /* Make new channel */
2762                                                                         chan = zt_new(p, AST_STATE_RESERVED, 0, SUB_THREEWAY, 0);
2763                                                                         /* Swap things around between the three-way and real call */
2764                                                                         swap_subs(p, SUB_THREEWAY, SUB_REAL);
2765                                                                         /* Disable echo canceller for better dialing */
2766                                                                         zt_disable_ec(p);
2767                                                                         res = tone_zone_play_tone(p->subs[SUB_REAL].zfd, ZT_TONE_DIALRECALL);
2768                                                                         if (res)
2769                                                                                 ast_log(LOG_WARNING, "Unable to start dial recall tone on channel %d\n", p->channel);
2770                                                                         p->owner = chan;
2771                                                                         if (pthread_create(&threadid, &attr, ss_thread, chan)) {
2772                                                                                 ast_log(LOG_WARNING, "Unable to start simple switch on channel %d\n", p->channel);
2773                                                                                 res = tone_zone_play_tone(p->subs[SUB_REAL].zfd, ZT_TONE_CONGESTION);
2774                                                                                 zt_enable_ec(p);
2775                                                                                 ast_hangup(chan);
2776                                                                         } else {
2777                                                                                 if (option_verbose > 2) 
2778                                                                                         ast_verbose(VERBOSE_PREFIX_3 "Started three way call on channel %d\n", p->channel);
2779                                                                                 /* Start music on hold if appropriate */
2780                                                                                 if (p->subs[SUB_THREEWAY].owner->bridge)
2781                                                                                         ast_moh_start(p->subs[SUB_THREEWAY].owner->bridge, NULL);
2782                                                                         }               
2783                                                                 } else
2784                                                                         ast_log(LOG_WARNING, "Unable to allocate three-way subchannel\n");
2785                                                         } else 
2786                                                                 ast_log(LOG_DEBUG, "Flash when call not up or ringing\n");
2787                                                 }
2788                                         } else {
2789                                                 /* Already have a 3 way call */
2790                                                 if (p->subs[SUB_THREEWAY].inthreeway) {
2791                                                         /* Call is already up, drop the last person */
2792                                                         if (option_debug)
2793                                                                 ast_log(LOG_DEBUG, "Got flash with three way call up, dropping last call on %d\n", p->channel);
2794                                                         /* If the primary call isn't answered yet, use it */
2795                                                         if ((p->subs[SUB_REAL].owner->_state != AST_STATE_UP) && (p->subs[SUB_THREEWAY].owner->_state == AST_STATE_UP)) {
2796                                                                 /* Swap back -- we're droppign the real 3-way that isn't finished yet*/
2797                                                                 swap_subs(p, SUB_THREEWAY, SUB_REAL);
2798                                                                 p->owner = p->subs[SUB_REAL].owner;
2799                                                         }
2800                                                         /* Drop the last call and stop the conference */
2801                                                         if (option_verbose > 2)
2802                                                                 ast_verbose(VERBOSE_PREFIX_3 "Dropping three-way call on %s\n", p->subs[SUB_THREEWAY].owner->name);
2803                                                         p->subs[SUB_THREEWAY].owner->_softhangup |= AST_SOFTHANGUP_DEV;
2804                                                         p->subs[SUB_REAL].inthreeway = 0;
2805                                                         p->subs[SUB_THREEWAY].inthreeway = 0;
2806                                                 } else {
2807                                                         /* Lets see what we're up to */
2808                                                         if ((ast->pbx) ||
2809                                                                         (ast->_state == AST_STATE_UP)) {
2810                                                                 int otherindex = SUB_THREEWAY;
2811                                                                 if (option_verbose > 2)
2812                                                                         ast_verbose(VERBOSE_PREFIX_3 "Building conference on call on %s and %s\n", p->subs[SUB_THREEWAY].owner->name, p->subs[SUB_REAL].owner->name);
2813                                                                 /* Put them in the threeway, and flip */
2814                                                                 p->subs[SUB_THREEWAY].inthreeway = 1;
2815                                                                 p->subs[SUB_REAL].inthreeway = 1;
2816                                                                 if (ast->_state == AST_STATE_UP) {
2817                                                                         swap_subs(p, SUB_THREEWAY, SUB_REAL);
2818                                                                         otherindex = SUB_REAL;
2819                                                                 }
2820                                                                 if (p->subs[otherindex].owner && p->subs[otherindex].owner->bridge)
2821                                                                         ast_moh_stop(p->subs[otherindex].owner->bridge);
2822                                                                 p->owner = p->subs[SUB_REAL].owner;
2823                                                                 if (ast->_state == AST_STATE_RINGING) {
2824                                                                      &nb