chan_skinny.c

Go to the documentation of this file.

/*
 * Asterisk -- An open source telephony toolkit.
 *
 * Copyright (C) 1999 - 2005, Digium, Inc.
 *
 * chan_skinny was developed by Jeremy McNamara & Florian Overkamp
 * chan_skinny was heavily modified/fixed by North Antara
 *
 * See http://www.asterisk.org for more information about
 * the Asterisk project. Please do not directly contact
 * any of the maintainers of this project for assistance;
 * the project provides a web site, mailing lists and IRC
 * channels for your use.
 *
 * This program is free software, distributed under the terms of
 * the GNU General Public License Version 2. See the LICENSE file
 * at the top of the source tree.
 */

/*! \file
 *
 * \brief Implementation of the Skinny protocol
 *
 * \author Jeremy McNamara & Florian Overkamp & North Antara
 * \ingroup channel_drivers
 */

/*! \li \ref chan_skinny.c uses the configuration file \ref skinny.conf
 * \addtogroup configuration_file
 */

/*! \page skinny.conf skinny.conf
 * \verbinclude skinny.conf.sample
 */

/*** MODULEINFO
 <support_level>extended</support_level>
 ***/

#include "asterisk.h"

#include <sys/socket.h>
#include <netinet/in.h>
#include <netinet/tcp.h>
#include <sys/ioctl.h>
#include <net/if.h>
#include <fcntl.h>
#include <netdb.h>
#include <arpa/inet.h>
#include <signal.h>
#include <ctype.h>

#include "asterisk/lock.h"
#include "asterisk/channel.h"
#include "asterisk/config.h"
#include "asterisk/module.h"
#include "asterisk/pbx.h"
#include "asterisk/sched.h"
#include "asterisk/io.h"
#include "asterisk/rtp_engine.h"
#include "asterisk/netsock2.h"
#include "asterisk/acl.h"
#include "asterisk/callerid.h"
#include "asterisk/cli.h"
#include "asterisk/manager.h"
#include "asterisk/say.h"
#include "asterisk/astdb.h"
#include "asterisk/causes.h"
#include "asterisk/pickup.h"
#include "asterisk/app.h"
#include "asterisk/mwi.h"
#include "asterisk/musiconhold.h"
#include "asterisk/utils.h"
#include "asterisk/dsp.h"
#include "asterisk/stringfields.h"
#include "asterisk/abstract_jb.h"
#include "asterisk/threadstorage.h"
#include "asterisk/devicestate.h"
#include "asterisk/indications.h"
#include "asterisk/linkedlists.h"
#include "asterisk/stasis_endpoints.h"
#include "asterisk/bridge.h"
#include "asterisk/parking.h"
#include "asterisk/stasis_channels.h"
#include "asterisk/format_cache.h"

/*** DOCUMENTATION
 <manager name="SKINNYdevices" language="en_US">
 <synopsis>
 List SKINNY devices (text format).
 </synopsis>
 <syntax>
 <xi:include xpointer="xpointer(/docs/manager[@name='Login']/syntax/parameter[@name='ActionID'])" />
 </syntax>
 <description>
 <para>Lists Skinny devices in text format with details on current status.
 Devicelist will follow as separate events, followed by a final event called
 DevicelistComplete.</para>
 </description>
 </manager>
 <manager name="SKINNYshowdevice" language="en_US">
 <synopsis>
 Show SKINNY device (text format).
 </synopsis>
 <syntax>
 <xi:include xpointer="xpointer(/docs/manager[@name='Login']/syntax/parameter[@name='ActionID'])" />
 <parameter name="Device" required="true">
 <para>The device name you want to check.</para>
 </parameter>
 </syntax>
 <description>
 <para>Show one SKINNY device with details on current status.</para>
 </description>
 </manager>
 <manager name="SKINNYlines" language="en_US">
 <synopsis>
 List SKINNY lines (text format).
 </synopsis>
 <syntax>
 <xi:include xpointer="xpointer(/docs/manager[@name='Login']/syntax/parameter[@name='ActionID'])" />
 </syntax>
 <description>
 <para>Lists Skinny lines in text format with details on current status.
 Linelist will follow as separate events, followed by a final event called
 LinelistComplete.</para>
 </description>
 </manager>
 <manager name="SKINNYshowline" language="en_US">
 <synopsis>
 Show SKINNY line (text format).
 </synopsis>
 <syntax>
 <xi:include xpointer="xpointer(/docs/manager[@name='Login']/syntax/parameter[@name='ActionID'])" />
 <parameter name="Line" required="true">
 <para>The line name you want to check.</para>
 </parameter>
 </syntax>
 <description>
 <para>Show one SKINNY line with details on current status.</para>
 </description>
 </manager>
 ***/

