Add support for parking with IAX2
[asterisk/asterisk.git] / channels / chan_skinny.c
1 /*
2  * Asterisk -- A telephony toolkit for Linux.
3  *
4  * Implementation of the Skinny protocol
5  * 
6  * Asterisk is Copyright (C) 1999-2003 Mark Spencer
7  *
8  * chan_skinny was developed by Jeremy McNamara & Florian Overkamp
9  *
10  * This program is free software, distributed under the terms of
11  * the GNU General Public License
12  *
13  */
14
15
16 #include <stdio.h>
17 #include <stdlib.h>
18 #include <pthread.h>
19 #include <string.h>
20 #include <asterisk/lock.h>
21 #include <asterisk/channel.h>
22 #include <asterisk/channel_pvt.h>
23 #include <asterisk/config.h>
24 #include <asterisk/logger.h>
25 #include <asterisk/module.h>
26 #include <asterisk/pbx.h>
27 #include <asterisk/options.h>
28 #include <asterisk/lock.h>
29 #include <asterisk/sched.h>
30 #include <asterisk/io.h>
31 #include <asterisk/rtp.h>
32 #include <asterisk/acl.h>
33 #include <asterisk/callerid.h>
34 #include <asterisk/cli.h>
35 #include <asterisk/say.h>
36 #include <asterisk/cdr.h>
37 #include <asterisk/astdb.h>
38 #include <asterisk/parking.h>
39 #include <asterisk/app.h>
40 #include <asterisk/musiconhold.h>
41 #include <sys/socket.h>
42 #include <netinet/in.h>
43 #include <netinet/tcp.h>
44 #include <sys/ioctl.h>
45 #include <net/if.h>
46 #include <errno.h>
47 #include <unistd.h>
48 #include <fcntl.h>
49 #include <netdb.h>
50 #include <arpa/inet.h>
51 #include <sys/signal.h>
52 #include <signal.h>
53 #include <pthread.h>
54 #include <asterisk/dsp.h>
55 #include <ctype.h>
56
57 /************************************************************************************/
58 /*                         Skinny/Asterisk Protocol Settings                        */
59 /************************************************************************************/
60 static char *desc = "Skinny Client Control Protocol (Skinny)";
61 static char *tdesc = "Skinny Client Control Protocol (Skinny)";
62 static char *type = "Skinny";
63 static char *config = "skinny.conf";
64
65 /* Just about everybody seems to support ulaw, so make it a nice default */
66 static int capability = AST_FORMAT_ULAW;
67
68 #define DEFAULT_SKINNY_PORT     2000
69 #define DEFAULT_SKINNY_BACKLOG  2
70 #define SKINNY_MAX_PACKET       1000
71
72 static int  keep_alive = 120;
73 static char date_format[6] = "D-M-Y";
74 static char version_id[16] = "P002F202";
75
76 // these should be in an include file, but dunno what to include
77 typedef unsigned char  UINT8;
78 typedef unsigned short UINT16;
79 typedef unsigned int   UINT32;
80
81 /************************************************************************************/
82 /*                                Protocol Messages                                 */
83 /************************************************************************************/
84 /* message types */
85 #define KEEP_ALIVE_MESSAGE 0x0000
86 /* no additional struct */
87
88 #define REGISTER_MESSAGE 0x0001
89 typedef struct register_message {
90         char name[16];
91         int userId;
92         int instance;
93         char ip[4];
94         int type;
95         int maxStreams;
96 } register_message;
97
98 #define IP_PORT_MESSAGE 0x0002
99
100 #define KEYPAD_BUTTON_MESSAGE 0x0003
101 typedef struct keypad_button_message {
102         int button;
103 } keypad_button_message;
104
105 #define STIMULUS_MESSAGE 0x0005
106 typedef struct stimulus_message {
107         int stimulus;
108         int stimulusInstance;
109 } stimulus_message;
110                 
111 #define OFFHOOK_MESSAGE 0x0006
112 #define ONHOOK_MESSAGE 0x0007
113
114 #define CAPABILITIES_RES_MESSAGE 0x0010
115 typedef struct station_capabilities {   
116         int codec;
117         int frames;
118         union {
119                 char res[8];
120                 long rate;
121         } payloads;     
122 } station_capabilities;
123
124 typedef struct capabilities_res_message {
125         int count;
126         struct station_capabilities caps[18];
127 } capabilities_res_message;
128
129 #define SPEED_DIAL_STAT_REQ_MESSAGE 0x000A
130 typedef struct speed_dial_stat_req_message {
131         int speedDialNumber;
132 } speed_dial_stat_req_message;
133
134 #define LINE_STATE_REQ_MESSAGE 0x000B
135 typedef struct line_state_req_message {
136         int lineNumber;
137 } line_state_req_message;
138
139 #define TIME_DATE_REQ_MESSAGE 0x000D
140 #define VERSION_REQ_MESSAGE 0x000F
141 #define BUTTON_TEMPLATE_REQ_MESSAGE 0x000E
142 #define SERVER_REQUEST_MESSAGE 0x0012
143 #define ALARM_MESSAGE 0x0020
144
145 #define OPEN_RECIEVE_CHANNEL_ACK_MESSAGE 0x0022 
146 typedef struct open_recieve_channel_ack_message {
147         int status;
148         char ipAddr[4];
149         int port;
150         int passThruId;
151 } open_recieve_channel_ack_message;
152
153 #define SOFT_KEY_SET_REQ_MESSAGE 0x0025
154 #define UNREGISTER_MESSAGE 0x0027
155 #define SOFT_KEY_TEMPLATE_REQ_MESSAGE 0x0028
156
157 #define REGISTER_ACK_MESSAGE 0x0081
158 typedef struct register_ack_message {
159         int keepAlive;
160         char dateTemplate[6];
161         char res[2];
162         int secondaryKeepAlive;
163         char res2[4];
164 } register_ack_message;
165
166 #define START_TONE_MESSAGE 0x0082
167 typedef struct start_tone_message {
168         int tone;
169 } start_tone_message;
170
171 #define STOP_TONE_MESSAGE 0x0083
172
173 #define SET_RINGER_MESSAGE 0x0085
174 typedef struct set_ringer_message {
175         int ringerMode;
176 } set_ringer_message;
177
178 #define SET_LAMP_MESSAGE 0x0086
179 typedef struct set_lamp_message {
180         int stimulus;
181         int stimulusInstance;
182         int deviceStimulus;
183 } set_lamp_message;
184
185 #define SET_SPEAKER_MESSAGE 0x0088 
186 typedef struct set_speaker_message {
187         int mode;
188 } set_speaker_message;
189
190 #define START_MEDIA_TRANSMISSION_MESSAGE 0x008A
191 typedef struct media_qualifier {
192         int precedence;
193         int vad;
194         int packets;
195         int bitRate;
196 } media_qualifier;
197
198 typedef struct start_media_transmission_message {
199         int conferenceId;
200         int passThruPartyId;
201         char remoteIp[4];
202         int remotePort;
203         int packetSize;
204         int payloadType;
205         media_qualifier qualifier;
206 } start_media_transmission_message;
207
208 #define STOP_MEDIA_TRANSMISSION_MESSAGE 0x008B
209 typedef struct stop_media_transmission_message {
210         int conferenceId;
211         int passThruPartyId;
212 } stop_media_transmission_message;
213
214 #define CALL_INFO_MESSAGE 0x008F
215 typedef struct call_info_message {
216         char callingPartyName[40];
217         char callingParty[24];
218         char calledPartyName[40];
219         char calledParty[24];
220         int  instance;
221         int  reference;
222         int  type;
223         char originalCalledPartyName[40];
224         char originalCalledParty[24];
225 } call_info_message;
226
227 #define SPEED_DIAL_STAT_RES_MESSAGE 0x0091
228 typedef struct speed_dial_stat_res_message {
229         int speedDialNumber;
230         char speedDialDirNumber[24];
231         char speedDialDisplayName[40];
232 } speed_dial_stat_res_message;
233
234 #define LINE_STAT_RES_MESSAGE 0x0092
235 typedef struct line_stat_res_message {
236         int  linenumber;
237         char lineDirNumber[24];
238         char lineDisplayName[42];
239         int  space;
240 } line_stat_res_message;
241
242 #define DEFINETIMEDATE_MESSAGE 0x0094
243 typedef struct definetimedate_message {
244         int year;       /* since 1900 */
245         int month;
246         int dayofweek;  /* monday = 1 */
247         int day;
248         int hour;
249         int minute;
250         int seconds;
251         int milliseconds;
252         int timestamp;
253 } definetimedate_message;
254  
255 #define DISPLAYTEXT_MESSAGE 0x0099
256 typedef struct displaytext_message {
257         char text[40];
258 } displaytext_message;
259
260 #define REGISTER_REJ_MESSAGE 0x009D
261 typedef struct register_rej_message {
262         char errMsg[33];
263 } register_rej_message;
264
265 #define CAPABILITIES_REQ_MESSAGE 0x009B
266
267 #define SERVER_RES_MESSAGE 0x009E
268 typedef struct server_identifier {
269         char serverName[48];
270 } server_identifier;
271
272 typedef struct server_res_message {
273         server_identifier server[5];
274         int serverListenPort[5];
275         int serverIpAddr[5];
276 } server_res_message;
277
278 #define BUTTON_TEMPLATE_RES_MESSAGE 0x0097
279 static const char *button_definition_hack = {
280         "\x01\x09\x01\x02\x02\x02\x03\x02\x04\x02\x05\x02\x06\x02\x07\x02"
281         "\x08\x02\x09\x02\x00\xff\x00\xff\x00\xff\x00\xff\x00\xff\x00\xff"
282         "\x00\xff\x00\xff\x00\xff\x00\xff\x00\xff\x00\xff\x00\xff\x00\xff"
283         "\x00\xff\x00\xff\x00\xff\x00\xff\x00\xff\x00\xff\x00\xff\x00\xff"
284         "\x00\xff\x00\xff\x00\xff\x00\xff\x00\xff\x00\xff\x00\xff\x00\xff"
285         "\x00\xff\x00\xff"
286 };
287
288 typedef struct buttondefinition {
289         UINT8 instanceNumber;
290         UINT8 buttonDefinition;
291 } button_definition;
292
293 typedef struct button_template_res_message {
294         UINT32 buttonOffset;
295         UINT32 buttonCount;
296         UINT32 totalButtonCount;
297         button_definition definition[42];
298 } button_template_res_message;
299
300 #define VERSION_RES_MESSAGE 0x0098
301 typedef struct version_res_message {
302         char version[16];
303 } version_res_message;
304
305 #define KEEP_ALIVE_ACK_MESSAGE 0x0100
306
307 #define OPEN_RECIEVE_CHANNEL_MESSAGE 0x0105
308 typedef struct open_recieve_channel_message {
309         int conferenceId;
310         int partyId;
311         int packets;
312         int capability;
313         int echo;
314         int bitrate;
315 } open_recieve_channel_message;
316
317 #define CLOSE_RECIEVE_CHANNEL_MESSAGE 0x0106
318 typedef struct close_recieve_channel_message {
319         int conferenceId;
320         int partyId;
321 } close_recieve_channel_message;
322
323 #define SOFT_KEY_TEMPLATE_RES_MESSAGE 0x0108
324 static const char *soft_key_template_hack = {
325         "\x52\x65\x64\x69\x61\x6c\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
326         "\x01\x00\x00\x00\x4e\x65\x77\x43\x61\x6c\6c\\x00\x00\x00\x00\x00"
327         "\x00\x00\x00\x00\x02\x00\x00\x00\x48\x6f\x6c\x64\x00\x00\x00\x00"
328         "\x00\x00\x00\x00\x00\x00\x00\x00\x03\x00\x00\x00\x54\x72\x6e\x73"
329         "\x66\x65\x72\x00\x00\x00\x00\x00\x00\x00\x00\x00\x04\x00\x00\x00"
330         "\x43\x46\x77\x64\x41\x6c\x00\x00\x00\x00\x00\x00\x00\x00\x00\x05"
331         "\x00\x00\x00\x43\x46\x77\x64\x20\x42\x75\x73\x79\x00\x00\x00\x00"
332         "\x00\x00\x00\x06\x00\x00\x00\x43\x46\x77\x64\x4e\x6f\x41\x6e\x73"
333         "\x77\x65\x72\x00\x00\x00\x00\x07\x00\x00\x00\x3c\x3c\x00\x00\x00"
334         "\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x08\x00\x00\x00\x45"
335         "\x6e\x64\x43\x61\x6c\x6c\x00\x00\x00\x00\x00\x00\x00\x00\x00\x09"
336         "\x00\x00\x00\x52\x65\x73\x75\x6d\x65\x00\x00\x00\x00\x00\x00\x00"
337         "\x00\x00\x0a\x00\x00\x00\x41\x6e\x73\x77\x65\x72\x00\x00\x00\x00"
338         "\x00\x00\x00\x00\x00\x00\x0b\x00\x00\x00\x49\x6e\x66\x6f\x00\x00"
339         "\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x0c\x00\x00\x00\x43\x6f"
340         "\x6e\x66\x72\x6e\x00\x00\x00\x00\x00\x00\x00\x00\x00\x0d\x00\x00"
341         "\x00\x50\x61\x72\x6b\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
342         "\x00\x0e\x00\x00\x00\x4a\x6f\x69\x6e\x00\x00\x00\x00\x00\x00\x00"
343         "\x00\x00\x00\x00\x0f\x00\x00\x00\x4d\x65\x65\x74\x4d\x65\x00\x00"
344         "\x00\x00\x00\x00\x00\x00\x00\x00\x10\x00\x00\x00\x50\x69\x63\x6b"
345         "\x55\x70\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x11\x00\x00\x00"
346         "\x47\x50\x69\x63\x6b\x55\x70\x00\x00\x00\x00\x00\x00\x00\x00\x00"
347         "\x12\x00\x00\x00\x52\x6d\x4c\x73\x43\x00\x00\x00\x00\x00\x00\x00"
348         "\x00\x00\x00\x13\x00\x00\x00\x42\x61\x72\x67\x65\x00\x00\x00\x00"
349         "\x00\x00\x00\x00\x00\x00\x00\x14\x00\x00\x00\x42\x61\x72\x67\x65"
350         "\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x15\x00\x00\x00"
351 };
352
353 typedef struct soft_key_template_definition {
354         char softKeyLabel[16];
355         int softKeyEvent;
356 } soft_key_template_definition;
357
358 typedef struct soft_key_template {
359         int softKeyOffset;
360         int softKeyCount;
361         int totalSoftKeyCount;
362     soft_key_template_definition softKeyTemplateDefinition[32];
363 } soft_key_template;
364
365 #define SOFT_KEY_SET_RES_MESSAGE 0x0109
366 static const char *soft_key_set_hack = {
367         "\x01\x02\x05\x03\x09\x0a\x0b\x10\x11\x12\x04\x0e\x0d\x00\x00\x00"
368         "\x2d\x01\x2e\x01\x31\x01\x2f\x01\x35\x01\x36\x01\x37\x01\x3c\x01"
369         "\x3d\x01\x3e\x01\x30\x01\x3a\x01\x39\x01\x00\x00\x00\x00\x00\x00"
370         "\x03\x09\x04\x0e\x0d\x13\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
371         "\x2f\x01\x35\x01\x30\x01\x3a\x01\x39\x01\x3f\x01\x00\x00\x00\x00"
372         "\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
373         "\x0a\x02\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
374         "\x36\x01\x2e\x01\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
375         "\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
376         "\x0b\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
377         "\x37\x01\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
378         "\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
379         "\x01\x09\x05\x10\x11\x12\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
380         "\x2d\x01\x35\x01\x31\x01\x3c\x01\x3d\x01\x3e\x01\x00\x00\x00\x00"
381         "\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
382         "\x00\x09\x04\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
383         "\x00\x00\x35\x01\x30\x01\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
384         "\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
385         "\x08\x09\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
386         "\x34\x01\x35\x01\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
387         "\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
388         "\x00\x09\x0d\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
389         "\x00\x00\x35\x01\x39\x01\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
390         "\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
391         "\x00\x09\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
392         "\x00\x00\x35\x01\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
393         "\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
394         "\x01\x09\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
395         "\x2d\x01\x35\x01\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
396         "\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
397         "\x15\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
398         "\x41\x01\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
399         "\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00"
400 };
401
402 typedef struct soft_key_set_definition {
403         UINT8  softKeyTemplateIndex[16];
404         UINT16 softKeyInfoIndex[16];
405 } soft_key_set_definition;
406
407 typedef struct soft_key_sets {
408         UINT32 softKeySetOffset;
409         UINT32 softKeySetCount;
410         UINT32 totalSoftKeySetCount;
411         soft_key_set_definition softKeySetDefinition[16];
412         UINT32 res;
413 } soft_key_sets;
414
415 #define SELECT_SOFT_KEYS_MESSAGE 0x0110
416 typedef struct select_soft_keys_message {
417         int instance;
418         int reference;
419         int softKeySetIndex;
420         int validKeyMask;
421 } select_soft_keys_message;
422
423 #define CALL_STATE_MESSAGE 0x0111
424 typedef struct call_state_message {
425         int callState;
426         int lineInstance;
427         int callReference;
428 } call_state_message;
429
430 #define ACTIVATE_CALL_PLANE_MESSAGE 0x0116
431 typedef struct activate_call_plane_message {
432         int lineInstance;
433 } activate_call_plane_message;
434
435 /* packet composition */
436 typedef struct {
437         int len;
438         int res;
439         int e;
440         union {
441                 speed_dial_stat_req_message speeddialreq;
442                 register_message reg;
443                 register_ack_message regack;
444                 register_rej_message regrej;
445                 capabilities_res_message caps;
446                 version_res_message version;
447                 button_template_res_message buttontemplate;
448                 displaytext_message displaytext;
449                 definetimedate_message definetimedate;
450                 start_tone_message starttone;
451                 speed_dial_stat_res_message speeddial;
452                 line_state_req_message line;
453                 line_stat_res_message linestat;
454                 soft_key_sets softkeysets;
455                 soft_key_template softkeytemplate;
456                 server_res_message serverres;
457                 set_lamp_message setlamp;
458                 set_ringer_message setringer;
459                 call_state_message callstate;
460                 keypad_button_message keypad;
461                 select_soft_keys_message selectsoftkey;
462                 activate_call_plane_message activatecallplane;
463                 stimulus_message stimulus;
464                 set_speaker_message setspeaker;
465                 call_info_message callinfo;
466                 start_media_transmission_message startmedia;
467                 stop_media_transmission_message stopmedia;
468                 open_recieve_channel_message openrecievechannel;
469                 open_recieve_channel_ack_message openrecievechannelack;
470                 close_recieve_channel_message closerecievechannel;
471         } data;
472 } skinny_req;
473
474 /************************************************************************************/
475 /*                            Asterisk specific globals                             */
476 /************************************************************************************/
477
478 static int skinnydebug = 1;     /* XXX for now, enable debugging default */
479
480 /* a hostname, portnumber, socket and such is usefull for VoIP protocols */
481 static struct sockaddr_in bindaddr;
482 static char ourhost[256];
483 static int ourport;
484 static struct in_addr __ourip;
485 struct hostent *hp;
486 static int skinnysock  = -1;
487 static pthread_t tcp_thread;
488 static pthread_t accept_t;
489 static char context[AST_MAX_EXTENSION] = "default";
490 static char language[MAX_LANGUAGE] = "";
491 static char musicclass[MAX_LANGUAGE] = "";
492 static char callerid[AST_MAX_EXTENSION] = "";
493 static char linelabel[AST_MAX_EXTENSION] ="";
494 static int nat = 0;
495 static unsigned int cur_callergroup = 0;
496 static unsigned int cur_pickupgroup = 0;
497 static int immediate = 0;
498 static int callwaiting = 0;
499 static int callreturn = 0;
500 static int threewaycalling = 0;
501 /* This is for flashhook transfers */
502 static int transfer = 0;
503 static int cancallforward = 0;
504 /*static int busycount = 3;*/
505 static char accountcode[20] = "";
506 static char mailbox[AST_MAX_EXTENSION];
507 static int amaflags = 0;
508 static int callnums = 1;
509
510
511 #define SUB_REAL 0
512 #define SUB_ALT  1
513 #define MAX_SUBS 2
514
515 #define SKINNY_SPEAKERON 1
516 #define SKINNY_SPEAKEROFF 2
517
518 #define SKINNY_OFFHOOK 1
519 #define SKINNY_ONHOOK 2
520 #define SKINNY_RINGOUT 3
521 #define SKINNY_RINGIN 4
522 #define SKINNY_CONNECTED 5
523 #define SKINNY_BUSY 6
524 #define SKINNY_CONGESTION 7
525 #define SKINNY_HOLD 8
526 #define SKINNY_CALLWAIT 9
527 #define SKINNY_TRANSFER 10
528 #define SKINNY_PARK 11
529 #define SKINNY_PROGRESS 12
530 #define SKINNY_INVALID 14
531
532 #define SKINNY_SILENCE 0
533 #define SKINNY_DIALTONE 33
534 #define SKINNY_BUSYTONE 35
535 #define SKINNY_ALERT 36
536 #define SKINNY_REORDER 37
537 #define SKINNY_CALLWAITTONE 45
538
539 #define SKINNY_LAMP_OFF 1
540 #define SKINNY_LAMP_ON  2
541 #define SKINNY_LAMP_WINK 3
542 #define SKINNY_LAMP_FLASH 4
543 #define SKINNY_LAMP_BLINK 5
544
545 #define SKINNY_RING_OFF 1
546 #define SKINNY_RING_INSIDE 2
547 #define SKINNY_RING_OUTSIDE 3
548 #define SKINNY_RING_FEATURE 4
549
550 #define TYPE_TRUNK              1
551 #define TYPE_LINE               2
552
553 #define STIMULUS_REDIAL 1
554 #define STIMULUS_SPEEDDIAL 2
555 #define STIMULUS_HOLD 3
556 #define STIMULUS_TRANSFER 4
557 #define STIMULUS_FORWARDALL 5
558 #define STIMULUS_FORWARDBUSY 6
559 #define STIMULUS_FORWARDNOANSWER 7
560 #define STIMULUS_DISPLAY 8
561 #define STIMULUS_LINE 9
562
563 /* Skinny rtp stream modes */
564 #define SKINNY_CX_SENDONLY 0
565 #define SKINNY_CX_RECVONLY 1
566 #define SKINNY_CX_SENDRECV 2
567 #define SKINNY_CX_CONF     3
568 #define SKINNY_CX_CONFERENCE 3
569 #define SKINNY_CX_MUTE     4
570 #define SKINNY_CX_INACTIVE 4
571
572 #if 0
573 static char *skinny_cxmodes[] = {
574     "sendonly",
575     "recvonly",
576     "sendrecv",
577     "confrnce",
578     "inactive"
579 };
580 #endif
581
582 /* driver scheduler */
583 static struct sched_context *sched;
584 static struct io_context *io;
585
586 /* usage count and locking */
587 static int usecnt = 0;
588 static ast_mutex_t usecnt_lock = AST_MUTEX_INITIALIZER;
589
590 /* Protect the monitoring thread, so only one process can kill or start it, and not
591    when it's doing something critical. */
592 static ast_mutex_t monlock         = AST_MUTEX_INITIALIZER;
593 /* Protect the network socket */
594 static ast_mutex_t netlock         = AST_MUTEX_INITIALIZER;
595 /* Protect the session list */
596 static ast_mutex_t sessionlock = AST_MUTEX_INITIALIZER;
597 /* Protect the device list */
598 static ast_mutex_t devicelock = AST_MUTEX_INITIALIZER;
599
600 /* This is the thread for the monitor which checks for input on the channels
601    which are not currently in use.  */
602 static pthread_t monitor_thread = 0;
603
604 /* Wait up to 16 seconds for first digit */
605 static int firstdigittimeout = 16000;
606
607 /* How long to wait for following digits */
608 static int gendigittimeout = 8000;
609
610 /* How long to wait for an extra digit, if there is an ambiguous match */
611 static int matchdigittimeout = 3000;
612
613 struct skinny_subchannel {
614         ast_mutex_t lock;
615         unsigned int callid;
616         struct ast_channel *owner;
617         struct skinny_line *parent;
618         struct ast_rtp *rtp;
619         time_t lastouttime;
620         int lastout;
621         int cxmode;
622         int nat;
623         int outgoing;
624         int alreadygone;
625         struct skinny_subchannel *next; /* for our circular linked list */
626 };
627
628 struct skinny_line {
629         ast_mutex_t lock;
630         char name[80];
631         char label[42];                                                 /* Label that shows next to the line buttons */
632         struct skinny_subchannel *sub;                  /* pointer to our current connection, channel and stuff */
633         char accountcode[80];
634         char exten[AST_MAX_EXTENSION];                  /* Extention where to start */
635         char context[AST_MAX_EXTENSION];
636         char language[MAX_LANGUAGE];
637         char callerid[AST_MAX_EXTENSION];               /* Caller*ID */
638         char lastcallerid[AST_MAX_EXTENSION];   /* Last Caller*ID */
639         char call_forward[AST_MAX_EXTENSION];   
640         char mailbox[AST_MAX_EXTENSION];
641         char musicclass[MAX_LANGUAGE];
642         int curtone;                                            /* Current tone */
643         unsigned int callgroup;
644         unsigned int pickupgroup;
645         int callwaiting;
646         int transfer;
647         int threewaycalling;
648         int cancallforward;
649         int callreturn;
650         int dnd; /* How does this affect callwait?  Do we just deny a skinny_request if we're dnd? */
651         int hascallerid;
652         int hidecallerid;
653         int amaflags;
654         int type;
655         int instance;
656         int group;
657         int needdestroy;
658         int capability;
659         int nonCodecCapability;
660         int onhooktime;
661         int msgstate;           /* voicemail message state */
662         int immediate;
663         int hookstate;
664         int progress;
665         struct skinny_line *next;
666         struct skinny_device *parent;
667 };
668
669 static struct skinny_device {
670         /* A device containing one or more lines */
671         char name[80];
672         char id[16];
673         char version_id[16];    
674         int type;
675         int registered;
676         struct sockaddr_in addr;
677         struct in_addr ourip;
678         struct skinny_line *lines;
679         struct ast_ha *ha;
680         struct skinnysession *session;
681         struct skinny_device *next;
682 } *devices = NULL;
683
684 struct skinnysession {
685         pthread_t t;
686         ast_mutex_t lock;
687         struct sockaddr_in sin;
688         int fd;
689         char inbuf[SKINNY_MAX_PACKET];
690         struct skinny_device *device;
691         struct skinnysession *next;
692 } *sessions = NULL;
693
694 static skinny_req *req_alloc(size_t size)
695 {
696         skinny_req *req;
697         req = malloc(size+12);
698         if (!req) {
699                 return NULL;
700         }       
701         memset(req, 0, size+12);
702         return req;
703 }
704
705 static struct skinny_subchannel *find_subchannel_by_line(struct skinny_line *l)
706 {
707         /* Need to figure out how to determine which sub we want */
708         
709         struct skinny_subchannel *sub = l->sub;
710         return sub;
711 }
712
713 static struct skinny_subchannel *find_subchannel_by_name(char *dest)
714 {
715         struct skinny_line *l;
716         struct skinny_device *d;
717         char line[256];
718         char *at;
719         char *device;
720         
721         strncpy(line, dest, sizeof(line) - 1);
722         at = strchr(line, '@');
723         if (!at) {
724                 ast_log(LOG_NOTICE, "Device '%s' has no @ (at) sign!\n", dest);
725                 return NULL;
726         }
727         *at = '\0';
728         at++;
729         device = at;
730         ast_mutex_lock(&devicelock);
731         d = devices;
732         while(d) {
733                 if (!strcasecmp(d->name, device)) {
734                         if (skinnydebug) {
735                                 printf("Found device: %s\n", d->name);
736                         }
737                         /* Found the device */
738                         l = d->lines;
739                         while (l) {
740                                 /* Search for the right line */
741                                 if (!strcasecmp(l->name, line)) {
742                                         ast_mutex_unlock(&devicelock);
743                                         return l->sub;
744                                 }
745                                 l = l->next;
746                         }
747                 }
748                 d = d->next;
749         }
750         /* Device not found*/
751         ast_mutex_unlock(&devicelock);
752         return NULL;
753 }
754
755 static int transmit_response(struct skinnysession *s, skinny_req *req)
756 {
757         int res = 0;
758         ast_mutex_lock(&s->lock);
759 #if 0
760         printf("writing packet type %d (%d bytes) to socket %d\n", req->e, req->len+8, s->fd);
761 #endif
762         res = write(s->fd, req, req->len+8);
763         if (res != req->len+8) {
764                 ast_log(LOG_WARNING, "Transmit: write only sent %d out of %d bytes: %s\n", res, req->len+8, strerror(errno));
765         }
766         ast_mutex_unlock(&s->lock);
767         return 1;
768 }
769
770 /* XXX Do this right*/
771 static int convert_cap(int capability)
772 {
773         return 4; // ulaw (this is not the same as asterisk's '4'  :) 
774
775 }
776
777 static void transmit_speaker_mode(struct skinnysession *s, int mode)
778 {
779         skinny_req *req;
780
781         req = req_alloc(sizeof(struct set_speaker_message));
782         if (!req) {
783                 ast_log(LOG_ERROR, "Unable to allocate skinny_request, this is bad\n");
784                 return;
785         }
786         req->len = sizeof(set_speaker_message)+4;
787         req->e = SET_SPEAKER_MESSAGE;
788         req->data.setspeaker.mode = mode; 
789         transmit_response(s, req);
790 }
791
792 static void transmit_callstate(struct skinnysession *s, int instance, int state, unsigned callid)
793
794         skinny_req *req;
795         int memsize = sizeof(struct call_state_message);
796
797         req = req_alloc(memsize);
798         if (!req) {
799                 ast_log(LOG_ERROR, "Unable to allocate skinny_request, this is bad\n");
800                 return;
801         }       
802         if (state == SKINNY_ONHOOK) {
803                 transmit_speaker_mode(s, SKINNY_SPEAKEROFF);
804         }
805         req->len = sizeof(call_state_message)+4;
806         req->e = CALL_STATE_MESSAGE;
807         req->data.callstate.callState = state;
808         req->data.callstate.lineInstance = instance;
809         req->data.callstate.callReference = callid;
810         transmit_response(s, req);
811         if (state == SKINNY_OFFHOOK) {
812                 memset(req, 0, memsize);
813                 req->len = sizeof(activate_call_plane_message)+4;
814                 req->e = ACTIVATE_CALL_PLANE_MESSAGE;
815                 req->data.activatecallplane.lineInstance = instance;
816                 transmit_response(s, req);
817         } else if (state == SKINNY_ONHOOK) {
818                 memset(req, 0, memsize);
819                 req->len = sizeof(activate_call_plane_message)+4;
820                 req->e = ACTIVATE_CALL_PLANE_MESSAGE;
821                 req->data.activatecallplane.lineInstance = 0;
822                 transmit_response(s, req);
823                 memset(req, 0, memsize);
824                 req->len = sizeof(close_recieve_channel_message)+4;
825                 req->e = CLOSE_RECIEVE_CHANNEL_MESSAGE;
826                 req->data.closerecievechannel.conferenceId = 0;
827                 req->data.closerecievechannel.partyId = 0;
828                 transmit_response(s, req);
829                 memset(req, 0, memsize);
830                 req->len = sizeof(stop_media_transmission_message)+4;
831                 req->e = STOP_MEDIA_TRANSMISSION_MESSAGE;
832                 req->data.stopmedia.conferenceId = 0;   
833                 req->data.stopmedia.passThruPartyId = 0;
834                 transmit_response(s, req);      
835         }
836 }       
837
838 static void transmit_connect(struct skinnysession *s)
839 {
840         skinny_req *req;
841         struct skinny_line *l = s->device->lines;
842
843         req = req_alloc(sizeof(struct open_recieve_channel_message));
844         if (!req) {
845                 ast_log(LOG_ERROR, "Unable to allocate skinny_request, this is bad\n");
846                 return;
847         }       
848         req->len = sizeof(struct call_info_message);
849         req->e = OPEN_RECIEVE_CHANNEL_MESSAGE;
850         req->data.openrecievechannel.conferenceId = 0;
851         req->data.openrecievechannel.partyId = 0;
852         req->data.openrecievechannel.packets = 20;
853         req->data.openrecievechannel.capability = convert_cap(l->capability); 
854         req->data.openrecievechannel.echo = 0;
855         req->data.openrecievechannel.bitrate = 0;
856         transmit_response(s, req);
857 }       
858
859 static void transmit_tone(struct skinnysession *s, int tone)
860 {
861         skinny_req *req;
862
863         if (tone > 0)
864                 req = req_alloc(sizeof(struct start_tone_message));
865         else 
866                 req = req_alloc(4);
867         if (!req) {
868                 ast_log(LOG_ERROR, "Unable to allocate skinny_request, this is bad\n");
869                 return;
870         }       
871         if (tone > 0) {
872                 req->len = sizeof(start_tone_message)+4;
873                 req->e = START_TONE_MESSAGE;
874                 req->data.starttone.tone = tone; // da tone
875         } else {
876                 req->len = 4;
877                 req->e = STOP_TONE_MESSAGE;
878         }
879         transmit_response(s, req);
880 }
881
882 #if 0
883 static void transmit_selectsoftkeys(struct skinnysession *s, int instance, int callid, int softkey)
884 {
885         skinny_req *req;
886         int memsize = sizeof(struct select_soft_keys_message);
887
888         req = req_alloc(memsize);
889         if (!req) {
890                 ast_log(LOG_ERROR, "Unable to allocate skinny_request, this is bad\n");
891                 return;
892         }       
893         memset(req, 0, memsize);
894         req->len = sizeof(select_soft_keys_message)+4;
895         req->e = SELECT_SOFT_KEYS_MESSAGE;
896         req->data.selectsoftkey.instance = instance;
897         req->data.selectsoftkey.reference = callid;
898         req->data.selectsoftkey.softKeySetIndex = softkey;
899         transmit_response(s, req);
900 }
901 #endif
902
903 static void transmit_lamp_indication(struct skinnysession *s, int instance, int indication)
904 {
905         skinny_req *req;
906
907         req = req_alloc(sizeof(struct set_lamp_message));
908         if (!req) {
909                 ast_log(LOG_ERROR, "Unable to allocate skinny_request, this is bad\n");
910                 return;
911         }       
912         req->len = sizeof(set_lamp_message)+4;
913         req->e = SET_LAMP_MESSAGE;
914         req->data.setlamp.stimulus = 0x9;  // magic number
915         req->data.setlamp.stimulusInstance = instance;
916         req->data.setlamp.deviceStimulus = indication;
917         transmit_response(s, req);
918 }
919
920 static void transmit_ringer_mode(struct skinnysession *s, int mode)
921 {
922         skinny_req *req;
923
924         req = req_alloc(sizeof(struct set_ringer_message));
925         if (!req) {
926                 ast_log(LOG_ERROR, "Unable to allocate skinny_request, this is bad\n");
927                 return;
928         }
929         req->len = sizeof(set_ringer_message)+4;
930         req->e = SET_RINGER_MESSAGE; 
931         req->data.setringer.ringerMode = mode; 
932         transmit_response(s, req);
933 }
934
935 /* I do not believe skinny can deal with video. 
936    Anyone know differently? */
937 static struct ast_rtp *skinny_get_vrtp_peer(struct ast_channel *chan)
938 {
939         return NULL;
940 }
941
942 static struct ast_rtp *skinny_get_rtp_peer(struct ast_channel *chan)
943 {
944         struct skinny_subchannel *sub;
945         sub = chan->pvt->pvt;
946         if (sub && sub->rtp)
947                 return sub->rtp;
948         return NULL;
949 }
950
951 static int skinny_set_rtp_peer(struct ast_channel *chan, struct ast_rtp *rtp, struct ast_rtp *vrtp)
952 {
953         struct skinny_subchannel *sub;
954         sub = chan->pvt->pvt;
955         if (sub) {
956                 /* transmit_modify_with_sdp(sub, rtp); @@FIXME@@ if needed */
957                 return 0;
958         }
959         return -1;
960 }
961
962 static struct ast_rtp_protocol skinny_rtp = {
963         get_rtp_info: skinny_get_rtp_peer,
964         get_vrtp_info: skinny_get_vrtp_peer,
965         set_rtp_peer: skinny_set_rtp_peer,
966 };
967
968 static int skinny_do_debug(int fd, int argc, char *argv[])
969 {
970         if (argc != 2)
971                 return RESULT_SHOWUSAGE;
972         skinnydebug = 1;
973         ast_cli(fd, "Skinny Debugging Enabled\n");
974         return RESULT_SUCCESS;
975 }
976
977 static int skinny_no_debug(int fd, int argc, char *argv[])
978 {
979         if (argc != 3)
980                 return RESULT_SHOWUSAGE;
981         skinnydebug = 0;
982         ast_cli(fd, "Skinny Debugging Disabled\n");
983         return RESULT_SUCCESS;
984 }
985
986 static int skinny_show_lines(int fd, int argc, char *argv[])
987 {
988         struct skinny_device  *d;
989         struct skinny_line *l;
990         int haslines = 0;
991         if (argc != 3) 
992                 return RESULT_SHOWUSAGE;
993         ast_mutex_lock(&devicelock);
994         d = devices;
995         while(d) {
996                 l = d->lines;
997                 ast_cli(fd, "Device '%s' at %s\n", d->name, inet_ntoa(d->addr.sin_addr));
998                 while(l) {
999                         ast_cli(fd, "   -- '%s@%s in '%s' is %s\n", l->name, d->name, l->context, l->sub->owner ? "active" : "idle");
1000                         haslines = 1;
1001                         l = l->next;
1002                 }
1003                 if (!haslines) {
1004                         ast_cli(fd, "   << No Lines Defined >>     ");
1005                 }
1006                 d = d->next;
1007         }
1008         ast_mutex_unlock(&devicelock);
1009         return RESULT_SUCCESS;
1010 }
1011
1012 static char show_lines_usage[] = 
1013 "Usage: skinny show lines\n"
1014 "       Lists all lines known to the Skinny subsystem.\n";
1015
1016 static char debug_usage[] = 
1017 "Usage: skinny debug\n"
1018 "       Enables dumping of Skinny packets for debugging purposes\n";
1019
1020 static char no_debug_usage[] = 
1021 "Usage: skinny no debug\n"
1022 "       Disables dumping of Skinny packets for debugging purposes\n";
1023
1024 static struct ast_cli_entry  cli_show_lines =
1025         { { "skinny", "show", "lines", NULL }, skinny_show_lines, "Show defined Skinny lines per device", show_lines_usage };
1026 static struct ast_cli_entry  cli_debug =
1027         { { "skinny", "debug", NULL }, skinny_do_debug, "Enable Skinny debugging", debug_usage };
1028 static struct ast_cli_entry  cli_no_debug =
1029         { { "skinny", "no", "debug", NULL }, skinny_no_debug, "Disable Skinny debugging", no_debug_usage };
1030
1031 static struct skinny_device *build_device(char *cat, struct ast_variable *v)
1032 {
1033         struct skinny_device *d;
1034         struct skinny_line *l;
1035         struct skinny_subchannel *sub;
1036         int i=0, y=0;
1037         
1038         d = malloc(sizeof(struct skinny_device));
1039         if (d) {
1040                 memset(d, 0, sizeof(struct skinny_device));
1041                 strncpy(d->name, cat, sizeof(d->name) - 1);
1042                 while(v) {
1043                         if (!strcasecmp(v->name, "host")) {
1044                                         if (ast_get_ip(&d->addr, v->value)) {
1045                                                 free(d);
1046                                                 return NULL;
1047                                         }                               
1048                         } else if (!strcasecmp(v->name, "port")) {
1049                                 d->addr.sin_port = htons(atoi(v->value));
1050                         } else if (!strcasecmp(v->name, "device")) {
1051                         strncpy(d->id, v->value, sizeof(d->id)-1);
1052                         } else if (!strcasecmp(v->name, "permit") || !strcasecmp(v->name, "deny")) {
1053                                 d->ha = ast_append_ha(v->name, v->value, d->ha);
1054                         } else if (!strcasecmp(v->name, "context")) {
1055                                 strncpy(context, v->value, sizeof(context) - 1);
1056                         } else if (!strcasecmp(v->name, "version")) {
1057                                 strncpy(d->version_id, v->value, sizeof(d->version_id) -1); 
1058                         } else if (!strcasecmp(v->name, "nat")) {
1059                                 nat = ast_true(v->value);
1060                         } else if (!strcasecmp(v->name, "callerid")) {
1061                                 if (!strcasecmp(v->value, "asreceived")) {
1062                                         strcpy(callerid, "");
1063                                 } else {
1064                                         strncpy(callerid, v->value, sizeof(callerid) - 1);
1065                                 }
1066                         } else if (!strcasecmp(v->name, "language")) {
1067                                 strncpy(language, v->value, sizeof(language)-1);
1068                         } else if (!strcasecmp(v->name, "accountcode")) {
1069                                 strncpy(accountcode, v->value, sizeof(accountcode)-1);
1070                         } else if (!strcasecmp(v->name, "amaflags")) {
1071                                 y = ast_cdr_amaflags2int(v->value);
1072                                 if (y < 0) {
1073                                         ast_log(LOG_WARNING, "Invalid AMA flags: %s at line %d\n", v->value, v->lineno);
1074                                 } else {
1075                                 amaflags = y;
1076                                 }
1077                         } else if (!strcasecmp(v->name, "musiconhold")) {
1078                                 strncpy(musicclass, v->value, sizeof(musicclass)-1);
1079                         } else if (!strcasecmp(v->name, "callgroup")) {
1080                                 cur_callergroup = ast_get_group(v->value);
1081                         } else if (!strcasecmp(v->name, "pickupgroup")) {
1082                                 cur_pickupgroup = ast_get_group(v->value);
1083                         } else if (!strcasecmp(v->name, "immediate")) {
1084                                 immediate = ast_true(v->value);
1085                         } else if (!strcasecmp(v->name, "cancallforward")) {
1086                                 cancallforward = ast_true(v->value);
1087                         } else if (!strcasecmp(v->name, "mailbox")) {
1088                                 strncpy(mailbox, v->value, sizeof(mailbox) -1);
1089                         } else if (!strcasecmp(v->name, "callreturn")) {
1090                                 callreturn = ast_true(v->value);
1091                         } else if (!strcasecmp(v->name, "immediate")) {
1092                                 immediate = ast_true(v->value);
1093                         } else if (!strcasecmp(v->name, "callwaiting")) {
1094                                 callwaiting = ast_true(v->value);
1095                         } else if (!strcasecmp(v->name, "transfer")) {
1096                                 transfer = ast_true(v->value);
1097                         } else if (!strcasecmp(v->name, "threewaycalling")) {
1098                                 threewaycalling = ast_true(v->value);
1099                         } else if (!strcasecmp(v->name, "linelabel")) {
1100                                 strncpy(linelabel, v->value, sizeof(linelabel)-1);
1101                         } else if (!strcasecmp(v->name, "trunk") || !strcasecmp(v->name, "line")) {
1102                                 l = malloc(sizeof(struct skinny_line));;
1103                                 if (l) {
1104                                         memset(l, 0, sizeof(struct skinny_line));
1105                                         strncpy(l->name, v->value, sizeof(l->name) - 1);
1106                                         
1107                                         /* XXX Should we check for uniqueness?? XXX */
1108                                         
1109                                         strncpy(l->context, context, sizeof(l->context) - 1);
1110                                         strncpy(l->callerid, callerid, sizeof(l->callerid) - 1);
1111                                         strncpy(l->label, linelabel, sizeof(l->label) - 1);
1112                                         strncpy(l->language, language, sizeof(l->language) - 1);
1113                                         strncpy(l->musicclass, musicclass, sizeof(l->musicclass)-1);
1114                                         strncpy(l->mailbox, mailbox, sizeof(l->mailbox)-1);
1115                                         strncpy(l->mailbox, mailbox, sizeof(l->mailbox)-1);
1116                                         if (strlen(mailbox)) {
1117                                                 ast_verbose(VERBOSE_PREFIX_3 "Setting mailbox '%s' on %s@%s\n", mailbox, d->name, l->name);
1118                                         }
1119                                 
1120                                         l->msgstate = -1;
1121                                         l->capability = capability;
1122                                         l->parent = d;
1123                                         if (!strcasecmp(v->name, "trunk")) {
1124                                                 l->type = TYPE_TRUNK;
1125                                         } else {
1126                                                 l->type = TYPE_LINE;
1127                                         }
1128                                         l->immediate = immediate;
1129                                         l->callgroup = cur_callergroup;
1130                                         l->pickupgroup = cur_pickupgroup;
1131                                         l->callreturn = callreturn;
1132                                         l->cancallforward = cancallforward;
1133                                         l->callwaiting = callwaiting;
1134                                         l->transfer = transfer; 
1135                                         l->threewaycalling = threewaycalling;
1136                                         l->onhooktime = time(NULL);
1137                                         l->instance = 1;
1138                                         /* ASSUME we're onhook at this point*/
1139                                         l->hookstate = SKINNY_ONHOOK;
1140
1141                                         for (i = 0; i < MAX_SUBS; i++) {
1142                                                 sub = malloc(sizeof(struct skinny_subchannel));
1143                                                 if (sub) {
1144                                                         ast_verbose(VERBOSE_PREFIX_3 "Allocating Skinny subchannel '%d' on %s@%s\n", i, l->name, d->name);
1145                                                         memset(sub, 0, sizeof(struct skinny_subchannel));
1146                                                         sub->parent = l;
1147                                                         /* Make a call*ID */
1148                                                         sub->callid = callnums;
1149                                                         callnums++;
1150                                                         sub->cxmode = SKINNY_CX_INACTIVE;
1151                                                         sub->nat = nat;
1152                                                         sub->next = l->sub;
1153                                                         l->sub = sub;
1154                                                 } else {
1155                                                         /* XXX Should find a way to clean up our memory */
1156                                                         ast_log(LOG_WARNING, "Out of memory allocating subchannel");
1157                                                         return NULL;
1158                                                 }
1159                                         }
1160                                         l->next = d->lines;
1161                                         d->lines = l;                   
1162                                 } else {
1163                                         /* XXX Should find a way to clean up our memory */
1164                                         ast_log(LOG_WARNING, "Out of memory allocating line");
1165                                         return NULL;
1166                                 }
1167                         } else {
1168                                 ast_log(LOG_WARNING, "Don't know keyword '%s' at line %d\n", v->name, v->lineno);
1169                         }
1170                         v = v->next;
1171                 }
1172         
1173                 if (!d->lines) {
1174                         ast_log(LOG_ERROR, "A Skinny device must have at least one line!\n");
1175                         return NULL;
1176                 }
1177
1178                 if (d->addr.sin_addr.s_addr && !ntohs(d->addr.sin_port))
1179                         d->addr.sin_port = htons(DEFAULT_SKINNY_PORT);
1180                 if (d->addr.sin_addr.s_addr) {
1181                         if (ast_ouraddrfor(&d->addr.sin_addr, &d->ourip)) {
1182                                 memcpy(&d->ourip, &__ourip, sizeof(d->ourip));
1183                         }
1184                 } else {
1185                         memcpy(&d->ourip, &__ourip, sizeof(d->ourip));
1186                 }
1187         }
1188         return d;
1189 }
1190
1191 static int has_voicemail(struct skinny_line *l)
1192 {
1193         return ast_app_has_voicemail(l->mailbox);
1194 }
1195
1196 static int skinny_register(skinny_req *req, struct skinnysession *s)
1197 {
1198         struct skinny_device *d;
1199         
1200         ast_mutex_lock(&devicelock);
1201         d = devices;
1202         while (d) {
1203                 if (!strcasecmp(req->data.reg.name, d->id)) {
1204                         /* XXX Deal with IP authentication */
1205                         s->device = d;
1206                         d->type = req->data.reg.type;
1207                         if (!strlen(d->version_id)) {
1208                                 strncpy(d->version_id, version_id, sizeof(d->version_id));
1209                         }
1210                         d->registered = 1;
1211                         d->session = s;
1212                         break;
1213                 }
1214                 d = d->next;
1215         }
1216         ast_mutex_unlock(&devicelock);
1217
1218         if (!d)
1219                 return 0;
1220         
1221         return 1;
1222 }               
1223
1224 static void start_rtp(struct skinny_subchannel *sub)
1225 {
1226                 ast_mutex_lock(&sub->lock);
1227                 /* Allocate the RTP */
1228                 sub->rtp = ast_rtp_new(sched, io, 1, 0);
1229                 if (sub->rtp && sub->owner)
1230                         sub->owner->fds[0] = ast_rtp_fd(sub->rtp);
1231                 if (sub->rtp)
1232                         ast_rtp_setnat(sub->rtp, sub->nat);
1233                 
1234                 /* Create the RTP connections  */
1235                 transmit_connect(sub->parent->parent->session);
1236                 ast_mutex_unlock(&sub->lock);
1237 }
1238
1239
1240 static void *skinny_ss(void *data)
1241 {
1242         struct ast_channel *chan = data;
1243         struct skinny_subchannel *sub = chan->pvt->pvt;
1244         struct skinny_line *l = sub->parent;
1245         struct skinnysession *s = l->parent->session;
1246         char exten[AST_MAX_EXTENSION] = "";
1247         int len = 0;
1248         int timeout = firstdigittimeout;
1249         int res;
1250         int getforward=0;
1251     
1252         if (option_verbose > 2) 
1253                 ast_verbose( VERBOSE_PREFIX_3 "Starting simple switch on '%s@%s'\n", l->name, l->parent->name);
1254
1255         while(len < AST_MAX_EXTENSION-1) {
1256         res = ast_waitfordigit(chan, timeout);
1257         timeout = 0;
1258         if (res < 0) {
1259                         if (skinnydebug)
1260                                 printf("Skinny(%s@%s): waitfordigit returned < 0\n", l->name, l->parent->name);
1261                 ast_indicate(chan, -1);
1262                         ast_hangup(chan);
1263             return NULL;
1264         } else if (res)  {
1265             exten[len++]=res;
1266             exten[len] = '\0';
1267         }
1268         if (!ast_ignore_pattern(chan->context, exten)) {
1269                         transmit_tone(s, SKINNY_SILENCE);
1270         } 
1271         if (ast_exists_extension(chan, chan->context, exten, 1, l->callerid)) {
1272             if (!res || !ast_matchmore_extension(chan, chan->context, exten, 1, l->callerid)) {
1273                 if (getforward) {
1274                     /* Record this as the forwarding extension */
1275                     strncpy(l->call_forward, exten, sizeof(l->call_forward)); 
1276                     if (option_verbose > 2) {
1277                         ast_verbose(VERBOSE_PREFIX_3 "Setting call forward to '%s' on channel %s\n", 
1278                                 l->call_forward, chan->name);
1279                     }
1280                     transmit_tone(s, SKINNY_DIALTONE); 
1281                     if (res) {
1282                             break;
1283                     }
1284                     usleep(500000);
1285                     ast_indicate(chan, -1);
1286                     sleep(1);
1287                     memset(exten, 0, sizeof(exten));
1288                     transmit_tone(s, SKINNY_DIALTONE); 
1289                     len = 0;
1290                     getforward = 0;
1291                 } else  {
1292                     strncpy(chan->exten, exten, sizeof(chan->exten)-1);
1293                     if (strlen(l->callerid)) {
1294                         if (!l->hidecallerid)
1295                             chan->callerid = strdup(l->callerid);
1296                         chan->ani = strdup(l->callerid);
1297                     }
1298                     ast_setstate(chan, AST_STATE_RING);
1299                     res = ast_pbx_run(chan);
1300                     if (res) {
1301                         ast_log(LOG_WARNING, "PBX exited non-zero\n");
1302                                                 transmit_tone(s, SKINNY_REORDER); 
1303                     }
1304                     return NULL;
1305                 }
1306             } else {
1307                 /* It's a match, but they just typed a digit, and there is an ambiguous match,
1308                    so just set the timeout to matchdigittimeout and wait some more */
1309                 timeout = matchdigittimeout;
1310             }
1311         } else if (res == 0) {
1312             ast_log(LOG_DEBUG, "Not enough digits (and no ambiguous match)...\n");
1313                 transmit_tone(s, SKINNY_REORDER); 
1314             ast_hangup(chan);
1315             return NULL;
1316         } else if (l->callwaiting && !strcmp(exten, "*70")) {
1317             if (option_verbose > 2) {
1318                 ast_verbose(VERBOSE_PREFIX_3 "Disabling call waiting on %s\n", chan->name);
1319             }
1320             /* Disable call waiting if enabled */
1321             l->callwaiting = 0;
1322             transmit_tone(s, SKINNY_DIALTONE);
1323                         len = 0;
1324             memset(exten, 0, sizeof(exten));
1325             timeout = firstdigittimeout;
1326                 
1327         } else if (!strcmp(exten,ast_pickup_ext())) {
1328             /* Scan all channels and see if any there
1329              * ringing channqels with that have call groups
1330              * that equal this channels pickup group  
1331              */
1332             if (ast_pickup_call(chan)) {
1333                 ast_log(LOG_WARNING, "No call pickup possible...\n");
1334                                 transmit_tone(s, SKINNY_REORDER);
1335             }
1336             ast_hangup(chan);
1337             return NULL;
1338             
1339         } else if (!l->hidecallerid && !strcmp(exten, "*67")) {
1340             if (option_verbose > 2) {
1341                 ast_verbose(VERBOSE_PREFIX_3 "Disabling Caller*ID on %s\n", chan->name);
1342             }
1343             /* Disable Caller*ID if enabled */
1344             l->hidecallerid = 1;
1345             if (chan->callerid)
1346                 free(chan->callerid);
1347             chan->callerid = NULL;
1348             transmit_tone(s, SKINNY_DIALTONE);
1349             len = 0;
1350             memset(exten, 0, sizeof(exten));
1351             timeout = firstdigittimeout;
1352         } else if (l->callreturn && !strcmp(exten, "*69")) {
1353             res = 0;
1354             if (strlen(l->lastcallerid)) {
1355                 res = ast_say_digit_str(chan, l->lastcallerid, "", chan->language);
1356             }
1357             if (!res) {
1358                 transmit_tone(s, SKINNY_DIALTONE);
1359                         }
1360             break;
1361         } else if (!strcmp(exten, "*78")) {
1362             /* Do not disturb */
1363             if (option_verbose > 2) {
1364                 ast_verbose(VERBOSE_PREFIX_3 "Enabled DND on channel %s\n", chan->name);
1365             }
1366             transmit_tone(s, SKINNY_DIALTONE);
1367             l->dnd = 1;
1368             getforward = 0;
1369             memset(exten, 0, sizeof(exten));
1370             len = 0;
1371         } else if (!strcmp(exten, "*79")) {
1372             /* Do not disturb */
1373             if (option_verbose > 2) {
1374                 ast_verbose(VERBOSE_PREFIX_3 "Disabled DND on channel %s\n", chan->name);
1375             }
1376                         transmit_tone(s, SKINNY_DIALTONE);
1377             l->dnd = 0;
1378             getforward = 0;
1379             memset(exten, 0, sizeof(exten));
1380             len = 0;
1381         } else if (l->cancallforward && !strcmp(exten, "*72")) {
1382             transmit_tone(s, SKINNY_DIALTONE);
1383             getforward = 1;
1384             memset(exten, 0, sizeof(exten));
1385             len = 0;
1386         } else if (l->cancallforward && !strcmp(exten, "*73")) {
1387             if (option_verbose > 2) {
1388                 ast_verbose(VERBOSE_PREFIX_3 "Cancelling call forwarding on channel %s\n", chan->name);
1389             }
1390             transmit_tone(s, SKINNY_DIALTONE); 
1391             memset(l->call_forward, 0, sizeof(l->call_forward));
1392             getforward = 0;
1393             memset(exten, 0, sizeof(exten));
1394             len = 0;
1395         } else if (!strcmp(exten, ast_parking_ext()) && 
1396                     sub->next->owner &&
1397                     sub->next->owner->bridge) {
1398             /* This is a three way call, the main call being a real channel, 
1399                 and we're parking the first call. */
1400             ast_masq_park_call(sub->next->owner->bridge, chan, 0, NULL);
1401             if (option_verbose > 2) {
1402                 ast_verbose(VERBOSE_PREFIX_3 "Parking call to '%s'\n", chan->name);
1403             }
1404             break;
1405         } else if (strlen(l->lastcallerid) && !strcmp(exten, "*80")) {
1406             if (option_verbose > 2) {
1407                 ast_verbose(VERBOSE_PREFIX_3 "Blacklisting number %s\n", l->lastcallerid);
1408             }
1409             res = ast_db_put("blacklist", l->lastcallerid, "1");
1410             if (!res) {
1411                 transmit_tone(s, SKINNY_DIALTONE);              
1412                 memset(exten, 0, sizeof(exten));
1413                 len = 0;
1414             }
1415         } else if (l->hidecallerid && !strcmp(exten, "*82")) {
1416             if (option_verbose > 2) {
1417                 ast_verbose(VERBOSE_PREFIX_3 "Enabling Caller*ID on %s\n", chan->name);
1418             }
1419             /* Enable Caller*ID if enabled */
1420             l->hidecallerid = 0;
1421             if (chan->callerid)
1422                 free(chan->callerid);
1423             if (strlen(l->callerid))
1424                 chan->callerid = strdup(l->callerid);
1425             transmit_tone(s, SKINNY_DIALTONE);
1426             len = 0;
1427             memset(exten, 0, sizeof(exten));
1428             timeout = firstdigittimeout;
1429         } else if (!ast_canmatch_extension(chan, chan->context, exten, 1, chan->callerid) &&
1430                         ((exten[0] != '*') || (strlen(exten) > 2))) {
1431             ast_log(LOG_WARNING, "Can't match [%s] from '%s' in context %s\n", exten, chan->callerid ? chan->callerid : "<Unknown Caller>", chan->context);
1432             transmit_tone(s, SKINNY_REORDER); 
1433                         sleep(3); // hang out for 3 seconds to let congestion play
1434                         break;
1435         }
1436         if (!timeout)
1437             timeout = gendigittimeout;
1438         if (len && !ast_ignore_pattern(chan->context, exten))
1439                         ast_indicate(chan, -1);
1440     }
1441         ast_hangup(chan);
1442         return NULL;
1443 }
1444
1445
1446
1447 static int skinny_call(struct ast_channel *ast, char *dest, int timeout)
1448 {
1449         int res = 0;
1450         int tone = 0;
1451         struct skinny_line *l;
1452     struct skinny_subchannel *sub;
1453         struct skinnysession *session;
1454         
1455         sub = ast->pvt->pvt;
1456     l = sub->parent;
1457         session = l->parent->session;
1458
1459         if (!l->parent->registered) {
1460                 ast_log(LOG_ERROR, "Device not registered, cannot call %s\n", dest);
1461                 return -1;
1462         }
1463         
1464         if ((ast->_state != AST_STATE_DOWN) && (ast->_state != AST_STATE_RESERVED)) {
1465                 ast_log(LOG_WARNING, "skinny_call called on %s, neither down nor reserved\n", ast->name);
1466                 return -1;
1467         }
1468
1469     if (skinnydebug) {
1470         ast_verbose(VERBOSE_PREFIX_3 "skinny_call(%s)\n", ast->name);
1471     }
1472
1473         if (l->dnd) {
1474                 ast_queue_control(ast, AST_CONTROL_BUSY, 0);
1475                 return -1;
1476         }
1477    
1478         switch (l->hookstate) {
1479         case SKINNY_OFFHOOK:
1480             tone = SKINNY_CALLWAITTONE;
1481             break;
1482         case SKINNY_ONHOOK:
1483                         tone = SKINNY_ALERT;
1484                         break;
1485         default:
1486             ast_log(LOG_ERROR, "Don't know how to deal with hookstate %d\n", l->hookstate);
1487             break;
1488     }
1489
1490         transmit_lamp_indication(session, l->instance, SKINNY_LAMP_BLINK);
1491         transmit_ringer_mode(session, SKINNY_RING_INSIDE);
1492         transmit_tone(session, tone);
1493         transmit_callstate(session, l->instance, SKINNY_RINGIN, sub->callid);
1494
1495 // Set the prompt
1496 // Select the active softkeys
1497
1498         ast_setstate(ast, AST_STATE_RINGING);
1499         ast_queue_control(ast, AST_CONTROL_RINGING, 0);
1500
1501         sub->outgoing = 1;
1502 //    sub->cxmode = SKINNY_CX_RECVONLY;
1503         if (l->type == TYPE_LINE) {
1504         if (!sub->rtp) {
1505             start_rtp(sub);
1506         } else {
1507                         /* do we need to anything if there already is an RTP allocated? */
1508 //           transmit_modify_request(sub);
1509         }
1510
1511 #if 0
1512         if (sub->next->owner && sub->next->callid) {
1513             /* try to prevent a callwait from disturbing the other connection */
1514             sub->next->cxmode = SKINNY_CX_RECVONLY;
1515       //      transmit_modify_request(sub->next);
1516         }
1517                 
1518                 /* not sure what this doing */
1519                 if (sub->next->owner && sub->next->callid) {
1520             /* Put the connection back in sendrecv */
1521             sub->next->cxmode = SKINNY_CX_SENDRECV;
1522 //           transmit_modify_request(sub->next);
1523         }
1524 #endif
1525
1526         } else {
1527                 ast_log(LOG_NOTICE, "Don't know how to dial on trunks yet\n");
1528                 res = -1;
1529         }
1530         return res;
1531 }
1532
1533
1534 static int skinny_hangup(struct ast_channel *ast)
1535 {
1536     struct skinny_subchannel *sub = ast->pvt->pvt;
1537     struct skinny_line *l = sub->parent;
1538         struct skinnysession *s = l->parent->session;
1539
1540     if (skinnydebug) {
1541         ast_verbose("skinny_hangup(%s) on %s@%s\n", ast->name, l->name, l->parent->name);
1542     }
1543     if (!ast->pvt->pvt) {
1544         ast_log(LOG_DEBUG, "Asked to hangup channel not connected\n");
1545         return 0;
1546     }
1547
1548         if (l->parent->registered) {
1549                     if ((sub->parent->type = TYPE_LINE) && (sub->parent->hookstate == SKINNY_OFFHOOK)) {
1550                         sub->parent->hookstate = SKINNY_ONHOOK;
1551                         transmit_callstate(s, l->instance, SKINNY_ONHOOK, sub->callid);
1552                         transmit_speaker_mode(s, SKINNY_SPEAKEROFF); 
1553                 } else if ((sub->parent->type = TYPE_LINE) && (sub->parent->hookstate == SKINNY_ONHOOK)) {
1554                         transmit_callstate(s, l->instance, SKINNY_ONHOOK, sub->callid);
1555                         transmit_speaker_mode(s, SKINNY_SPEAKEROFF); 
1556                         transmit_ringer_mode(s, SKINNY_RING_OFF);
1557                         transmit_tone(s, SKINNY_SILENCE);
1558                 } 
1559         }
1560     ast_mutex_lock(&sub->lock);
1561     sub->owner = NULL;
1562     ast->pvt->pvt = NULL;
1563     sub->alreadygone = 0;
1564     sub->outgoing = 0;
1565     sub->cxmode = SKINNY_CX_INACTIVE;
1566     if (sub->rtp) {
1567         ast_rtp_destroy(sub->rtp);
1568         sub->rtp = NULL;
1569     }
1570     ast_mutex_unlock(&sub->lock);
1571     return 0;
1572 }
1573
1574 static int skinny_answer(struct ast_channel *ast)
1575 {
1576         int res = 0;
1577         struct skinny_subchannel *sub = ast->pvt->pvt;
1578         struct skinny_line *l = sub->parent;
1579     sub->cxmode = SKINNY_CX_SENDRECV;
1580     if (!sub->rtp) {
1581                 start_rtp(sub);
1582     } else {
1583 //        transmit_modify_request(sub);
1584     }
1585     ast_verbose("skinny_answer(%s) on %s@%s-%d\n", ast->name, l->name, l->parent->name, sub->callid);
1586         if (ast->_state != AST_STATE_UP) {
1587                 ast_setstate(ast, AST_STATE_UP);
1588
1589 //              transmit_notify_request(sub, "");
1590 //              transmit_modify_request(sub);
1591         }
1592         return res;
1593 }
1594
1595 static struct ast_frame *skinny_rtp_read(struct skinny_subchannel *sub)
1596 {
1597         /* Retrieve audio/etc from channel.  Assumes sub->lock is already held. */
1598         struct ast_frame *f;
1599         f = ast_rtp_read(sub->rtp);
1600         if (sub->owner) {
1601                 /* We already hold the channel lock */
1602                 if (f->frametype == AST_FRAME_VOICE) {
1603                         if (f->subclass != sub->owner->nativeformats) {
1604                                 ast_log(LOG_DEBUG, "Oooh, format changed to %d\n", f->subclass);
1605                                 sub->owner->nativeformats = f->subclass;
1606                                 ast_set_read_format(sub->owner, sub->owner->readformat);
1607                                 ast_set_write_format(sub->owner, sub->owner->writeformat);
1608                         }
1609                 }
1610         }
1611         return f;
1612 }
1613
1614
1615 static struct ast_frame  *skinny_read(struct ast_channel *ast)
1616 {
1617         struct ast_frame *fr;
1618         struct skinny_subchannel *sub = ast->pvt->pvt;
1619         ast_mutex_lock(&sub->lock);
1620         fr = skinny_rtp_read(sub);
1621         ast_mutex_unlock(&sub->lock);
1622         return fr;
1623 }
1624
1625 static int skinny_write(struct ast_channel *ast, struct ast_frame *frame)
1626 {
1627         struct skinny_subchannel *sub = ast->pvt->pvt;
1628         int res = 0;
1629         if (frame->frametype != AST_FRAME_VOICE) {
1630                 if (frame->frametype == AST_FRAME_IMAGE)
1631                         return 0;
1632                 else {
1633                         ast_log(LOG_WARNING, "Can't send %d type frames with SKINNY write\n", frame->frametype);
1634                         return 0;
1635                 }
1636         } else {
1637                 if (!(frame->subclass & ast->nativeformats)) {
1638                         ast_log(LOG_WARNING, "Asked to transmit frame type %d, while native formats is %d (read/write = %d/%d)\n",
1639                                 frame->subclass, ast->nativeformats, ast->readformat, ast->writeformat);
1640                         return -1;
1641                 }
1642         }
1643         if (sub) {
1644                 ast_mutex_lock(&sub->lock);
1645                 if (sub->rtp) {
1646                         res =  ast_rtp_write(sub->rtp, frame);
1647                 }
1648                 ast_mutex_unlock(&sub->lock);
1649         }
1650         return res;
1651 }
1652
1653 static int skinny_fixup(struct ast_channel *oldchan, struct ast_channel *newchan, int needlock)
1654 {
1655         struct skinny_subchannel *sub = newchan->pvt->pvt;
1656     ast_log(LOG_NOTICE, "skinny_fixup(%s, %s)\n", oldchan->name, newchan->name);
1657         if (sub->owner != oldchan) {
1658                 ast_log(LOG_WARNING, "old channel wasn't %p but was %p\n", oldchan, sub->owner);
1659                 return -1;
1660         }
1661         sub->owner = newchan;
1662         return 0;
1663 }
1664
1665 static int skinny_senddigit(struct ast_channel *ast, char digit)
1666 {
1667 //      struct skinny_subchannel *sub = ast->pvt->pvt;
1668 //      int tmp;
1669 //      sprintf(tmp, "%d", digit);  // not right
1670 //      transmit_tone(sub->parent->parent->session, digit);
1671         return -1;
1672 }
1673
1674 static char *control2str(int ind) {
1675     switch (ind) {
1676         case AST_CONTROL_HANGUP:
1677             return "Other end has hungup";
1678         case AST_CONTROL_RING:
1679             return "Local ring";
1680         case AST_CONTROL_RINGING:
1681             return "Remote end is ringing";
1682         case AST_CONTROL_ANSWER:
1683             return "Remote end has answered";
1684         case AST_CONTROL_BUSY:
1685             return "Remote end is busy";
1686         case AST_CONTROL_TAKEOFFHOOK:
1687             return "Make it go off hook";
1688         case AST_CONTROL_OFFHOOK:
1689             return "Line is off hook";
1690         case AST_CONTROL_CONGESTION:
1691             return "Congestion (circuits busy)";
1692         case AST_CONTROL_FLASH:
1693             return "Flash hook";
1694         case AST_CONTROL_WINK:
1695             return "Wink";
1696         case AST_CONTROL_OPTION:
1697             return "Set a low-level option";
1698         case AST_CONTROL_RADIO_KEY:
1699             return "Key Radio";
1700         case AST_CONTROL_RADIO_UNKEY:
1701             return "Un-Key Radio";
1702                 case -1:
1703                         return "Stop tone";
1704     }
1705     return "UNKNOWN";
1706 }
1707
1708
1709 static int skinny_indicate(struct ast_channel *ast, int ind)
1710 {
1711         struct skinny_subchannel *sub = ast->pvt->pvt;
1712         struct skinny_line *l = sub->parent;
1713         struct skinnysession *s = l->parent->session;
1714
1715     if (skinnydebug) {
1716         ast_verbose(VERBOSE_PREFIX_3 "Asked to indicate '%s' condition on channel %s\n", control2str(ind), ast->name);
1717     }
1718         switch(ind) {
1719         case AST_CONTROL_RINGING:
1720                 transmit_tone(s, SKINNY_ALERT);
1721                 transmit_callstate(s, l->instance, SKINNY_PROGRESS, sub->callid);
1722                 break;
1723         case AST_CONTROL_BUSY:
1724                 transmit_tone(s, SKINNY_BUSYTONE);
1725                 transmit_callstate(s, l->instance, SKINNY_BUSY, sub->callid);
1726                 break;
1727         case AST_CONTROL_CONGESTION:
1728                 transmit_tone(s, SKINNY_REORDER);
1729                 transmit_callstate(s, l->instance, SKINNY_CONGESTION, sub->callid);
1730                 break;
1731         case -1:
1732                 transmit_tone(s, SKINNY_SILENCE);
1733                 break;          
1734         default:
1735                 ast_log(LOG_WARNING, "Don't know how to indicate condition %d\n", ind);
1736                 return -1;
1737         }
1738         return 0;
1739 }
1740         
1741 static struct ast_channel *skinny_new(struct skinny_subchannel *sub, int state)
1742 {
1743         struct ast_channel *tmp;
1744         struct skinny_line *l = sub->parent;
1745         int fmt;
1746         l = sub->parent;
1747         tmp = ast_channel_alloc(1);
1748         if (tmp) {
1749                 tmp->nativeformats = l->capability;
1750                 if (!tmp->nativeformats)
1751                         tmp->nativeformats = capability;
1752                 fmt = ast_best_codec(tmp->nativeformats);
1753                 snprintf(tmp->name, sizeof(tmp->name), "Skinny/%s@%s-%d", l->name, l->parent->name, sub->callid);
1754                 if (sub->rtp)
1755                         tmp->fds[0] = ast_rtp_fd(sub->rtp);
1756                 tmp->type = type;
1757                 ast_setstate(tmp, state);
1758                 if (state == AST_STATE_RING)
1759                         tmp->rings = 1;
1760                 tmp->writeformat = fmt;
1761                 tmp->pvt->rawwriteformat = fmt;
1762                 tmp->readformat = fmt;
1763                 tmp->pvt->rawreadformat = fmt;
1764                 tmp->pvt->pvt = sub;
1765                 tmp->pvt->call = skinny_call;
1766                 tmp->pvt->hangup = skinny_hangup;
1767                 tmp->pvt->answer = skinny_answer;
1768                 tmp->pvt->read = skinny_read;
1769                 tmp->pvt->write = skinny_write;
1770                 tmp->pvt->indicate = skinny_indicate;
1771                 tmp->pvt->fixup = skinny_fixup;
1772                 tmp->pvt->send_digit = skinny_senddigit;
1773 //              tmp->pvt->bridge = ast_rtp_bridge;
1774                 if (strlen(l->language))
1775                         strncpy(tmp->language, l->language, sizeof(tmp->language)-1);
1776                 if (strlen(l->accountcode))
1777                         strncpy(tmp->accountcode, l->accountcode, sizeof(tmp->accountcode)-1);
1778                 if (l->amaflags)
1779                         tmp->amaflags = l->amaflags;
1780                 sub->owner = tmp;
1781                 ast_mutex_lock(&usecnt_lock);
1782                 usecnt++;
1783                 ast_mutex_unlock(&usecnt_lock);
1784                 ast_update_use_count();
1785                 tmp->callgroup = l->callgroup;
1786                 tmp->pickupgroup = l->pickupgroup;
1787                 strncpy(tmp->call_forward, l->call_forward, sizeof(tmp->call_forward));
1788                 strncpy(tmp->context, l->context, sizeof(tmp->context)-1);
1789                 strncpy(tmp->exten,l->exten, sizeof(tmp->exten)-1);
1790                 if (strlen(l->callerid))
1791                         tmp->callerid = strdup(l->callerid);
1792                 tmp->priority = 1;
1793                 if (state != AST_STATE_DOWN) {
1794                         if (ast_pbx_start(tmp)) {
1795                                 ast_log(LOG_WARNING, "Unable to start PBX on %s\n", tmp->name);
1796                                 ast_hangup(tmp);
1797                                 tmp = NULL;
1798                         }
1799                 }
1800         } else {
1801                 ast_log(LOG_WARNING, "Unable to allocate channel structure\n");
1802     }
1803
1804         return tmp;
1805 }
1806
1807 static int handle_message(skinny_req *req, struct skinnysession *s)
1808 {
1809         struct skinny_subchannel *sub;
1810         struct ast_channel *c;
1811         struct ast_frame f = { 0, };    
1812         struct sockaddr_in sin;
1813         struct sockaddr_in us;
1814         struct skinny_line *lines;
1815         char name[16];
1816         char addr[4];
1817         char d;
1818         int digit;
1819         int res=0;
1820         int speedDialNum;
1821         int lineNumber;
1822         int stimulus;
1823         int stimulusInstance;
1824         int status;
1825         int port;
1826         int i;
1827         time_t timer;
1828         struct tm *cmtime;
1829         pthread_t t;
1830         
1831         if ( (!s->device) && (req->e != REGISTER_MESSAGE && req->e != ALARM_MESSAGE)) {
1832                 ast_log(LOG_WARNING, "Client sent message #%d without first registering.\n", req->e);
1833                 free(req);
1834                 return 0;
1835         }
1836
1837                 
1838         switch(req->e)  {
1839         case ALARM_MESSAGE:
1840                 if (skinnydebug)
1841                         printf("Recieved AlarmMessage\n");
1842                 break;
1843         case REGISTER_MESSAGE:
1844                 if (skinnydebug)
1845                         printf("Device %s is attempting to register\n", req->data.reg.name);
1846                 res = skinny_register(req, s);  
1847                 if (!res) {
1848                         ast_log(LOG_ERROR, "Rejecting Device %s: Device not found\n", req->data.reg.name);
1849                         memcpy(&name, req->data.reg.name, sizeof(req->data.reg.name));
1850                         memset(req, 0, sizeof(skinny_req));
1851                         req->len = sizeof(register_rej_message)+4;
1852                         req->e = REGISTER_REJ_MESSAGE;
1853                         sprintf(req->data.regrej.errMsg, "No Authority: %s", name);
1854                         transmit_response(s, req);
1855                         break;
1856                 }
1857                 if (option_verbose > 2) 
1858                         ast_verbose(VERBOSE_PREFIX_3 "Device '%s' successfuly registered\n", s->device->name); 
1859                 memset(req, 0, SKINNY_MAX_PACKET);
1860                 req->len = sizeof(register_ack_message)+4;
1861                 req->e = REGISTER_ACK_MESSAGE;
1862                 strcpy(req->data.regack.res, "0");
1863                 req->data.regack.keepAlive = keep_alive;
1864                 strcpy(req->data.regack.dateTemplate, date_format);     
1865                 strcpy(req->data.regack.res2, "0");
1866                 req->data.regack.secondaryKeepAlive = keep_alive;
1867                 transmit_response(s, req);
1868                 if (skinnydebug)
1869                         printf ("Requesting capabilities\n");
1870                 memset(req, 0, SKINNY_MAX_PACKET);
1871                 req->len = 4;
1872                 req->e = CAPABILITIES_REQ_MESSAGE;
1873                 transmit_response(s, req);
1874                 break;
1875         case UNREGISTER_MESSAGE:
1876                 /* XXX Acutally unregister the device */
1877                 break;
1878         case IP_PORT_MESSAGE:
1879                 break;
1880         case STIMULUS_MESSAGE:
1881                 stimulus = req->data.stimulus.stimulus;
1882                 stimulusInstance = req->data.stimulus.stimulusInstance;
1883                 
1884                 switch(stimulus) {
1885                 case STIMULUS_REDIAL:
1886                         // XXX how we gonna deal with redial ?!?!
1887                         if (skinnydebug) {
1888                                 printf("Recieved Stimulus: Redial(%d)\n", stimulusInstance);
1889                         }
1890                         break;
1891                 case STIMULUS_SPEEDDIAL:
1892                         if (skinnydebug) {
1893                                 printf("Recieved Stimulus: SpeedDial(%d)\n", stimulusInstance);
1894                         }
1895                         break;
1896                 case STIMULUS_HOLD:
1897                         // Easy enough
1898                         if (skinnydebug) {
1899                                 printf("Recieved Stimulus: Hold(%d)\n", stimulusInstance);
1900                         }
1901                         break;
1902                 case STIMULUS_TRANSFER:
1903                         if (skinnydebug) {
1904                                 printf("Recieved Stimulus: Transfer(%d)\n", stimulusInstance);
1905                         }
1906                         transmit_tone(s, SKINNY_DIALTONE);
1907                                 
1908                         // figure out how to transfer
1909
1910                         break;
1911                 case STIMULUS_FORWARDALL:
1912                 case STIMULUS_FORWARDBUSY:
1913                 case STIMULUS_FORWARDNOANSWER:
1914                         // Gonna be fun
1915                         if (skinnydebug) {
1916                                 printf("Recieved Stimulus: Forward (%d)\n", stimulusInstance);
1917                         }
1918                         break;
1919                 case STIMULUS_DISPLAY:
1920                         // XXX Not sure
1921                         if (skinnydebug) {
1922                                 printf("Recieved Stimulus: Display(%d)\n", stimulusInstance);
1923                         }
1924                         break;
1925                 case STIMULUS_LINE:
1926                         if (skinnydebug) {
1927                                 printf("Recieved Stimulus: Line(%d)\n", stimulusInstance);
1928                         }               
1929                         sub = find_subchannel_by_line(s->device->lines);
1930                         transmit_speaker_mode(s, 1);  // Turn on
1931                 break;
1932                 default:
1933                         printf("RECEIVED UNKNOWN STIMULUS:  %d(%d)\n", stimulus, stimulusInstance);                     
1934                         break;
1935                 }
1936                         
1937                         
1938                 break;
1939         case VERSION_REQ_MESSAGE:
1940                 if (skinnydebug)
1941                         printf ("Version Request\n");
1942                 memset(req, 0, SKINNY_MAX_PACKET);
1943                 req->len = sizeof(version_res_message)+4;
1944                 req->e = VERSION_RES_MESSAGE;
1945                 sprintf(req->data.version.version, s->device->version_id);
1946                 transmit_response(s, req);
1947                 break;
1948         case SERVER_REQUEST_MESSAGE:
1949                 if (skinnydebug)
1950                         printf ("Recieved Server Request\n");
1951                 memset(req, 0, SKINNY_MAX_PACKET);
1952                 req->len = sizeof(server_res_message)+4;
1953                 req->e = SERVER_RES_MESSAGE;
1954                 memcpy(req->data.serverres.server[0].serverName, ourhost, 
1955                                 sizeof(req->data.serverres.server[0].serverName));
1956                 req->data.serverres.serverListenPort[0] = ourport;
1957                 req->data.serverres.serverIpAddr[0] = __ourip.s_addr;
1958                 transmit_response(s, req);      
1959                 break;
1960         case BUTTON_TEMPLATE_REQ_MESSAGE:
1961                 if (skinnydebug)
1962                         printf ("Buttontemplate requested\n");
1963                 memset(req, 0, SKINNY_MAX_PACKET);
1964                 req->len = sizeof(button_template_res_message)+4;
1965                 req->e = BUTTON_TEMPLATE_RES_MESSAGE;   
1966                 req->data.buttontemplate.buttonOffset           = 0;
1967                 req->data.buttontemplate.buttonCount            = 10;
1968                 req->data.buttontemplate.totalButtonCount       = 10;
1969                 /* XXX Figure out how to do this correctly */
1970                 memcpy(req->data.buttontemplate.definition,
1971                            button_definition_hack, 
1972                            sizeof(req->data.buttontemplate.definition));
1973                 transmit_response(s, req);
1974                 break;
1975         case SOFT_KEY_SET_REQ_MESSAGE:
1976                 if (skinnydebug)
1977                         printf ("Received SoftKeySetReq\n");
1978                 memset(req, 0, SKINNY_MAX_PACKET);
1979                 req->len = sizeof(soft_key_sets)+4;
1980                 req->e = SOFT_KEY_SET_RES_MESSAGE;
1981                 req->data.softkeysets.softKeySetOffset          = 0;
1982                 req->data.softkeysets.softKeySetCount           = 11;
1983                 req->data.softkeysets.totalSoftKeySetCount  = 11;       
1984                 /* XXX Wicked hack XXX */
1985                 memcpy(req->data.softkeysets.softKeySetDefinition, 
1986                            soft_key_set_hack, 
1987                            sizeof(req->data.softkeysets.softKeySetDefinition));
1988                 transmit_response(s,req);
1989                 break;
1990         case SOFT_KEY_TEMPLATE_REQ_MESSAGE:
1991                 if (skinnydebug)
1992                         printf ("Recieved SoftKey Template Request\n");
1993                 memset(req, 0, SKINNY_MAX_PACKET);
1994                 req->len = sizeof(soft_key_template)+4;
1995                 req->e = SOFT_KEY_TEMPLATE_RES_MESSAGE;
1996                 req->data.softkeytemplate.softKeyOffset         = 0;
1997                 req->data.softkeytemplate.softKeyCount          = 21;
1998                 req->data.softkeytemplate.totalSoftKeyCount = 21; 
1999                 /* XXX Another wicked hack XXX */
2000                 memcpy(req->data.softkeytemplate.softKeyTemplateDefinition,
2001                            soft_key_template_hack,
2002                            sizeof(req->data.softkeytemplate.softKeyTemplateDefinition));
2003                 transmit_response(s,req);
2004                 break;
2005         case TIME_DATE_REQ_MESSAGE:
2006                 if (skinnydebug)
2007                         printf ("Received Time/Date Request\n");
2008                 memset(req, 0, SKINNY_MAX_PACKET);
2009                 req->len = sizeof(definetimedate_message)+4;
2010                 req->e = DEFINETIMEDATE_MESSAGE;
2011                 timer=time(NULL);
2012                 cmtime = localtime(&timer);
2013                 req->data.definetimedate.year = cmtime->tm_year+1900;
2014                 req->data.definetimedate.month = cmtime->tm_mon+1;
2015                 req->data.definetimedate.dayofweek = cmtime->tm_wday;
2016                 req->data.definetimedate.day = cmtime->tm_mday;
2017                 req->data.definetimedate.hour = cmtime->tm_hour;
2018                 req->data.definetimedate.minute = cmtime->tm_min;
2019                 req->data.definetimedate.seconds = cmtime->tm_sec;
2020                 transmit_response(s, req);
2021                 break;
2022         case SPEED_DIAL_STAT_REQ_MESSAGE:
2023                 /* Not really sure how Speed Dial's are different than the 
2024                    Softkey templates */
2025                 speedDialNum = req->data.speeddialreq.speedDialNumber;
2026 //              if (skinnydebug)
2027 //                      printf ("Recieved SpeedDialStatReq: %d\n", speedDialNum);
2028                 memset(req, 0, SKINNY_MAX_PACKET);
2029                 req->len = sizeof(speed_dial_stat_res_message)+4;
2030                 req->e = SPEED_DIAL_STAT_RES_MESSAGE;
2031 #if 0   
2032                 /* XXX Do this right XXX */     
2033                 req->data.speeddialreq.speedDialNumber = speedDialNum;
2034                 sprintf(req->data.speeddial.speedDialDirNumber, "31337");
2035                 sprintf(req->data.speeddial.speedDialDisplayName, "Asterisk Rules!");
2036 #endif          
2037                 transmit_response(s, req);
2038                 break;
2039         case LINE_STATE_REQ_MESSAGE:
2040                 lineNumber = req->data.line.lineNumber;
2041                 if (skinnydebug)
2042                         printf ("Received LineStateReq\n");
2043                 memset(req, 0, SKINNY_MAX_PACKET);
2044                 req->len = sizeof(line_stat_res_message)+4;
2045                 req->e = LINE_STAT_RES_MESSAGE; 
2046                 sub = find_subchannel_by_line(s->device->lines);
2047                 if (!sub) {
2048                         ast_log(LOG_NOTICE, "No available lines on: %s\n", s->device->name);
2049                         return 0;
2050                 }
2051                 lines = sub->parent;
2052                 ast_mutex_lock(&devicelock);
2053                 for (i=1; i < lineNumber; i++) {
2054                         lines = lines->next;
2055                 }
2056                 ast_mutex_unlock(&devicelock);
2057                 req->data.linestat.linenumber = lineNumber;             
2058                 memcpy(req->data.linestat.lineDirNumber, lines->name,
2059                                 sizeof(req->data.linestat.lineDirNumber));
2060                 memcpy(req->data.linestat.lineDisplayName, lines->label,
2061                                 sizeof(req->data.linestat.lineDisplayName)); 
2062                 transmit_response(s,req);
2063                 break;
2064         case CAPABILITIES_RES_MESSAGE:
2065                 if (skinnydebug)
2066                         printf ("Received CapabilitiesRes\n");  
2067                 // zien wat ie kan en verwerken (handshake)
2068                 break;
2069         case KEEP_ALIVE_MESSAGE:
2070                 memset(req, 0, SKINNY_MAX_PACKET);
2071                 req->len = 4;
2072                 req->e = KEEP_ALIVE_ACK_MESSAGE;
2073                 transmit_response(s, req);
2074                 break;
2075         case OFFHOOK_MESSAGE:
2076                 transmit_ringer_mode(s,SKINNY_RING_OFF);
2077                 transmit_lamp_indication(s, s->device->lines->instance, SKINNY_LAMP_ON); 
2078                 
2079                 sub = find_subchannel_by_line(s->device->lines);
2080                 if (!sub) {
2081                         ast_log(LOG_NOTICE, "No available lines on: %s\n", s->device->name);
2082                         return 0;
2083                 }
2084                 sub->parent->hookstate = SKINNY_OFFHOOK;
2085                 
2086                         if (sub->outgoing) {
2087                                 transmit_callstate(s, s->device->lines->instance, SKINNY_OFFHOOK, sub->callid);
2088                                 transmit_tone(s, SKINNY_SILENCE);
2089                                 ast_setstate(sub->owner, AST_STATE_UP);
2090                                 // select soft keys
2091                         } else {        
2092                                 if (!sub->owner) {      
2093
2094                                         transmit_callstate(s, s->device->lines->instance, SKINNY_OFFHOOK, sub->callid);
2095                                         transmit_tone(s, SKINNY_DIALTONE);
2096                                         c = skinny_new(sub, AST_STATE_DOWN);                    
2097                                         if(c) {
2098                                                 /* start switch */
2099                                                 if (pthread_create(&t, NULL, skinny_ss, c)) {
2100                                                         ast_log(LOG_WARNING, "Unable to create switch thread: %s\n", strerror(errno));
2101                                                         ast_hangup(c);
2102                                                 }
2103                                         } else {
2104                                                 ast_log(LOG_WARNING, "Unable to create channel for %s@%s\n", sub->parent->name, s->device->name);
2105                                         }
2106                                 
2107                                 } else {
2108                                         ast_log(LOG_DEBUG, "Current sub [%s] already has owner\n", sub->owner->name);
2109                                 }
2110                         }
2111                 break;
2112         case ONHOOK_MESSAGE:
2113                 sub = find_subchannel_by_line(s->device->lines);
2114                 if (sub->parent->hookstate == SKINNY_ONHOOK) {
2115                         /* Somthing else already put us back on hook */ 
2116                         break;
2117                 }
2118                 sub->cxmode = SKINNY_CX_RECVONLY;
2119                 sub->parent->hookstate = SKINNY_ONHOOK;
2120                 transmit_callstate(s, s->device->lines->instance, sub->parent->hookstate,sub->callid);
2121             if (skinnydebug)
2122                         printf("Skinny %s@%s went on hook\n",sub->parent->name, sub->parent->parent->name);
2123             if (sub->rtp) {
2124  //         transmit_modify_request(sub);
2125         }
2126         if (sub->parent->transfer && (sub->owner && sub->next->owner) && ((!sub->outgoing) || (!sub->next->outgoing))) {
2127                         /* We're allowed to transfer, we have two active calls and */
2128                         /* we made at least one of the calls.  Let's try and transfer */
2129 #if 0
2130              if ((res = attempt_transfer(p)) < 0) {
2131                                  if (p->sub->next->owner) {
2132                                         sub->next->alreadygone = 1;
2133                                         ast_queue_hangup(sub->next->owner,1);
2134                                 }
2135                          } else if (res) {
2136                                     ast_log(LOG_WARNING, "Transfer attempt failed\n");
2137                                         return -1;
2138              }
2139 #endif
2140        } else {
2141            /* Hangup the current call */
2142            /* If there is another active call, skinny_hangup will ring the phone with the other call */
2143            if (sub->owner) {
2144                sub->alreadygone = 1;
2145                ast_queue_hangup(sub->owner, 1);
2146            } else {
2147                ast_log(LOG_WARNING, "Skinny(%s@%s-%d) channel already destroyed\n", 
2148                            sub->parent->name, sub->parent->parent->name, sub->callid);
2149            }
2150        }
2151        if ((sub->parent->hookstate == SKINNY_ONHOOK) && (!sub->rtp) && (!sub->next->rtp)) {
2152                         if (has_voicemail(sub->parent)) {
2153                                 transmit_lamp_indication(s, s->device->lines->instance, SKINNY_LAMP_FLASH); 
2154             } else {
2155                                 transmit_lamp_indication(s, s->device->lines->instance, SKINNY_LAMP_OFF);
2156             }
2157        }
2158            break;
2159         case KEYPAD_BUTTON_MESSAGE:
2160                 digit = req->data.keypad.button;
2161                 if (skinnydebug) {
2162                         printf("Collected digit: [%d]\n", digit);
2163                 }
2164                 f.frametype = AST_FRAME_DTMF;
2165                 if (digit == 14) {
2166                         sprintf(&d, "*");
2167                 } else if (digit == 15) {
2168                         sprintf(&d, "#");
2169                 } else {
2170                         sprintf(&d, "%d", digit);
2171                 }
2172                 f.subclass  = d;  
2173                 f.src = "skinny";
2174
2175                 sub = find_subchannel_by_line(s->device->lines);                
2176
2177                 if (sub->owner) {
2178                         /* XXX MUST queue this frame to all subs in threeway call if threeway call is active */
2179                         ast_queue_frame(sub->owner, &f, 1);
2180             if (sub->next->owner) {
2181                                 ast_queue_frame(sub->next->owner, &f, 1);
2182             }
2183         } else {
2184                         printf("No owner: %s\n", s->device->lines->name);
2185                 }
2186                 break;
2187         case OPEN_RECIEVE_CHANNEL_ACK_MESSAGE:
2188                 printf("Recieved Open Recieve Channel Ack\n");
2189                 status = req->data.openrecievechannelack.status;
2190                 if (status) {
2191                         ast_log(LOG_ERROR, "Open Recieve Channel Failure\n");
2192                         break;
2193                 }
2194                 memcpy(addr, req->data.openrecievechannelack.ipAddr, sizeof(addr));
2195                 port = req->data.openrecievechannelack.port;
2196                                 
2197                 sin.sin_family = AF_INET;
2198                 memcpy(&sin.sin_addr, addr, sizeof(sin.sin_addr));  // Endian?
2199                 sin.sin_port = htons(port);
2200         
2201                 sub = find_subchannel_by_line(s->device->lines);
2202                 ast_rtp_set_peer(sub->rtp, &sin);
2203                 ast_rtp_get_us(sub->rtp, &us);
2204                 
2205                 printf("us port: %d\n", ntohs(us.sin_port));
2206                 printf("sin port: %d\n", ntohs(sin.sin_port));
2207
2208                 memset(req, 0, SKINNY_MAX_PACKET);
2209                 req->len = sizeof(start_media_transmission_message)+4;
2210                 req->e = START_MEDIA_TRANSMISSION_MESSAGE;
2211                 req->data.startmedia.conferenceId = 0;
2212                 req->data.startmedia.passThruPartyId = 0;
2213                 memcpy(req->data.startmedia.remoteIp, &s->device->ourip, 4); // Endian?
2214                 req->data.startmedia.remotePort = ntohs(us.sin_port);
2215                 req->data.startmedia.packetSize = 20;
2216                 req->data.startmedia.payloadType = convert_cap(s->device->lines->capability);
2217                 req->data.startmedia.qualifier.precedence = 127;
2218                 req->data.startmedia.qualifier.vad = 0;
2219                 req->data.startmedia.qualifier.packets = 0;
2220                 req->data.startmedia.qualifier.bitRate = 0;
2221                 transmit_response(s, req);
2222                 break;  
2223         default:
2224                 printf("RECEIVED UNKNOWN MESSAGE TYPE:  %x\n", req->e);
2225                 break;
2226         }
2227
2228         free(req);
2229         return 1;
2230
2231 }
2232
2233 static void destroy_session(struct skinnysession *s)
2234 {
2235         struct skinnysession *cur, *prev = NULL;
2236         ast_mutex_lock(&sessionlock);
2237         cur = sessions;
2238         while(cur) {
2239                 if (cur == s)
2240                         break;
2241                 prev = cur;
2242                 cur = cur->next;
2243         }
2244         if (cur) {
2245                 if (prev)
2246                         prev->next = cur->next;
2247                 else
2248                         sessions = cur->next;
2249                 if (s->fd > -1)
2250                         close(s->fd);
2251                 free(s);
2252         } else
2253                 ast_log(LOG_WARNING, "Trying to delete non-existant session %p?\n", s);
2254         ast_mutex_unlock(&sessionlock);
2255 }
2256
2257 static int get_input(struct skinnysession *s)  
2258 {  
2259  
2260         int res;  
2261         int dlen = 0;  
2262  
2263         fd_set fds;  
2264         FD_ZERO(&fds);  
2265         FD_SET(s->fd, &fds);  
2266  
2267         res = ast_select(s->fd + 1, &fds, NULL, NULL, NULL);  
2268  
2269         if (res < 0) {
2270                 ast_log(LOG_WARNING, "Select returned error: %s\n", strerror(errno));
2271         } else if (res > 0) {
2272                 memset(s->inbuf,0,sizeof(s->inbuf));
2273                 res = read(s->fd, s->inbuf, 4);
2274                 if (res != 4) {
2275                         ast_log(LOG_WARNING, "Skinny Client sent less data than expected.\n");
2276                         return -1;
2277                 }
2278                 dlen = *(int *)s->inbuf;
2279                 res = read(s->fd, s->inbuf+4, dlen+4);
2280                 ast_mutex_unlock(&s->lock);
2281                 if (res != (dlen+4)) {
2282                         ast_log(LOG_WARNING, "Skinny Client sent less data than expected.\n");
2283                         return -1;
2284                 } 
2285  
2286         }  
2287         return res;  
2288 }   
2289
2290
2291 static skinny_req *skinny_req_parse(struct skinnysession *s)
2292 {
2293         skinny_req *req;
2294         
2295         req = malloc(SKINNY_MAX_PACKET);
2296         if (!req) {
2297                 ast_log(LOG_ERROR, "Unable to allocate skinny_request, this is bad\n");
2298                 return NULL;
2299         }
2300         memset(req, 0, sizeof(skinny_req));
2301         memcpy(req, s->inbuf, *(int*)(s->inbuf)+8); // +8
2302         if (req->e < 0) {
2303                 ast_log(LOG_ERROR, "Event Message is NULL from socket %d, This is bad\n", s->fd);
2304                 free(req);
2305                 return NULL;
2306         }
2307         return req;
2308 }
2309
2310 static void *skinny_session(void *data)
2311 {
2312         int res;
2313         skinny_req *req;
2314         struct skinnysession *s = data;
2315         
2316         ast_verbose(VERBOSE_PREFIX_3 "Starting Skinny session from %s\n",  inet_ntoa(s->sin.sin_addr));
2317
2318         for (;;) {
2319                 res = 0;
2320                 res = get_input(s);
2321                 if (res < 0)
2322                         break;
2323                 req = skinny_req_parse(s);
2324                 if (!req) {
2325                         return NULL;
2326                 }
2327                 res = handle_message(req, s);
2328                 if (res < 0) {
2329                         destroy_session(s);
2330                         return NULL;
2331                 } 
2332         }
2333         ast_log(LOG_NOTICE, "Skinny Session returned: %s\n", strerror(errno));
2334         destroy_session(s);
2335         return 0;
2336 }
2337
2338 static void *accept_thread(void *ignore)
2339 {
2340         int as;
2341         struct sockaddr_in sin;
2342         int sinlen;
2343         struct skinnysession *s;
2344         struct protoent *p;
2345         int arg = 1;
2346         pthread_attr_t attr;
2347
2348         pthread_attr_init(&attr);
2349         pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
2350
2351         for (;;) {
2352                 sinlen = sizeof(sin);
2353                 as = accept(skinnysock, (struct sockaddr *)&sin, &sinlen);
2354                 if (as < 0) {
2355                         ast_log(LOG_NOTICE, "Accept returned -1: %s\n", strerror(errno));
2356                         continue;
2357                 }
2358                 p = getprotobyname("tcp");
2359                 if(p) {
2360                         if( setsockopt(as, p->p_proto, TCP_NODELAY, (char *)&arg, sizeof(arg) ) < 0 ) {
2361                                 ast_log(LOG_WARNING, "Failed to set Skinny tcp connection to TCP_NODELAY mode: %s\n", strerror(errno));
2362                         }
2363                 }
2364                 s = malloc(sizeof(struct skinnysession));
2365                 if (!s) {
2366                         ast_log(LOG_WARNING, "Failed to allocate Skinny session: %s\n", strerror(errno));
2367                         continue;
2368                 } 
2369                 memset(s, 0, sizeof(struct skinnysession));
2370                 memcpy(&s->sin, &sin, sizeof(sin));
2371                 ast_mutex_init(&s->lock);
2372                 s->fd = as;
2373                 ast_mutex_lock(&sessionlock);
2374                 s->next = sessions;
2375                 sessions = s;
2376                 ast_mutex_unlock(&sessionlock);
2377                 
2378                 if (pthread_create(&tcp_thread, NULL, skinny_session, s))
2379                         destroy_session(s);
2380         }
2381         
2382         
2383         if (skinnydebug)
2384                 printf("killing accept thread\n");
2385         
2386         close(as);
2387         return 0;
2388 }
2389
2390 static void *do_monitor(void *data)
2391 {
2392         int res;
2393
2394 #if 0
2395         /* Add an I/O event to our TCP socket */
2396         if (skinnysock > -1)  {
2397                 ast_io_add(io, skinnysock, accept_thread, AST_IO_IN, NULL);
2398         } else {
2399                 ast_log(LOG_WARNING, "Unable to create I/O socket event\n");            
2400         }
2401 #endif
2402
2403
2404         /* This thread monitors all the interfaces which are not yet in use
2405            (and thus do not have a separate thread) indefinitely */
2406         /* From here on out, we die whenever asked */
2407         for(;;) {
2408                 pthread_testcancel();
2409                 /* Wait for sched or io */
2410                 res = ast_sched_wait(sched);
2411                 if ((res < 0) || (res > 1000))
2412                         res = 1000;
2413                 res = ast_io_wait(io, res);
2414                 ast_mutex_lock(&monlock);
2415                 if (res >= 0) 
2416                         ast_sched_runq(sched);
2417                 ast_mutex_unlock(&monlock);
2418         }
2419         /* Never reached */
2420         return NULL;
2421         
2422 }
2423
2424 static int restart_monitor(void)
2425 {
2426
2427         /* If we're supposed to be stopped -- stay stopped */
2428         if (monitor_thread == (pthread_t)-2)
2429                 return 0;
2430         if (ast_mutex_lock(&monlock)) {
2431                 ast_log(LOG_WARNING, "Unable to lock monitor\n");
2432                 return -1;
2433         }
2434         if (monitor_thread == pthread_self()) {
2435                 ast_mutex_unlock(&monlock);
2436                 ast_log(LOG_WARNING, "Cannot kill myself\n");
2437                 return -1;
2438         }
2439         if (monitor_thread) {
2440                 /* Wake up the thread */
2441                 pthread_kill(monitor_thread, SIGURG);
2442         } else {
2443                 /* Start a new monitor */
2444                 if (pthread_create(&monitor_thread, NULL, do_monitor, NULL) < 0) {
2445                         ast_mutex_unlock(&monlock);
2446                         ast_log(LOG_ERROR, "Unable to start monitor thread.\n");
2447                         return -1;
2448                 }
2449         }
2450         ast_mutex_unlock(&monlock);
2451         return 0;
2452 }
2453
2454 static struct ast_channel *skinny_request(char *type, int format, void *data)
2455 {
2456         int oldformat;
2457         struct skinny_subchannel *sub;
2458         struct ast_channel *tmpc = NULL;
2459         char tmp[256];
2460         char *dest = data;
2461
2462         oldformat = format;
2463         format &= capability;
2464         if (!format) {
2465                 ast_log(LOG_NOTICE, "Asked to get a channel of unsupported format '%d'\n", format);
2466                 return NULL;
2467         }
2468         
2469         strncpy(tmp, dest, sizeof(tmp) - 1);
2470         if (!strlen(tmp)) {
2471                 ast_log(LOG_NOTICE, "Skinny channels require a device\n");
2472                 return NULL;
2473         }
2474         
2475         sub = find_subchannel_by_name(tmp);  
2476         if (!sub) {
2477                 ast_log(LOG_NOTICE, "No available lines on: %s\n", dest);
2478                 return NULL;
2479         }
2480         
2481     if (option_verbose > 2) {
2482         ast_verbose(VERBOSE_PREFIX_3 "skinny_request(%s)\n", tmp);
2483         ast_verbose(VERBOSE_PREFIX_3 "Skinny cw: %d, dnd: %d, so: %d, sno: %d\n", 
2484                     sub->parent->callwaiting, sub->parent->dnd, sub->owner ? 1 : 0, sub->next->owner ? 1: 0);
2485     }
2486         
2487         tmpc = skinny_new(sub->owner ? sub->next : sub, AST_STATE_DOWN);
2488         if (!tmpc)
2489                 ast_log(LOG_WARNING, "Unable to make channel for '%s'\n", tmp);
2490         restart_monitor();
2491
2492         /* and finish */        
2493         return tmpc;
2494 }
2495
2496 static int reload_config(void)
2497 {
2498         int on=1;
2499         struct ast_config *cfg;
2500         struct ast_variable *v;
2501         int format;
2502         char *cat;
2503         struct skinny_device *d;
2504         int oldport = ntohs(bindaddr.sin_port);
2505         
2506         if (gethostname(ourhost, sizeof(ourhost))) {
2507                 ast_log(LOG_WARNING, "Unable to get hostname, Skinny disabled\n");
2508                 return 0;
2509         }
2510         cfg = ast_load(config);
2511
2512         /* We *must* have a config file otherwise stop immediately */
2513         if (!cfg) {
2514                 ast_log(LOG_NOTICE, "Unable to load config %s, Skinny disabled\n", config);
2515                 return 0;
2516         }
2517
2518         /* load the general section */
2519         memset(&bindaddr, 0, sizeof(bindaddr));
2520         v = ast_variable_browse(cfg, "general");
2521         while(v) {
2522                 /* Create the interface list */
2523                 if (!strcasecmp(v->name, "bindaddr")) {
2524                         if (!(hp = gethostbyname(v->value))) {
2525                                 ast_log(LOG_WARNING, "Invalid address: %s\n", v->value);
2526                         } else {
2527                                 memcpy(&bindaddr.sin_addr, hp->h_addr, sizeof(bindaddr.sin_addr));
2528                         }
2529                 } else if (!strcasecmp(v->name, "keepAlive")) {
2530                         keep_alive = atoi(v->value);            
2531                 } else if (!strcasecmp(v->name, "dateFormat")) {
2532                         strncpy(date_format, v->value, sizeof(date_format) - 1);        
2533                 } else if (!strcasecmp(v->name, "allow")) {
2534                         format = ast_getformatbyname(v->value);
2535                         if (format < 1) 
2536                                 ast_log(LOG_WARNING, "Cannot allow unknown format '%s'\n", v->value);
2537                         else
2538                                 capability |= format;
2539                 } else if (!strcasecmp(v->name, "disallow")) {
2540                         format = ast_getformatbyname(v->value);
2541                         if (format < 1) 
2542                                 ast_log(LOG_WARNING, "Cannot disallow unknown format '%s'\n", v->value);
2543                         else
2544                                 capability &= ~format;
2545                 } else if (!strcasecmp(v->name, "port")) {
2546                         if (sscanf(v->value, "%i", &ourport) == 1) {
2547                                 bindaddr.sin_port = htons(ourport);
2548                         } else {
2549                                 ast_log(LOG_WARNING, "Invalid port number '%s' at line %d of %s\n", v->value, v->lineno, config);
2550                         }
2551                 }
2552                 v = v->next;
2553         }
2554
2555         if (ntohl(bindaddr.sin_addr.s_addr)) {
2556                 memcpy(&__ourip, &bindaddr.sin_addr, sizeof(__ourip));
2557         } else {
2558                 hp = gethostbyname(ourhost);
2559                 if (!hp) {
2560                         ast_log(LOG_WARNING, "Unable to get our IP address, Skinny disabled\n");
2561                         return 0;
2562                 }
2563                 memcpy(&__ourip, hp->h_addr, sizeof(__ourip));
2564         }
2565         if (!ntohs(bindaddr.sin_port))
2566                 bindaddr.sin_port = ntohs(DEFAULT_SKINNY_PORT);
2567         bindaddr.sin_family = AF_INET;
2568         
2569         /* load the device sections */
2570         cat = ast_category_browse(cfg, NULL);
2571         while(cat) {
2572                 if (strcasecmp(cat, "general")) {
2573                         d = build_device(cat, ast_variable_browse(cfg, cat));
2574                         if (d) {
2575                                 if (option_verbose > 2) {
2576                                         ast_verbose(VERBOSE_PREFIX_3 "Added device '%s'\n", d->name);
2577                 }
2578                                 ast_mutex_lock(&devicelock);
2579                                 d->next = devices;
2580                                 devices = d;
2581                                 ast_mutex_unlock(&devicelock);
2582                         }
2583                 }
2584                 cat = ast_category_browse(cfg, cat);
2585         }
2586         ast_mutex_lock(&netlock);
2587         if ((skinnysock > -1) && (ntohs(bindaddr.sin_port) != oldport)) {
2588                 close(skinnysock);
2589                 skinnysock = -1;
2590         }
2591         if (skinnysock < 0) {
2592                 skinnysock = socket(AF_INET, SOCK_STREAM, 0);
2593                 if(setsockopt(skinnysock, SOL_SOCKET, SO_REUSEADDR, &on, sizeof(on)) == -1) {
2594                         ast_log(LOG_ERROR, "Set Socket Options failed: errno %d, %s", errno, strerror(errno));
2595                         return 0;
2596                 }
2597
2598                 if (skinnysock < 0) {
2599                         ast_log(LOG_WARNING, "Unable to create Skinny socket: %s\n", strerror(errno));
2600                 } else {
2601                         if (bind(skinnysock, (struct sockaddr *)&bindaddr, sizeof(bindaddr)) < 0) {
2602                                 ast_log(LOG_WARNING, "Failed to bind to %s:%d: %s\n",
2603                                                 inet_ntoa(bindaddr.sin_addr), ntohs(bindaddr.sin_port),
2604                                                         strerror(errno));
2605                                 close(skinnysock);
2606                                 skinnysock = -1;
2607                                 return 0;
2608                         } 
2609
2610                         if (listen(skinnysock,DEFAULT_SKINNY_BACKLOG)) {
2611                                         ast_log(LOG_WARNING, "Failed to start listening to %s:%d: %s\n",
2612                                                 inet_ntoa(bindaddr.sin_addr), ntohs(bindaddr.sin_port),
2613                                                         strerror(errno));
2614                                         close(skinnysock);
2615                                         skinnysock = -1;
2616                                         return 0;
2617                         }
2618                 
2619                         if (option_verbose > 1)
2620                                 ast_verbose(VERBOSE_PREFIX_2 "Skinny listening on %s:%d\n", 
2621                                         inet_ntoa(bindaddr.sin_addr), ntohs(bindaddr.sin_port));
2622
2623                         pthread_create(&accept_t,NULL, accept_thread, NULL);
2624
2625                 }
2626         }
2627         ast_mutex_unlock(&netlock);
2628
2629
2630         /* and unload the configuration when were done */
2631         ast_destroy(cfg);
2632
2633         return 0;
2634 }
2635
2636 #if 0
2637 void delete_devices(void)
2638 {
2639         struct skinny_device *d, *dlast;
2640         struct skinny_line *l, *llast;
2641         struct skinny_subchannel *sub, *slast;
2642         
2643         ast_mutex_lock(&devicelock);
2644         
2645         /* Delete all devices */
2646         for (d=devices;d;) {
2647                 
2648                 /* Delete all lines for this device */
2649                 for (l=d->lines;l;) {
2650                         /* Delete all subchannels for this line */
2651                         for (sub=l->sub;sub;) {
2652                                 slast = sub;
2653                                 sub = sub->next;
2654                                 free(slast);
2655                         }
2656                         llast = l;
2657                         l = l->next;
2658                         free(llast);
2659                 }
2660                 dlast = d;
2661                 d = d->next;
2662                 free(dlast);
2663         }
2664         devices=NULL;
2665         ast_mutex_unlock(&devicelock);
2666 }
2667 #endif
2668
2669 int reload(void)
2670 {
2671 #if 0
2672 // XXX Causes Seg
2673
2674         delete_devices();
2675         reload_config();
2676         restart_monitor();
2677 #endif
2678         return 0;
2679 }
2680
2681
2682 int load_module()
2683 {
2684         int res = 0;
2685
2686         /* load and parse config */
2687         res = reload_config();
2688         
2689         /* Announce our presence to Asterisk */ 
2690         if (!res) {
2691                 /* Make sure we can register our skinny channel type */
2692                 if (ast_channel_register(type, tdesc, capability, skinny_request)) {
2693                         ast_log(LOG_ERROR, "Unable to register channel class %s\n", type);
2694                         return -1;
2695                 }
2696         }
2697         skinny_rtp.type = type;
2698         ast_rtp_proto_register(&skinny_rtp);
2699         ast_cli_register(&cli_show_lines);
2700         ast_cli_register(&cli_debug);
2701         ast_cli_register(&cli_no_debug);
2702         sched = sched_context_create();
2703         if (!sched) {
2704                 ast_log(LOG_WARNING, "Unable to create schedule context\n");
2705         }
2706         io = io_context_create();
2707         if (!io) {
2708                 ast_log(LOG_WARNING, "Unable to create I/O context\n");
2709         }
2710         /* And start the monitor for the first time */
2711         restart_monitor();
2712         return res;
2713 }
2714
2715 int unload_module()
2716 {
2717
2718 #if 0   
2719         struct skinny_subchannel *p, *pl;
2720
2721         ast_channel_unregister(type);
2722         ast_verbose("Skinny module unloading\n");
2723         
2724         /* First, take us out of the channel loop */
2725         ast_channel_unregister(type);
2726         
2727         /* close all IP connections */
2728         if (!ast_mutex_lock(&devicelock)) {
2729                 /* Hangup all interfaces if they have an owner */
2730                 p = iflist;
2731                 while(p) {
2732                         if (p->owner)
2733                                 ast_softhangup(p->owner, AST_SOFTHANGUP_APPUNLOAD);
2734                         p = p->next;
2735                 }
2736                 iflist = NULL;
2737                 ast_mutex_unlock(&iflock);
2738         } else {
2739                 ast_log(LOG_WARNING, "Unable to lock the monitor\n");
2740                 return -1;
2741         }
2742         if (!ast_mutex_lock(&monlock)) {
2743                 if (monitor_thread && (monitor_thread != -2)) {
2744                         pthread_cancel(monitor_thread);
2745                         pthread_kill(monitor_thread, SIGURG);
2746                         pthread_join(monitor_thread, NULL);
2747                 }
2748                 monitor_thread = -2;
2749                 ast_mutex_unlock(&monlock);
2750         } else {
2751                 ast_log(LOG_WARNING, "Unable to lock the monitor\n");
2752                 return -1;
2753         }
2754
2755         if (!ast_mutex_lock(&iflock)) {
2756                 /* Destroy all the interfaces and free their memory */
2757                 p = iflist;
2758                 while(p) {
2759                         pl = p;
2760                         p = p->next;
2761                         /* Free associated memory */
2762                         free(pl);
2763                 }
2764                 iflist = NULL;
2765                 ast_mutex_unlock(&iflock);
2766         } else {
2767                 ast_log(LOG_WARNING, "Unable to lock the monitor\n");
2768                 return -1;
2769         }
2770 #endif
2771         /* if we're still here something was fscked up */   
2772         return -1;
2773 }
2774
2775 int usecount()
2776 {
2777         int res;
2778         ast_mutex_lock(&usecnt_lock);
2779         res = usecnt;
2780         ast_mutex_unlock(&usecnt_lock);
2781         return res;
2782 }
2783
2784 char *key()
2785 {
2786         return ASTERISK_GPL_KEY;
2787 }
2788
2789 char *description()
2790 {
2791         return desc;
2792 }