/* Skinny debugging only available if asterisk configured with --enable-dev-mode */
#ifdef AST_DEVMODE
static int skinnydebug = 0;
char dbgcli_buf[256];
#define DEBUG_GENERAL (1 << 1)
#define DEBUG_SUB (1 << 2)
#define DEBUG_PACKET (1 << 3)
#define DEBUG_AUDIO (1 << 4)
#define DEBUG_LOCK (1 << 5)
#define DEBUG_TEMPLATE (1 << 6)
#define DEBUG_THREAD (1 << 7)
#define DEBUG_HINT (1 << 8)
#define DEBUG_KEEPALIVE (1 << 9)
#define SKINNY_DEBUG(type, verb_level, text, ...) \
 do{ \
 if (skinnydebug & (type)) { \
 ast_verb(verb_level, "[%d] " text, ast_get_tid(), ##__VA_ARGS__); \
 } \
 }while(0)
#else
#define SKINNY_DEBUG(type, verb_level, text, ...)
#endif

/*************************************
 * Skinny/Asterisk Protocol Settings *
 *************************************/
static const char tdesc[] = "Skinny Client Control Protocol (Skinny)";
static const char config[] = "skinny.conf";

static struct ast_format_cap *default_cap;

enum skinny_codecs {
 SKINNY_CODEC_ALAW = 2,
 SKINNY_CODEC_ULAW = 4,
 SKINNY_CODEC_G722 = 6,
 SKINNY_CODEC_G723_1 = 9,
 SKINNY_CODEC_G729A = 12,
 SKINNY_CODEC_G726_32 = 82, /* XXX Which packing order does this translate to? */
 SKINNY_CODEC_H261 = 100,
 SKINNY_CODEC_H263 = 101
};

#define DEFAULT_SKINNY_PORT 2000
#define DEFAULT_SKINNY_BACKLOG 2
#define SKINNY_MAX_PACKET 2000
#define DEFAULT_AUTH_TIMEOUT 30
#define DEFAULT_AUTH_LIMIT 50

static struct {
 unsigned int tos;
 unsigned int tos_audio;
 unsigned int tos_video;
 unsigned int cos;
 unsigned int cos_audio;
 unsigned int cos_video;
} qos = { 0, 0, 0, 0, 0, 0 };

static int keep_alive = 120;
static int auth_timeout = DEFAULT_AUTH_TIMEOUT;
static int auth_limit = DEFAULT_AUTH_LIMIT;
static int unauth_sessions = 0;
static char immed_dialchar;
static char vmexten[AST_MAX_EXTENSION]; /* Voicemail pilot number */
static char used_context[AST_MAX_EXTENSION]; /* placeholder to check if context are already used in regcontext */
static char regcontext[AST_MAX_CONTEXT]; /* Context for auto-extension */
static char date_format[6] = "D-M-Y";
static char version_id[16] = "P002F202";

#if __BYTE_ORDER == __LITTLE_ENDIAN
#define letohl(x) (x)
#define letohs(x) (x)
#define htolel(x) (x)
#define htoles(x) (x)
#else
#if defined(HAVE_BYTESWAP_H)
#include <byteswap.h>
#define letohl(x) bswap_32(x)
#define letohs(x) bswap_16(x)
#define htolel(x) bswap_32(x)
#define htoles(x) bswap_16(x)
#elif defined(HAVE_SYS_ENDIAN_SWAP16)
#include <sys/endian.h>
#define letohl(x) __swap32(x)
#define letohs(x) __swap16(x)
#define htolel(x) __swap32(x)
#define htoles(x) __swap16(x)
#elif defined(HAVE_SYS_ENDIAN_BSWAP16)
#include <sys/endian.h>
#define letohl(x) bswap32(x)
#define letohs(x) bswap16(x)
#define htolel(x) bswap32(x)
#define htoles(x) bswap16(x)
#else
#define __bswap_16(x) \
 ((((x) & 0xff00) >> 8) | \
 (((x) & 0x00ff) << 8))
#define __bswap_32(x) \
 ((((x) & 0xff000000) >> 24) | \
 (((x) & 0x00ff0000) >> 8) | \
 (((x) & 0x0000ff00) << 8) | \
 (((x) & 0x000000ff) << 24))
#define letohl(x) __bswap_32(x)
#define letohs(x) __bswap_16(x)
#define htolel(x) __bswap_32(x)
#define htoles(x) __bswap_16(x)
#endif
#endif

/*! Global jitterbuffer configuration - by default, jb is disabled
 * \note Values shown here match the defaults shown in skinny.conf.sample */
static struct ast_jb_conf default_jbconf =
{
 .flags = 0,
 .max_size = 200,
 .resync_threshold = 1000,
 .impl = "fixed",
 .target_extra = 40,
};
static struct ast_jb_conf global_jbconf;

#ifdef AST_DEVMODE
AST_THREADSTORAGE(message2str_threadbuf);
#define MESSAGE2STR_BUFSIZE 35
#endif

AST_THREADSTORAGE(device2str_threadbuf);
#define DEVICE2STR_BUFSIZE 15

AST_THREADSTORAGE(control2str_threadbuf);
#define CONTROL2STR_BUFSIZE 100

AST_THREADSTORAGE(substate2str_threadbuf);
#define SUBSTATE2STR_BUFSIZE 15

AST_THREADSTORAGE(callstate2str_threadbuf);
#define CALLSTATE2STR_BUFSIZE 15

/*********************
 * Protocol Messages *
 *********************/
/* message types */
#define KEEP_ALIVE_MESSAGE 0x0000
/* no additional struct */

#define REGISTER_MESSAGE 0x0001
struct register_message {
 char name[16];
 uint32_t userId;
 uint32_t instance;
 uint32_t ip;
 uint32_t type;
 uint32_t maxStreams;
 uint32_t space;
 uint8_t protocolVersion;
 /*! \brief space2 is used for newer version of skinny */
 char space2[3];
};

#define IP_PORT_MESSAGE 0x0002

#define KEYPAD_BUTTON_MESSAGE 0x0003
struct keypad_button_message {
 uint32_t button;
 uint32_t lineInstance;
 uint32_t callReference;
};


#define ENBLOC_CALL_MESSAGE 0x0004
struct enbloc_call_message {
 char calledParty[24];
};

#define STIMULUS_MESSAGE 0x0005
struct stimulus_message {
 uint32_t stimulus;
 uint32_t stimulusInstance;
 uint32_t callreference;
};

#define OFFHOOK_MESSAGE 0x0006
struct offhook_message {
 uint32_t instance;
 uint32_t reference;
};

#define ONHOOK_MESSAGE 0x0007
struct onhook_message {
 uint32_t instance;
 uint32_t reference;
};

#define CAPABILITIES_RES_MESSAGE 0x0010
struct station_capabilities {
 uint32_t codec; /* skinny codec, not ast codec */
 uint32_t frames;
 union {
 char res[8];
 uint32_t rate;
 } payloads;
};

#define SKINNY_MAX_CAPABILITIES 18

struct capabilities_res_message {
 uint32_t count;
 struct station_capabilities caps[SKINNY_MAX_CAPABILITIES];
};

#define SPEED_DIAL_STAT_REQ_MESSAGE 0x000A
struct speed_dial_stat_req_message {
 uint32_t speedDialNumber;
};

#define LINE_STATE_REQ_MESSAGE 0x000B
struct line_state_req_message {
 uint32_t lineNumber;
};

#define TIME_DATE_REQ_MESSAGE 0x000D
#define BUTTON_TEMPLATE_REQ_MESSAGE 0x000E
#define VERSION_REQ_MESSAGE 0x000F
#define SERVER_REQUEST_MESSAGE 0x0012

#define ALARM_MESSAGE 0x0020
struct alarm_message {
 uint32_t alarmSeverity;
 char displayMessage[80];
 uint32_t alarmParam1;
 uint32_t alarmParam2;
};

#define OPEN_RECEIVE_CHANNEL_ACK_MESSAGE 0x0022
struct open_receive_channel_ack_message_ip4 {
 uint32_t status;
 uint32_t ipAddr;
 uint32_t port;
 uint32_t callReference;
};
struct open_receive_channel_ack_message_ip6 {
 uint32_t status;
 uint32_t space;
 char ipAddr[16];
 uint32_t port;
 uint32_t callReference;
};

#define SOFT_KEY_SET_REQ_MESSAGE 0x0025

#define SOFT_KEY_EVENT_MESSAGE 0x0026
struct soft_key_event_message {
 uint32_t softKeyEvent;
 uint32_t instance;
 uint32_t callreference;
};

#define UNREGISTER_MESSAGE 0x0027
#define SOFT_KEY_TEMPLATE_REQ_MESSAGE 0x0028
#define HEADSET_STATUS_MESSAGE 0x002B
#define REGISTER_AVAILABLE_LINES_MESSAGE 0x002D

#define SERVICEURL_STATREQ_MESSAGE 0x0033
struct serviceurl_statreq_message {
 uint32_t instance;
};

#define REGISTER_ACK_MESSAGE 0x0081
struct register_ack_message {
 uint32_t keepAlive;
 char dateTemplate[6];
 char res[2];
 uint32_t secondaryKeepAlive;
 char res2[4];
};

#define START_TONE_MESSAGE 0x0082
struct start_tone_message {
 uint32_t tone;
 uint32_t space;
 uint32_t instance;
 uint32_t reference;
};

#define STOP_TONE_MESSAGE 0x0083
struct stop_tone_message {
 uint32_t instance;
 uint32_t reference;
 uint32_t space;
};

#define SET_RINGER_MESSAGE 0x0085
struct set_ringer_message {
 uint32_t ringerMode;
 uint32_t unknown1; /* See notes in transmit_ringer_mode */
 uint32_t unknown2;
 uint32_t space[2];
};

#define SET_LAMP_MESSAGE 0x0086
struct set_lamp_message {
 uint32_t stimulus;
 uint32_t stimulusInstance;
 uint32_t deviceStimulus;
};

#define SET_SPEAKER_MESSAGE 0x0088
struct set_speaker_message {
 uint32_t mode;
};

/* XXX When do we need to use this? */
#define SET_MICROPHONE_MESSAGE 0x0089
struct set_microphone_message {
 uint32_t mode;
};

#define START_MEDIA_TRANSMISSION_MESSAGE 0x008A
struct media_qualifier {
 uint32_t precedence;
 uint32_t vad;
 uint32_t packets;
 uint32_t bitRate;
};

struct start_media_transmission_message_ip4 {
 uint32_t conferenceId;
 uint32_t passThruPartyId;
 uint32_t remoteIp;
 uint32_t remotePort;
 uint32_t packetSize;
 uint32_t payloadType;
 struct media_qualifier qualifier;
 uint32_t space[19];
};

struct start_media_transmission_message_ip6 {
 uint32_t conferenceId;
 uint32_t passThruPartyId;
 uint32_t space;
 char remoteIp[16];
 uint32_t remotePort;
 uint32_t packetSize;
 uint32_t payloadType;
 struct media_qualifier qualifier;
 /*! \brief space2 is used for newer version of skinny */
 uint32_t space2[19];
};

#define STOP_MEDIA_TRANSMISSION_MESSAGE 0x008B
struct stop_media_transmission_message {
 uint32_t conferenceId;
 uint32_t passThruPartyId;
 uint32_t space[3];
};

#define CALL_INFO_MESSAGE 0x008F
struct call_info_message {
 char callingPartyName[40];
 char callingParty[24];
 char calledPartyName[40];
 char calledParty[24];
 uint32_t instance;
 uint32_t reference;
 uint32_t type;
 char originalCalledPartyName[40];
 char originalCalledParty[24];
 char lastRedirectingPartyName[40];
 char lastRedirectingParty[24];
 uint32_t originalCalledPartyRedirectReason;
 uint32_t lastRedirectingReason;
 char callingPartyVoiceMailbox[24];
 char calledPartyVoiceMailbox[24];
 char originalCalledPartyVoiceMailbox[24];
 char lastRedirectingVoiceMailbox[24];
 uint32_t space[3];
};

#define FORWARD_STAT_MESSAGE 0x0090
struct forward_stat_message {
 uint32_t activeforward;
 uint32_t lineNumber;
 uint32_t fwdall;
 char fwdallnum[24];
 uint32_t fwdbusy;
 char fwdbusynum[24];
 uint32_t fwdnoanswer;
 char fwdnoanswernum[24];
};

#define SPEED_DIAL_STAT_RES_MESSAGE 0x0091
struct speed_dial_stat_res_message {
 uint32_t speedDialNumber;
 char speedDialDirNumber[24];
 char speedDialDisplayName[40];
};

#define LINE_STAT_RES_MESSAGE 0x0092
struct line_stat_res_message {
 uint32_t lineNumber;
 char lineDirNumber[24];
 char lineDisplayName[24];
 uint32_t space[15];
};

#define DEFINETIMEDATE_MESSAGE 0x0094
struct definetimedate_message {
 uint32_t year; /* since 1900 */
 uint32_t month;
 uint32_t dayofweek; /* monday = 1 */
 uint32_t day;
 uint32_t hour;
 uint32_t minute;
 uint32_t seconds;
 uint32_t milliseconds;
 uint32_t timestamp;
};

#define BUTTON_TEMPLATE_RES_MESSAGE 0x0097
struct button_definition {
 uint8_t instanceNumber;
 uint8_t buttonDefinition;
};

struct button_definition_template {
 uint8_t buttonDefinition;
 /* for now, anything between 0xB0 and 0xCF is custom */
 /*int custom;*/
};

#define STIMULUS_REDIAL 0x01
#define STIMULUS_SPEEDDIAL 0x02
#define STIMULUS_HOLD 0x03
#define STIMULUS_TRANSFER 0x04
#define STIMULUS_FORWARDALL 0x05
#define STIMULUS_FORWARDBUSY 0x06
#define STIMULUS_FORWARDNOANSWER 0x07
#define STIMULUS_DISPLAY 0x08
#define STIMULUS_LINE 0x09
#define STIMULUS_VOICEMAIL 0x0F
#define STIMULUS_AUTOANSWER 0x11
#define STIMULUS_SERVICEURL 0x14
#define STIMULUS_DND 0x3F
#define STIMULUS_CONFERENCE 0x7D
#define STIMULUS_CALLPARK 0x7E
#define STIMULUS_CALLPICKUP 0x7F
#define STIMULUS_NONE 0xFF

/* Button types */
#define BT_REDIAL STIMULUS_REDIAL
#define BT_SPEEDDIAL STIMULUS_SPEEDDIAL
#define BT_HOLD STIMULUS_HOLD
#define BT_TRANSFER STIMULUS_TRANSFER
#define BT_FORWARDALL STIMULUS_FORWARDALL
#define BT_FORWARDBUSY STIMULUS_FORWARDBUSY
#define BT_FORWARDNOANSWER STIMULUS_FORWARDNOANSWER
#define BT_DISPLAY STIMULUS_DISPLAY
#define BT_LINE STIMULUS_LINE
#define BT_VOICEMAIL STIMULUS_VOICEMAIL
#define BT_AUTOANSWER STIMULUS_AUTOANSWER
#define BT_SERVICEURL STIMULUS_SERVICEURL
#define BT_DND STIMULUS_DND
#define BT_CONFERENCE STIMULUS_CONFERENCE
#define BT_CALLPARK STIMULUS_CALLPARK
#define BT_CALLPICKUP STIMULUS_CALLPICKUP
#define BT_NONE 0x00

/* Custom button types - add our own between 0xB0 and 0xCF.
 This may need to be revised in the future,
 if stimuluses are ever added in this range. */
#define BT_CUST_LINESPEEDDIAL 0xB0 /* line or speeddial with/without hint */
#define BT_CUST_LINE 0xB1 /* line or speeddial with hint only */

struct button_template_res_message {
 uint32_t buttonOffset;
 uint32_t buttonCount;
 uint32_t totalButtonCount;
 struct button_definition definition[42];
};

#define VERSION_RES_MESSAGE 0x0098
struct version_res_message {
 char version[16];
};

#define DISPLAYTEXT_MESSAGE 0x0099
struct displaytext_message {
 char text[40];
};

#define CLEAR_NOTIFY_MESSAGE 0x0115
#define CLEAR_DISPLAY_MESSAGE 0x009A
struct clear_display_message {
 uint32_t space;
};

#define CAPABILITIES_REQ_MESSAGE 0x009B

#define REGISTER_REJ_MESSAGE 0x009D
struct register_rej_message {
 char errMsg[33];
};

#define SERVER_RES_MESSAGE 0x009E
struct server_identifier {
 char serverName[48];
};

struct server_res_message {
 struct server_identifier server[5];
 uint32_t serverListenPort[5];
 uint32_t serverIpAddr[5];
};

#define RESET_MESSAGE 0x009F
struct reset_message {
 uint32_t resetType;
};

#define KEEP_ALIVE_ACK_MESSAGE 0x0100

#define OPEN_RECEIVE_CHANNEL_MESSAGE 0x0105
struct open_receive_channel_message {
 uint32_t conferenceId;
 uint32_t partyId;
 uint32_t packets;
 uint32_t capability;
 uint32_t echo;
 uint32_t bitrate;
 uint32_t space[36];
};

#define CLOSE_RECEIVE_CHANNEL_MESSAGE 0x0106
struct close_receive_channel_message {
 uint32_t conferenceId;
 uint32_t partyId;
 uint32_t space[2];
};

#define SOFT_KEY_TEMPLATE_RES_MESSAGE 0x0108
struct soft_key_template_definition {
 char softKeyLabel[16];
 uint32_t softKeyEvent;
};

#define BKSP_REQ_MESSAGE 0x0119
struct bksp_req_message {
 uint32_t instance;
 uint32_t callreference;
};

#define KEYDEF_ONHOOK 0
#define KEYDEF_CONNECTED 1
#define KEYDEF_ONHOLD 2
#define KEYDEF_RINGIN 3
#define KEYDEF_OFFHOOK 4
#define KEYDEF_CONNWITHTRANS 5
#define KEYDEF_DADFD 6 /* Digits After Dialing First Digit */
#define KEYDEF_CONNWITHCONF 7
#define KEYDEF_RINGOUT 8
#define KEYDEF_OFFHOOKWITHFEAT 9
#define KEYDEF_UNKNOWN 10
#define KEYDEF_SLAHOLD 11
#define KEYDEF_SLACONNECTEDNOTACTIVE 12
#define KEYDEF_RINGOUTWITHTRANS 13

#define SOFTKEY_NONE 0x00
#define SOFTKEY_REDIAL 0x01
#define SOFTKEY_NEWCALL 0x02
#define SOFTKEY_HOLD 0x03
#define SOFTKEY_TRNSFER 0x04
#define SOFTKEY_CFWDALL 0x05
#define SOFTKEY_CFWDBUSY 0x06
#define SOFTKEY_CFWDNOANSWER 0x07
#define SOFTKEY_BKSPC 0x08
#define SOFTKEY_ENDCALL 0x09
#define SOFTKEY_RESUME 0x0A
#define SOFTKEY_ANSWER 0x0B
#define SOFTKEY_INFO 0x0C
#define SOFTKEY_CONFRN 0x0D
#define SOFTKEY_PARK 0x0E
#define SOFTKEY_JOIN 0x0F
#define SOFTKEY_MEETME 0x10
#define SOFTKEY_PICKUP 0x11
#define SOFTKEY_GPICKUP 0x12
#define SOFTKEY_DND 0x13
#define SOFTKEY_IDIVERT 0x14
#define SOFTKEY_FORCEDIAL 0x15

#define KEYMASK_ALL 0xFFFFFFFF
#define KEYMASK_NONE (1 << 0)
#define KEYMASK_REDIAL (1 << 1)
#define KEYMASK_NEWCALL (1 << 2)
#define KEYMASK_HOLD (1 << 3)
#define KEYMASK_TRNSFER (1 << 4)
#define KEYMASK_CFWDALL (1 << 5)
#define KEYMASK_CFWDBUSY (1 << 6)
#define KEYMASK_CFWDNOANSWER (1 << 7)
#define KEYMASK_BKSPC (1 << 8)
#define KEYMASK_ENDCALL (1 << 9)
#define KEYMASK_RESUME (1 << 10)
#define KEYMASK_ANSWER (1 << 11)
#define KEYMASK_INFO (1 << 12)
#define KEYMASK_CONFRN (1 << 13)
#define KEYMASK_PARK (1 << 14)
#define KEYMASK_JOIN (1 << 15)
#define KEYMASK_MEETME (1 << 16)
#define KEYMASK_PICKUP (1 << 17)
#define KEYMASK_GPICKUP (1 << 18)
#define KEYMASK_DND (1 << 29)
#define KEYMASK_IDIVERT (1 << 20)
#define KEYMASK_FORCEDIAL (1 << 21)

/* Localized message "codes" (in octal)
 Below is en_US (taken from a 7970) */

/* "\200\000" ??? */
#define OCTAL_REDIAL "\200\001" /* Redial */
#define OCTAL_NEWCALL "\200\002" /* New Call */
#define OCTAL_HOLD "\200\003" /* Hold */
#define OCTAL_TRANSFER "\200\004" /* Transfer */
#define OCTAL_CFWDALL "\200\005" /* CFwdALL */
#define OCTAL_CFWDBUSY "\200\006" /* CFwdBusy */
#define OCTAL_CFWDNOAN "\200\007" /* CFwdNoAnswer */
#define OCTAL_BKSPC "\200\010" /* << */
#define OCTAL_ENDCALL "\200\011" /* EndCall */
#define OCTAL_RESUME "\200\012" /* Resume */
#define OCTAL_ANSWER "\200\013" /* Answer */
#define OCTAL_INFO "\200\014" /* Info */
#define OCTAL_CONFRN "\200\015" /* Confrn */
#define OCTAL_PARK "\200\016" /* Park */
#define OCTAL_JOIN "\200\017" /* Join */
#define OCTAL_MEETME "\200\020" /* MeetMe */
#define OCTAL_PICKUP "\200\021" /* PickUp */
#define OCTAL_GPICKUP "\200\022" /* GPickUp */
#define OCTAL_CUROPTS "\200\023" /* Your current options */
#define OCTAL_OFFHOOK "\200\024" /* Off Hook */
#define OCTAL_ONHOOK "\200\025" /* On Hook */
#define OCTAL_RINGOUT "\200\026" /* Ring out */
#define OCTAL_FROM "\200\027" /* From */
#define OCTAL_CONNECTED "\200\030" /* Connected */
#define OCTAL_BUSY "\200\031" /* Busy */
#define OCTAL_LINEINUSE "\200\032" /* Line In Use */
#define OCTAL_CALLWAITING "\200\033" /* Call Waiting */
#define OCTAL_CALLXFER "\200\034" /* Call Transfer */
#define OCTAL_CALLPARK "\200\035" /* Call Park */
#define OCTAL_CALLPROCEED "\200\036" /* Call Proceed */
#define OCTAL_INUSEREMOTE "\200\037" /* In Use Remote */
#define OCTAL_ENTRNUM "\200\040" /* Enter number */
#define OCTAL_PARKAT "\200\041" /* Call park At */
#define OCTAL_PRIMONLY "\200\042" /* Primary Only */
#define OCTAL_TMPFAIL "\200\043" /* Temp Fail */
#define OCTAL_HAVEVMAIL "\200\044" /* You Have VoiceMail */
#define OCTAL_FWDEDTO "\200\045" /* Forwarded to */
#define OCTAL_CANTCOMPCNF "\200\046" /* Can Not Complete Conference */
#define OCTAL_NOCONFBRDG "\200\047" /* No Conference Bridge */
#define OCTAL_NOPRIMARYCTL "\200\050" /* Can Not Hold Primary Control */
#define OCTAL_INVALCONFPART "\200\051" /* Invalid Conference Participant */
#define OCTAL_INCONFALREADY "\200\052" /* In Conference Already */
#define OCTAL_NOPARTINFO "\200\053" /* No Participant Info */
#define OCTAL_MAXPARTEXCEED "\200\054" /* Exceed Maximum Parties */
#define OCTAL_KEYNOTACTIVE "\200\055" /* Key Is Not Active */
#define OCTAL_ERRNOLIC "\200\056" /* Error No License */
#define OCTAL_ERRDBCFG "\200\057" /* Error DBConfig */
#define OCTAL_ERRDB "\200\060" /* Error Database */
#define OCTAL_ERRPASSLMT "\200\061" /* Error Pass Limit */
#define OCTAL_ERRUNK "\200\062" /* Error Unknown */
#define OCTAL_ERRMISMATCH "\200\063" /* Error Mismatch */
#define OCTAL_CONFERENCE "\200\064" /* Conference */
#define OCTAL_PARKNO "\200\065" /* Park Number */
#define OCTAL_PRIVATE "\200\066" /* Private */
#define OCTAL_INSUFBANDW "\200\067" /* Not Enough Bandwidth */
#define OCTAL_UNKNUM "\200\070" /* Unknown Number */
#define OCTAL_RMLSTC "\200\071" /* RmLstC */
#define OCTAL_VOICEMAIL "\200\072" /* Voicemail */
#define OCTAL_IMMDIV "\200\073" /* ImmDiv */
#define OCTAL_INTRCPT "\200\074" /* Intrcpt */
#define OCTAL_SETWTCH "\200\075" /* SetWtch */
#define OCTAL_TRNSFVM "\200\076" /* TrnsfVM */
#define OCTAL_DND "\200\077" /* DND */
#define OCTAL_DIVALL "\200\100" /* DivAll */
#define OCTAL_CALLBACK "\200\101" /* CallBack */
#define OCTAL_NETCNGREROUT "\200\102" /* Network congestion,rerouting */
#define OCTAL_BARGE "\200\103" /* Barge */
#define OCTAL_BARGEFAIL "\200\104" /* Failed to setup Barge */
#define OCTAL_BARGEEXIST "\200\105" /* Another Barge exists */
#define OCTAL_INCOMPATDEV "\200\106" /* Incompatible device type */
#define OCTAL_PARKNONUM "\200\107" /* No Park Number Available */
#define OCTAL_PARKREVERSION "\200\110" /* CallPark Reversion */
#define OCTAL_SRVNOTACTIVE "\200\111" /* Service is not Active */
#define OCTAL_HITRAFFIC "\200\112" /* High Traffic Try Again Later */
#define OCTAL_QRT "\200\113" /* QRT */
#define OCTAL_MCID "\200\114" /* MCID */
#define OCTAL_DIRTRFR "\200\115" /* DirTrfr */
#define OCTAL_SELECT "\200\116" /* Select */
#define OCTAL_CONFLIST "\200\117" /* ConfList */
#define OCTAL_IDIVERT "\200\120" /* iDivert */
#define OCTAL_CBARGE "\200\121" /* cBarge */
#define OCTAL_CANTCOMPLXFER "\200\122" /* Can Not Complete Transfer */
#define OCTAL_CANTJOINCALLS "\200\123" /* Can Not Join Calls */
#define OCTAL_MCIDSUCCESS "\200\124" /* Mcid Successful */
#define OCTAL_NUMNOTCFG "\200\125" /* Number Not Configured */
#define OCTAL_SECERROR "\200\126" /* Security Error */
#define OCTAL_VIDBANDWNA "\200\127" /* Video Bandwidth Unavailable */
#define OCTAL_VIDMODE "\200\130" /* VidMode */
#define OCTAL_CALLDURTIMEOUT "\200\131" /* Max Call Duration Timeout */
#define OCTAL_HOLDDURTIMEOUT "\200\132" /* Max Hold Duration Timeout */
#define OCTAL_OPICKUP "\200\133" /* OPickUp */
/* "\200\134" ??? */
/* "\200\135" ??? */
/* "\200\136" ??? */
/* "\200\137" ??? */
/* "\200\140" ??? */
#define OCTAL_EXTXFERRESTRICT "\200\141" /* External Transfer Restricted */
/* "\200\142" ??? */
/* "\200\143" ??? */
/* "\200\144" ??? */
#define OCTAL_MACADD "\200\145" /* Mac Address */
#define OCTAL_HOST "\200\146" /* Host Name */
#define OCTAL_DOMAIN "\200\147" /* Domain Name */
#define OCTAL_IPADD "\200\150" /* IP Address */
#define OCTAL_SUBMASK "\200\151" /* Subnet Mask */
#define OCTAL_TFTP1 "\200\152" /* TFTP Server 1 */
#define OCTAL_ROUTER1 "\200\153" /* Default Router 1 */
#define OCTAL_ROUTER2 "\200\154" /* Default Router 2 */
#define OCTAL_ROUTER3 "\200\155" /* Default Router 3 */
#define OCTAL_ROUTER4 "\200\156" /* Default Router 4 */
#define OCTAL_ROUTER5 "\200\157" /* Default Router 5 */
#define OCTAL_DNS1 "\200\160" /* DNS Server 1 */
#define OCTAL_DNS2 "\200\161" /* DNS Server 2 */
#define OCTAL_DNS3 "\200\162" /* DNS Server 3 */
#define OCTAL_DNS4 "\200\163" /* DNS Server 4 */
#define OCTAL_DNS5 "\200\164" /* DNS Server 5 */
#define OCTAL_VLANOPID "\200\165" /* Operational VLAN Id */
#define OCTAL_VLANADID "\200\166" /* Admin. VLAN Id */
#define OCTAL_CM1 "\200\167" /* CallManager 1 */
#define OCTAL_CM2 "\200\170" /* CallManager 2 */
#define OCTAL_CM3 "\200\171" /* CallManager 3 */
#define OCTAL_CM4 "\200\172" /* CallManager 4 */
#define OCTAL_CM5 "\200\173" /* CallManager 5 */
#define OCTAL_URLINFO "\200\174" /* Information URL */
#define OCTAL_URLDIRS "\200\175" /* Directories URL */
#define OCTAL_URLMSGS "\200\176" /* Messages URL */
#define OCTAL_URLSRVS "\200\177" /* Services URL */

static struct soft_key_template_definition soft_key_template_default[] = {
 { OCTAL_REDIAL, SOFTKEY_REDIAL },
 { OCTAL_NEWCALL, SOFTKEY_NEWCALL },
 { OCTAL_HOLD, SOFTKEY_HOLD },
 { OCTAL_TRANSFER, SOFTKEY_TRNSFER },
 { OCTAL_CFWDALL, SOFTKEY_CFWDALL },
 { OCTAL_CFWDBUSY, SOFTKEY_CFWDBUSY },
 { OCTAL_CFWDNOAN, SOFTKEY_CFWDNOANSWER },
 { OCTAL_BKSPC, SOFTKEY_BKSPC },
 { OCTAL_ENDCALL, SOFTKEY_ENDCALL },
 { OCTAL_RESUME, SOFTKEY_RESUME },
 { OCTAL_ANSWER, SOFTKEY_ANSWER },
 { OCTAL_INFO, SOFTKEY_INFO },
 { OCTAL_CONFRN, SOFTKEY_CONFRN },
 { OCTAL_PARK, SOFTKEY_PARK },
 { OCTAL_JOIN, SOFTKEY_JOIN },
 { OCTAL_MEETME, SOFTKEY_MEETME },
 { OCTAL_PICKUP, SOFTKEY_PICKUP },
 { OCTAL_GPICKUP, SOFTKEY_GPICKUP },
 { OCTAL_DND, SOFTKEY_DND },
 { OCTAL_IDIVERT, SOFTKEY_IDIVERT },
 { "Dial", SOFTKEY_FORCEDIAL},
};

struct soft_key_definitions {
 const uint8_t mode;
 const uint8_t *defaults;
 const int count;
};

static const uint8_t soft_key_default_onhook[] = {
 SOFTKEY_REDIAL,
 SOFTKEY_NEWCALL,
 SOFTKEY_CFWDALL,
 SOFTKEY_CFWDBUSY,
 SOFTKEY_CFWDNOANSWER,
 SOFTKEY_DND,
 SOFTKEY_GPICKUP,
 /*SOFTKEY_CONFRN,*/
};

static const uint8_t soft_key_default_connected[] = {
 SOFTKEY_HOLD,
 SOFTKEY_ENDCALL,
 SOFTKEY_TRNSFER,
 SOFTKEY_PARK,
 SOFTKEY_CFWDALL,
 SOFTKEY_CFWDBUSY,
 SOFTKEY_CFWDNOANSWER,
};

static const uint8_t soft_key_default_onhold[] = {
 SOFTKEY_RESUME,
 SOFTKEY_NEWCALL,
 SOFTKEY_ENDCALL,
 SOFTKEY_TRNSFER,
};

static const uint8_t soft_key_default_ringin[] = {
 SOFTKEY_ANSWER,
 SOFTKEY_ENDCALL,
 SOFTKEY_TRNSFER,
};

static const uint8_t soft_key_default_offhook[] = {
 SOFTKEY_REDIAL,
 SOFTKEY_ENDCALL,
 SOFTKEY_TRNSFER,
 SOFTKEY_CFWDALL,
 SOFTKEY_CFWDBUSY,
 SOFTKEY_CFWDNOANSWER,
 SOFTKEY_GPICKUP,
};

static const uint8_t soft_key_default_connwithtrans[] = {
 SOFTKEY_HOLD,
 SOFTKEY_ENDCALL,
 SOFTKEY_TRNSFER,
 SOFTKEY_PARK,
 SOFTKEY_CFWDALL,
 SOFTKEY_CFWDBUSY,
 SOFTKEY_CFWDNOANSWER,
};

static const uint8_t soft_key_default_dadfd[] = {
 SOFTKEY_BKSPC,
 SOFTKEY_ENDCALL,
 SOFTKEY_TRNSFER,
 SOFTKEY_FORCEDIAL,
};

static const uint8_t soft_key_default_connwithconf[] = {
 SOFTKEY_NONE,
};

static const uint8_t soft_key_default_ringout[] = {
 SOFTKEY_NONE,
 SOFTKEY_ENDCALL,
};

static const uint8_t soft_key_default_ringoutwithtransfer[] = {
 SOFTKEY_NONE,
 SOFTKEY_ENDCALL,
 SOFTKEY_TRNSFER,
};

static const uint8_t soft_key_default_offhookwithfeat[] = {
 SOFTKEY_REDIAL,
 SOFTKEY_ENDCALL,
 SOFTKEY_TRNSFER,
};

static const uint8_t soft_key_default_unknown[] = {
 SOFTKEY_NONE,
};

static const uint8_t soft_key_default_SLAhold[] = {
 SOFTKEY_REDIAL,
 SOFTKEY_NEWCALL,
 SOFTKEY_RESUME,
};

static const uint8_t soft_key_default_SLAconnectednotactive[] = {
 SOFTKEY_REDIAL,
 SOFTKEY_NEWCALL,
 SOFTKEY_JOIN,
};

static const struct soft_key_definitions soft_key_default_definitions[] = {
 {KEYDEF_ONHOOK, soft_key_default_onhook, sizeof(soft_key_default_onhook) / sizeof(uint8_t)},
 {KEYDEF_CONNECTED, soft_key_default_connected, sizeof(soft_key_default_connected) / sizeof(uint8_t)},
 {KEYDEF_ONHOLD, soft_key_default_onhold, sizeof(soft_key_default_onhold) / sizeof(uint8_t)},
 {KEYDEF_RINGIN, soft_key_default_ringin, sizeof(soft_key_default_ringin) / sizeof(uint8_t)},
 {KEYDEF_OFFHOOK, soft_key_default_offhook, sizeof(soft_key_default_offhook) / sizeof(uint8_t)},
 {KEYDEF_CONNWITHTRANS, soft_key_default_connwithtrans, sizeof(soft_key_default_connwithtrans) / sizeof(uint8_t)},
 {KEYDEF_DADFD, soft_key_default_dadfd, sizeof(soft_key_default_dadfd) / sizeof(uint8_t)},
 {KEYDEF_CONNWITHCONF, soft_key_default_connwithconf, sizeof(soft_key_default_connwithconf) / sizeof(uint8_t)},
 {KEYDEF_RINGOUT, soft_key_default_ringout, sizeof(soft_key_default_ringout) / sizeof(uint8_t)},
 {KEYDEF_RINGOUTWITHTRANS, soft_key_default_ringoutwithtransfer, sizeof(soft_key_default_ringoutwithtransfer) / sizeof(uint8_t)},
 {KEYDEF_OFFHOOKWITHFEAT, soft_key_default_offhookwithfeat, sizeof(soft_key_default_offhookwithfeat) / sizeof(uint8_t)},
 {KEYDEF_UNKNOWN, soft_key_default_unknown, sizeof(soft_key_default_unknown) / sizeof(uint8_t)},
 {KEYDEF_SLAHOLD, soft_key_default_SLAhold, sizeof(soft_key_default_SLAhold) / sizeof(uint8_t)},
 {KEYDEF_SLACONNECTEDNOTACTIVE, soft_key_default_SLAconnectednotactive, sizeof(soft_key_default_SLAconnectednotactive) / sizeof(uint8_t)}
};

struct soft_key_template_res_message {
 uint32_t softKeyOffset;
 uint32_t softKeyCount;
 uint32_t totalSoftKeyCount;
 struct soft_key_template_definition softKeyTemplateDefinition[32];
};

#define SOFT_KEY_SET_RES_MESSAGE 0x0109

struct soft_key_set_definition {
 uint8_t softKeyTemplateIndex[16];
 uint16_t softKeyInfoIndex[16];
};

struct soft_key_set_res_message {
 uint32_t softKeySetOffset;
 uint32_t softKeySetCount;
 uint32_t totalSoftKeySetCount;
 struct soft_key_set_definition softKeySetDefinition[16];
 uint32_t res;
};

#define SELECT_SOFT_KEYS_MESSAGE 0x0110
struct select_soft_keys_message {
 uint32_t instance;
 uint32_t reference;
 uint32_t softKeySetIndex;
 uint32_t validKeyMask;
};

#define CALL_STATE_MESSAGE 0x0111
struct call_state_message {
 uint32_t callState;
 uint32_t lineInstance;
 uint32_t callReference;
 uint32_t space[3];
};

#define DISPLAY_PROMPT_STATUS_MESSAGE 0x0112
struct display_prompt_status_message {
 uint32_t messageTimeout;
 char promptMessage[32];
 uint32_t lineInstance;
 uint32_t callReference;
 uint32_t space[3];
};

#define CLEAR_PROMPT_MESSAGE 0x0113
struct clear_prompt_message {
 uint32_t lineInstance;
 uint32_t callReference;
};

#define DISPLAY_NOTIFY_MESSAGE 0x0114
struct display_notify_message {
 uint32_t displayTimeout;
 char displayMessage[100];
};

#define ACTIVATE_CALL_PLANE_MESSAGE 0x0116
struct activate_call_plane_message {
 uint32_t lineInstance;
};

#define DIALED_NUMBER_MESSAGE 0x011D
struct dialed_number_message {
 char dialedNumber[24];
 uint32_t lineInstance;
 uint32_t callReference;
};

#define MAX_SERVICEURL 256
#define SERVICEURL_STAT_MESSAGE 0x012F
struct serviceurl_stat_message {
 uint32_t instance;
 char url[MAX_SERVICEURL];
 char displayName[40];
};

#define MAXCALLINFOSTR 256
#define MAXDISPLAYNOTIFYSTR 32

#define DISPLAY_PRINOTIFY_MESSAGE 0x0120
struct display_prinotify_message {
 uint32_t timeout;
 uint32_t priority;
 char text[MAXDISPLAYNOTIFYSTR];
};

#define CLEAR_PRINOTIFY_MESSAGE 0x0121
struct clear_prinotify_message {
 uint32_t priority;
};

#define CALL_INFO_MESSAGE_VARIABLE 0x014A
struct call_info_message_variable {
 uint32_t instance;
 uint32_t callreference;
 uint32_t calldirection;
 uint32_t unknown1;
 uint32_t unknown2;
 uint32_t unknown3;
 uint32_t unknown4;
 uint32_t unknown5;
 char calldetails[MAXCALLINFOSTR];
};

#define DISPLAY_PRINOTIFY_MESSAGE_VARIABLE 0x0144
struct display_prinotify_message_variable {
 uint32_t timeout;
 uint32_t priority;
 char text[MAXDISPLAYNOTIFYSTR];
};

#define DISPLAY_PROMPT_STATUS_MESSAGE_VARIABLE 0x0145
struct display_prompt_status_message_variable {
 uint32_t unknown;
 uint32_t lineInstance;
 uint32_t callReference;
 char promptMessage[MAXCALLINFOSTR];
};

union skinny_data {
 struct alarm_message alarm;
 struct speed_dial_stat_req_message speeddialreq;
 struct register_message reg;
 struct register_ack_message regack;
 struct register_rej_message regrej;
 struct capabilities_res_message caps;
 struct version_res_message version;
 struct button_template_res_message buttontemplate;
 struct displaytext_message displaytext;
 struct clear_display_message cleardisplay;
 struct display_prompt_status_message displaypromptstatus;
 struct clear_prompt_message clearpromptstatus;
 struct definetimedate_message definetimedate;
 struct start_tone_message starttone;
 struct stop_tone_message stoptone;
 struct speed_dial_stat_res_message speeddial;
 struct line_state_req_message line;
 struct line_stat_res_message linestat;
 struct soft_key_set_res_message softkeysets;
 struct soft_key_template_res_message softkeytemplate;
 struct server_res_message serverres;
 struct reset_message reset;
 struct set_lamp_message setlamp;
 struct set_ringer_message setringer;
 struct call_state_message callstate;
 struct keypad_button_message keypad;
 struct select_soft_keys_message selectsoftkey;
 struct activate_call_plane_message activatecallplane;
 struct stimulus_message stimulus;
 struct offhook_message offhook;
 struct onhook_message onhook;
 struct set_speaker_message setspeaker;
 struct set_microphone_message setmicrophone;
 struct call_info_message callinfo;
 struct start_media_transmission_message_ip4 startmedia_ip4;
 struct start_media_transmission_message_ip6 startmedia_ip6;
 struct stop_media_transmission_message stopmedia;
 struct open_receive_channel_message openreceivechannel;
 struct open_receive_channel_ack_message_ip4 openreceivechannelack_ip4;
 struct open_receive_channel_ack_message_ip6 openreceivechannelack_ip6;
 struct close_receive_channel_message closereceivechannel;
 struct display_notify_message displaynotify;
 struct dialed_number_message dialednumber;
 struct soft_key_event_message softkeyeventmessage;
 struct enbloc_call_message enbloccallmessage;
 struct forward_stat_message forwardstat;
 struct bksp_req_message bkspmessage;
 struct call_info_message_variable callinfomessagevariable;
 struct display_prompt_status_message_variable displaypromptstatusvar;
 struct serviceurl_stat_message serviceurlmessage;
 struct clear_prinotify_message clearprinotify;
 struct display_prinotify_message displayprinotify;
 struct display_prinotify_message_variable displayprinotifyvar;
};

/* packet composition */
struct skinny_req {
 uint32_t len;
 uint32_t res;
 uint32_t e;
 union skinny_data data;
};

/* XXX This is the combined size of the variables above. (len, res, e)
 If more are added, this MUST change.
 (sizeof(skinny_req) - sizeof(skinny_data)) DOES NOT WORK on all systems (amd64?). */
static int skinny_header_size = 12;

/*****************************
 * Asterisk specific globals *
 *****************************/

static int skinnyreload = 0;

/* a hostname, portnumber, socket and such is usefull for VoIP protocols */
static struct sockaddr_in bindaddr;
static char ourhost[256];
static int ourport;
static struct in_addr __ourip;
static struct ast_hostent ahp;
static struct hostent *hp;
static int skinnysock = -1;
static pthread_t accept_t;
static int callnums = 1;

#define SKINNY_DEVICE_UNKNOWN -1
#define SKINNY_DEVICE_NONE 0
#define SKINNY_DEVICE_30SPPLUS 1
#define SKINNY_DEVICE_12SPPLUS 2
#define SKINNY_DEVICE_12SP 3
#define SKINNY_DEVICE_12 4
#define SKINNY_DEVICE_30VIP 5
#define SKINNY_DEVICE_7910 6
#define SKINNY_DEVICE_7960 7
#define SKINNY_DEVICE_7940 8
#define SKINNY_DEVICE_7935 9
#define SKINNY_DEVICE_ATA186 12 /* Cisco ATA-186 */
#define SKINNY_DEVICE_7941 115
#define SKINNY_DEVICE_7971 119
#define SKINNY_DEVICE_7914 124 /* Expansion module */
#define SKINNY_DEVICE_7985 302
#define SKINNY_DEVICE_7911 307
#define SKINNY_DEVICE_7961GE 308
#define SKINNY_DEVICE_7941GE 309
#define SKINNY_DEVICE_7931 348
#define SKINNY_DEVICE_7921 365
#define SKINNY_DEVICE_7906 369
#define SKINNY_DEVICE_7962 404 /* Not found */
#define SKINNY_DEVICE_7937 431
#define SKINNY_DEVICE_7942 434
#define SKINNY_DEVICE_7945 435
#define SKINNY_DEVICE_7965 436
#define SKINNY_DEVICE_7975 437
#define SKINNY_DEVICE_7905 20000
#define SKINNY_DEVICE_7920 30002
#define SKINNY_DEVICE_7970 30006
#define SKINNY_DEVICE_7912 30007
#define SKINNY_DEVICE_7902 30008
#define SKINNY_DEVICE_CIPC 30016 /* Cisco IP Communicator */
#define SKINNY_DEVICE_7961 30018
#define SKINNY_DEVICE_7936 30019
#define SKINNY_DEVICE_SCCPGATEWAY_AN 30027 /* Analog gateway */
#define SKINNY_DEVICE_SCCPGATEWAY_BRI 30028 /* BRI gateway */

#define SKINNY_SPEAKERON 1
#define SKINNY_SPEAKEROFF 2

#define SKINNY_MICON 1
#define SKINNY_MICOFF 2

#define SKINNY_OFFHOOK 1
#define SKINNY_ONHOOK 2
#define SKINNY_RINGOUT 3
#define SKINNY_RINGIN 4
#define SKINNY_CONNECTED 5
#define SKINNY_BUSY 6
#define SKINNY_CONGESTION 7
#define SKINNY_HOLD 8
#define SKINNY_CALLWAIT 9
#define SKINNY_TRANSFER 10
#define SKINNY_PARK 11
#define SKINNY_PROGRESS 12
#define SKINNY_CALLREMOTEMULTILINE 13
#define SKINNY_INVALID 14

#define SKINNY_INCOMING 1
#define SKINNY_OUTGOING 2

#define SKINNY_SILENCE 0x00 /* Note sure this is part of the protocol, remove? */
#define SKINNY_DIALTONE 0x21
#define SKINNY_BUSYTONE 0x23
#define SKINNY_ALERT 0x24
#define SKINNY_REORDER 0x25
#define SKINNY_CALLWAITTONE 0x2D
#define SKINNY_ZIPZIP 0x31
#define SKINNY_ZIP 0x32
#define SKINNY_BEEPBONK 0x33
#define SKINNY_BARGIN 0x43
#define SKINNY_NOTONE 0x7F

#define SKINNY_LAMP_OFF 1
#define SKINNY_LAMP_ON 2
#define SKINNY_LAMP_WINK 3
#define SKINNY_LAMP_FLASH 4
#define SKINNY_LAMP_BLINK 5

#define SKINNY_RING_OFF 1
#define SKINNY_RING_INSIDE 2
#define SKINNY_RING_OUTSIDE 3
#define SKINNY_RING_FEATURE 4

#define SKINNY_CFWD_ALL (1 << 0)
#define SKINNY_CFWD_BUSY (1 << 1)
#define SKINNY_CFWD_NOANSWER (1 << 2)

/* Skinny rtp stream modes. Do we really need this? */
#define SKINNY_CX_SENDONLY 0
#define SKINNY_CX_RECVONLY 1
#define SKINNY_CX_SENDRECV 2
#define SKINNY_CX_CONF 3
#define SKINNY_CX_CONFERENCE 3
#define SKINNY_CX_MUTE 4
#define SKINNY_CX_INACTIVE 4

#if 0
static const char * const skinny_cxmodes[] = {
 "sendonly",
 "recvonly",
 "sendrecv",
 "confrnce",
 "inactive"
};
#endif

/* driver scheduler */
static struct ast_sched_context *sched = NULL;

/* Protect the network socket */
AST_MUTEX_DEFINE_STATIC(netlock);

/* Wait up to 16 seconds for first digit */
static int firstdigittimeout = 16000;

/* How long to wait for following digits */
static int gendigittimeout = 8000;

/* How long to wait for an extra digit, if there is an ambiguous match */
static int matchdigittimeout = 3000;

/*!
 * To apease the stupid compiler option on ast_sched_del()
 * since we don't care about the return value.
 */
static int not_used;

#define SUBSTATE_UNSET 0
#define SUBSTATE_OFFHOOK 1
#define SUBSTATE_ONHOOK 2
#define SUBSTATE_RINGOUT 3
#define SUBSTATE_RINGIN 4
#define SUBSTATE_CONNECTED 5
#define SUBSTATE_BUSY 6
#define SUBSTATE_CONGESTION 7
#define SUBSTATE_HOLD 8
#define SUBSTATE_CALLWAIT 9
#define SUBSTATE_PROGRESS 12
#define SUBSTATE_DIALING 101

#define DIALTYPE_NORMAL 1<<0
#define DIALTYPE_CFWD 1<<1
#define DIALTYPE_XFER 1<<2

struct skinny_subchannel {
 struct ast_channel *owner;
 struct ast_rtp_instance *rtp;
 struct ast_rtp_instance *vrtp;
 unsigned int callid;
 char exten[AST_MAX_EXTENSION];
 /* time_t lastouttime; */ /* Unused */
 int progress;
 int ringing;
 /* int lastout; */ /* Unused */
 int cxmode;
 int nat;
 int calldirection;
 int blindxfer;
 int xferor;
 int substate;
 int aa_sched;
 int aa_beep;
 int aa_mute;
 int dialer_sched;
 int cfwd_sched;
 int dialType;
 int getforward;
 char *origtonum;
 char *origtoname;

 AST_LIST_ENTRY(skinny_subchannel) list;
 struct skinny_subchannel *related;
 struct skinny_line *line;
 struct skinny_subline *subline;
};

#define SKINNY_LINE_OPTIONS \
 char name[80]; \
 char label[24]; \
 char accountcode[AST_MAX_ACCOUNT_CODE]; \
 char exten[AST_MAX_EXTENSION]; \
 char context[AST_MAX_CONTEXT]; \
 char language[MAX_LANGUAGE]; \
 char cid_num[AST_MAX_EXTENSION]; \
 char cid_name[AST_MAX_EXTENSION]; \
 char lastcallerid[AST_MAX_EXTENSION]; \
 int cfwdtype; \
 char call_forward_all[AST_MAX_EXTENSION]; \
 char call_forward_busy[AST_MAX_EXTENSION]; \
 char call_forward_noanswer[AST_MAX_EXTENSION]; \
 char mailbox[AST_MAX_MAILBOX_UNIQUEID]; \
 char vmexten[AST_MAX_EXTENSION]; \
 char regexten[AST_MAX_EXTENSION]; \
 char regcontext[AST_MAX_CONTEXT]; \
 char parkinglot[AST_MAX_CONTEXT]; \
 char mohinterpret[MAX_MUSICCLASS]; \
 char mohsuggest[MAX_MUSICCLASS]; \
 char lastnumberdialed[AST_MAX_EXTENSION]; \
 char dialoutexten[AST_MAX_EXTENSION]; \
 char dialoutcontext[AST_MAX_CONTEXT]; \
 ast_group_t callgroup; \
 ast_group_t pickupgroup; \
 struct ast_namedgroups *named_callgroups; \
 struct ast_namedgroups *named_pickupgroups; \
 int callwaiting; \
 int transfer; \
 int threewaycalling; \
 int mwiblink; \
 int cancallforward; \
 int callfwdtimeout; \
 int dnd; \
 int hidecallerid; \
 int amaflags; \
 int instance; \
 int group; \
 int nonCodecCapability; \
 int immediate; \
 int nat; \
 int directmedia; \
 int prune;

struct skinny_line {
 SKINNY_LINE_OPTIONS
 ast_mutex_t lock;
 struct skinny_container *container;
 struct ast_mwi_subscriber *mwi_event_sub; /* Event based MWI */
 struct skinny_subchannel *activesub;
 AST_LIST_HEAD(, skinny_subchannel) sub;
 AST_LIST_HEAD(, skinny_subline) sublines;
 AST_LIST_ENTRY(skinny_line) list;
 AST_LIST_ENTRY(skinny_line) all;
 struct skinny_device *device;
 struct ast_format_cap *cap;
 struct ast_format_cap *confcap;
 struct ast_variable *chanvars; /*!< Channel variables to set for inbound call */
 int newmsgs;
};

static struct skinny_line_options{
 SKINNY_LINE_OPTIONS
} default_line_struct = {
 .callwaiting = 1,
 .transfer = 1,
 .mwiblink = 0,
 .dnd = 0,
 .hidecallerid = 0,
 .amaflags = 0,
 .instance = 0,
 .directmedia = 0,
 .nat = 0,
 .callfwdtimeout = 20000,
 .prune = 0,
};
static struct skinny_line_options *default_line = &default_line_struct;

static AST_LIST_HEAD_STATIC(lines, skinny_line);

struct skinny_subline {
 struct skinny_container *container;
 struct skinny_line *line;
 struct skinny_subchannel *sub;
 AST_LIST_ENTRY(skinny_subline) list;
 char name[80];
 char context[AST_MAX_CONTEXT];
 char exten[AST_MAX_EXTENSION];
 char stname[AST_MAX_EXTENSION];
 char lnname[AST_MAX_EXTENSION];
 char ourName[40];
 char ourNum[24];
 char theirName[40];
 char theirNum[24];
 int calldirection;
 int substate;
 int extenstate;
 unsigned int callid;
};

struct skinny_speeddial {
 ast_mutex_t lock;
 struct skinny_container *container;
 char label[42];
 char context[AST_MAX_CONTEXT];
 char exten[AST_MAX_EXTENSION];
 int instance;
 int stateid;
 int laststate;
 int isHint;

 AST_LIST_ENTRY(skinny_speeddial) list;
 struct skinny_device *parent;
};

struct skinny_serviceurl {
 int instance;
 char url[MAX_SERVICEURL];
 char displayName[40];
 AST_LIST_ENTRY(skinny_serviceurl) list;
 struct skinny_device *device;
};

#define SKINNY_DEVICECONTAINER 1
#define SKINNY_LINECONTAINER 2
#define SKINNY_SUBLINECONTAINER 3
#define SKINNY_SDCONTAINER 4

struct skinny_container {
 int type;
 void *data;
};

struct skinny_addon {
 ast_mutex_t lock;
 char type[10];
 AST_LIST_ENTRY(skinny_addon) list;
 struct skinny_device *parent;
};

#define SKINNY_DEVICE_OPTIONS \
 char name[80]; \
 char id[16]; \
 char version_id[16]; \
 char vmexten[AST_MAX_EXTENSION]; \
 int type; \
 int protocolversion; \
 int hookstate; \
 int lastlineinstance; \
 int lastcallreference; \
 int earlyrtp; \
 int transfer; \
 int callwaiting; \
 int mwiblink; \
 int dnd; \
 int prune;

struct skinny_device {
 SKINNY_DEVICE_OPTIONS
 struct type *first;
 struct type *last;
 ast_mutex_t lock;
 struct sockaddr_in addr;
 struct in_addr ourip;
 struct ast_ha *ha;
 struct skinnysession *session;
 struct skinny_line *activeline;
 struct ast_format_cap *cap;
 struct ast_format_cap *confcap;
 struct ast_endpoint *endpoint;
 AST_LIST_HEAD(, skinny_line) lines;
 AST_LIST_HEAD(, skinny_speeddial) speeddials;
 AST_LIST_HEAD(, skinny_serviceurl) serviceurls;
 AST_LIST_HEAD(, skinny_addon) addons;
 AST_LIST_ENTRY(skinny_device) list;
};

static struct skinny_device_options {
 SKINNY_DEVICE_OPTIONS
} default_device_struct = {
 .transfer = 1,
 .earlyrtp = 1,
 .callwaiting = 1,
 .mwiblink = 0,
 .dnd = 0,
 .prune = 0,
 .hookstate = SKINNY_ONHOOK,
};
static struct skinny_device_options *default_device = &default_device_struct;

static AST_LIST_HEAD_STATIC(devices, skinny_device);

struct skinnysession {
 pthread_t t;
 ast_mutex_t lock;
 struct timeval start;
 struct sockaddr_in sin;
 int fd;
 char outbuf[SKINNY_MAX_PACKET];
 struct skinny_device *device;
 AST_LIST_ENTRY(skinnysession) list;
 int lockstate; /* Only for use in the skinny_session thread */
 int auth_timeout_sched;
 int keepalive_timeout_sched;
 struct timeval last_keepalive;
 int keepalive_count;
};

static struct ast_channel *skinny_request(const char *type, struct ast_format_cap *cap, const struct ast_assigned_ids *assignedids, const struct ast_channel *requestor, const char *dest, int *cause);
static AST_LIST_HEAD_STATIC(sessions, skinnysession);

static int skinny_devicestate(const char *data);
static int skinny_call(struct ast_channel *ast, const char *dest, int timeout);
static int skinny_hangup(struct ast_channel *ast);
static int skinny_answer(struct ast_channel *ast);
static struct ast_frame *skinny_read(struct ast_channel *ast);
static int skinny_write(struct ast_channel *ast, struct ast_frame *frame);
static int skinny_indicate(struct ast_channel *ast, int ind, const void *data, size_t datalen);
static int skinny_fixup(struct ast_channel *oldchan, struct ast_channel *newchan);
static int skinny_senddigit_begin(struct ast_channel *ast, char digit);
static int skinny_senddigit_end(struct ast_channel *ast, char digit, unsigned int duration);
static void mwi_event_cb(void *userdata, struct stasis_subscription *sub, struct stasis_message *msg);
static int skinny_dialer_cb(const void *data);
static int skinny_reload(void);

static void skinny_set_owner(struct skinny_subchannel* sub, struct ast_channel* chan);
static void setsubstate(struct skinny_subchannel *sub, int state);
static void dumpsub(struct skinny_subchannel *sub, int forcehangup);
static void activatesub(struct skinny_subchannel *sub, int state);
static void dialandactivatesub(struct skinny_subchannel *sub, char exten[AST_MAX_EXTENSION]);
static int skinny_nokeepalive_cb(const void *data);

static void transmit_definetimedate(struct skinny_device *d);

static struct ast_channel_tech skinny_tech = {
 .type = "Skinny",
 .description = tdesc,
 .properties = AST_CHAN_TP_WANTSJITTER | AST_CHAN_TP_CREATESJITTER,
 .requester = skinny_request,
 .devicestate = skinny_devicestate,
 .call = skinny_call,
 .hangup = skinny_hangup,
 .answer = skinny_answer,
 .read = skinny_read,
 .write = skinny_write,
 .indicate = skinny_indicate,
 .fixup = skinny_fixup,
 .send_digit_begin = skinny_senddigit_begin,
 .send_digit_end = skinny_senddigit_end,
};

static int skinny_extensionstate_cb(const char *context, const char *exten, struct ast_state_cb_info *info, void *data);

static struct skinny_line *skinny_line_alloc(void)
{
 struct skinny_line *l;
 if (!(l = ast_calloc(1, sizeof(*l)))) {
 return NULL;
 }

 l->cap = ast_format_cap_alloc(AST_FORMAT_CAP_FLAG_DEFAULT);
 l->confcap = ast_format_cap_alloc(AST_FORMAT_CAP_FLAG_DEFAULT);
 if (!l->cap || !l->confcap) {
 ao2_cleanup(l->cap);
 ao2_cleanup(l->confcap);
 ast_free(l);
 return NULL;
 }
 return l;
}
static struct skinny_line *skinny_line_destroy(struct skinny_line *l)
{
 ao2_ref(l->cap, -1);
 ao2_ref(l->confcap, -1);
 l->named_callgroups = ast_unref_namedgroups(l->named_callgroups);
 l->named_pickupgroups = ast_unref_namedgroups(l->named_pickupgroups);
 ast_free(l->container);
 ast_free(l);
 return NULL;
}
static struct skinny_device *skinny_device_alloc(const char *dname)
{
 struct skinny_device *d;
 if (!(d = ast_calloc(1, sizeof(*d)))) {
 return NULL;
 }

 d->cap = ast_format_cap_alloc(AST_FORMAT_CAP_FLAG_DEFAULT);
 d->confcap = ast_format_cap_alloc(AST_FORMAT_CAP_FLAG_DEFAULT);
 d->endpoint = ast_endpoint_create("Skinny", dname);
 if (!d->cap || !d->confcap || !d->endpoint) {
 ao2_cleanup(d->cap);
 ao2_cleanup(d->confcap);
 ast_free(d);
 return NULL;
 }

 ast_copy_string(d->name, dname, sizeof(d->name));

 return d;
}
static struct skinny_device *skinny_device_destroy(struct skinny_device *d)
{
 ao2_ref(d->cap, -1);
 ao2_ref(d->confcap, -1);
 ast_endpoint_shutdown(d->endpoint);
 ast_free(d);
 return NULL;
}

static void *get_button_template(struct skinnysession *s, struct button_definition_template *btn)
{
 struct skinny_device *d = s->device;
 struct skinny_addon *a;
 int i;

 switch (d->type) {
 case SKINNY_DEVICE_30SPPLUS:
 case SKINNY_DEVICE_30VIP:
 /* 13 rows, 2 columns */
 for (i = 0; i < 4; i++)
 (btn++)->buttonDefinition = BT_CUST_LINE;
 (btn++)->buttonDefinition = BT_REDIAL;
 (btn++)->buttonDefinition = BT_VOICEMAIL;
 (btn++)->buttonDefinition = BT_CALLPARK;
 (btn++)->buttonDefinition = BT_FORWARDALL;
 (btn++)->buttonDefinition = BT_CONFERENCE;
 for (i = 0; i < 4; i++)
 (btn++)->buttonDefinition = BT_NONE;
 for (i = 0; i < 13; i++)
 (btn++)->buttonDefinition = BT_SPEEDDIAL;

 break;
 case SKINNY_DEVICE_12SPPLUS:
 case SKINNY_DEVICE_12SP:
 case SKINNY_DEVICE_12:
 /* 6 rows, 2 columns */
 for (i = 0; i < 2; i++)
 (btn++)->buttonDefinition = BT_CUST_LINE;
 for (i = 0; i < 4; i++)
 (btn++)->buttonDefinition = BT_SPEEDDIAL;
 (btn++)->buttonDefinition = BT_HOLD;
 (btn++)->buttonDefinition = BT_REDIAL;
 (btn++)->buttonDefinition = BT_TRANSFER;
 (btn++)->buttonDefinition = BT_FORWARDALL;
 (btn++)->buttonDefinition = BT_CALLPARK;
 (btn++)->buttonDefinition = BT_VOICEMAIL;
 break;
 case SKINNY_DEVICE_7910:
 (btn++)->buttonDefinition = BT_LINE;
 (btn++)->buttonDefinition = BT_HOLD;
 (btn++)->buttonDefinition = BT_TRANSFER;
 (btn++)->buttonDefinition = BT_DISPLAY;
 (btn++)->buttonDefinition = BT_VOICEMAIL;
 (btn++)->buttonDefinition = BT_CONFERENCE;
 (btn++)->buttonDefinition = BT_FORWARDALL;
 for (i = 0; i < 2; i++)
 (btn++)->buttonDefinition = BT_SPEEDDIAL;
 (btn++)->buttonDefinition = BT_REDIAL;
 break;
 case SKINNY_DEVICE_7960:
 case SKINNY_DEVICE_7961:
 case SKINNY_DEVICE_7961GE:
 case SKINNY_DEVICE_7962:
 case SKINNY_DEVICE_7965:
 for (i = 0; i < 6; i++)
 (btn++)->buttonDefinition = BT_CUST_LINESPEEDDIAL;
 break;
 case SKINNY_DEVICE_7940:
 case SKINNY_DEVICE_7941:
 case SKINNY_DEVICE_7941GE:
 case SKINNY_DEVICE_7942:
 case SKINNY_DEVICE_7945:
 for (i = 0; i < 2; i++)
 (btn++)->buttonDefinition = BT_CUST_LINESPEEDDIAL;
 break;
 case SKINNY_DEVICE_7935:
 case SKINNY_DEVICE_7936:
 for (i = 0; i < 2; i++)
 (btn++)->buttonDefinition = BT_LINE;
 break;
 case SKINNY_DEVICE_ATA186:
 (btn++)->buttonDefinition = BT_LINE;
 break;
 case SKINNY_DEVICE_7970:
 case SKINNY_DEVICE_7971:
 case SKINNY_DEVICE_7975:
 case SKINNY_DEVICE_CIPC:
 for (i = 0; i < 8; i++)
 (btn++)->buttonDefinition = BT_CUST_LINESPEEDDIAL;
 break;
 case SKINNY_DEVICE_7985:
 /* XXX I have no idea what the buttons look like on these. */
 ast_log(LOG_WARNING, "Unsupported device type '%d (7985)' found.\n", d->type);
 break;
 case SKINNY_DEVICE_7912:
 case SKINNY_DEVICE_7911:
 case SKINNY_DEVICE_7905:
 (btn++)->buttonDefinition = BT_LINE;
 (btn++)->buttonDefinition = BT_HOLD;
 break;
 case SKINNY_DEVICE_7920:
 /* XXX I don't know if this is right. */
 for (i = 0; i < 4; i++)
 (btn++)->buttonDefinition = BT_CUST_LINESPEEDDIAL;
 break;
 case SKINNY_DEVICE_7921:
 for (i = 0; i < 6; i++)
 (btn++)->buttonDefinition = BT_CUST_LINESPEEDDIAL;
 break;
 case SKINNY_DEVICE_7902:
 ast_log(LOG_WARNING, "Unsupported device type '%d (7902)' found.\n", d->type);
 break;
 case SKINNY_DEVICE_7906:
 ast_log(LOG_WARNING, "Unsupported device type '%d (7906)' found.\n", d->type);
 break;
 case SKINNY_DEVICE_7931:
 ast_log(LOG_WARNING, "Unsupported device type '%d (7931)' found.\n", d->type);
 break;
 case SKINNY_DEVICE_7937:
 ast_log(LOG_WARNING, "Unsupported device type '%d (7937)' found.\n", d->type);
 break;
 case SKINNY_DEVICE_7914:
 ast_log(LOG_WARNING, "Unsupported device type '%d (7914)' found. Expansion module registered by itself?\n", d->type);
 break;
 case SKINNY_DEVICE_SCCPGATEWAY_AN:
 case SKINNY_DEVICE_SCCPGATEWAY_BRI:
 ast_log(LOG_WARNING, "Unsupported device type '%d (SCCP gateway)' found.\n", d->type);
 break;
 default:
 ast_log(LOG_WARNING, "Unknown device type '%d' found.\n", d->type);
 break;
 }

 AST_LIST_LOCK(&d->addons);
 AST_LIST_TRAVERSE(&d->addons, a, list) {
 if (!strcasecmp(a->type, "7914")) {
 for (i = 0; i < 14; i++)
 (btn++)->buttonDefinition = BT_CUST_LINESPEEDDIAL;
 } else {
 ast_log(LOG_WARNING, "Unknown addon type '%s' found. Skipping.\n", a->type);
 }
 }
 AST_LIST_UNLOCK(&d->addons);

 return btn;
}

static struct skinny_req *req_alloc(size_t size, int response_message)
{
 struct skinny_req *req;

 if (!(req = ast_calloc(1, skinny_header_size + size + 4)))
 return NULL;

 req->len = htolel(size+4);
 req->e = htolel(response_message);

 return req;
}

static struct skinny_line *find_line_by_instance(struct skinny_device *d, int instance)
{
 struct skinny_line *l;

 /*Dialing from on hook or on a 7920 uses instance 0 in requests
 but we need to start looking at instance 1 */

 if (!instance)
 instance = 1;

 AST_LIST_TRAVERSE(&d->lines, l, list){
 if (l->instance == instance)
 break;
 }

 if (!l) {
 ast_log(LOG_WARNING, "Could not find line with instance '%d' on device '%s'\n", instance, d->name);
 }
 return l;
}

static struct skinny_line *find_line_by_name(const char *dest)
{
 struct skinny_line *l;
 struct skinny_line *tmpl = NULL;
 struct skinny_device *d;
 char line[256];
 char *at;
 char *device;
 int checkdevice = 0;

 ast_copy_string(line, dest, sizeof(line));
 at = strchr(line, '@');
 if (at)
 *at++ = '\0';
 device = at;

 if (!ast_strlen_zero(device))
 checkdevice = 1;

 AST_LIST_LOCK(&devices);
 AST_LIST_TRAVERSE(&devices, d, list){
 if (checkdevice && tmpl)
 break;
 else if (!checkdevice) {
 /* This is a match, since we're checking for line on every device. */
 } else if (!strcasecmp(d->name, device)) {
 } else
 continue;

 /* Found the device (or we don't care which device) */
 AST_LIST_TRAVERSE(&d->lines, l, list){
 /* Search for the right line */
 if (!strcasecmp(l->name, line)) {
 if (tmpl) {
 ast_log(LOG_WARNING, "Ambiguous line name: %s\n", line);
 AST_LIST_UNLOCK(&devices);
 return NULL;
 } else
 tmpl = l;
 }
 }
 }
 AST_LIST_UNLOCK(&devices);
 return tmpl;
}

static struct skinny_subline *find_subline_by_name(const char *dest)
{
 struct skinny_line *l;
 struct skinny_subline *subline;
 struct skinny_subline *tmpsubline = NULL;
 struct skinny_device *d;

 AST_LIST_LOCK(&devices);
 AST_LIST_TRAVERSE(&devices, d, list){
 AST_LIST_TRAVERSE(&d->lines, l, list){
 AST_LIST_TRAVERSE(&l->sublines, subline, list){
 if (!strcasecmp(subline->name, dest)) {
 if (tmpsubline) {
 ast_verb(2, "Ambiguous subline name: %s\n", dest);
 AST_LIST_UNLOCK(&devices);
 return NULL;
 } else
 tmpsubline = subline;
 }
 }
 }
 }
 AST_LIST_UNLOCK(&devices);
 return tmpsubline;
}

static struct skinny_subline *find_subline_by_callid(struct skinny_device *d, int callid)
{
 struct skinny_subline *subline;
 struct skinny_line *l;

 AST_LIST_TRAVERSE(&d->lines, l, list){
 AST_LIST_TRAVERSE(&l->sublines, subline, list){
 if (subline->callid == callid) {
 return subline;
 }
 }
 }
 return NULL;
}

/*!
 * implement the setvar config line
 */
static struct ast_variable *add_var(const char *buf, struct ast_variable *list)
{
 struct ast_variable *tmpvar = NULL;
 char *varname = ast_strdupa(buf), *varval = NULL;

 if ((varval = strchr(varname,'='))) {
 *varval++ = '\0';
 if ((tmpvar = ast_variable_new(varname, varval, ""))) {
 tmpvar->next = list;
 list = tmpvar;
 }
 }
 return list;
}

static void skinny_locksub(struct skinny_subchannel *sub)
{
 if (sub && sub->owner) {
 ast_channel_lock(sub->owner);
 }
}

static void skinny_unlocksub(struct skinny_subchannel *sub)
{
 if (sub && sub->owner) {
 ast_channel_unlock(sub->owner);
 }
}

static int skinny_sched_del(int sched_id, struct skinny_subchannel *sub)
{
 SKINNY_DEBUG(DEBUG_SUB, 3, "Sub %u - Deleting SCHED %d\n",
 sub->callid, sched_id);
 return ast_sched_del(sched, sched_id);
}

static int skinny_sched_add(int when, ast_sched_cb callback, struct skinny_subchannel *sub)
{
 int ret;
 ret = ast_sched_add(sched, when, callback, sub);
 SKINNY_DEBUG(DEBUG_SUB, 3, "Sub %u - Added SCHED %d\n",
 sub->callid, ret);
 return ret;
}

/* It's quicker/easier to find the subchannel when we know the instance number too */
static struct skinny_subchannel *find_subchannel_by_instance_reference(struct skinny_device *d, int instance, int reference)
{
 struct skinny_line *l = find_line_by_instance(d, instance);
 struct skinny_subchannel *sub;

 if (!l) {
 return NULL;
 }

 /* 7920 phones set call reference to 0, so use the first
 sub-channel on the list.
 This MIGHT need more love to be right */
 if (!reference)
 sub = AST_LIST_FIRST(&l->sub);
 else {
 AST_LIST_TRAVERSE(&l->sub, sub, list) {
 if (sub->callid == reference)
 break;
 }
 }
 if (!sub) {
 ast_log(LOG_WARNING, "Could not find subchannel with reference '%d' on '%s'\n", reference, d->name);
 }
 return sub;
}

/* Find the subchannel when we only have the callid - this shouldn't happen often */
static struct skinny_subchannel *find_subchannel_by_reference(struct skinny_device *d, int reference)
{
 struct skinny_line *l;
 struct skinny_subchannel *sub = NULL;

 AST_LIST_TRAVERSE(&d->lines, l, list){
 AST_LIST_TRAVERSE(&l->sub, sub, list){
 if (sub->callid == reference)
 break;
 }
 if (sub)
 break;
 }

 if (!l) {
 ast_log(LOG_WARNING, "Could not find any lines that contained a subchannel with reference '%d' on device '%s'\n", reference, d->name);
 } else {
 if (!sub) {
 ast_log(LOG_WARNING, "Could not find subchannel with reference '%d' on '%s@%s'\n", reference, l->name, d->name);
 }
 }
 return sub;
}

static struct skinny_speeddial *find_speeddial_by_instance(struct skinny_device *d, int instance, int isHint)
{
 struct skinny_speeddial *sd;

 AST_LIST_TRAVERSE(&d->speeddials, sd, list) {
 if (sd->isHint == isHint && sd->instance == instance)
 break;
 }

 if (!sd) {
 ast_log(LOG_WARNING, "Could not find speeddial with instance '%d' on device '%s'\n", instance, d->name);
 }
 return sd;
}

static struct ast_format *codec_skinny2ast(enum skinny_codecs skinnycodec)
{
 switch (skinnycodec) {
 case SKINNY_CODEC_ALAW:
 return ast_format_alaw;
 case SKINNY_CODEC_ULAW:
 return ast_format_ulaw;
 case SKINNY_CODEC_G722:
 return ast_format_g722;
 case SKINNY_CODEC_G723_1:
 return ast_format_g723;
 case SKINNY_CODEC_G729A:
 return ast_format_g729;
 case SKINNY_CODEC_G726_32:
 return ast_format_g726; /* XXX Is this right? */
 case SKINNY_CODEC_H261:
 return ast_format_h261;
 case SKINNY_CODEC_H263:
 return ast_format_h263;
 default:
 return ast_format_none;
 }
}

static int codec_ast2skinny(const struct ast_format *astcodec)
{
 if (ast_format_cmp(astcodec, ast_format_alaw) == AST_FORMAT_CMP_EQUAL) {
 return SKINNY_CODEC_ALAW;
 } else if (ast_format_cmp(astcodec, ast_format_ulaw) == AST_FORMAT_CMP_EQUAL) {
 return SKINNY_CODEC_ULAW;
 } else if (ast_format_cmp(astcodec, ast_format_g722) == AST_FORMAT_CMP_EQUAL) {
 return SKINNY_CODEC_G722;
 } else if (ast_format_cmp(astcodec, ast_format_g723) == AST_FORMAT_CMP_EQUAL) {
 return SKINNY_CODEC_G723_1;
 } else if (ast_format_cmp(astcodec, ast_format_g729) == AST_FORMAT_CMP_EQUAL) {
 return SKINNY_CODEC_G729A;
 } else if (ast_format_cmp(astcodec, ast_format_g726) == AST_FORMAT_CMP_EQUAL) {
 return SKINNY_CODEC_G726_32;
 } else if (ast_format_cmp(astcodec, ast_format_h261) == AST_FORMAT_CMP_EQUAL) {
 return SKINNY_CODEC_H261;
 } else if (ast_format_cmp(astcodec, ast_format_h263) == AST_FORMAT_CMP_EQUAL) {
 return SKINNY_CODEC_H263;
 } else {
 return 0;
 }
}

static int set_callforwards(struct skinny_line *l, const char *cfwd, int cfwdtype)
{
 if (!l)
 return 0;

 if (!ast_strlen_zero(cfwd)) {
 if (cfwdtype & SKINNY_CFWD_ALL) {
 l->cfwdtype |= SKINNY_CFWD_ALL;
 ast_copy_string(l->call_forward_all, cfwd, sizeof(l->call_forward_all));
 }
 if (cfwdtype & SKINNY_CFWD_BUSY) {
 l->cfwdtype |= SKINNY_CFWD_BUSY;
 ast_copy_string(l->call_forward_busy, cfwd, sizeof(l->call_forward_busy));
 }
 if (cfwdtype & SKINNY_CFWD_NOANSWER) {
 l->cfwdtype |= SKINNY_CFWD_NOANSWER;
 ast_copy_string(l->call_forward_noanswer, cfwd, sizeof(l->call_forward_noanswer));
 }
 } else {
 if (cfwdtype & SKINNY_CFWD_ALL) {
 l->cfwdtype &= ~SKINNY_CFWD_ALL;
 memset(l->call_forward_all, 0, sizeof(l->call_forward_all));
 }
 if (cfwdtype & SKINNY_CFWD_BUSY) {
 l->cfwdtype &= ~SKINNY_CFWD_BUSY;
 memset(l->call_forward_busy, 0, sizeof(l->call_forward_busy));
 }
 if (cfwdtype & SKINNY_CFWD_NOANSWER) {
 l->cfwdtype &= ~SKINNY_CFWD_NOANSWER;
 memset(l->call_forward_noanswer, 0, sizeof(l->call_forward_noanswer));
 }
 }
 return l->cfwdtype;
}

static void cleanup_stale_contexts(char *new, char *old)
{
 char *oldcontext, *newcontext, *stalecontext, *stringp, newlist[AST_MAX_CONTEXT];

 while ((oldcontext = strsep(&old, "&"))) {
 stalecontext = NULL;
 ast_copy_string(newlist, new, sizeof(newlist));
 stringp = newlist;
 while ((newcontext = strsep(&stringp, "&"))) {
 if (strcmp(newcontext, oldcontext) == 0) {
 /* This is not the context you're looking for */
 stalecontext = NULL;
 break;
 } else if (strcmp(newcontext, oldcontext)) {
 stalecontext = oldcontext;
 }

 }
 ast_context_destroy_by_name(stalecontext, "Skinny");
 }
}

static void register_exten(struct skinny_line *l)
{
 char multi[256];
 char *stringp, *ext, *context;

 if (ast_strlen_zero(regcontext))
 return;

 ast_copy_string(multi, S_OR(l->regexten, l->name), sizeof(multi));
 stringp = multi;
 while ((ext = strsep(&stringp, "&"))) {
 if ((context = strchr(ext, '@'))) {
 *context++ = '\0'; /* split ext@context */
 if (!ast_context_find(context)) {
 ast_log(LOG_WARNING, "Context %s must exist in regcontext= in skinny.conf!\n", context);
 continue;
 }
 } else {
 context = regcontext;
 }
 ast_add_extension(context, 1, ext, 1, NULL, NULL, "Noop",
 ast_strdup(l->name), ast_free_ptr, "Skinny");
 }
}

static void unregister_exten(struct skinny_line *l)
{
 char multi[256];
 char *stringp, *ext, *context;

 if (ast_strlen_zero(regcontext))
 return;

 ast_copy_string(multi, S_OR(l->regexten, l->name), sizeof(multi));
 stringp = multi;
 while ((ext = strsep(&stringp, "&"))) {
 if ((context = strchr(ext, '@'))) {
 *context++ = '\0'; /* split ext@context */
 if (!ast_context_find(context)) {
 ast_log(LOG_WARNING, "Context %s must exist in regcontext= in skinny.conf!\n", context);
 continue;
 }
 } else {
 context = regcontext;
 }
 ast_context_remove_extension(context, ext, 1, NULL);
 }
}

static int skinny_register(struct skinny_req *req, struct skinnysession *s)
{
 struct skinny_device *d;
 struct skinny_line *l;
 struct skinny_subline *subline;
 struct skinny_speeddial *sd;
 struct sockaddr_in sin;
 socklen_t slen;
 int instance;
 int res = -1;

 if (-1 < s->auth_timeout_sched) {
 not_used = ast_sched_del(sched, s->auth_timeout_sched);
 s->auth_timeout_sched = -1;
 }

 AST_LIST_LOCK(&devices);
 AST_LIST_TRAVERSE(&devices, d, list){
 struct ast_sockaddr addr;
 ast_sockaddr_from_sin(&addr, &s->sin);
 if (!strcasecmp(req->data.reg.name, d->id)
 && ast_apply_ha(d->ha, &addr)) {
 RAII_VAR(struct ast_json *, blob, NULL, ast_json_unref);

 if (d->session) {
 ast_log(LOG_WARNING, "Device already registered.\n");
 transmit_definetimedate(d);
 res = 0;
 break;
 }
 s->device = d;
 d->type = letohl(req->data.reg.type);
 d->protocolversion = letohl(req->data.reg.protocolVersion);
 if (ast_strlen_zero(d->version_id)) {
 ast_copy_string(d->version_id, version_id, sizeof(d->version_id));
 }
 d->session = s;

 slen = sizeof(sin);
 if (getsockname(s->fd, (struct sockaddr *)&sin, &slen)) {
 ast_log(LOG_WARNING, "Cannot get socket name\n");
 sin.sin_addr = __ourip;
 }
 d->ourip = sin.sin_addr;

 AST_LIST_TRAVERSE(&d->speeddials, sd, list) {
 sd->stateid = ast_extension_state_add(sd->context, sd->exten, skinny_extensionstate_cb, sd->container);
 }
 instance = 0;
 AST_LIST_TRAVERSE(&d->lines, l, list) {
 instance++;
 }
 AST_LIST_TRAVERSE(&d->lines, l, list) {
 ast_format_cap_get_compatible(l->confcap, d->cap, l->cap);
 /* l->capability = d->capability; */
 l->instance = instance;
 l->newmsgs = ast_app_has_voicemail(l->mailbox, NULL);
 set_callforwards(l, NULL, SKINNY_CFWD_ALL|SKINNY_CFWD_BUSY|SKINNY_CFWD_NOANSWER);
 register_exten(l);
 /* initialize MWI on line and device */
 mwi_event_cb(l, NULL, NULL);
 AST_LIST_TRAVERSE(&l->sublines, subline, list) {
 ast_extension_state_add(subline->context, subline->exten, skinny_extensionstate_cb, subline->container);
 }
 ast_devstate_changed(AST_DEVICE_NOT_INUSE, AST_DEVSTATE_CACHABLE, "Skinny/%s", l->name);
 --instance;
 }
 ast_endpoint_set_state(d->endpoint, AST_ENDPOINT_ONLINE);
 blob = ast_json_pack("{s: s}", "peer_status", "Registered");
 ast_endpoint_blob_publish(d->endpoint, ast_endpoint_state_type(), blob);
 res = 1;
 break;
 }
 }
 AST_LIST_UNLOCK(&devices);
 return res;
}

static void end_session(struct skinnysession *s)
{
 pthread_cancel(s->t);
}

#ifdef AST_DEVMODE
static char *callstate2str(int ind)
{
 char *tmp;

 switch (ind) {
 case SKINNY_OFFHOOK:
 return "SKINNY_OFFHOOK";
 case SKINNY_ONHOOK:
 return "SKINNY_ONHOOK";
 case SKINNY_RINGOUT:
 return "SKINNY_RINGOUT";
 case SKINNY_RINGIN:
 return "SKINNY_RINGIN";
 case SKINNY_CONNECTED:
 return "SKINNY_CONNECTED";
 case SKINNY_BUSY:
 return "SKINNY_BUSY";
 case SKINNY_CONGESTION:
 return "SKINNY_CONGESTION";
 case SKINNY_PROGRESS:
 return "SKINNY_PROGRESS";
 case SKINNY_HOLD:
 return "SKINNY_HOLD";
 case SKINNY_CALLWAIT:
 return "SKINNY_CALLWAIT";
 default:
 if (!(tmp = ast_threadstorage_get(&callstate2str_threadbuf, CALLSTATE2STR_BUFSIZE)))
 return "Unknown";
 snprintf(tmp, CALLSTATE2STR_BUFSIZE, "UNKNOWN-%d", ind);
 return tmp;
 }
}

#endif

static int transmit_response_bysession(struct skinnysession *s, struct skinny_req *req)
{
 int res = 0;
 unsigned long len;

 if (!s) {
 ast_log(LOG_WARNING, "Asked to transmit to a non-existent session!\n");
 return -1;
 }

 ast_mutex_lock(&s->lock);

 /* Don't optimize out assigning letohl() to len. It is necessary to guarantee that the comparison will always catch invalid values.
 * letohl() may or may not return a signed value depending upon which definition is used. */
 len = letohl(req->len);
 if (SKINNY_MAX_PACKET < len) {
 ast_log(LOG_WARNING, "transmit_response: the length of the request (%u) is out of bounds (%d)\n", letohl(req->len), SKINNY_MAX_PACKET);
 ast_mutex_unlock(&s->lock);
 return -1;
 }

 memset(s->outbuf, 0, sizeof(s->outbuf));
 memcpy(s->outbuf, req, skinny_header_size);
 memcpy(s->outbuf+skinny_header_size, &req->data, letohl(req->len));

 res = write(s->fd, s->outbuf, letohl(req->len)+8);

 if (res != letohl(req->len)+8) {
 ast_log(LOG_WARNING, "Transmit: write only sent %d out of %u bytes: %s\n", res, letohl(req->len)+8, strerror(errno));
 if (res == -1) {
 ast_log(LOG_WARNING, "Transmit: Skinny Client was lost, unregistering\n");
 end_session(s);
 }

 }

 ast_free(req);
 ast_mutex_unlock(&s->lock);
 return 1;
}

static void transmit_response(struct skinny_device *d, struct skinny_req *req)
{
 transmit_response_bysession(d->session, req);
}

static void transmit_registerrej(struct skinnysession *s)
{
 struct skinny_req *req;
 char name[16];

 if (!(req = req_alloc(sizeof(struct register_rej_message), REGISTER_REJ_MESSAGE)))
 return;

 memcpy(&name, req->data.reg.name, sizeof(name));
 snprintf(req->data.regrej.errMsg, sizeof(req->data.regrej.errMsg), "No Authority: %s", name);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting REGISTER_REJ_MESSAGE to UNKNOWN_DEVICE\n");
 transmit_response_bysession(s, req);
}

static void transmit_speaker_mode(struct skinny_device *d, int mode)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct set_speaker_message), SET_SPEAKER_MESSAGE)))
 return;

 req->data.setspeaker.mode = htolel(mode);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting SET_SPEAKER_MESSAGE to %s, mode %d\n", d->name, mode);
 transmit_response(d, req);
}

static void transmit_microphone_mode(struct skinny_device *d, int mode)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct set_microphone_message), SET_MICROPHONE_MESSAGE)))
 return;

 req->data.setmicrophone.mode = htolel(mode);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting SET_MICROPHONE_MESSAGE to %s, mode %d\n", d->name, mode);
 transmit_response(d, req);
}

//static void transmit_callinfo(struct skinny_subchannel *sub)
static void transmit_callinfo(struct skinny_device *d, int instance, int callid,
 char *fromname, char *fromnum, char *toname, char *tonum, int calldirection, char *origtonum, char *origtoname)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct call_info_message), CALL_INFO_MESSAGE)))
 return;

 ast_copy_string(req->data.callinfo.callingPartyName, fromname, sizeof(req->data.callinfo.callingPartyName));
 ast_copy_string(req->data.callinfo.callingParty, fromnum, sizeof(req->data.callinfo.callingParty));
 ast_copy_string(req->data.callinfo.calledPartyName, toname, sizeof(req->data.callinfo.calledPartyName));
 ast_copy_string(req->data.callinfo.calledParty, tonum, sizeof(req->data.callinfo.calledParty));
 if (origtoname) {
 ast_copy_string(req->data.callinfo.originalCalledPartyName, origtoname, sizeof(req->data.callinfo.originalCalledPartyName));
 }
 if (origtonum) {
 ast_copy_string(req->data.callinfo.originalCalledParty, origtonum, sizeof(req->data.callinfo.originalCalledParty));
 }

 req->data.callinfo.instance = htolel(instance);
 req->data.callinfo.reference = htolel(callid);
 req->data.callinfo.type = htolel(calldirection);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting CALL_INFO_MESSAGE to %s, to %s(%s) from %s(%s), origto %s(%s) (dir=%d) on %s(%d)\n",
 d->name, toname, tonum, fromname, fromnum, origtoname, origtonum, calldirection, d->name, instance);
 transmit_response(d, req);
}

static void transmit_callinfo_variable(struct skinny_device *d, int instance, int callreference,
 char *fromname, char *fromnum, char *toname, char *tonum, int calldirection, char *origtonum, char *origtoname)
{
 struct skinny_req *req;
 char *strptr;
 char *thestrings[13];
 int i;
 int callinfostrleft = MAXCALLINFOSTR;

 if (!(req = req_alloc(sizeof(struct call_info_message_variable), CALL_INFO_MESSAGE_VARIABLE)))
 return;

 req->data.callinfomessagevariable.instance = htolel(instance);
 req->data.callinfomessagevariable.callreference = htolel(callreference);
 req->data.callinfomessagevariable.calldirection = htolel(calldirection);

 req->data.callinfomessagevariable.unknown1 = htolel(0x00);
 req->data.callinfomessagevariable.unknown2 = htolel(0x00);
 req->data.callinfomessagevariable.unknown3 = htolel(0x00);
 req->data.callinfomessagevariable.unknown4 = htolel(0x00);
 req->data.callinfomessagevariable.unknown5 = htolel(0x00);

 thestrings[0] = fromnum;
 thestrings[1] = ""; /* Appears to be origfrom */
 if (calldirection == SKINNY_OUTGOING) {
 thestrings[2] = tonum;
 thestrings[3] = origtonum;
 } else {
 thestrings[2] = "";
 thestrings[3] = "";
 }
 thestrings[4] = "";
 thestrings[5] = "";
 thestrings[6] = "";
 thestrings[7] = "";

 thestrings[8] = "";
 thestrings[9] = fromname;
 thestrings[10] = toname;
 thestrings[11] = origtoname;
 thestrings[12] = "";

 strptr = req->data.callinfomessagevariable.calldetails;

 for(i = 0; i < 13; i++) {
 if (thestrings[i]) {
 ast_copy_string(strptr, thestrings[i], callinfostrleft);
 strptr += strlen(thestrings[i]) + 1;
 callinfostrleft -= strlen(thestrings[i]) + 1;
 } else {
 ast_copy_string(strptr, "", callinfostrleft);
 strptr++;
 callinfostrleft--;
 }
 }

 req->len = req->len - (callinfostrleft & ~0x3);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting CALL_INFO_MESSAGE_VARIABLE to %s, to %s(%s) from %s(%s), origto %s(%s) (dir=%d) on %s(%d)\n",
 d->name, toname, tonum, fromname, fromnum, origtoname, origtonum, calldirection, d->name, instance);
 transmit_response(d, req);
}

static void send_callinfo(struct skinny_subchannel *sub)
{
 struct ast_channel *ast;
 struct skinny_device *d;
 struct skinny_line *l;
 struct ast_party_id connected_id;
 char *fromname;
 char *fromnum;
 char *toname;
 char *tonum;

 if (!sub || !sub->owner || !sub->line || !sub->line->device) {
 return;
 }

 ast = sub->owner;
 l = sub->line;
 d = l->device;
 connected_id = ast_channel_connected_effective_id(ast);

 if (sub->calldirection == SKINNY_INCOMING) {
 if ((ast_party_id_presentation(&connected_id) & AST_PRES_RESTRICTION) == AST_PRES_ALLOWED) {
 fromname = S_COR(connected_id.name.valid, connected_id.name.str, "");
 fromnum = S_COR(connected_id.number.valid, connected_id.number.str, "");
 } else {
 fromname = "";
 fromnum = "";
 }
 toname = S_COR(ast_channel_caller(ast)->id.name.valid, ast_channel_caller(ast)->id.name.str, "");
 tonum = S_COR(ast_channel_caller(ast)->id.number.valid, ast_channel_caller(ast)->id.number.str, "");
 } else if (sub->calldirection == SKINNY_OUTGOING) {
 fromname = S_COR(ast_channel_caller(ast)->id.name.valid, ast_channel_caller(ast)->id.name.str, "");
 fromnum = S_COR(ast_channel_caller(ast)->id.number.valid, ast_channel_caller(ast)->id.number.str, "");
 toname = S_COR(ast_channel_connected(ast)->id.name.valid, ast_channel_connected(ast)->id.name.str, "");
 tonum = S_COR(ast_channel_connected(ast)->id.number.valid, ast_channel_connected(ast)->id.number.str, l->lastnumberdialed);
 } else {
 ast_verb(1, "Error sending Callinfo to %s(%d) - No call direction in sub\n", d->name, l->instance);
 return;
 }

 if (d->protocolversion < 17) {
 transmit_callinfo(d, l->instance, sub->callid, fromname, fromnum, toname, tonum, sub->calldirection, sub->origtonum, sub->origtoname);
 } else {
 transmit_callinfo_variable(d, l->instance, sub->callid, fromname, fromnum, toname, tonum, sub->calldirection, sub->origtonum, sub->origtoname);
 }
}

static void push_callinfo(struct skinny_subline *subline, struct skinny_subchannel *sub)
{
 struct ast_channel *ast;
 struct skinny_device *d;
 struct skinny_line *l;
 struct ast_party_id connected_id;
 char *fromname;
 char *fromnum;
 char *toname;
 char *tonum;

 if (!sub || !sub->owner || !sub->line || !sub->line->device) {
 return;
 }

 ast = sub->owner;
 l = sub->line;
 d = l->device;
 connected_id = ast_channel_connected_effective_id(ast);

 if (sub->calldirection == SKINNY_INCOMING) {
 if((ast_party_id_presentation(&connected_id) & AST_PRES_RESTRICTION) == AST_PRES_ALLOWED) {
 fromname = S_COR(connected_id.name.valid, connected_id.name.str, "");
 fromnum = S_COR(connected_id.number.valid, connected_id.number.str, "");
 } else {
 fromname = "";
 fromnum = "";
 }
 toname = S_COR(ast_channel_caller(ast)->id.name.valid, ast_channel_caller(ast)->id.name.str, "");
 tonum = S_COR(ast_channel_caller(ast)->id.number.valid, ast_channel_caller(ast)->id.number.str, "");
 } else if (sub->calldirection == SKINNY_OUTGOING) {
 fromname = S_COR(ast_channel_caller(ast)->id.name.valid, ast_channel_caller(ast)->id.name.str, "");
 fromnum = S_COR(ast_channel_caller(ast)->id.number.valid, ast_channel_caller(ast)->id.number.str, "");
 toname = S_COR(ast_channel_connected(ast)->id.name.valid, ast_channel_connected(ast)->id.name.str, "");
 tonum = S_COR(ast_channel_connected(ast)->id.number.valid, ast_channel_connected(ast)->id.number.str, l->lastnumberdialed);
 } else {
 ast_verb(1, "Error sending Callinfo to %s(%d) - No call direction in sub\n", d->name, l->instance);
 return;
 }

 if (d->protocolversion < 17) {
 transmit_callinfo(subline->line->device, subline->line->instance, subline->callid, fromname, fromnum, toname, tonum, sub->calldirection, sub->origtonum, sub->origtoname);
 } else {
 transmit_callinfo_variable(subline->line->device, subline->line->instance, subline->callid, fromname, fromnum, toname, tonum, sub->calldirection, sub->origtonum, sub->origtoname);
 }
}

static void transmit_connect(struct skinny_device *d, struct skinny_subchannel *sub)
{
 struct skinny_req *req;
 struct skinny_line *l = sub->line;
 struct ast_format *tmpfmt;
 unsigned int framing;

 if (!(req = req_alloc(sizeof(struct open_receive_channel_message), OPEN_RECEIVE_CHANNEL_MESSAGE)))
 return;

 tmpfmt = ast_format_cap_get_format(l->cap, 0);
 framing = ast_format_cap_get_format_framing(l->cap, tmpfmt);

 req->data.openreceivechannel.conferenceId = htolel(sub->callid);
 req->data.openreceivechannel.partyId = htolel(sub->callid);
 req->data.openreceivechannel.packets = htolel(framing);
 req->data.openreceivechannel.capability = htolel(codec_ast2skinny(tmpfmt));
 req->data.openreceivechannel.echo = htolel(0);
 req->data.openreceivechannel.bitrate = htolel(0);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting OPEN_RECEIVE_CHANNEL_MESSAGE to %s, confid %u, partyid %u, ms %u, fmt %d, echo %d, brate %d\n",
 d->name, sub->callid, sub->callid, framing, codec_ast2skinny(tmpfmt), 0, 0);

 ao2_ref(tmpfmt, -1);

 transmit_response(d, req);
}

static void transmit_start_tone(struct skinny_device *d, int tone, int instance, int reference)
{
 struct skinny_req *req;
 if (!(req = req_alloc(sizeof(struct start_tone_message), START_TONE_MESSAGE)))
 return;
 req->data.starttone.tone = htolel(tone);
 req->data.starttone.instance = htolel(instance);
 req->data.starttone.reference = htolel(reference);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting START_TONE_MESSAGE to %s, tone %d, inst %d, ref %d\n",
 d->name, tone, instance, reference);
 transmit_response(d, req);
}

static void transmit_stop_tone(struct skinny_device *d, int instance, int reference)
{
 struct skinny_req *req;
 if (!(req = req_alloc(sizeof(struct stop_tone_message), STOP_TONE_MESSAGE)))
 return;
 req->data.stoptone.instance = htolel(instance);
 req->data.stoptone.reference = htolel(reference);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting STOP_TONE_MESSAGE to %s, inst %d, ref %d\n",
 d->name, instance, reference);
 transmit_response(d, req);
}

static int keyset_translatebitmask(int keyset, int intmask)
{
 int extmask = 0;
 int x, y;
 const struct soft_key_definitions *softkeymode = soft_key_default_definitions;

 for(x = 0; x < ARRAY_LEN(soft_key_default_definitions); x++) {
 if (softkeymode[x].mode == keyset) {
 const uint8_t *defaults = softkeymode[x].defaults;

 for (y = 0; y < softkeymode[x].count; y++) {
 if (intmask & (1 << (defaults[y]))) {
 extmask |= (1 << ((y)));
 }
 }
 break;
 }
 }

 return extmask;
}

static void transmit_selectsoftkeys(struct skinny_device *d, int instance, int callid, int softkey, int mask)
{
 struct skinny_req *req;
 int newmask;

 if (!(req = req_alloc(sizeof(struct select_soft_keys_message), SELECT_SOFT_KEYS_MESSAGE)))
 return;

 newmask = keyset_translatebitmask(softkey, mask);
 req->data.selectsoftkey.instance = htolel(instance);
 req->data.selectsoftkey.reference = htolel(callid);
 req->data.selectsoftkey.softKeySetIndex = htolel(softkey);
 req->data.selectsoftkey.validKeyMask = htolel(newmask);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting SELECT_SOFT_KEYS_MESSAGE to %s, inst %d, callid %d, softkey %d, mask 0x%08x\n",
 d->name, instance, callid, softkey, (unsigned)newmask);
 transmit_response(d, req);
}

static void transmit_lamp_indication(struct skinny_device *d, int stimulus, int instance, int indication)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct set_lamp_message), SET_LAMP_MESSAGE)))
 return;

 req->data.setlamp.stimulus = htolel(stimulus);
 req->data.setlamp.stimulusInstance = htolel(instance);
 req->data.setlamp.deviceStimulus = htolel(indication);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting SET_LAMP_MESSAGE to %s, stim %d, inst %d, ind %d\n",
 d->name, stimulus, instance, indication);
 transmit_response(d, req);
}

static void transmit_ringer_mode(struct skinny_device *d, int mode)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct set_ringer_message), SET_RINGER_MESSAGE)))
 return;

 req->data.setringer.ringerMode = htolel(mode);
 /* XXX okay, I don't quite know what this is, but here's what happens (on a 7960).
 Note: The phone will always show as ringing on the display.

 1: phone will audibly ring over and over
 2: phone will audibly ring only once
 any other value, will NOT cause the phone to audibly ring
 */
 req->data.setringer.unknown1 = htolel(1);
 /* XXX the value here doesn't seem to change anything. Must be higher than 0.
 Perhaps a packet capture can shed some light on this. */
 req->data.setringer.unknown2 = htolel(1);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting SET_RINGER_MESSAGE to %s, mode %d, unk1 1, unk2 1\n",
 d->name, mode);
 transmit_response(d, req);
}

static void transmit_clear_display_message(struct skinny_device *d, int instance, int reference)
{
 struct skinny_req *req;
 if (!(req = req_alloc(sizeof(struct clear_display_message), CLEAR_DISPLAY_MESSAGE)))
 return;

 //what do we want hear CLEAR_DISPLAY_MESSAGE or CLEAR_PROMPT_STATUS???
 //if we are clearing the display, it appears there is no instance and refernece info (size 0)
 //req->data.clearpromptstatus.lineInstance = instance;
 //req->data.clearpromptstatus.callReference = reference;

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting CLEAR_DISPLAY_MESSAGE to %s\n", d->name);
 transmit_response(d, req);
}

/* This function is not currently used, but will be (wedhorn)*/
/* static void transmit_display_message(struct skinny_device *d, const char *text, int instance, int reference)
{
 struct skinny_req *req;

 if (text == 0) {
 ast_verb(1, "Bug, Asked to display empty message\n");
 return;
 }

 if (!(req = req_alloc(sizeof(struct displaytext_message), DISPLAYTEXT_MESSAGE)))
 return;

 ast_copy_string(req->data.displaytext.text, text, sizeof(req->data.displaytext.text));
 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting DISPLAYTEXT_MESSAGE to %s, text %s\n", d->name, text);
 transmit_response(d, req);
} */

static void transmit_displaynotify(struct skinny_device *d, const char *text, int t)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct display_notify_message), DISPLAY_NOTIFY_MESSAGE)))
 return;

 ast_copy_string(req->data.displaynotify.displayMessage, text, sizeof(req->data.displaynotify.displayMessage));
 req->data.displaynotify.displayTimeout = htolel(t);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting DISPLAY_NOTIFY_MESSAGE to %s, text %s\n", d->name, text);
 transmit_response(d, req);
}

static void transmit_clearprinotify(struct skinny_device *d, int priority)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct clear_prinotify_message), CLEAR_PRINOTIFY_MESSAGE)))
 return;

 req->data.clearprinotify.priority = htolel(priority);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting CLEAR_PRINOTIFY_MESSAGE to %s, priority %d\n", d->name, priority);
 transmit_response(d, req);
}

static void _transmit_displayprinotify(struct skinny_device *d, const char *text, const char *extratext, int timeout, int priority)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct display_prinotify_message), DISPLAY_PRINOTIFY_MESSAGE)))
 return;

 req->data.displayprinotify.timeout = htolel(timeout);
 req->data.displayprinotify.priority = htolel(priority);

 if ((char)*text == '\200') {
 int octalstrlen = strlen(text);
 ast_copy_string(req->data.displayprinotify.text, text, sizeof(req->data.displayprinotify.text));
 ast_copy_string(req->data.displayprinotify.text+octalstrlen, extratext, sizeof(req->data.displayprinotify.text)-octalstrlen);
 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting DISPLAY_PRINOTIFY_MESSAGE to %s, '\\%03o\\%03o', '%s', timeout=%d, priority=%d\n",
 d->name, (unsigned)*text, (unsigned)*(text+1), extratext, timeout, priority);
 } else {
 ast_copy_string(req->data.displayprinotify.text, text, sizeof(req->data.displayprinotify.text));
 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting DISPLAY_PRINOTIFY_MESSAGE to %s, '%s', timeout=%d, priority=%d\n",
 d->name, text, timeout, priority);
 }

 transmit_response(d, req);
}

static void _transmit_displayprinotifyvar(struct skinny_device *d, const char *text, const char *extratext, int timeout, int priority)
{
 struct skinny_req *req;
 int packetlen;

 if (!(req = req_alloc(sizeof(struct display_prinotify_message_variable), DISPLAY_PRINOTIFY_MESSAGE_VARIABLE)))
 return;

 req->data.displayprinotifyvar.timeout = htolel(timeout);
 req->data.displayprinotifyvar.priority = htolel(priority);

 if ((char)*text == '\200') {
 int octalstrlen = strlen(text);
 ast_copy_string(req->data.displayprinotifyvar.text, text, sizeof(req->data.displayprinotifyvar.text));
 ast_copy_string(req->data.displayprinotifyvar.text+octalstrlen, extratext, sizeof(req->data.displayprinotifyvar.text)-octalstrlen);
 packetlen = req->len - MAXDISPLAYNOTIFYSTR + strlen(text) + strlen(extratext);
 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting DISPLAY_PRINOTIFY_MESSAGE_VARIABLE to %s, '\\%03o\\%03o', '%s', timeout=%d, priority=%d\n",
 d->name, (unsigned)*text, (unsigned)*(text+1), extratext, timeout, priority);
 } else {
 ast_copy_string(req->data.displayprinotifyvar.text, text, sizeof(req->data.displayprinotifyvar.text));
 packetlen = req->len - MAXDISPLAYNOTIFYSTR + strlen(text);
 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting DISPLAY_PRINOTIFY_MESSAGE_VARIABLE to %s, '%s', timeout=%d, priority=%d\n",
 d->name, text, timeout, priority);
 }

 req->len = (packetlen & ~0x3) + 4;

 transmit_response(d, req);
}

static void send_displayprinotify(struct skinny_device *d, const char *text, const char *extratext, int timeout, int priority)
{
 if (d->protocolversion < 17) {
 _transmit_displayprinotify(d, text, extratext, timeout, priority);
 } else {
 _transmit_displayprinotifyvar(d, text, extratext, timeout, priority);
 }
}

static void transmit_displaypromptstatus(struct skinny_device *d, const char *text, const char *extratext, int t, int instance, int callid)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct display_prompt_status_message), DISPLAY_PROMPT_STATUS_MESSAGE)))
 return;

 req->data.displaypromptstatus.messageTimeout = htolel(t);
 req->data.displaypromptstatus.lineInstance = htolel(instance);
 req->data.displaypromptstatus.callReference = htolel(callid);

 if ((char)*text == '\200') {
 int octalstrlen = strlen(text);
 ast_copy_string(req->data.displaypromptstatus.promptMessage, text, sizeof(req->data.displaypromptstatusvar.promptMessage));
 ast_copy_string(req->data.displaypromptstatus.promptMessage+octalstrlen, extratext, sizeof(req->data.displaypromptstatus.promptMessage)-octalstrlen);
 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting DISPLAY_PROMPT_STATUS_MESSAGE to %s, '\\%03o\\%03o', '%s'\n",
 d->name, (unsigned)*text, (unsigned)*(text+1), extratext);
 } else {
 ast_copy_string(req->data.displaypromptstatus.promptMessage, text, sizeof(req->data.displaypromptstatus.promptMessage));
 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting DISPLAY_PROMPT_STATUS_MESSAGE to %s, '%s'\n",
 d->name, text);
 }
 transmit_response(d, req);
}

static void transmit_displaypromptstatusvar(struct skinny_device *d, const char *text, const char *extratext, int t, int instance, int callid)
{
 struct skinny_req *req;
 int packetlen;

 if (!(req = req_alloc(sizeof(struct display_prompt_status_message_variable), DISPLAY_PROMPT_STATUS_MESSAGE_VARIABLE)))
 return;

 req->data.displaypromptstatusvar.lineInstance = htolel(instance);
 req->data.displaypromptstatusvar.callReference = htolel(callid);

 if ((char)*text == '\200') {
 int octalstrlen = strlen(text);
 ast_copy_string(req->data.displaypromptstatusvar.promptMessage, text, sizeof(req->data.displaypromptstatusvar.promptMessage));
 ast_copy_string(req->data.displaypromptstatusvar.promptMessage+octalstrlen, extratext, sizeof(req->data.displaypromptstatusvar.promptMessage)-octalstrlen);
 packetlen = req->len - MAXCALLINFOSTR + strlen(text) + strlen(extratext);
 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting DISPLAY_PROMPT_STATUS_MESSAGE_VARIABLE to %s, '\\%03o\\%03o', '%s'\n",
 d->name, (unsigned)*text, (unsigned)*(text+1), extratext);
 } else {
 ast_copy_string(req->data.displaypromptstatusvar.promptMessage, text, sizeof(req->data.displaypromptstatus.promptMessage));
 packetlen = req->len - MAXCALLINFOSTR + strlen(text);
 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting DISPLAY_PROMPT_STATUS_MESSAGE_VARIABLE to %s, '%s'\n",
 d->name, text);
 }
 req->len = (packetlen & ~0x3) + 4;

 transmit_response(d, req);
}

static void send_displaypromptstatus(struct skinny_device *d, const char *text, const char *extratext, int t, int instance, int callid)
{
 if (d->protocolversion < 17) {
 transmit_displaypromptstatus(d, text, extratext, t, instance, callid);
 } else {
 transmit_displaypromptstatusvar(d, text, extratext, t, instance, callid);
 }
}

static void transmit_clearpromptmessage(struct skinny_device *d, int instance, int callid)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct clear_prompt_message), CLEAR_PROMPT_MESSAGE)))
 return;

 req->data.clearpromptstatus.lineInstance = htolel(instance);
 req->data.clearpromptstatus.callReference = htolel(callid);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting CLEAR_PROMPT_MESSAGE to %s, inst %d, callid %d\n",
 d->name, instance, callid);
 transmit_response(d, req);
}

static void transmit_dialednumber(struct skinny_device *d, const char *text, int instance, int callid)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct dialed_number_message), DIALED_NUMBER_MESSAGE)))
 return;

 ast_copy_string(req->data.dialednumber.dialedNumber, text, sizeof(req->data.dialednumber.dialedNumber));
 req->data.dialednumber.lineInstance = htolel(instance);
 req->data.dialednumber.callReference = htolel(callid);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting DIALED_NUMBER_MESSAGE to %s, num %s, inst %d, callid %d\n",
 d->name, text, instance, callid);
 transmit_response(d, req);
}

static void transmit_closereceivechannel(struct skinny_device *d, struct skinny_subchannel *sub)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct close_receive_channel_message), CLOSE_RECEIVE_CHANNEL_MESSAGE)))
 return;

 req->data.closereceivechannel.conferenceId = htolel(0);
 req->data.closereceivechannel.partyId = htolel(sub->callid);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting CLOSE_RECEIVE_CHANNEL_MESSAGE to %s, confid %d, callid %u\n",
 d->name, 0, sub->callid);
 transmit_response(d, req);
}

static void transmit_stopmediatransmission(struct skinny_device *d, struct skinny_subchannel *sub)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct stop_media_transmission_message), STOP_MEDIA_TRANSMISSION_MESSAGE)))
 return;

 req->data.stopmedia.conferenceId = htolel(0);
 req->data.stopmedia.passThruPartyId = htolel(sub->callid);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting STOP_MEDIA_TRANSMISSION_MESSAGE to %s, confid %d, passthrupartyid %u\n",
 d->name, 0, sub->callid);
 transmit_response(d, req);
}

static void transmit_startmediatransmission(struct skinny_device *d, struct skinny_subchannel *sub, struct sockaddr_in dest,
 struct ast_format *format, unsigned int framing)
{
 struct skinny_req *req;

 if (d->protocolversion < 17) {
 if (!(req = req_alloc(sizeof(struct start_media_transmission_message_ip4), START_MEDIA_TRANSMISSION_MESSAGE)))
 return;
 req->data.startmedia_ip4.conferenceId = htolel(sub->callid);
 req->data.startmedia_ip4.passThruPartyId = htolel(sub->callid);
 req->data.startmedia_ip4.remoteIp = dest.sin_addr.s_addr;
 req->data.startmedia_ip4.remotePort = htolel(ntohs(dest.sin_port));
 req->data.startmedia_ip4.packetSize = htolel(framing);
 req->data.startmedia_ip4.payloadType = htolel(codec_ast2skinny(format));
 req->data.startmedia_ip4.qualifier.precedence = htolel(127);
 req->data.startmedia_ip4.qualifier.vad = htolel(0);
 req->data.startmedia_ip4.qualifier.packets = htolel(0);
 req->data.startmedia_ip4.qualifier.bitRate = htolel(0);
 } else {
 if (!(req = req_alloc(sizeof(struct start_media_transmission_message_ip6), START_MEDIA_TRANSMISSION_MESSAGE)))
 return;
 req->data.startmedia_ip6.conferenceId = htolel(sub->callid);
 req->data.startmedia_ip6.passThruPartyId = htolel(sub->callid);
 memcpy(req->data.startmedia_ip6.remoteIp, &dest.sin_addr.s_addr, sizeof(dest.sin_addr.s_addr));
 req->data.startmedia_ip6.remotePort = htolel(ntohs(dest.sin_port));
 req->data.startmedia_ip6.packetSize = htolel(framing);
 req->data.startmedia_ip6.payloadType = htolel(codec_ast2skinny(format));
 req->data.startmedia_ip6.qualifier.precedence = htolel(127);
 req->data.startmedia_ip6.qualifier.vad = htolel(0);
 req->data.startmedia_ip6.qualifier.packets = htolel(0);
 req->data.startmedia_ip6.qualifier.bitRate = htolel(0);
 }

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting START_MEDIA_TRANSMISSION_MESSAGE to %s, callid %u, passthrupartyid %u, ip %s:%d, ms %u, fmt %d, prec 127\n",
 d->name, sub->callid, sub->callid, ast_inet_ntoa(dest.sin_addr), dest.sin_port, framing, codec_ast2skinny(format));
 transmit_response(d, req);
}

static void transmit_activatecallplane(struct skinny_device *d, struct skinny_line *l)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct activate_call_plane_message), ACTIVATE_CALL_PLANE_MESSAGE)))
 return;

 req->data.activatecallplane.lineInstance = htolel(l->instance);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting ACTIVATE_CALL_PLANE_MESSAGE to %s, inst %d\n",
 d->name, l->instance);
 transmit_response(d, req);
}

static void transmit_callstate(struct skinny_device *d, int buttonInstance, unsigned callid, int state)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct call_state_message), CALL_STATE_MESSAGE)))
 return;

 req->data.callstate.callState = htolel(state);
 req->data.callstate.lineInstance = htolel(buttonInstance);
 req->data.callstate.callReference = htolel(callid);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting CALL_STATE_MESSAGE to %s, state %s, inst %d, callid %u\n",
 d->name, callstate2str(state), buttonInstance, callid);
 transmit_response(d, req);
}

static void transmit_cfwdstate(struct skinny_device *d, struct skinny_line *l)
{
 struct skinny_req *req;
 int anyon = 0;

 if (!(req = req_alloc(sizeof(struct forward_stat_message), FORWARD_STAT_MESSAGE)))
 return;

 if (l->cfwdtype & SKINNY_CFWD_ALL) {
 if (!ast_strlen_zero(l->call_forward_all)) {
 ast_copy_string(req->data.forwardstat.fwdallnum, l->call_forward_all, sizeof(req->data.forwardstat.fwdallnum));
 req->data.forwardstat.fwdall = htolel(1);
 anyon++;
 } else {
 req->data.forwardstat.fwdall = htolel(0);
 }
 }
 if (l->cfwdtype & SKINNY_CFWD_BUSY) {
 if (!ast_strlen_zero(l->call_forward_busy)) {
 ast_copy_string(req->data.forwardstat.fwdbusynum, l->call_forward_busy, sizeof(req->data.forwardstat.fwdbusynum));
 req->data.forwardstat.fwdbusy = htolel(1);
 anyon++;
 } else {
 req->data.forwardstat.fwdbusy = htolel(0);
 }
 }
 if (l->cfwdtype & SKINNY_CFWD_NOANSWER) {
 if (!ast_strlen_zero(l->call_forward_noanswer)) {
 ast_copy_string(req->data.forwardstat.fwdnoanswernum, l->call_forward_noanswer, sizeof(req->data.forwardstat.fwdnoanswernum));
 req->data.forwardstat.fwdnoanswer = htolel(1);
 anyon++;
 } else {
 req->data.forwardstat.fwdnoanswer = htolel(0);
 }
 }
 req->data.forwardstat.lineNumber = htolel(l->instance);
 if (anyon)
 req->data.forwardstat.activeforward = htolel(7);
 else
 req->data.forwardstat.activeforward = htolel(0);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting FORWARD_STAT_MESSAGE to %s, inst %d, all %s, busy %s, noans %s, acitve %d\n",
 d->name, l->instance, l->call_forward_all, l->call_forward_busy, l->call_forward_noanswer, anyon ? 7 : 0);
 transmit_response(d, req);
}

static void transmit_speeddialstatres(struct skinny_device *d, struct skinny_speeddial *sd)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct speed_dial_stat_res_message), SPEED_DIAL_STAT_RES_MESSAGE)))
 return;

 req->data.speeddialreq.speedDialNumber = htolel(sd->instance);
 ast_copy_string(req->data.speeddial.speedDialDirNumber, sd->exten, sizeof(req->data.speeddial.speedDialDirNumber));
 ast_copy_string(req->data.speeddial.speedDialDisplayName, sd->label, sizeof(req->data.speeddial.speedDialDisplayName));

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting SPEED_DIAL_STAT_RES_MESSAGE to %s, inst %d, dir %s, display %s\n",
 d->name, sd->instance, sd->exten, sd->label);
 transmit_response(d, req);
}

//static void transmit_linestatres(struct skinny_device *d, struct skinny_line *l)
static void transmit_linestatres(struct skinny_device *d, int instance)
{
 struct skinny_req *req;
 struct skinny_line *l;
 struct skinny_speeddial *sd;

 if (!(req = req_alloc(sizeof(struct line_stat_res_message), LINE_STAT_RES_MESSAGE)))
 return;

 if ((l = find_line_by_instance(d, instance))) {
 req->data.linestat.lineNumber = letohl(l->instance);
 memcpy(req->data.linestat.lineDirNumber, l->name, sizeof(req->data.linestat.lineDirNumber));
 memcpy(req->data.linestat.lineDisplayName, l->label, sizeof(req->data.linestat.lineDisplayName));
 } else if ((sd = find_speeddial_by_instance(d, instance, 1))) {
 req->data.linestat.lineNumber = letohl(sd->instance);
 memcpy(req->data.linestat.lineDirNumber, sd->label, sizeof(req->data.linestat.lineDirNumber));
 memcpy(req->data.linestat.lineDisplayName, sd->label, sizeof(req->data.linestat.lineDisplayName));
 }

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting LINE_STAT_RES_MESSAGE to %s, inst %d, num %s, label %s\n",
 d->name, l->instance, req->data.linestat.lineDirNumber, req->data.linestat.lineDisplayName);
 transmit_response(d, req);
}

static void transmit_definetimedate(struct skinny_device *d)
{
 struct skinny_req *req;
 struct timeval now = ast_tvnow();
 struct ast_tm cmtime;

 if (!(req = req_alloc(sizeof(struct definetimedate_message), DEFINETIMEDATE_MESSAGE)))
 return;

 ast_localtime(&now, &cmtime, NULL);
 req->data.definetimedate.year = htolel(cmtime.tm_year+1900);
 req->data.definetimedate.month = htolel(cmtime.tm_mon+1);
 req->data.definetimedate.dayofweek = htolel(cmtime.tm_wday);
 req->data.definetimedate.day = htolel(cmtime.tm_mday);
 req->data.definetimedate.hour = htolel(cmtime.tm_hour);
 req->data.definetimedate.minute = htolel(cmtime.tm_min);
 req->data.definetimedate.seconds = htolel(cmtime.tm_sec);
 req->data.definetimedate.milliseconds = htolel(cmtime.tm_usec / 1000);
 req->data.definetimedate.timestamp = htolel(now.tv_sec);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting DEFINETIMEDATE_MESSAGE to %s, date %u %u %u dow %u time %u:%u:%u.%u\n",
 d->name, req->data.definetimedate.year, req->data.definetimedate.month, req->data.definetimedate.day, req->data.definetimedate.dayofweek,
 req->data.definetimedate.hour, req->data.definetimedate.minute, req->data.definetimedate.seconds, req->data.definetimedate.milliseconds);
 transmit_response(d, req);
}

static void transmit_versionres(struct skinny_device *d)
{
 struct skinny_req *req;
 if (!(req = req_alloc(sizeof(struct version_res_message), VERSION_RES_MESSAGE)))
 return;

 ast_copy_string(req->data.version.version, d->version_id, sizeof(req->data.version.version));

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting VERSION_RES_MESSAGE to %s, version %s\n", d->name, d->version_id);
 transmit_response(d, req);
}

static void transmit_serverres(struct skinny_device *d)
{
 struct skinny_req *req;
 if (!(req = req_alloc(sizeof(struct server_res_message), SERVER_RES_MESSAGE)))
 return;

 memcpy(req->data.serverres.server[0].serverName, ourhost,
 sizeof(req->data.serverres.server[0].serverName));
 req->data.serverres.serverListenPort[0] = htolel(ourport);
 req->data.serverres.serverIpAddr[0] = htolel(d->ourip.s_addr);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting SERVER_RES_MESSAGE to %s, srvname %s %s:%d\n",
 d->name, ourhost, ast_inet_ntoa(d->ourip), ourport);
 transmit_response(d, req);
}

static void transmit_softkeysetres(struct skinny_device *d)
{
 struct skinny_req *req;
 int i;
 int x;
 int y;
 int keydefcount;
 const struct soft_key_definitions *softkeymode = soft_key_default_definitions;

 if (!(req = req_alloc(sizeof(struct soft_key_set_res_message), SOFT_KEY_SET_RES_MESSAGE)))
 return;

 SKINNY_DEBUG(DEBUG_TEMPLATE, 3, "Creating Softkey Template\n");

 keydefcount = ARRAY_LEN(soft_key_default_definitions);
 req->data.softkeysets.softKeySetOffset = htolel(0);
 req->data.softkeysets.softKeySetCount = htolel(keydefcount);
 req->data.softkeysets.totalSoftKeySetCount = htolel(keydefcount);
 for (x = 0; x < keydefcount; x++) {
 const uint8_t *defaults = softkeymode->defaults;
 /* XXX I wanted to get the size of the array dynamically, but that wasn't wanting to work.
 This will have to do for now. */
 for (y = 0; y < softkeymode->count; y++) {
 for (i = 0; i < (sizeof(soft_key_template_default) / sizeof(struct soft_key_template_definition)); i++) {
 if (defaults[y] == i+1) {
 req->data.softkeysets.softKeySetDefinition[softkeymode->mode].softKeyTemplateIndex[y] = (i+1);
 req->data.softkeysets.softKeySetDefinition[softkeymode->mode].softKeyInfoIndex[y] = htoles(i+301);
 SKINNY_DEBUG(DEBUG_TEMPLATE, 4, "softKeySetDefinition : softKeyTemplateIndex: %d softKeyInfoIndex: %d\n",
 i+1, i+301);
 }
 }
 }
 softkeymode++;
 }

 SKINNY_DEBUG(DEBUG_PACKET | DEBUG_TEMPLATE, 3, "Transmitting SOFT_KEY_SET_RES_MESSAGE to %s, template data\n",
 d->name);
 transmit_response(d, req);
}

static void transmit_softkeytemplateres(struct skinny_device *d)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct soft_key_template_res_message), SOFT_KEY_TEMPLATE_RES_MESSAGE)))
 return;

 req->data.softkeytemplate.softKeyOffset = htolel(0);
 req->data.softkeytemplate.softKeyCount = htolel(sizeof(soft_key_template_default) / sizeof(struct soft_key_template_definition));
 req->data.softkeytemplate.totalSoftKeyCount = htolel(sizeof(soft_key_template_default) / sizeof(struct soft_key_template_definition));
 memcpy(req->data.softkeytemplate.softKeyTemplateDefinition,
 soft_key_template_default,
 sizeof(soft_key_template_default));

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting SOFT_KEY_TEMPLATE_RES_MESSAGE to %s, offset 0, keycnt %u, totalkeycnt %u, template data\n",
 d->name, req->data.softkeytemplate.softKeyCount, req->data.softkeytemplate.totalSoftKeyCount);
 transmit_response(d, req);
}

static void transmit_reset(struct skinny_device *d, int fullrestart)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct reset_message), RESET_MESSAGE)))
 return;

 if (fullrestart)
 req->data.reset.resetType = 2;
 else
 req->data.reset.resetType = 1;

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting RESET_MESSAGE to %s, type %s\n",
 d->name, (fullrestart) ? "Restarting" : "Resetting");
 transmit_response(d, req);
}

static void transmit_keepaliveack(struct skinnysession *s)
{
 struct skinny_req *req;

 if (!(req = req_alloc(0, KEEP_ALIVE_ACK_MESSAGE)))
 return;

#ifdef AST_DEVMODE
 {
 struct skinny_device *d = s->device;
 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting KEEP_ALIVE_ACK_MESSAGE to %s\n", (d ? d->name : "unregistered"));
 }
#endif
 transmit_response_bysession(s, req);
}

static void transmit_registerack(struct skinny_device *d)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct register_ack_message), REGISTER_ACK_MESSAGE)))
 return;

 req->data.regack.res[0] = '0';
 req->data.regack.res[1] = '\0';
 req->data.regack.keepAlive = htolel(keep_alive);
 memcpy(req->data.regack.dateTemplate, date_format, sizeof(req->data.regack.dateTemplate));
 req->data.regack.res2[0] = '0';
 req->data.regack.res2[1] = '\0';
 req->data.regack.secondaryKeepAlive = htolel(keep_alive);

#ifdef AST_DEVMODE
 {
 short res = req->data.regack.res[0] << 8 | req->data.regack.res[1];
 unsigned int res2 = req->data.regack.res2[0] << 24 | req->data.regack.res2[1] << 16 | req->data.regack.res2[2] << 8 | req->data.regack.res2[3];
 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting REGISTER_ACK_MESSAGE to %s, keepalive %d, datetemplate %s, seckeepalive %d, res 0x%04x, res2 0x%08x\n",
 d->name, keep_alive, date_format, keep_alive, (unsigned)res, res2);
 }
#endif

 transmit_response(d, req);
}

static void transmit_capabilitiesreq(struct skinny_device *d)
{
 struct skinny_req *req;

 if (!(req = req_alloc(0, CAPABILITIES_REQ_MESSAGE)))
 return;

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting CAPABILITIES_REQ_MESSAGE to %s\n", d->name);
 transmit_response(d, req);
}

static void transmit_backspace(struct skinny_device *d, int instance, unsigned callid)
{
 struct skinny_req *req;

 if (!(req = req_alloc(sizeof(struct bksp_req_message), BKSP_REQ_MESSAGE)))
 return;

 req->data.bkspmessage.instance = htolel(instance);
 req->data.bkspmessage.callreference = htolel(callid);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting BKSP_REQ_MESSAGE to %s, inst %d, callid %u \n",
 d->name, instance, callid);
 transmit_response(d, req);
}

static void transmit_serviceurlstat(struct skinny_device *d, int instance)
{
 struct skinny_req *req;
 struct skinny_serviceurl *surl;

 if (!(req = req_alloc(sizeof(struct serviceurl_stat_message), SERVICEURL_STAT_MESSAGE)))
 return;

 AST_LIST_TRAVERSE(&d->serviceurls, surl, list) {
 if (surl->instance == instance) {
 break;
 }
 }

 if (surl) {
 memcpy(req->data.serviceurlmessage.displayName, surl->displayName, sizeof(req->data.serviceurlmessage.displayName));
 memcpy(req->data.serviceurlmessage.url, surl->url, sizeof(req->data.serviceurlmessage.url));
 }
 req->data.serviceurlmessage.instance = htolel(instance);

 SKINNY_DEBUG(DEBUG_PACKET, 3, "Transmitting SERVICEURL_STAT_MESSAGE to %s, inst %d\n",
 d->name, instance);
 transmit_response(d, req);
}

static int skinny_extensionstate_cb(const char *context, const char *exten, struct ast_state_cb_info *info, void *data)
{
 struct skinny_container *container = data;
 struct skinny_device *d = NULL;
 char hint[AST_MAX_EXTENSION];
 int state = info->exten_state;

 /* only interested in device state here */
 if (info->reason != AST_HINT_UPDATE_DEVICE) {
 return 0;
 }

 if (container->type == SKINNY_SDCONTAINER) {
 struct skinny_speeddial *sd = container->data;
 d = sd->parent;

 SKINNY_DEBUG(DEBUG_HINT, 3, "Got hint %s on speeddial %s\n", ast_extension_state2str(state), sd->label);

 if (ast_get_hint(hint, sizeof(hint), NULL, 0, NULL, sd->context, sd->exten)) {
 /* If they are not registered, we will override notification and show no availability */
 if (ast_device_state(hint) == AST_DEVICE_UNAVAILABLE) {
 transmit_lamp_indication(d, STIMULUS_LINE, sd->instance, SKINNY_LAMP_FLASH);
 transmit_callstate(d, sd->instance, 0, SKINNY_ONHOOK);
 return 0;
 }
 switch (state) {
 case AST_EXTENSION_DEACTIVATED: /* Retry after a while */
 case AST_EXTENSION_REMOVED: /* Extension is gone */
 SKINNY_DEBUG(DEBUG_HINT, 3, "Extension state: Watcher for hint %s %s. Notify Device %s\n",
 exten, state == AST_EXTENSION_DEACTIVATED ? "deactivated" : "removed", d->name);
 sd->stateid = -1;
 transmit_lamp_indication(d, STIMULUS_LINE, sd->instance, SKINNY_LAMP_OFF);
 transmit_callstate(d, sd->instance, 0, SKINNY_ONHOOK);
 break;
 case AST_EXTENSION_RINGING:
 case AST_EXTENSION_UNAVAILABLE:
 transmit_lamp_indication(d, STIMULUS_LINE, sd->instance, SKINNY_LAMP_BLINK);
 transmit_callstate(d, sd->instance, 0, SKINNY_RINGIN);
 break;
 case AST_EXTENSION_BUSY: /* callstate = SKINNY_BUSY wasn't wanting to work - I'll settle for this */
 case AST_EXTENSION_INUSE:
 transmit_lamp_indication(d, STIMULUS_LINE, sd->instance, SKINNY_LAMP_ON);
 transmit_callstate(d, sd->instance, 0, SKINNY_CALLREMOTEMULTILINE);
 break;
 case AST_EXTENSION_ONHOLD:
 transmit_lamp_indication(d, STIMULUS_LINE, sd->instance, SKINNY_LAMP_WINK);
 transmit_callstate(d, sd->instance, 0, SKINNY_HOLD);
 break;
 case AST_EXTENSION_NOT_INUSE:
 default:
 transmit_lamp_indication(d, STIMULUS_LINE, sd->instance, SKINNY_LAMP_OFF);
 transmit_callstate(d, sd->instance, 0, SKINNY_ONHOOK);
 break;
 }
 }
 sd->laststate = state;
 } else if (container->type == SKINNY_SUBLINECONTAINER) {
 struct skinny_subline *subline = container->data;
 struct skinny_line *l = subline->line;
 d = l->device;

 SKINNY_DEBUG(DEBUG_HINT, 3, "Got hint %s on subline %s (%s@%s)\n", ast_extension_state2str(state), subline->name, exten, context);

 subline->extenstate = state;

 if (subline->callid == 0) {
 return 0;
 }

 switch (state) {
 case AST_EXTENSION_RINGING: /* Handled by normal ringin */
 break;
 case AST_EXTENSION_INUSE:
 if (subline->sub && (subline->sub->substate == SKINNY_CONNECTED)) { /* Device has a real call */
 transmit_callstate(d, l->instance, subline->callid, SKINNY_CONNECTED);
 transmit_selectsoftkeys(d, l->instance, subline->callid, KEYDEF_CONNECTED, KEYMASK_ALL);
 send_displaypromptstatus(d, OCTAL_CONNECTED, "", 0, l->instance, subline->callid);
 } else { /* Some other device has active call */
 transmit_callstate(d, l->instance, subline->callid, SKINNY_CALLREMOTEMULTILINE);
 transmit_selectsoftkeys(d, l->instance, subline->callid, KEYDEF_SLACONNECTEDNOTACTIVE, KEYMASK_ALL);
 send_displaypromptstatus(d, "In Use", "", 0, l->instance, subline->callid);
 }
 transmit_lamp_indication(d, STIMULUS_LINE, l->instance, SKINNY_LAMP_ON);
 transmit_ringer_mode(d, SKINNY_RING_OFF);
 transmit_activatecallplane(d, l);
 break;
 case AST_EXTENSION_ONHOLD:
 transmit_callstate(d, l->instance, subline->callid, SKINNY_HOLD);
 transmit_selectsoftkeys(d, l->instance, subline->callid, KEYDEF_SLAHOLD, KEYMASK_ALL);
 send_displaypromptstatus(d, "Hold", "", 0, l->instance, subline->callid);
 transmit_lamp_indication(d, STIMULUS_LINE, l->instance, SKINNY_LAMP_BLINK);
 transmit_activatecallplane(d, l);
 break;
 case AST_EXTENSION_NOT_INUSE:
 transmit_callstate(d, l->instance, subline->callid, SKINNY_ONHOOK);
 transmit_selectsoftkeys(d, l->instance, subline->callid, KEYDEF_ONHOOK, KEYMASK_ALL);
 transmit_clearpromptmessage(d, l->instance, subline->callid);
 transmit_lamp_indication(d, STIMULUS_LINE, l->instance, SKINNY_LAMP_OFF);
 transmit_activatecallplane(d, l);
 subline->callid = 0;
 break;
 default:
 ast_log(LOG_WARNING, "AST_EXTENSION_STATE %s not configured\n", ast_extension_state2str(state));
 }
 } else {
 ast_log(LOG_WARNING, "Invalid data supplied to skinny_extensionstate_cb\n");
 }

 return 0;
}

static void update_connectedline(struct skinny_subchannel *sub, const void *data, size_t datalen)
{
 struct ast_channel *c = sub->owner;
 struct skinny_line *l = sub->line;
 struct skinny_device *d = l->device;

 if (!d->session) {
 return;
 }

 if (sub->calldirection == SKINNY_OUTGOING && !sub->origtonum) {
 /* Do not set origtonum before here or origtoname won't be set */
 sub->origtonum = ast_strdup(sub->exten);
 if (ast_channel_connected(c)->id.name.valid) {
 sub->origtoname = ast_strdup(ast_channel_connected(c)->id.name.str);
 }
 }

 if (!ast_channel_caller(c)->id.number.valid
 || ast_strlen_zero(ast_channel_caller(c)->id.number.str)
 || !ast_channel_connected(c)->id.number.valid
 || ast_strlen_zero(ast_channel_connected(c)->id.number.str))
 return;

 SKINNY_DEBUG(DEBUG_SUB, 3, "Sub %u - Updating\n", sub->callid);

 send_callinfo(sub);
}

static void mwi_event_cb(void *userdata, struct stasis_subscription *sub, struct stasis_message *msg)
{
 struct skinny_line *l = userdata;
 struct skinny_device *d = l->device;
 struct skinny_line *l2;
 int dev_msgs = 0;

 if (!d || !d->session) {
 return;
 }

 if (msg && ast_mwi_state_type() == stasis_message_type(msg)) {
 struct ast_mwi_state *mwi_state = stasis_message_data(msg);
 l->newmsgs = mwi_state->new_msgs;
 }

 if (l->newmsgs) {
 transmit_lamp_indication(d, STIMULUS_VOICEMAIL, l->instance, l->mwiblink?SKINNY_LAMP_BLINK:SKINNY_LAMP_ON);
 } else {
 transmit_lamp_indication(d, STIMULUS_VOICEMAIL, l->instance, SKINNY_LAMP_OFF);
 }

 /* find out wether the device lamp should be on or off */
 AST_LIST_TRAVERSE(&d->lines, l2, list) {
 if (l2->newmsgs) {
 dev_msgs++;
 }
 }

 if (dev_msgs) {
 transmit_lamp_indication(d, STIMULUS_VOICEMAIL, 0, d->mwiblink?SKINNY_LAMP_BLINK:SKINNY_LAMP_ON);
 } else {
 transmit_lamp_indication(d, STIMULUS_VOICEMAIL, 0, SKINNY_LAMP_OFF);
 }
 ast_verb(3, "Skinny mwi_event_cb found %d new messages\n", l->newmsgs);
}

/* I do not believe skinny can deal with video.
 Anyone know differently? */
/* Yes, it can. Currently 7985 and Cisco VT Advantage do video. */
static enum ast_rtp_glue_result skinny_get_vrtp_peer(struct ast_channel *c, struct ast_rtp_instance **instance)
{
 struct skinny_subchannel *sub = NULL;

 if (!(sub = ast_channel_tech_pvt(c)) || !(sub->vrtp))
 return AST_RTP_GLUE_RESULT_FORBID;

 ao2_ref(sub->vrtp, +1);
 *instance = sub->vrtp;

 return AST_RTP_GLUE_RESULT_REMOTE;
}

static enum ast_rtp_glue_result skinny_get_rtp_peer(struct ast_channel *c, struct ast_rtp_instance **instance)
{
 struct skinny_subchannel *sub = NULL;
 struct skinny_line *l;
 enum ast_rtp_glue_result res = AST_RTP_GLUE_RESULT_REMOTE;

 SKINNY_DEBUG(DEBUG_AUDIO, 4, "skinny_get_rtp_peer() Channel = %s\n", ast_channel_name(c));

 if (!(sub = ast_channel_tech_pvt(c)))
 return AST_RTP_GLUE_RESULT_FORBID;

 skinny_locksub(sub);

 if (!(sub->rtp)){
 skinny_unlocksub(sub);
 return AST_RTP_GLUE_RESULT_FORBID;
 }

 ao2_ref(sub->rtp, +1);
 *instance = sub->rtp;

 l = sub->line;

 if (!l->directmedia || l->nat){
 res = AST_RTP_GLUE_RESULT_LOCAL;
 SKINNY_DEBUG(DEBUG_AUDIO, 4, "skinny_get_rtp_peer() Using AST_RTP_GLUE_RESULT_LOCAL \n");
 }

 skinny_unlocksub(sub);

 return res;

}

static int skinny_set_rtp_peer(struct ast_channel *c, struct ast_rtp_instance *rtp, struct ast_rtp_instance *vrtp, struct ast_rtp_instance *trtp, const struct ast_format_cap *codecs, int nat_active)
{
 struct skinny_subchannel *sub;
 struct skinny_line *l;
 struct skinny_device *d;
 struct sockaddr_in us = { 0, };
 struct sockaddr_in them = { 0, };
 struct ast_sockaddr them_tmp;
 struct ast_sockaddr us_tmp;

 sub = ast_channel_tech_pvt(c);

 if (ast_channel_state(c) != AST_STATE_UP)
 return 0;

 if (!sub) {
 return -1;
 }

 l = sub->line;
 d = l->device;

 if (rtp){
 struct ast_format *tmpfmt;
 unsigned int framing;
 ast_rtp_instance_get_remote_address(rtp, &them_tmp);
 ast_sockaddr_to_sin(&them_tmp, &them);

 /* Shutdown any early-media or previous media on re-invite */
 transmit_stopmediatransmission(d, sub);

 SKINNY_DEBUG(DEBUG_AUDIO, 4, "Peerip = %s:%d\n", ast_inet_ntoa(them.sin_addr), ntohs(them.sin_port));

 tmpfmt = ast_format_cap_get_format(l->cap, 0);
 framing = ast_format_cap_get_format_framing(l->cap, tmpfmt);

 SKINNY_DEBUG(DEBUG_AUDIO, 4, "Setting payloadType to '%s' (%u ms)\n", ast_format_get_name(tmpfmt), framing);

 if (!(l->directmedia) || (l->nat)){
 ast_rtp_instance_get_local_address(rtp, &us_tmp);
 ast_sockaddr_to_sin(&us_tmp, &us);
 us.sin_addr.s_addr = us.sin_addr.s_addr ? us.sin_addr.s_addr : d->ourip.s_addr;
 transmit_startmediatransmission(d, sub, us, tmpfmt, framing);
 } else {
 transmit_startmediatransmission(d, sub, them, tmpfmt, framing);
 }

 ao2_ref(tmpfmt, -1);

 return 0;
 }
 /* Need a return here to break the bridge */
 return 0;
}

static struct ast_rtp_glue skinny_rtp_glue = {
 .type = "Skinny",
 .get_rtp_info = skinny_get_rtp_peer,
 .get_vrtp_info = skinny_get_vrtp_peer,
 .update_peer = skinny_set_rtp_peer,
};

#ifdef AST_DEVMODE
static char *skinny_debugs(void)
{
 char *ptr;
 int posn = 0;

 ptr = dbgcli_buf;
 ptr[0] = '\0';
 if (skinnydebug & DEBUG_GENERAL) {
 strcpy(ptr, "general "); /* SAFE */
 posn += 8;
 ptr += 8;
 }
 if (skinnydebug & DEBUG_SUB) {
 strcpy(ptr, "sub "); /* SAFE */
 posn += 4;
 ptr += 4;
 }
 if (skinnydebug & DEBUG_AUDIO) {
 strcpy(ptr, "audio "); /* SAFE */
 posn += 6;
 ptr += 6;
 }
 if (skinnydebug & DEBUG_PACKET) {
 strcpy(ptr, "packet "); /* SAFE */
 posn += 7;
 ptr += 7;
 }
 if (skinnydebug & DEBUG_LOCK) {
 strcpy(ptr, "lock "); /* SAFE */
 posn += 5;
 ptr += 5;
 }
 if (skinnydebug & DEBUG_TEMPLATE) {
 strcpy(ptr, "template "); /* SAFE */
 posn += 9;
 ptr += 9;
 }
 if (skinnydebug & DEBUG_THREAD) {
 strcpy(ptr, "thread "); /* SAFE */
 posn += 7;
 ptr += 7;
 }
 if (skinnydebug & DEBUG_HINT) {
 strcpy(ptr, "hint "); /* SAFE */
 posn += 5;
 ptr += 5;
 }
 if (skinnydebug & DEBUG_KEEPALIVE) {
 strcpy(ptr, "keepalive "); /* SAFE */
 posn += 10;
 ptr += 10;
 }
 if (posn > 0) {
 strncpy(--ptr, "\0", 1);
 }
 return dbgcli_buf;
}

static char *complete_skinny_debug(const char *line, const char *word, int pos, int state)
{
 const char *debugOpts[]={ "all","audio","hint","keepalive","lock","off","packet","show","sub","template","thread",NULL };
 char *wordptr = (char *)word;
 char buf[32];
 char *bufptr = buf;
 int buflen = sizeof(buf);
 int wordlen;
 int which = 0;
 int i = 0;

 if (*word == '+' || *word == '-' || *word == '!') {
 *bufptr = *word;
 wordptr++;
 bufptr++;
 buflen--;
 }
 wordlen = strlen(wordptr);

 while (debugOpts[i]) {
 if (!strncasecmp(wordptr, debugOpts[i], wordlen) && ++which > state) {
 ast_copy_string(bufptr, debugOpts[i], buflen);
 return ast_strdup(buf);
 }
 i++;
 }

 return NULL;
}

static char *handle_skinny_set_debug(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a)
{
 int i;
 int result = 0;
 const char *arg;
 int bitmask;
 int negate;

 switch (cmd) {
 case CLI_INIT:
 e->command = "skinny debug";
 e->usage =
 "Usage: skinny debug {audio|hint|keepalive|lock|off|packet|show|sub|template|thread}\n"
 " Enables/Disables various Skinny debugging messages\n";
 return NULL;
 case CLI_GENERATE:
 return complete_skinny_debug(a->line, a->word, a->pos, a->n);

 }

 if (a->argc < 3)
 return CLI_SHOWUSAGE;

 if (a->argc == 3 && !strncasecmp(a->argv[e->args-1], "show", 4)) {
 ast_cli(a->fd, "Skinny Debugging - %s\n", skinny_debugs());
 return CLI_SUCCESS;
 }

 for(i = e->args; i < a->argc; i++) {
 result++;
 arg = a->argv[i];

 if (!strncasecmp(arg, "off", 3)) {
 skinnydebug = 0;
 continue;
 }

 if (!strncasecmp(arg, "all", 3)) {
 skinnydebug = DEBUG_GENERAL|DEBUG_SUB|DEBUG_PACKET|DEBUG_AUDIO|DEBUG_LOCK|DEBUG_TEMPLATE|DEBUG_THREAD|DEBUG_HINT|DEBUG_KEEPALIVE;
 continue;
 }

 if (!strncasecmp(arg, "-", 1) || !strncasecmp(arg, "!", 1)) {
 negate = 1;
 arg++;
 } else if (!strncasecmp(arg, "+", 1)) {
 negate = 0;
 arg++;
 } else {
 negate = 0;
 }

 if (!strncasecmp(arg, "general", 7)) {
 bitmask = DEBUG_GENERAL;
 } else if (!strncasecmp(arg, "sub", 3)) {
 bitmask = DEBUG_SUB;
 } else if (!strncasecmp(arg, "packet", 6)) {
 bitmask = DEBUG_PACKET;
 } else if (!strncasecmp(arg, "audio", 5)) {
 bitmask = DEBUG_AUDIO;
 } else if (!strncasecmp(arg, "lock", 4)) {
 bitmask = DEBUG_LOCK;
 } else if (!strncasecmp(arg, "template", 8)) {
 bitmask = DEBUG_TEMPLATE;
 } else if (!strncasecmp(arg, "thread", 6)) {
 bitmask = DEBUG_THREAD;
 } else if (!strncasecmp(arg, "hint", 4)) {
 bitmask = DEBUG_HINT;
 } else if (!strncasecmp(arg, "keepalive", 9)) {
 bitmask = DEBUG_KEEPALIVE;
 } else {
 ast_cli(a->fd, "Skinny Debugging - option '%s' unknown\n", a->argv[i]);
 result--;
 continue;
 }

 if (negate) {
 skinnydebug &= ~bitmask;
 } else {
 skinnydebug |= bitmask;
 }
 }
 if (result) {
 ast_cli(a->fd, "Skinny Debugging - %s\n", skinnydebug ? skinny_debugs() : "off");
 return CLI_SUCCESS;
 } else {
 return CLI_SHOWUSAGE;
 }
}
#endif

static char *handle_skinny_reload(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a)
{
 switch (cmd) {
 case CLI_INIT:
 e->command = "skinny reload";
 e->usage =
 "Usage: skinny reload\n"
 " Reloads the chan_skinny configuration\n";
 return NULL;
 case CLI_GENERATE:
 return NULL;
 }

 if (a->argc != e->args)
 return CLI_SHOWUSAGE;

 skinny_reload();
 return CLI_SUCCESS;

}

static char *complete_skinny_devices(const char *word, int state)
{
 struct skinny_device *d;
 int wordlen = strlen(word), which = 0;

 AST_LIST_TRAVERSE(&devices, d, list) {
 if (!strncasecmp(word, d->name, wordlen) && ++which > state) {
 return ast_strdup(d->name);
 }
 }

 return NULL;
}

static char *complete_skinny_show_device(const char *line, const char *word, int pos, int state)
{
 return (pos == 3 ? complete_skinny_devices(word, state) : NULL);
}

static char *complete_skinny_reset(const char *line, const char *word, int pos, int state)
{
 if (pos == 2) {
 static const char * const completions[] = { "all", NULL };
 char *ret = ast_cli_complete(word, completions, state);
 if (!ret) {
 ret = complete_skinny_devices(word, state - 1);
 }
 return ret;
 } else if (pos == 3) {
 static const char * const completions[] = { "restart", NULL };
 return ast_cli_complete(word, completions, state);
 }

 return NULL;
}

static char *complete_skinny_show_line(const char *line, const char *word, int pos, int state)
{
 if (pos == 3) {
 struct skinny_device *d;
 struct skinny_line *l;
 int wordlen = strlen(word), which = 0;

 AST_LIST_TRAVERSE(&devices, d, list) {
 AST_LIST_TRAVERSE(&d->lines, l, list) {
 if (!strncasecmp(word, l->name, wordlen) && ++which > state) {
 return ast_strdup(l->name);
 }
 }
 }
 } else if (pos == 4) {
 static const char * const completions[] = { "on", NULL };
 return ast_cli_complete(word, completions, state);
 } else if (pos == 5) {
 return complete_skinny_devices(word, state);
 }

 return NULL;
}

static char *handle_skinny_reset(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a)
{
 struct skinny_device *d;

 switch (cmd) {
 case CLI_INIT:
 e->command = "skinny reset";
 e->usage =
 "Usage: skinny reset <DeviceId|DeviceName|all> [restart]\n"
 " Causes a Skinny device to reset itself, optionally with a full restart\n";
 return NULL;
 case CLI_GENERATE:
 return complete_skinny_reset(a->line, a->word, a->pos, a->n);
 }

 if (a->argc < 3 || a->argc > 4)
 return CLI_SHOWUSAGE;

 AST_LIST_LOCK(&devices);
 AST_LIST_TRAVERSE(&devices, d, list) {
 int resetonly = 1;
 if (!strcasecmp(a->argv[2], d->id) || !strcasecmp(a->argv[2], d->name) || !strcasecmp(a->argv[2], "all")) {
 if (!(d->session))
 continue;

 if (a->argc == 4 && !strcasecmp(a->argv[3], "restart"))
 resetonly = 0;

 transmit_reset(d, resetonly);
 }
 }
 AST_LIST_UNLOCK(&devices);
 return CLI_SUCCESS;
}

static char *device2str(int type)
{
 char *tmp;

 switch (type) {
 case SKINNY_DEVICE_NONE:
 return "No Device";
 case SKINNY_DEVICE_30SPPLUS:
 return "30SP Plus";
 case SKINNY_DEVICE_12SPPLUS:
 return "12SP Plus";
 case SKINNY_DEVICE_12SP:
 return "12SP";
 case SKINNY_DEVICE_12:
 return "12";
 case SKINNY_DEVICE_30VIP:
 return "30VIP";
 case SKINNY_DEVICE_7910:
 return "7910";
 case SKINNY_DEVICE_7960:
 return "7960";
 case SKINNY_DEVICE_7940:
 return "7940";
 case SKINNY_DEVICE_7935:
 return "7935";
 case SKINNY_DEVICE_ATA186:
 return "ATA186";
 case SKINNY_DEVICE_7941:
 return "7941";
 case SKINNY_DEVICE_7971:
 return "7971";
 case SKINNY_DEVICE_7914:
 return "7914";
 case SKINNY_DEVICE_7985:
 return "7985";
 case SKINNY_DEVICE_7911:
 return "7911";
 case SKINNY_DEVICE_7961GE:
 return "7961GE";
 case SKINNY_DEVICE_7941GE:
 return "7941GE";
 case SKINNY_DEVICE_7931:
 return "7931";
 case SKINNY_DEVICE_7921:
 return "7921";
 case SKINNY_DEVICE_7906:
 return "7906";
 case SKINNY_DEVICE_7962:
 return "7962";
 case SKINNY_DEVICE_7937:
 return "7937";
 case SKINNY_DEVICE_7942:
 return "7942";
 case SKINNY_DEVICE_7945:
 return "7945";
 case SKINNY_DEVICE_7965:
 return "7965";
 case SKINNY_DEVICE_7975:
 return "7975";
 case SKINNY_DEVICE_7905:
 return "7905";
 case SKINNY_DEVICE_7920:
 return "7920";
 case SKINNY_DEVICE_7970:
 return "7970";
 case SKINNY_DEVICE_7912:
 return "7912";
 case SKINNY_DEVICE_7902:
 return "7902";
 case SKINNY_DEVICE_CIPC:
 return "IP Communicator";
 case SKINNY_DEVICE_7961:
 return "7961";
 case SKINNY_DEVICE_7936:
 return "7936";
 case SKINNY_DEVICE_SCCPGATEWAY_AN:
 return "SCCPGATEWAY_AN";
 case SKINNY_DEVICE_SCCPGATEWAY_BRI:
 return "SCCPGATEWAY_BRI";
 case SKINNY_DEVICE_UNKNOWN:
 return "Unknown";
 default:
 if (!(tmp = ast_threadstorage_get(&device2str_threadbuf, DEVICE2STR_BUFSIZE)))
 return "Unknown";
 snprintf(tmp, DEVICE2STR_BUFSIZE, "UNKNOWN-%d", type);
 return tmp;
 }
}

static char *_skinny_show_devices(int fd, int *total, struct mansession *s, const struct message *m, int argc, const char * const *argv)
{
 struct skinny_device *d;
 struct skinny_line *l;
 const char *id;
 char idtext[256] = "";
 int total_devices = 0;

 if (s) { /* Manager - get ActionID */
 id = astman_get_header(m, "ActionID");
 if (!ast_strlen_zero(id))
 snprintf(idtext, sizeof(idtext), "ActionID: %s\r\n", id);
 }

 switch (argc) {
 case 3:
 break;
 default:
 return CLI_SHOWUSAGE;
 }

 if (!s) {
 ast_cli(fd, "Name DeviceId IP Type R NL\n");
 ast_cli(fd, "-------------------- ---------------- --------------- --------------- - --\n");
 }

 AST_LIST_LOCK(&devices);
 AST_LIST_TRAVERSE(&devices, d, list) {
 int numlines = 0;
 total_devices++;
 AST_LIST_TRAVERSE(&d->lines, l, list) {
 numlines++;
 }
 if (!s) {
 ast_cli(fd, "%-20s %-16s %-15s %-15s %c %2d\n",
 d->name,
 d->id,
 d->session?ast_inet_ntoa(d->session->sin.sin_addr):"",
 device2str(d->type),
 d->session?'Y':'N',
 numlines);
 } else {
 astman_append(s,
 "Event: DeviceEntry\r\n%s"
 "Channeltype: SKINNY\r\n"
 "ObjectName: %s\r\n"
 "ChannelObjectType: device\r\n"
 "DeviceId: %s\r\n"
 "IPaddress: %s\r\n"
 "Type: %s\r\n"
 "Devicestatus: %s\r\n"
 "NumberOfLines: %d\r\n",
 idtext,
 d->name,
 d->id,
 d->session?ast_inet_ntoa(d->session->sin.sin_addr):"-none-",
 device2str(d->type),
 d->session?"registered":"unregistered",
 numlines);
 }
 }
 AST_LIST_UNLOCK(&devices);

 if (total)
 *total = total_devices;

 return CLI_SUCCESS;
}

/*! \brief Show SKINNY devices in the manager API */
/* Inspired from chan_sip */
static int manager_skinny_show_devices(struct mansession *s, const struct message *m)
{
 const char *a[] = {"skinny", "show", "devices"};
 int total = 0;

 astman_send_listack(s, m, "Device status list will follow", "start");

 /* List the devices in separate manager events */
 _skinny_show_devices(-1, &total, s, m, 3, a);

 /* Send final confirmation */
 astman_send_list_complete_start(s, m, "DevicelistComplete", total);
 astman_send_list_complete_end(s);
 return 0;
}

static char *handle_skinny_show_devices(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a)
{

 switch (cmd) {
 case CLI_INIT:
 e->command = "skinny show devices";
 e->usage =
 "Usage: skinny show devices\n"
 " Lists all devices known to the Skinny subsystem.\n";
 return NULL;
 case CLI_GENERATE:
 return NULL;
 }

 return _skinny_show_devices(a->fd, NULL, NULL, NULL, a->argc, a->argv);
}

static char *_skinny_show_device(int type, int fd, struct mansession *s, const struct message *m, int argc, const char * const *argv)
{
 struct skinny_device *d;
 struct skinny_line *l;
 struct skinny_speeddial *sd;
 struct skinny_addon *sa;
 struct skinny_serviceurl *surl;
 struct ast_str *codec_buf = ast_str_alloca(AST_FORMAT_CAP_NAMES_LEN);

 if (argc < 4) {
 return CLI_SHOWUSAGE;
 }

 AST_LIST_LOCK(&devices);
 AST_LIST_TRAVERSE(&devices, d, list) {
 if (!strcasecmp(argv[3], d->id) || !strcasecmp(argv[3], d->name)) {
 int numlines = 0, numaddons = 0, numspeeddials = 0, numserviceurls = 0;

 AST_LIST_TRAVERSE(&d->lines, l, list){
 numlines++;
 }

 AST_LIST_TRAVERSE(&d->addons, sa, list) {
 numaddons++;
 }

 AST_LIST_TRAVERSE(&d->speeddials, sd, list) {
 numspeeddials++;
 }

 AST_LIST_TRAVERSE(&d->serviceurls, surl, list) {
 numserviceurls++;
 }

 if (type == 0) { /* CLI */
 ast_cli(fd, "Name: %s\n", d->name);
 ast_cli(fd, "Id: %s\n", d->id);
 ast_cli(fd, "version: %s\n", S_OR(d->version_id, "Unknown"));
 ast_cli(fd, "Ip address: %s\n", (d->session ? ast_inet_ntoa(d->session->sin.sin_addr) : "Unknown"));
 ast_cli(fd, "Port: %d\n", (d->session ? ntohs(d->session->sin.sin_port) : 0));
 ast_cli(fd, "Device Type: %s\n", device2str(d->type));
 ast_cli(fd, "Conf Codecs: %s\n", ast_format_cap_get_names(d->confcap, &codec_buf));
 ast_cli(fd, "Neg Codecs: %s\n", ast_format_cap_get_names(d->cap, &codec_buf));
 ast_cli(fd, "Registered: %s\n", (d->session ? "Yes" : "No"));
 ast_cli(fd, "Lines: %d\n", numlines);
 AST_LIST_TRAVERSE(&d->lines, l, list) {
 ast_cli(fd, " %s (%s)\n", l->name, l->label);
 }
 ast_cli(fd, "Addons: %d\n", numaddons);
 AST_LIST_TRAVERSE(&d->addons, sa, list) {
 ast_cli(fd, " %s\n", sa->type);
 }
 ast_cli(fd, "Speeddials: %d\n", numspeeddials);
 AST_LIST_TRAVERSE(&d->speeddials, sd, list) {
 ast_cli(fd, " %s (%s) ishint: %d\n", sd->exten, sd->label, sd->isHint);
 }
 ast_cli(fd, "ServiceURLs: %d\n", numserviceurls);
 AST_LIST_TRAVERSE(&d->