chan_unistim.c

Go to the documentation of this file.

/*
 * Asterisk -- An open source telephony toolkit.
 *
 * UNISTIM channel driver for asterisk
 *
 * Copyright (C) 2005 - 2007, Cedric Hans
 *
 * Cedric Hans <cedric.hans@mlkj.net>
 *
 * Asterisk 1.4 patch by Peter Be
 *
 * 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 chan_unistim channel driver for Asterisk
 * \author Cedric Hans <cedric.hans@mlkj.net>
 *
 * Unistim (Unified Networks IP Stimulus) channel driver
 * for Nortel i2002, i2004 and i2050
 *
 * \ingroup channel_drivers
 */
 
/*** MODULEINFO
    <support_level>extended</support_level>
 ***/
 
#include "asterisk.h"
 
#include <sys/stat.h>
#include <signal.h>
 
#if defined(__CYGWIN__) || defined(__NetBSD__)
/*
 * cygwin headers are partly inconsistent. struct iovec is defined in sys/uio.h
 * which is not included by default by sys/socket.h - in_pktinfo is defined in
 * w32api/ws2tcpip.h but this probably has compatibility problems with sys/socket.h
 * So for the time being we simply disable HAVE_PKTINFO when building under cygwin.
 *    This should be done in some common header, but for now this is the only file
 * using iovec and in_pktinfo so it suffices to apply the fix here.
 */
#ifdef HAVE_PKTINFO
#undef HAVE_PKTINFO
#endif
#endif /* __CYGWIN__ || __NetBSD__ */
 
#include "asterisk/paths.h" /* ast_config_AST_LOG_DIR used in (too ?) many places */
#include "asterisk/network.h"
#include "asterisk/channel.h"
#include "asterisk/config.h"
#include "asterisk/module.h"
#include "asterisk/pbx.h"
#include "asterisk/rtp_engine.h"
#include "asterisk/unaligned.h"
#include "asterisk/netsock2.h"
#include "asterisk/acl.h"
#include "asterisk/callerid.h"
#include "asterisk/cli.h"
#include "asterisk/app.h"
#include "asterisk/mwi.h"
#include "asterisk/musiconhold.h"
#include "asterisk/causes.h"
#include "asterisk/indications.h"
#include "asterisk/pickup.h"
#include "asterisk/astobj2.h"
#include "asterisk/astdb.h"
#include "asterisk/features_config.h"
#include "asterisk/bridge.h"
#include "asterisk/stasis_channels.h"
#include "asterisk/format_cache.h"
 
#define DEFAULTCONTEXT    "default"
#define DEFAULTCALLERID  "Unknown"
#define DEFAULTCALLERNAME       " "
#define DEFAULTHEIGHT    3
#define USTM_LOG_DIR        "unistimHistory"
#define USTM_LANG_DIR       "unistimLang"
 
/*! Size of the transmit buffer */
#define MAX_BUF_SIZE        64
/*! Number of slots for the transmit queue */
#define MAX_BUF_NUMBER    150
/*! Number of digits displayed on screen */
#define MAX_SCREEN_NUMBER   15
/*! Length of month label size */
#define MONTH_LABEL_SIZE 3
/*! Try x times before removing the phone */
#define NB_MAX_RETRANSMIT       8
/*! Nb of milliseconds waited when no events are scheduled */
#define IDLE_WAIT          1000
/*! Wait x milliseconds before resending a packet */
#define RETRANSMIT_TIMER    2000
/*! How often the mailbox is checked for new messages */
#define TIMER_MWI          5000
/*! Timeout value for entered number being dialed */
#define DEFAULT_INTERDIGIT_TIMER    4000
 
/*! Not used */
#define DEFAULT_CODEC      0x00
#define SIZE_PAGE          4096
#define DEVICE_NAME_LEN  16
#define AST_CONFIG_MAX_PATH     255
#define MAX_ENTRY_LOG      30
 
#define SUB_REAL        0
#define SUB_RING                1
#define SUB_THREEWAY            2
 
struct ast_format_cap *global_cap;
 
enum autoprovision {
    AUTOPROVISIONING_NO = 0,
    AUTOPROVISIONING_YES,
    AUTOPROVISIONING_TN
};
 
enum autoprov_extn {
    /*! Do not create an extension into the default dialplan */
    EXTENSION_NONE = 0,
    /*! Prompt user for an extension number and register it */
    EXTENSION_ASK,
    /*! Register an extension with the line=> value */
    EXTENSION_LINE,
    /*! Used with AUTOPROVISIONING_TN */
    EXTENSION_TN
};
#define OUTPUT_HANDSET    0xC0
#define OUTPUT_HEADPHONE    0xC1
#define OUTPUT_SPEAKER    0xC2
 
#define VOLUME_LOW        0x01
#define VOLUME_LOW_SPEAKER      0x03
#define VOLUME_NORMAL      0x02
#define VOLUME_INSANELY_LOUD    0x07
 
#define MUTE_OFF        0x00
#define MUTE_ON      0xFF
#define MUTE_ON_DISCRET  0xCE
 
#define LED_BAR_OFF         0x00 /* bar off */
#define LED_BAR_ON          0x01 /* bar on */
#define LED_BAR_P2          0x02 /* bar 1s on/1s */
#define LED_BAR_P3          0x03 /* bar 2.5s on/0.5s off */
#define LED_BAR_P4          0x04 /* bar 0.6s on/0.3s off */
#define LED_BAR_P5          0x05 /* bar 0.5s on/0.5s off */
#define LED_BAR_P6          0x06 /* bar 2s on/0.5s off */
#define LED_BAR_P7          0x07 /* bar off */
#define LED_SPEAKER_OFF         0x08
#define LED_SPEAKER_ON          0x09
#define LED_HEADPHONE_OFF       0x010
#define LED_HEADPHONE_ON        0x011
#define LED_MUTE_OFF            0x018
#define LED_MUTE_ON         0x019
#define LED_MUTE_BLINK          0x1A
 
#define SIZE_HEADER      6
#define SIZE_MAC_ADDR      17
#define TEXT_LENGTH_MAX  24
#define TEXT_LINE0        0x00
#define TEXT_LINE1        0x20
#define TEXT_LINE2        0x40
#define TEXT_NORMAL      0x05
#define TEXT_INVERSE        0x25
#define STATUS_LENGTH_MAX       28
 
#define FAV_ICON_NONE          0x00
#define FAV_ICON_ONHOOK_BLACK      0x20
#define FAV_ICON_ONHOOK_WHITE      0x21
#define FAV_ICON_SPEAKER_ONHOOK_BLACK   0x22
#define FAV_ICON_SPEAKER_ONHOOK_WHITE   0x23
#define FAV_ICON_OFFHOOK_BLACK    0x24
#define FAV_ICON_OFFHOOK_WHITE    0x25
#define FAV_ICON_ONHOLD_BLACK      0x26
#define FAV_ICON_ONHOLD_WHITE      0x27
#define FAV_ICON_SPEAKER_OFFHOOK_BLACK  0x28
#define FAV_ICON_SPEAKER_OFFHOOK_WHITE  0x29
#define FAV_ICON_PHONE_BLACK        0x2A
#define FAV_ICON_PHONE_WHITE        0x2B
#define FAV_ICON_SPEAKER_ONHOLD_BLACK   0x2C
#define FAV_ICON_SPEAKER_ONHOLD_WHITE   0x2D
#define FAV_ICON_HEADPHONES      0x2E
#define FAV_ICON_HEADPHONES_ONHOLD      0x2F
#define FAV_ICON_HOME          0x30
#define FAV_ICON_CITY          0x31
#define FAV_ICON_SHARP        0x32
#define FAV_ICON_PAGER        0x33
#define FAV_ICON_CALL_CENTER        0x34
#define FAV_ICON_FAX            0x35
#define FAV_ICON_MAILBOX        0x36
#define FAV_ICON_REFLECT        0x37
#define FAV_ICON_COMPUTER          0x38
#define FAV_ICON_FORWARD        0x39
#define FAV_ICON_LOCKED      0x3A
#define FAV_ICON_TRASH        0x3B
#define FAV_ICON_INBOX        0x3C
#define FAV_ICON_OUTBOX      0x3D
#define FAV_ICON_MEETING        0x3E
#define FAV_ICON_BOX            0x3F
 
#define FAV_BLINK_FAST        0x20
#define FAV_BLINK_SLOW        0x40
 
#define FAV_MAX_LENGTH        0x0A
 
#define FAVNUM                    6
#define EXPNUM                    24
#define FAV_LINE_ICON         FAV_ICON_ONHOOK_BLACK
 
static void dummy(char *unused, ...)
{
    return;
}
 
/*! \brief Global jitterbuffer configuration - by default, jb is disabled
 *  \note Values shown here match the defaults shown in unistim.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;
 
 
/* #define DUMP_PACKET 1 */
/* #define DEBUG_TIMER ast_verbose */
 
#define DEBUG_TIMER dummy
/*! Enable verbose output. can also be set with the CLI */
static int unistimdebug = 0;
static int unistim_port;
static enum autoprovision autoprovisioning = AUTOPROVISIONING_NO;
static int unistim_keepalive;
static int unistimsock = -1;
 
static struct {
    unsigned int tos;
    unsigned int tos_audio;
    unsigned int cos;
    unsigned int cos_audio;
} qos = { 0, 0, 0, 0 };
 
static struct io_context *io;
static struct ast_sched_context *sched;
static struct sockaddr_in public_ip = { 0, };
static unsigned char *buff; /*! Receive buffer address */
static int unistim_reloading = 0;
AST_MUTEX_DEFINE_STATIC(unistim_reload_lock);
 
/*! This is the thread for the monitor which checks for input on the channels
 * which are not currently in use.  */
static pthread_t monitor_thread = AST_PTHREADT_NULL;
 
/*! Protect the monitoring thread, so only one process can kill or start it, and not
 *    when it's doing something critical. */
AST_MUTEX_DEFINE_STATIC(monlock);
/*! Protect the session list */
AST_MUTEX_DEFINE_STATIC(sessionlock);
/*! Protect the device list */
AST_MUTEX_DEFINE_STATIC(devicelock);
 
enum phone_state {
    STATE_INIT,
    STATE_AUTHDENY,
    STATE_MAINPAGE,
    STATE_EXTENSION,
    STATE_DIALPAGE,
    STATE_RINGING,
    STATE_CALL,
    STATE_SELECTOPTION,
    STATE_SELECTCODEC,
    STATE_SELECTLANGUAGE,
    STATE_CLEANING,
    STATE_HISTORY
};
 
enum handset_state {
    STATE_ONHOOK,
    STATE_OFFHOOK,
};
 
enum phone_key {
    KEY_0 = 0x40,
    KEY_1 = 0x41,
    KEY_2 = 0x42,
    KEY_3 = 0x43,
    KEY_4 = 0x44,
    KEY_5 = 0x45,
    KEY_6 = 0x46,
    KEY_7 = 0x47,
    KEY_8 = 0x48,
    KEY_9 = 0x49,
    KEY_STAR = 0x4a,
    KEY_SHARP = 0x4b,
    KEY_UP = 0x4c,
    KEY_DOWN = 0x4d,
    KEY_RIGHT = 0x4e,
    KEY_LEFT = 0x4f,
    KEY_QUIT = 0x50,
    KEY_COPY = 0x51,
    KEY_FUNC1 = 0x54,
    KEY_FUNC2 = 0x55,
    KEY_FUNC3 = 0x56,
    KEY_FUNC4 = 0x57,
    KEY_ONHOLD = 0x5b,
    KEY_HANGUP = 0x5c,
    KEY_MUTE = 0x5d,
    KEY_HEADPHN = 0x5e,
    KEY_LOUDSPK = 0x5f,
    KEY_FAV0 = 0x60,
    KEY_FAV1 = 0x61,
    KEY_FAV2 = 0x62,
    KEY_FAV3 = 0x63,
    KEY_FAV4 = 0x64,
    KEY_FAV5 = 0x65,
    KEY_COMPUTR = 0x7b,
    KEY_CONF = 0x7c,
    KEY_SNDHIST = 0x7d,
    KEY_RCVHIST = 0x7e,
    KEY_INDEX = 0x7f
};
 
enum charset {
    LANG_DEFAULT,
    ISO_8859_1,
    ISO_8859_2,
    ISO_8859_4,
    ISO_8859_5,
    ISO_2022_JP,
};
 
static const int dtmf_row[] = { 697,  770,  852,  941 };
static const float dtmf_col[] = { 1209, 1336, 1477, 1633 };
 
struct wsabuf {
    u_long len;
    unsigned char *buf;
};
 
struct unistim_subchannel {
    ast_mutex_t lock;
    unsigned int subtype;       /*! SUB_REAL, SUB_RING or SUB_THREEWAY */
    struct ast_channel *owner;  /*! Asterisk channel used by the subchannel */
    struct unistim_line *parent;    /*! Unistim line */
    struct ast_rtp_instance *rtp;   /*! RTP handle */
    int softkey;            /*! Softkey assigned */
    pthread_t ss_thread;        /*! unistim_ss thread handle */
    int alreadygone;
    int holding;            /*! this subchannel holds someone */
    signed char ringvolume;
    signed char ringstyle;
    int moh;                    /*!< Music on hold in progress */
    AST_LIST_ENTRY(unistim_subchannel) list;
};
 
/*!
 * \todo Convert to stringfields
 */
struct unistim_line {
    ast_mutex_t lock;
    char name[80]; /*! Like 200 */
    char fullname[101]; /*! Like USTM/200\@black */
    char exten[AST_MAX_EXTENSION]; /*! Extension where to start */
    char cid_num[AST_MAX_EXTENSION]; /*! CallerID Number */
    char mailbox[AST_MAX_EXTENSION]; /*! Mailbox for MWI */
    char musicclass[MAX_MUSICCLASS]; /*! MusicOnHold class */
    ast_group_t callgroup; /*! Call group */
    ast_group_t pickupgroup; /*! Pickup group */
    char accountcode[AST_MAX_ACCOUNT_CODE]; /*! Account code (for billing) */
    int amaflags; /*! AMA flags (for billing) */
    struct ast_format_cap *cap; /*! Codec supported */
    char parkinglot[AST_MAX_CONTEXT]; /*! Parkinglot */
    struct unistim_line *next;
    struct unistim_device *parent;
    AST_LIST_ENTRY(unistim_line) list;
};
 
/*!
 * \brief A device containing one or more lines
 */
static struct unistim_device {
    ast_mutex_t lock;
    int receiver_state;       /*!< state of the receiver (see ReceiverState) */
    int size_phone_number;    /*!< size of the phone number */
    char context[AST_MAX_EXTENSION]; /*!< Context to start in */
    char phone_number[AST_MAX_EXTENSION];     /*!< the phone number entered by the user */
    char redial_number[AST_MAX_EXTENSION];   /*!< the last phone number entered by the user */
    char id[18];                /*!< mac address of the current phone in ascii */
    char name[DEVICE_NAME_LEN];     /*!< name of the device */
    int hasexp;                          /*!< if device have expansion connected */
    char expsoftkeylabel[EXPNUM][11];       /*!< soft key label */
    char softkeylabel[FAVNUM][11];       /*!< soft key label */
    char softkeynumber[FAVNUM][AST_MAX_EXTENSION];      /*!< number dialed when the soft key is pressed */
    char softkeyicon[FAVNUM];       /*!< icon number */
    char softkeydevice[FAVNUM][16];      /*!< name of the device monitored */
    struct unistim_subchannel *ssub[FAVNUM];
    struct unistim_line *sline[FAVNUM];
    struct unistim_device *sp[FAVNUM];   /*!< pointer to the device monitored by this soft key */
    char language[MAX_LANGUAGE];    /*!< Language for asterisk sounds */
    int height;                         /*!< The number of lines the phone can display */
    char maintext0[25];          /*!< when the phone is idle, display this string on line 0 */
    char maintext1[25];          /*!< when the phone is idle, display this string on line 1 */
    char maintext2[25];          /*!< when the phone is idle, display this string on line 2 */
    char titledefault[13];    /*!< title (text before date/time) */
    char datetimeformat;        /*!< format used for displaying time/date */
    signed char contrast;             /*!< contrast */
    char country[3];            /*!< country used for dial tone frequency */
    struct ast_tone_zone *tz;          /*!< Tone zone for res_indications (ring, busy, congestion) */
    signed char ringvolume;         /*!< Ring volume */
    signed char ringstyle;           /*!< Ring melody */
    signed char cwvolume;           /*!< Ring volume on call waiting */
    signed char cwstyle;             /*!< Ring melody on call waiting */
    int interdigit_timer;       /*!< Interdigit timer for dialing number by timeout */
    int dtmfduration;       /*!< DTMF playback duration */
    time_t nextdial;        /*!< Timer used for dial by timeout */
    int rtp_port;              /*!< RTP port used by the phone */
    int rtp_method;          /*!< Select the unistim data used to establish a RTP session */
    int status_method;            /*!< Select the unistim packet used for sending status text */
    char codec_number;            /*!< The current codec used to make calls */
    int missed_call;            /*!< Number of call unanswered */
    int callhistory;            /*!< Allowed to record call history */
        int sharp_dial;             /*!< Execute Dial on '#' or not */
    char lst_cid[TEXT_LENGTH_MAX];  /*!< Last callerID received */
    char lst_cnm[TEXT_LENGTH_MAX];  /*!< Last callername recevied */
    char call_forward[AST_MAX_EXTENSION];   /*!< Forward number */
    int output;                  /*!< Handset, headphone or speaker */
    int previous_output;        /*!< Previous output */
    int volume;                  /*!< Default volume */
    int selected;                           /*!< softkey selected */
    int microphone;             /*!< Microphone mode (audio tx) */
    int lastmsgssent;                                                   /*! Used by MWI */
    time_t nextmsgcheck;                                            /*! Used by MWI */
    int nat;                    /*!< Used by the obscure ast_rtp_setnat */
    enum autoprov_extn extension;   /*!< See ifdef EXTENSION for valid values */
    char extension_number[11];      /*!< Extension number entered by the user */
    signed char to_delete;           /*!< Used in reload */
    struct ast_silence_generator *silence_generator;
    AST_LIST_HEAD(,unistim_subchannel) subs; /*!< pointer to our current connection, channel... */
    AST_LIST_HEAD(,unistim_line) lines;
    struct ast_ha *ha;
    struct unistimsession *session;
    struct unistim_device *next;
} *devices = NULL;
 
static struct unistimsession {
    ast_mutex_t lock;
    struct sockaddr_in sin;  /*!< IP address of the phone */
    struct sockaddr_in sout;    /*!< IP address of server */
    int timeout;                /*!< time-out in ticks : resend packet if no ack was received before the timeout occured */
    unsigned short seq_phone;       /*!< sequence number for the next packet (when we receive a request) */
    unsigned short seq_server;      /*!< sequence number for the next packet (when we send a request) */
    unsigned short last_seq_ack;    /*!< sequence number of the last ACK received */
    unsigned long tick_next_ping;   /*!< time for the next ping */
    int last_buf_available;  /*!< number of a free slot */
    int nb_retransmit;            /*!< number of retransmission */
    int state;                    /*!< state of the phone (see phone_state) */
    int size_buff_entry;        /*!< size of the buffer used to enter datas */
    char buff_entry[16];        /*!< Buffer for temporary datas */
    char macaddr[18];              /*!< mac address of the phone (not always available) */
    char firmware[8];              /*!< firmware of the phone (not always available) */
    struct wsabuf wsabufsend[MAX_BUF_NUMBER];      /*!< Size of each paquet stored in the buffer array & pointer to this buffer */
    unsigned char buf[MAX_BUF_NUMBER][MAX_BUF_SIZE];    /*!< Buffer array used to keep the lastest non-acked paquets */
    struct unistim_device *device;
    struct unistimsession *next;
} *sessions = NULL;
 
/*! Store on screen phone menu item (label and handler function) */
struct unistim_menu_item {
    char *label;
    int state;
    void (*handle_option)(struct unistimsession *);
};
 
/*! Language item for currently existed translations */
struct unistim_languages {
    char *label;
    char *lang_short;
    int encoding;
    struct ao2_container *trans;
};
 
/*!
 * \page Unistim datagram formats
 *
 * Format of datagrams :
 * bytes 0 & 1 : ffff for discovery packet, 0000 for everything else
 * byte 2 : sequence number (high part)
 * byte 3 : sequence number (low part)
 * byte 4 : 2 = ask question or send info, 1 = answer or ACK, 0 = retransmit request
 * byte 5 : direction, 1 = server to phone, 2 = phone to server arguments
 */
 
static const unsigned char packet_rcv_discovery[] =
    { 0xff, 0xff, 0xff, 0xff, 0x02, 0x02, 0xff, 0xff, 0xff, 0xff, 0x9e, 0x03, 0x08 };
static const unsigned char packet_send_discovery_ack[] =
    { 0x00, 0x00, /*Initial Seq (2 bytes) */ 0x00, 0x00, 0x00, 0x01 };
 
static const unsigned char packet_recv_firm_version[] =
    { 0x00, 0x00, 0x00, 0x13, 0x9a, 0x0a, 0x02 };
static const unsigned char packet_recv_it_type[] =
    { 0x00, 0x00, 0x00, 0x13, 0x9a, 0x04, 0x03 };
static const unsigned char packet_recv_pressed_key[] =
    { 0x00, 0x00, 0x00, 0x13, 0x99, 0x04, 0x00 };
static const unsigned char packet_recv_pick_up[] =
    { 0x00, 0x00, 0x00, 0x13, 0x99, 0x03, 0x04 };
static const unsigned char packet_recv_hangup[] =
    { 0x00, 0x00, 0x00, 0x13, 0x99, 0x03, 0x03 };
static const unsigned char packet_recv_r2[] = { 0x00, 0x00, 0x00, 0x13, 0x96, 0x03, 0x03 };
 
/*! Expansion module (i2004 KEM) */
static const unsigned char packet_recv_expansion_pressed_key[] =
    { 0x00, 0x00, 0x00, 0x13, 0x89, 0x04, 0x59 };
static const unsigned char packet_send_expansion_next[] = { 0x09, 0x03, 0x17 };
static const unsigned char packet_send_expansion_icon[] = { 0x09, 0x06, 0x59, 0x05, /*pos */ 0x47, /*icon */ 0x20 };      /* display an icon in front of the text zone */
static const unsigned char packet_send_expansion_text[] = { 0x09, 0x0f, 0x57, 0x19, /*pos */ 0x47, /*text */ 0x20,
    0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20 /*end_text */ };
 
 
/*! TransportAdapter */
static const unsigned char packet_recv_resume_connection_with_server[] =
    { 0xff, 0xff, 0xff, 0xff, 0x9e, 0x03, 0x08 };
static const unsigned char packet_recv_mac_addr[] =
    { 0xff, 0xff, 0xff, 0xff, 0x9a, 0x0d, 0x07 /*MacAddr */  };
 
static const unsigned char packet_send_date_time3[] =
    { 0x11, 0x09, 0x02, 0x02, /*Month */ 0x05, /*Day */ 0x06, /*Hour */ 0x07,
/*Minutes */ 0x08, 0x32
};
static const unsigned char packet_send_date_time[] =
    { 0x11, 0x09, 0x02, 0x0a, /*Month */ 0x05, /*Day */ 0x06, /*Hour */ 0x07, /*Minutes */
0x08, 0x32, 0x17, 0x04, 0x24, 0x07, 0x19,
    0x04, 0x07, 0x00, 0x19, 0x05, 0x09, 0x3e, 0x0f, 0x16, 0x05, 0x00, 0x80, 0x00, 0x1e,
        0x05, 0x12, 0x00, 0x78
};
 
static const unsigned char packet_send_no_ring[] =
    { 0x16, 0x04, 0x1a, 0x00, 0x16, 0x04, 0x11, 0x00 };
static const unsigned char packet_send_s4[] =
    { 0x16, 0x04, 0x1a, 0x00, 0x16, 0x04, 0x11, 0x00, 0x16, 0x06, 0x32, 0xdf, 0x00, 0xff,
0x16, 0x05, 0x1c, 0x00, 0x00, 0x17, 0x05,
    0x0b, 0x00, 0x00, 0x19, 0x04, 0x00, 0x00, 0x19, 0x04, 0x00, 0x08, 0x19, 0x04, 0x00,
        0x10, 0x19, 0x04, 0x00, 0x18, 0x16, 0x05,
    0x31, 0x00, 0x00, 0x16, 0x05, 0x04, 0x00, 0x00
};
static const unsigned char packet_send_call[] =
    { 0x16, 0x04, 0x1a, 0x00, 0x16, 0x04, 0x11, 0x00, 0x16, 0x06, 0x32, 0xdf,
    0x00, 0xff, 0x16, 0x05, 0x1c, 0x00, 0x00, 0x16, 0x0a, 0x38, 0x00, 0x12, 0xca, 0x03,
        0xc0, 0xc3, 0xc5, 0x16, 0x16, 0x30, 0x00,
    0x00, /*codec */ 0x12, 0x12, /* frames per packet */ 0x01, 0x5c, 0x00, /*port RTP */
        0x0f, 0xa0, /* port RTCP */ 0x9c, 0x41,
    /*port RTP */ 0x0f, 0xa0, /* port RTCP */ 0x9c, 0x41, /* IP Address */ 0x0a, 0x01,
        0x16, 0x66
};
static const unsigned char packet_send_stream_based_tone_off[] =
    { 0x16, 0x05, 0x1c, 0x00, 0x00 };
 
static const unsigned char packet_send_mute[] = { 0x16, 0x05, 0x04, 0x00, 0x00 };
#ifdef NOT_USED
static const unsigned char packet_send_CloseAudioStreamRX[] = { 0x16, 0x05, 0x31, 0x00, 0xff };
static const unsigned char packet_send_CloseAudioStreamTX[] = { 0x16, 0x05, 0x31, 0xff, 0x00 };
#endif
static const unsigned char packet_send_stream_based_tone_on[] =
    { 0x16, 0x06, 0x1b, 0x00, 0x00, 0x05 };
static const unsigned char packet_send_stream_based_tone_single_freq[] =
    { 0x16, 0x06, 0x1d, 0x00, 0x01, 0xb8 };
static const unsigned char packet_send_stream_based_tone_dual_freq[] =
    { 0x16, 0x08, 0x1d, 0x00, 0x01, 0xb8, 0x01, 0x5e };
static const unsigned char packet_send_select_output[] =
    { 0x16, 0x06, 0x32, 0xc0, 0x01, 0x00 };
 
static const unsigned char packet_send_ring[] =
    { 0x16, 0x06, 0x32, 0xdf, 0x00, 0xff, 0x16, 0x05, 0x1c, 0x00, 0x00, 0x16,
    0x04, 0x1a, 0x01, 0x16, 0x05, 0x12, 0x13 /* Ring type 10 to 17 */ , 0x18, 0x16, 0x04, 0x18,     /* volume 00, 10, 20... */
    0x20, 0x16, 0x04, 0x10, 0x00
};
//static const unsigned char packet_send_end_call[] =
//  { 0x16, 0x06, 0x32, 0xdf, 0x00, 0xff, 0x16, 0x05, 0x31, 0x00, 0x00, /* Headset LED off */ 0x19, 0x04, 0x00,
//0x10, /* Mute LED off */ 0x19, 0x04, 0x00, 0x18,/* Stream unmute */ 0x16, 0x05, 0x04, 0x00, 0x00, /* Query RTCP */ 0x16, 0x04, 0x37, 0x10 };
static const unsigned char packet_send_end_call[] =
    { 0x16, 0x06, 0x32, 0xdf, 0x00, 0xff, 0x16, 0x05, 0x31, 0x00, 0x00, /* Query RTCP */ 0x16, 0x04, 0x37, 0x10 };
static const unsigned char packet_send_s9[] =
    { 0x16, 0x06, 0x32, 0xdf, 0x00, 0xff, 0x19, 0x04, 0x00, 0x10, 0x16, 0x05, 0x1c, 0x00,
0x00 };
static const unsigned char packet_send_rtp_packet_size[] =
    { 0x16, 0x08, 0x38, 0x00, 0x00, 0xe0, 0x00, 0xa0 };
static const unsigned char packet_send_jitter_buffer_conf[] =
    { 0x16, 0x0e, 0x3a, 0x00, /* jitter */ 0x02, /* high water mark */ 0x04, 0x00, 0x00,
/* early packet resync 2 bytes */ 0x3e, 0x80,
    0x00, 0x00, /* late packet resync 2 bytes */ 0x3e, 0x80
};
 
/* Duration in ms div 2 (0x20 = 64ms, 0x08 = 16ms)
static unsigned char packet_send_StreamBasedToneCad[] =
  { 0x16, 0x0a, 0x1e, 0x00, duration on  0x0a, duration off  0x0d, duration on 0x0a, duration off 0x0d, duration on 0x0a, duration off 0x2b }; */
static const unsigned char packet_send_open_audio_stream_rx[] =
    { 0x16, 0x1a, 0x30, 0x00, 0xff, /* Codec */ 0x00, 0x00, 0x01, 0x00, 0xb8, 0xb8, 0x0e,
0x0e, 0x01, /* Port */ 0x14, 0x50, 0x00,
    0x00, /* Port */ 0x14, 0x50, 0x00, 0x00, /* Dest IP */ 0x0a, 0x93, 0x69, 0x05
};
static const unsigned char packet_send_open_audio_stream_tx[] =
    { 0x16, 0x1a, 0x30, 0xff, 0x00, 0x00, /* Codec */ 0x00, 0x01, 0x00, 0xb8, 0xb8, 0x0e,
0x0e, 0x01, /* Local port */ 0x14, 0x50,
    0x00, 0x00, /* Rmt Port */ 0x14, 0x50, 0x00, 0x00, /* Dest IP */ 0x0a, 0x93, 0x69, 0x05
};
 
static const unsigned char packet_send_open_audio_stream_rx3[] =
    { 0x16, 0x1a, 0x30, 0x00, 0xff, /* Codec */ 0x00, 0x00, 0x02, 0x01, 0xb8, 0xb8, 0x06,
0x06, 0x81, /* RTP Port */ 0x14, 0x50,
/* RTCP Port */ 0x14,
    0x51, /* RTP Port */ 0x14, 0x50, /* RTCP Port */ 0x00, 0x00, /* Dest IP */ 0x0a, 0x93,
        0x69, 0x05
};
static const unsigned char packet_send_open_audio_stream_tx3[] =
    { 0x16, 0x1a, 0x30, 0xff, 0x00, 0x00, /* Codec */ 0x00, 0x02, 0x01, 0xb8, 0xb8, 0x06,
0x06, 0x81, /* RTP Local port */ 0x14, 0x50,
    /* RTCP Port */ 0x00, 0x00, /* RTP Rmt Port */ 0x14, 0x50, /* RTCP Port */ 0x00, 0x00,
        /* Dest IP */ 0x0a, 0x93, 0x69, 0x05
};
 
static const unsigned char packet_send_arrow[] = { 0x17, 0x04, 0x04, 0x00 };
static const unsigned char packet_send_blink_cursor[] = { 0x17, 0x04, 0x10, 0x86 };
static const unsigned char packet_send_date_time2[] = { 0x17, 0x04, 0x17, 0x3d, 0x11, 0x09, 0x02, 0x0a, /*Month */ 0x05,   /*Day */
    0x06, /*Hour */ 0x07, /*Minutes */ 0x08, 0x32
};
static const unsigned char packet_send_Contrast[] =
    { 0x17, 0x04, 0x24, /*Contrast */ 0x08 };
static const unsigned char packet_send_start_timer[] =
    { 0x17, 0x05, 0x0b, /*Timer option*/0x05, /* Timer ID */0x00, 0x17, 0x08, 0x16,
    /* Text */ 'T', 'i', 'm', 'e', 'r' };
static const unsigned char packet_send_stop_timer[] = { 0x17, 0x05, 0x0b, 0x02, 0x00 };
static const unsigned char packet_send_icon[] = { 0x17, 0x05, 0x14, /*pos */ 0x00, /*icon */ 0x25 };      /* display an icon in front of the text zone */
static const unsigned char packet_send_S7[] = { 0x17, 0x06, 0x0f, 0x30, 0x07, 0x07 };
static const unsigned char packet_send_set_pos_cursor[] =
    { 0x17, 0x06, 0x10, 0x81, 0x04, /*pos */ 0x20 };
 
static unsigned char monthlabels[] =
    { 'J', 'a', 'n', 'F', 'e', 'b', 'M', 'a', 'r', 'A', 'p', 'r', 'M', 'a', 'y', 'J', 'u', 'n',
        'J', 'u', 'l', 'A', 'u', 'g', 'S', 'e', 'p', 'O', 'c', 't', 'N', 'o', 'v', 'D', 'e', 'c' };
static unsigned char packet_send_monthlabels_download[] =
  { 0x17, 0x0a, 0x15, /* Month (3 char) */ '-', '-', '-', '-', '-', '-', 0x20 };
static const unsigned char packet_send_favorite[] =
    { 0x17, 0x0f, 0x19, 0x10, /*pos */ 0x01, /*name */ 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
0x20, 0x20, 0x20, 0x20, /*end_name */ 0x19,
    0x05, 0x0f, /*pos */ 0x01, /*icone */ 0x00
};
static const unsigned char packet_send_title[] =
    { 0x17, 0x10, 0x19, 0x02, /*text */ 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
0x20, 0x20, 0x20, 0x20 /*end_text */  };
static const unsigned char packet_send_text[] =
    { 0x17, 0x1e, 0x1b, 0x04, /*pos */ 0x00, /*inverse */ 0x25, /*text */ 0x20, 0x20,
0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
    0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
        /*end_text */ 0x17, 0x04, 0x10, 0x87
};
static const unsigned char packet_send_status[] =
    { 0x17, 0x20, 0x19, 0x08, /*text */ 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
    0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20    /*end_text */
};
static const unsigned char packet_send_status2[] =
    { 0x17, 0x0b, 0x19, /* pos [08|28|48|68] */ 0x00, /* text */ 0x20, 0x20, 0x20, 0x20,
0x20, 0x20, 0x20 /* end_text */  };
 
/* Multiple character set support */
/* ISO-8859-1 - Western European) */
static const unsigned char packet_send_charset_iso_8859_1[] =
    { 0x17, 0x08, 0x21, 0x1b, 0x2d, 0x41, 0x1b, 0x00 };
/* ISO-8859-2 - Central European) */
static const unsigned char packet_send_charset_iso_8859_2[] =
    { 0x17, 0x08, 0x21, 0x1b, 0x2d, 0x42, 0x1b, 0x00 };
/* ISO-8859-4 - Baltic) */
static const unsigned char packet_send_charset_iso_8859_4[] =
    { 0x17, 0x08, 0x21, 0x1b, 0x2d, 0x44, 0x1b, 0x00 };
/* ISO 8859-5 - cyrillic */
static const unsigned char packet_send_charset_iso_8859_5[] =
    { 0x17, 0x08, 0x21, 0x1b, 0x2d, 0x4c, 0x1b, 0x00 };
/* Japanese (ISO-2022-JP ?) */
static const unsigned char packet_send_charset_iso_2022_jp[] =
    { 0x17, 0x08, 0x21, 0x1b, 0x29, 0x49, 0x1b, 0x7e };
 
static const unsigned char packet_send_led_update[] = { 0x19, 0x04, 0x00, 0x00 };
 
static const unsigned char packet_send_query_basic_manager_04[] = { 0x1a, 0x04, 0x01, 0x04 };
static const unsigned char packet_send_query_mac_address[] = { 0x1a, 0x04, 0x01, 0x08 };
static const unsigned char packet_send_query_basic_manager_10[] = { 0x1a, 0x04, 0x01, 0x10 };
static const unsigned char packet_send_S1[] = { 0x1a, 0x07, 0x07, 0x00, 0x00, 0x00, 0x13 };
 
static unsigned char packet_send_ping[] =
    { 0x1e, 0x05, 0x12, 0x00, /*Watchdog timer */ 0x78 };
 
#define BUFFSEND unsigned char buffsend[64] = { 0x00, 0x00, 0xaa, 0xbb, 0x02, 0x01 }
 
static const char tdesc[] = "UNISTIM Channel Driver";
static const char channel_type[] = "USTM";
 
/*! Protos */
static struct ast_channel *unistim_new(struct unistim_subchannel *sub, int state, const struct ast_assigned_ids *assignedids, const struct ast_channel *requestor);
static int load_module(void);
static int reload(void);
static int unload_module(void);
static int reload_config(void);
static void unistim_set_owner(struct unistim_subchannel *sub, struct ast_channel *chan);
static void show_main_page(struct unistimsession *pte);
static struct ast_channel *unistim_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 int unistim_call(struct ast_channel *ast, const char *dest, int timeout);
static int unistim_hangup(struct ast_channel *ast);
static int unistim_answer(struct ast_channel *ast);
static struct ast_frame *unistim_read(struct ast_channel *ast);
static int unistim_write(struct ast_channel *ast, struct ast_frame *frame);
static int unistim_indicate(struct ast_channel *ast, int ind, const void *data,
    size_t datalen);
static int unistim_fixup(struct ast_channel *oldchan, struct ast_channel *newchan);
static int unistim_senddigit_begin(struct ast_channel *ast, char digit);
static int unistim_senddigit_end(struct ast_channel *ast, char digit,
    unsigned int duration);
static int unistim_sendtext(struct ast_channel *ast, const char *text);
 
static int write_entry_history(struct unistimsession *pte, FILE * f, char c,
    char *line1);
static void change_callerid(struct unistimsession *pte, int type, char *callerid);
 
static struct ast_channel_tech unistim_tech = {
    .type = channel_type,
    .description = tdesc,
    .properties = AST_CHAN_TP_WANTSJITTER | AST_CHAN_TP_CREATESJITTER,
    .requester = unistim_request,
    .call = unistim_call,
    .hangup = unistim_hangup,
    .answer = unistim_answer,
    .read = unistim_read,
    .write = unistim_write,
    .indicate = unistim_indicate,
    .fixup = unistim_fixup,
    .send_digit_begin = unistim_senddigit_begin,
    .send_digit_end = unistim_senddigit_end,
    .send_text = unistim_sendtext,
};
 
static void send_start_rtp(struct unistim_subchannel *);
 
static void send_callerid_screen(struct unistimsession *, struct unistim_subchannel *);
static void key_favorite(struct unistimsession *, char);
 
static void handle_select_codec(struct unistimsession *);
static void handle_select_language(struct unistimsession *);
static int find_language(const char*);
 
static int unistim_free_sub(struct unistim_subchannel *);
 
static struct unistim_menu_item options_menu[] =
{
    {"Change codec", STATE_SELECTCODEC, handle_select_codec},
    {"Language", STATE_SELECTLANGUAGE, handle_select_language},
    {NULL, 0, NULL}
};
 
static struct unistim_languages options_languages[] =
{
    {"English", "en", ISO_8859_1, NULL},
    {"French", "fr", ISO_8859_1, NULL},
    {"Russian", "ru", ISO_8859_5, NULL},
    {NULL, NULL, 0, NULL}
};
 
static char ustm_strcopy[1024];
 
struct ustm_lang_entry {
    const char *str_orig;
    const char *str_trans;
};
 
static int lang_hash_fn(const void *obj, const int flags)
{
    const struct ustm_lang_entry *entry = obj;
    return ast_str_hash(entry->str_orig);
}
 
static int lang_cmp_fn(void *obj, void *arg, int flags)
{
    struct ustm_lang_entry *entry1 = obj;
    struct ustm_lang_entry *entry2 = arg;
 
    return (!strcmp(entry1->str_orig, entry2->str_orig)) ? (CMP_MATCH | CMP_STOP) : 0;
}
 
static const char *ustmtext(const char *str, struct unistimsession *pte)
{
    struct ustm_lang_entry *lang_entry;
    struct ustm_lang_entry le_search;
    struct unistim_languages *lang = NULL;
    int size;
 
    if (pte->device) {
        lang = &options_languages[find_language(pte->device->language)];
    }
    if (!lang) {
        return str;
    }
    /* Check if specified language exists */
    if (!lang->trans) {
        char tmp[1024], *p, *p_orig = NULL, *p_trans = NULL;
        FILE *f;
 
        lang->trans = ao2_container_alloc_hash(AO2_ALLOC_OPT_LOCK_MUTEX, 0, 8,
            lang_hash_fn, NULL, lang_cmp_fn);
        if (!lang->trans) {
            ast_log(LOG_ERROR, "Unable to allocate container for translation!\n");
            return str;
        }
        snprintf(tmp, sizeof(tmp), "%s/%s/%s.po", ast_config_AST_VAR_DIR,
             USTM_LANG_DIR, lang->lang_short);
        f = fopen(tmp, "r");
        if (!f) {
            ast_log(LOG_WARNING, "There is no translation file for '%s'\n", lang->lang_short);
            return str;
        }
        while (fgets(tmp, sizeof(tmp), f)) {
            if (!(p = strchr(tmp, '\n'))) {
                ast_log(LOG_ERROR, "Too long line found in language file - truncated!\n");
                continue;
            }
            *p = '\0';
            if (!(p = strchr(tmp, '"'))) {
                continue;
            }
            if (tmp == strstr(tmp, "msgid")) {
                p_orig = ast_strdup(p + 1);
                p = strchr(p_orig, '"');
            } else if (tmp == strstr(tmp, "msgstr")) {
                p_trans = ast_strdup(p + 1);
                p = strchr(p_trans, '"');
            } else {
                continue;
            }
            *p = '\0';
            if (!p_trans || !p_orig) {
                continue;
            }
            if (ast_strlen_zero(p_trans)) {
                ast_free(p_trans);
                ast_free(p_orig);
                p_trans = NULL;
                p_orig = NULL;
                continue;
            }
            if (!(lang_entry = ao2_alloc(sizeof(*lang_entry), NULL))) {
                fclose(f);
                return str;
            }
 
            lang_entry->str_trans = p_trans;
            lang_entry->str_orig = p_orig;
            ao2_link(lang->trans, lang_entry);
            p_trans = NULL;
            p_orig = NULL;
        }
 
        fclose(f);
    }
 
    le_search.str_orig = str;
    if ((lang_entry = ao2_find(lang->trans, &le_search, OBJ_POINTER))) {
        size = strlen(lang_entry->str_trans)+1;
            if (size > 1024) {
            size = 1024;
        }
        memcpy(ustm_strcopy, lang_entry->str_trans, size);
        ao2_ref(lang_entry, -1);
        return ustm_strcopy;
    }
 
    return str;
}
 
static void display_last_error(const char *sz_msg)
{
    /* Display the error message */
    ast_log(LOG_WARNING, "%s : (%d) %s\n", sz_msg, errno, strerror(errno));
}
 
static unsigned int get_tick_count(void)
{
    struct timeval now = ast_tvnow();
 
    return (now.tv_sec * 1000) + (now.tv_usec / 1000);
}
 
/* Send data to a phone without retransmit nor buffering */
static void send_raw_client(int size, const unsigned char *data, struct sockaddr_in *addr_to,
                const struct sockaddr_in *addr_ourip)
{
#ifdef HAVE_PKTINFO
    struct iovec msg_iov;
    struct msghdr msg;
    char buffer[CMSG_SPACE(sizeof(struct in_pktinfo))];
    struct cmsghdr *ip_msg = (struct cmsghdr *) buffer;
    struct in_pktinfo *pki = (struct in_pktinfo *) CMSG_DATA(ip_msg);
 
    /* cast this to a non-const pointer, since the sendmsg() API
     * does not provide read-only and write-only flavors of the
     * structures used for its arguments, but in this case we know
     * the data will not be modified
     */
    msg_iov.iov_base = (char *) data;
    msg_iov.iov_len = size;
 
    msg.msg_name = addr_to;  /* optional address */
    msg.msg_namelen = sizeof(struct sockaddr_in);   /* size of address */
    msg.msg_iov = &msg_iov;  /* scatter/gather array */
    msg.msg_iovlen = 1;          /* # elements in msg_iov */
    msg.msg_control = ip_msg;       /* ancillary data */
    msg.msg_controllen = sizeof(buffer);    /* ancillary data buffer len */
    msg.msg_flags = 0;            /* flags on received message */
 
    ip_msg->cmsg_len = CMSG_LEN(sizeof(*pki));
    ip_msg->cmsg_level = IPPROTO_IP;
    ip_msg->cmsg_type = IP_PKTINFO;
    pki->ipi_ifindex = 0;      /* Interface index, 0 = use interface specified in routing table */
    pki->ipi_spec_dst.s_addr = addr_ourip->sin_addr.s_addr; /* Local address */
    /* pki->ipi_addr = ;   Header Destination address - ignored by kernel */
 
#ifdef DUMP_PACKET
    if (unistimdebug) {
        int tmp;
        ast_verb(0, "\n**> From %s sending %d bytes to %s ***\n",
                    ast_inet_ntoa(addr_ourip->sin_addr), (int) size,
                    ast_inet_ntoa(addr_to->sin_addr));
        for (tmp = 0; tmp < size; tmp++)
            ast_verb(0, "%02hhx ", data[tmp]);
        ast_verb(0, "\n******************************************\n");
 
    }
#endif
 
    if (sendmsg(unistimsock, &msg, 0) == -1) {
        display_last_error("Error sending datas");
    }
#else
    if (sendto(unistimsock, data, size, 0, (struct sockaddr *) addr_to, sizeof(*addr_to))
        == -1)
        display_last_error("Error sending datas");
#endif
}
 
static void send_client(int size, const unsigned char *data, struct unistimsession *pte)
{
    unsigned int tick;
    int buf_pos;
    unsigned short seq = ntohs(++pte->seq_server);
 
    ast_mutex_lock(&pte->lock);
    buf_pos = pte->last_buf_available;
 
    if (buf_pos >= MAX_BUF_NUMBER) {
        ast_log(LOG_WARNING, "Error : send queue overflow\n");
        ast_mutex_unlock(&pte->lock);
        return;
    }
    memcpy((void *)data + sizeof(unsigned short), (void *)&seq, sizeof(unsigned short));
    pte->wsabufsend[buf_pos].len = size;
    memcpy(pte->wsabufsend[buf_pos].buf, data, size);
 
    tick = get_tick_count();
    pte->timeout = tick + RETRANSMIT_TIMER;
 
/*#ifdef DUMP_PACKET */
    if (unistimdebug) {
        ast_verb(0, "Sending datas with seq #0x%04x Using slot #%d :\n", (unsigned)pte->seq_server, buf_pos);
    }
/*#endif */
    send_raw_client(pte->wsabufsend[buf_pos].len, pte->wsabufsend[buf_pos].buf, &(pte->sin),
                  &(pte->sout));
    pte->last_buf_available++;
    ast_mutex_unlock(&pte->lock);
}
 
static void send_ping(struct unistimsession *pte)
{
    BUFFSEND;
    if (unistimdebug) {
        ast_verb(0, "Sending ping\n");
    }
    pte->tick_next_ping = get_tick_count() + unistim_keepalive;
    memcpy(buffsend + SIZE_HEADER, packet_send_ping, sizeof(packet_send_ping));
    send_client(SIZE_HEADER + sizeof(packet_send_ping), buffsend, pte);
}
 
static int get_to_address(int fd, struct sockaddr_in *toAddr)
{
#ifdef HAVE_PKTINFO
    int err;
    char cmbuf[0x100];
    struct cmsghdr *cmsg;
    struct sockaddr_in peeraddr;
    struct in_addr addr;
    struct msghdr mh = {
        .msg_name = &peeraddr,
        .msg_namelen = sizeof(peeraddr),
        .msg_control = cmbuf,
        .msg_controllen = sizeof(cmbuf),
    };
    memset(&addr, 0, sizeof(addr));
    /* Get info about the incoming packet */
    err = recvmsg(fd, &mh, MSG_PEEK);
    if (err == -1) {
        ast_log(LOG_WARNING, "recvmsg returned an error: %s\n", strerror(errno));
        return err;
    }
    for(cmsg = CMSG_FIRSTHDR(&mh);
        cmsg != NULL;
        cmsg = CMSG_NXTHDR(&mh, cmsg))
    {
         if (cmsg->cmsg_level == IPPROTO_IP && cmsg->cmsg_type == IP_PKTINFO) {
            struct in_pktinfo *pkt = (struct in_pktinfo*)CMSG_DATA(cmsg);
            addr = pkt->ipi_addr;
            if (unistimdebug) {
                ast_verb(0, "message received on address %s\n", ast_inet_ntoa(addr));
            }
        }
    }
    memcpy(&toAddr->sin_addr, &addr, sizeof(struct in_addr));
    return err;
#else
    memcpy(toAddr, &public_ip, sizeof(*toAddr));
    return 0;
#endif
}
 
 
/* Allocate memory & initialize structures for a new phone */
/* addr_from : ip address of the phone */
static struct unistimsession *create_client(const struct sockaddr_in *addr_from)
{
    int tmp;
    struct unistimsession *s;
 
    if (!(s = ast_calloc(1, sizeof(*s))))
        return NULL;
 
    memcpy(&s->sin, addr_from, sizeof(struct sockaddr_in));
    if (get_to_address(unistimsock, &s->sout) < 0) {
        ast_free(s);
        return NULL;
    }
    s->sout.sin_family = AF_INET;
    if (unistimdebug) {
        ast_verb(0, "Creating a new entry for the phone from %s received via server ip %s\n",
             ast_inet_ntoa(addr_from->sin_addr), ast_inet_ntoa(s->sout.sin_addr));
    }
    ast_mutex_init(&s->lock);
    ast_mutex_lock(&sessionlock);
    s->next = sessions;
    sessions = s;
 
    s->timeout = get_tick_count() + RETRANSMIT_TIMER;
    s->state = STATE_INIT;
    s->tick_next_ping = get_tick_count() + unistim_keepalive;
    /* Initialize struct wsabuf  */
    for (tmp = 0; tmp < MAX_BUF_NUMBER; tmp++) {
        s->wsabufsend[tmp].buf = s->buf[tmp];
    }
    ast_mutex_unlock(&sessionlock);
    return s;
}
 
static void send_end_call(struct unistimsession *pte)
{
    BUFFSEND;
    if (unistimdebug) {
        ast_verb(0, "Sending end call\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_end_call, sizeof(packet_send_end_call));
    send_client(SIZE_HEADER + sizeof(packet_send_end_call), buffsend, pte);
}
 
static void set_ping_timer(struct unistimsession *pte)
{
    unsigned int tick = 0;  /* XXX what is this for, anyways */
 
    pte->timeout = pte->tick_next_ping;
    DEBUG_TIMER("tick = %u next ping at %u tick\n", tick, pte->timeout);
    return;
}
 
/* Checking if our send queue is empty,
 * if true, setting up a timer for keepalive */
static void check_send_queue(struct unistimsession *pte)
{
    /* Check if our send queue contained only one element */
    if (pte->last_buf_available == 1) {
        if (unistimdebug) {
            ast_verb(0, "Our single packet was ACKed.\n");
        }
        pte->last_buf_available--;
        set_ping_timer(pte);
        return;
    }
    /* Check if this ACK catch up our latest packet */
    else if (pte->last_seq_ack + 1 == pte->seq_server + 1) {
        if (unistimdebug) {
            ast_verb(0, "Our send queue is completely ACKed.\n");
        }
        pte->last_buf_available = 0;    /* Purge the send queue */
        set_ping_timer(pte);
        return;
    }
    if (unistimdebug) {
        ast_verb(0, "We still have packets in our send queue\n");
    }
    return;
}
 
static void send_start_timer(struct unistimsession *pte)
{
    BUFFSEND;
    if (unistimdebug) {
        ast_verb(0, "Sending start timer\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_start_timer, sizeof(packet_send_start_timer));
    send_client(SIZE_HEADER + sizeof(packet_send_start_timer), buffsend, pte);
}
 
static void send_stop_timer(struct unistimsession *pte)
{
    BUFFSEND;
    if (unistimdebug) {
        ast_verb(0, "Sending stop timer\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_stop_timer, sizeof(packet_send_stop_timer));
    send_client(SIZE_HEADER + sizeof(packet_send_stop_timer), buffsend, pte);
}
 
static void send_icon(unsigned char pos, unsigned char status, struct unistimsession *pte)
{
    BUFFSEND;
    if (unistimdebug) {
        ast_verb(0, "Sending icon pos %d with status 0x%02hhx\n", pos, status);
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_icon, sizeof(packet_send_icon));
    buffsend[9] = pos;
    buffsend[10] = status;
    send_client(SIZE_HEADER + sizeof(packet_send_icon), buffsend, pte);
}
 
static void send_expansion_next(struct unistimsession *pte)
{
    BUFFSEND;
    memcpy(buffsend + SIZE_HEADER, packet_send_expansion_next, sizeof(packet_send_expansion_next));
    send_client(SIZE_HEADER + sizeof(packet_send_expansion_next), buffsend, pte);
}
 
 
static void send_expansion_icon(unsigned char pos, unsigned char status, struct unistimsession *pte)
{
    BUFFSEND;
    if (unistimdebug) {
        ast_verb(0, "Sending expansion icon pos %d with status 0x%02hhx\n", pos, status);
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_expansion_icon, sizeof(packet_send_expansion_icon));
    buffsend[10] = pos;
    buffsend[11] = status;
    send_client(SIZE_HEADER + sizeof(packet_send_expansion_icon), buffsend, pte);
}
 
/* inverse : TEXT_INVERSE : yes, TEXT_NORMAL  : no */
static void send_expansion_text(unsigned char pos, struct unistimsession *pte, const char *text)
{
    int i;
    BUFFSEND;
    if (!text) {
        ast_log(LOG_ERROR, "[expansion] Asked to display NULL text (pos %d)\n", pos);
        return;
    }
    if (unistimdebug) {
        ast_verb(0, "[expansion] Sending text at pos %d\n", pos);
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_expansion_text, sizeof(packet_send_expansion_text));
    buffsend[10] = pos;
    i = strlen(text);
    if (i > TEXT_LENGTH_MAX) {
        i = TEXT_LENGTH_MAX;
    }
    memcpy(buffsend + 11, text, i);
    send_client(SIZE_HEADER + sizeof(packet_send_expansion_text), buffsend, pte);
}
 
static void send_tone(struct unistimsession *pte, uint16_t tone1, uint16_t tone2)
{
    BUFFSEND;
    if (!tone1) {
        if (unistimdebug) {
            ast_verb(0, "Sending Stream Based Tone Off\n");
        }
        memcpy(buffsend + SIZE_HEADER, packet_send_stream_based_tone_off,
               sizeof(packet_send_stream_based_tone_off));
        send_client(SIZE_HEADER + sizeof(packet_send_stream_based_tone_off), buffsend, pte);
        return;
    }
    /* Since most of the world use a continuous tone, it's useless
       if (unistimdebug)
       ast_verb(0, "Sending Stream Based Tone Cadence Download\n");
       memcpy (buffsend + SIZE_HEADER, packet_send_StreamBasedToneCad, sizeof (packet_send_StreamBasedToneCad));
       send_client (SIZE_HEADER + sizeof (packet_send_StreamBasedToneCad), buffsend, pte); */
    if (unistimdebug) {
        ast_verb(0, "Sending Stream Based Tone Frequency Component List Download %d %d\n", tone1, tone2);
    }
    tone1 *= 8;
    if (!tone2) {
        memcpy(buffsend + SIZE_HEADER, packet_send_stream_based_tone_single_freq,
               sizeof(packet_send_stream_based_tone_single_freq));
        put_unaligned_uint16(&buffsend[10], htons(tone1));
        send_client(SIZE_HEADER + sizeof(packet_send_stream_based_tone_single_freq), buffsend,
                   pte);
    } else {
        tone2 *= 8;
        memcpy(buffsend + SIZE_HEADER, packet_send_stream_based_tone_dual_freq,
               sizeof(packet_send_stream_based_tone_dual_freq));
        put_unaligned_uint16(&buffsend[10], htons(tone1));
        put_unaligned_uint16(&buffsend[12], htons(tone2));
        send_client(SIZE_HEADER + sizeof(packet_send_stream_based_tone_dual_freq), buffsend,
                   pte);
    }
 
    if (unistimdebug) {
        ast_verb(0, "Sending Stream Based Tone On\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_stream_based_tone_on,
           sizeof(packet_send_stream_based_tone_on));
    send_client(SIZE_HEADER + sizeof(packet_send_stream_based_tone_on), buffsend, pte);
}
 
/* Positions for favorites
 |--------------------|
 |  5            2    | <-- not on screen in i2002
 |  4            1    |
 |  3            0    |
 
 
 KEM Positions
 
 |--------------------|
 |  12           24   |
 |  11           23   |
 |  10           22   |
 |  9            21   |
 |  8            20   |
 |  7            19   |
 |  6            18   |
 |  5            17   |
 |  4            16   |
 |  3            15   |
 |  2            14   |
 |  1            13   |
 
*/
 
/* status (icons) : 00 = nothing, 2x/3x = see parser.h, 4x/5x = blink fast, 6x/7x = blink slow */
static void
send_favorite(unsigned char pos, unsigned char status, struct unistimsession *pte,
             const char *text)
{
    BUFFSEND;
    int i;
 
    if (unistimdebug) {
        ast_verb(0, "Sending favorite pos %d with status 0x%02hhx\n", pos, status);
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_favorite, sizeof(packet_send_favorite));
    buffsend[10] = pos;
    buffsend[24] = pos;
    buffsend[25] = status;
    i = strlen(ustmtext(text, pte));
    if (i > FAV_MAX_LENGTH) {
        i = FAV_MAX_LENGTH;
    }
    memcpy(buffsend + FAV_MAX_LENGTH + 1, ustmtext(text, pte), i);
    send_client(SIZE_HEADER + sizeof(packet_send_favorite), buffsend, pte);
}
 
static void send_favorite_short(unsigned char pos, unsigned char status, struct unistimsession *pte) {
    send_favorite(pos, status, pte, pte->device->softkeylabel[pos]);
    return;
}
 
static void send_favorite_selected(unsigned char status, struct unistimsession *pte) {
    if (pte->device->selected != -1) {
        send_favorite(pte->device->selected, status, pte, pte->device->softkeylabel[pte->device->selected]);
    }
    return;
}
 
static void send_expansion_short(unsigned char pos, unsigned char status, struct unistimsession *pte) {
    send_expansion_icon(pos, status, pte);
    send_expansion_text(pos, pte, ustmtext(pte->device->expsoftkeylabel[pos], pte));
    send_expansion_next(pte);
    return;
}
 
static int soft_key_visible(struct unistim_device* d, unsigned char num)
{
    if(d->height == 1 && num % 3 == 2) {
        return 0;
    }
    return 1;
}
 
static void refresh_all_favorite(struct unistimsession *pte)
{
    unsigned char i = 0;
    char data[256];
    struct unistim_line *line;
    line = AST_LIST_FIRST(&pte->device->lines);
 
    if (unistimdebug) {
        ast_verb(0, "Refreshing all favorite\n");
    }
    for (i = 0; i < FAVNUM; i++) {
        unsigned char status = pte->device->softkeyicon[i];
 
        if (!soft_key_visible(pte->device, i)) {
            continue;
        }
        if (!strcasecmp(pte->device->softkeylabel[i], "DND") && line) {
            if (!ast_db_get("DND", line->name, data, sizeof(data))) {
                status = FAV_ICON_SPEAKER_ONHOOK_WHITE;
            }
        }
 
        send_favorite_short(i, status, pte);
    }
    if (pte->device->hasexp) {
        for (i = 0; i < EXPNUM; i++) {
            send_expansion_short(i, FAV_ICON_NONE, pte);
        }
    }
}
 
static int is_key_favorite(struct unistim_device *d, int fav)
{
    if ((fav < 0) || (fav >= FAVNUM)) {
        return 0;
    }
    if (d->sline[fav]) {
        return 0;
    }
    if (d->softkeynumber[fav][0] == '\0') {
        return 0;
    }
    return 1;
}
 
static int is_key_line(struct unistim_device *d, int fav)
{
    if ((fav < 0) || (fav >= FAVNUM)) {
        return 0;
    }
    if (!d->sline[fav]) {
        return 0;
    }
    if (is_key_favorite(d, fav)) {
        return 0;
    }
    return 1;
}
 
static int get_active_softkey(struct unistimsession *pte)
{
    return pte->device->selected;
}
 
static int get_avail_softkey(struct unistimsession *pte, const char* name)
{
    int i;
 
    if (!is_key_line(pte->device, pte->device->selected)) {
        pte->device->selected = -1;
    }
    for (i = 0; i < FAVNUM; i++) {
        if (pte->device->selected != -1 && pte->device->selected != i) {
            continue;
        }
        if (!soft_key_visible(pte->device, i)) {
            continue;
        }
        if (pte->device->ssub[i]) {
            continue;
        }
        if (is_key_line(pte->device, i)) {
            if (name && strcmp(name, pte->device->sline[i]->name)) {
                continue;
            }
            if (unistimdebug) {
                ast_verb(0, "Found softkey %d for device %s\n", i, name);
            }
            return i;
        }
    }
    return -1;
}
 
 
/* Change the status for this phone (pte) and update for each phones where pte is bookmarked
 * use FAV_ICON_*_BLACK constant in status parameters */
static void change_favorite_icon(struct unistimsession *pte, unsigned char status)
{
    struct unistim_device *d = devices;
    int i;
    /* Update the current phone line softkey icon */
    if (pte->state != STATE_CLEANING) {
        int softkeylinepos = get_active_softkey(pte);
        if (softkeylinepos != -1) {
            send_favorite_short(softkeylinepos, status, pte);
        }
    }
    /* Notify other phones if we're in their bookmark */
    while (d) {
        for (i = 0; i < FAVNUM; i++) {
            if (d->sp[i] == pte->device) {  /* It's us ? */
                if (d->softkeyicon[i] != status) {      /* Avoid resending the same icon */
                    d->softkeyicon[i] = status;
                    if (d->session) {
                        send_favorite(i, status + 1, d->session, d->softkeylabel[i]);
                    }
                }
            }
        }
        d = d->next;
    }
}
 
static int register_extension(const struct unistimsession *pte)
{
    struct unistim_line *line;
    line = AST_LIST_FIRST(&pte->device->lines);
    if (unistimdebug) {
        ast_verb(0, "Trying to register extension '%s' into context '%s' to %s\n",
                    pte->device->extension_number, pte->device->context,
                    line->fullname);
    }
    return ast_add_extension(pte->device->context, 0,
                             pte->device->extension_number, 1, NULL, NULL, "Dial",
                             line->fullname, 0, "Unistim");
}
 
static int unregister_extension(const struct unistimsession *pte)
{
    if (unistimdebug) {
        ast_verb(0, "Trying to unregister extension '%s' context '%s'\n",
                    pte->device->extension_number, pte->device->context);
    }
    return ast_context_remove_extension(pte->device->context,
                                        pte->device->extension_number, 1, "Unistim");
}
 
/* Free memory allocated for a phone */
static void close_client(struct unistimsession *s)
{
    struct unistim_subchannel *sub = NULL;
    struct unistimsession *cur, *prev = NULL;
    ast_mutex_lock(&sessionlock);
    cur = sessions;
    /* Looking for the session in the linked chain */
    while (cur) {
        if (cur == s) {
            break;
        }
        prev = cur;
        cur = cur->next;
    }
    if (cur) {                    /* Session found ? */
        if (cur->device) {        /* This session was registered ? */
            s->state = STATE_CLEANING;
            if (unistimdebug) {
                ast_verb(0, "close_client session %p device %p\n", s, s->device);
            }
            change_favorite_icon(s, FAV_ICON_NONE);
            ast_mutex_lock(&s->device->lock);
            AST_LIST_LOCK(&s->device->subs);
            AST_LIST_TRAVERSE_SAFE_BEGIN(&s->device->subs, sub, list) {
                if (!sub) {
                    continue;
                }
                if (sub->owner) {       /* Call in progress ? */
                    if (unistimdebug) {
                        ast_verb(0, "Aborting call\n");
                    }
                    ast_queue_hangup_with_cause(sub->owner, AST_CAUSE_NETWORK_OUT_OF_ORDER);
                } else {
                    if (unistimdebug) {
                        ast_debug(1, "Released sub %u of channel %s@%s\n", sub->subtype, sub->parent->name, s->device->name);
                    }
                    AST_LIST_REMOVE_CURRENT(list);
                    unistim_free_sub(sub);
                }
            }
            AST_LIST_TRAVERSE_SAFE_END;
            AST_LIST_UNLOCK(&s->device->subs);
 
            if (!ast_strlen_zero(s->device->extension_number)) {
                unregister_extension(s);
            }
            cur->device->session = NULL;
            ast_mutex_unlock(&s->device->lock);
        } else {
            if (unistimdebug) {
                ast_verb(0, "Freeing an unregistered client\n");
            }
        }
        if (prev) {
            prev->next = cur->next;
        } else {
            sessions = cur->next;
        }
        ast_mutex_destroy(&s->lock);
        ast_free(s);
    } else {
        ast_log(LOG_WARNING, "Trying to delete non-existent session %p?\n", s);
    }
    ast_mutex_unlock(&sessionlock);
    return;
}
 
/* Return 1 if the session chained link was modified */
static int send_retransmit(struct unistimsession *pte)
{
    int i;
 
    ast_mutex_lock(&pte->lock);
    if (++pte->nb_retransmit >= NB_MAX_RETRANSMIT) {
        if (unistimdebug) {
            ast_verb(0, "Too many retransmit - freeing client\n");
        }
        ast_mutex_unlock(&pte->lock);
        close_client(pte);
        return 1;
    }
    pte->timeout = get_tick_count() + RETRANSMIT_TIMER;
 
    for (i = pte->last_buf_available - (pte->seq_server - pte->last_seq_ack);
         i < pte->last_buf_available; i++) {
        if (i < 0) {
            ast_log(LOG_WARNING,
                    "Asked to retransmit an ACKed slot ! last_buf_available=%d, seq_server = #0x%04x last_seq_ack = #0x%04x\n",
                    pte->last_buf_available, (unsigned)pte->seq_server, (unsigned)pte->last_seq_ack);
            continue;
        }
 
        if (unistimdebug) {
            unsigned short *sbuf = (unsigned short *) pte->wsabufsend[i].buf;
            unsigned short seq;
 
            seq = ntohs(sbuf[1]);
            ast_verb(0, "Retransmit slot #%d (seq=#0x%04x), last ack was #0x%04x\n", i,
                        (unsigned)seq, (unsigned)pte->last_seq_ack);
        }
        send_raw_client(pte->wsabufsend[i].len, pte->wsabufsend[i].buf, &pte->sin,
                      &pte->sout);
    }
    ast_mutex_unlock(&pte->lock);
    return 0;
}
 
/* inverse : TEXT_INVERSE : yes, TEXT_NORMAL  : no */
static void send_text(unsigned char pos, unsigned char inverse, struct unistimsession *pte,
         const char *text)
{
    int i;
    BUFFSEND;
    if (!text) {
        ast_log(LOG_ERROR, "Asked to display NULL text (pos %d, inverse flag %d)\n", pos, inverse);
        return;
    }
    if (pte->device && pte->device->height == 1 && pos != TEXT_LINE0) {
        return;
    }
    if (unistimdebug) {
        ast_verb(0, "Sending text at pos %d, inverse flag %d\n", pos, inverse);
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_text, sizeof(packet_send_text));
    buffsend[10] = pos;
    buffsend[11] = inverse;
    i = strlen(text);
    if (i > TEXT_LENGTH_MAX) {
        i = TEXT_LENGTH_MAX;
    }
    memcpy(buffsend + 12, text, i);
    send_client(SIZE_HEADER + sizeof(packet_send_text), buffsend, pte);
}
 
static void send_text_status(struct unistimsession *pte, const char *text)
{
    BUFFSEND;
    int i;
    if (unistimdebug) {
        ast_verb(0, "Sending status text\n");
    }
    if (pte->device) {
        if (pte->device->status_method == 1) {  /* For new firmware and i2050 soft phone */
            int n = strlen(text);
            /* Must send individual button separately */
            int j;
            for (i = 0, j = 0; i < 4; i++, j += 7) {
                int pos = 0x08 + (i * 0x20);
                memcpy(buffsend + SIZE_HEADER, packet_send_status2,
                       sizeof(packet_send_status2));
 
                buffsend[9] = pos;
                memcpy(buffsend + 10, (j < n) ? (text + j) : "       ", 7);
                send_client(SIZE_HEADER + sizeof(packet_send_status2), buffsend, pte);
            }
            return;
        }
    }
 
    memcpy(buffsend + SIZE_HEADER, packet_send_status, sizeof(packet_send_status));
    i = strlen(text);
    if (i > STATUS_LENGTH_MAX) {
        i = STATUS_LENGTH_MAX;
    }
    memcpy(buffsend + 10, text, i);
    send_client(SIZE_HEADER + sizeof(packet_send_status), buffsend, pte);
 
}
 
static void send_led_update(struct unistimsession *pte, unsigned char led)
{
    BUFFSEND;
    if (unistimdebug) {
        ast_verb(0, "Sending led_update (%x)\n", (unsigned)led);
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_led_update, sizeof(packet_send_led_update));
    buffsend[9] = led;
    send_client(SIZE_HEADER + sizeof(packet_send_led_update), buffsend, pte);
}
 
static void send_mute(struct unistimsession *pte, unsigned char mute)
{
/*
    0x00 = unmute TX, 0x01 = mute TX
    0x20 = unmute RX, 0x21 = mute RX
*/
    BUFFSEND;
    if (unistimdebug) {
        ast_verb(0, "Sending mute packet (%x)\n", (unsigned)mute);
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_mute, sizeof(packet_send_mute));
    buffsend[9] = mute;
    send_client(SIZE_HEADER + sizeof(packet_send_mute), buffsend, pte);
}
 
 
/* output = OUTPUT_HANDSET, OUTPUT_HEADPHONE or OUTPUT_SPEAKER
 * volume = VOLUME_LOW, VOLUME_NORMAL, VOLUME_INSANELY_LOUD
 * mute = MUTE_OFF, MUTE_ON */
static void
send_select_output(struct unistimsession *pte, unsigned char output, unsigned char volume,
                 unsigned char mute)
{
    BUFFSEND;
    int mute_icon = -1;
    if (unistimdebug) {
        ast_verb(0, "Sending select output packet output=%x volume=%x mute=%x\n",
            (unsigned)output, (unsigned)volume, (unsigned)mute);
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_select_output,
           sizeof(packet_send_select_output));
    buffsend[9] = output;
    if (output == OUTPUT_SPEAKER && volume == VOLUME_LOW) {
        volume = VOLUME_LOW_SPEAKER;
    }
    buffsend[10] = volume;
    if (mute == MUTE_ON_DISCRET) {
        buffsend[11] = MUTE_ON;
    } else {
        buffsend[11] = mute;
    }
    send_client(SIZE_HEADER + sizeof(packet_send_select_output), buffsend, pte);
    if (output == OUTPUT_HANDSET) {
        mute_icon = (mute == MUTE_ON) ? FAV_ICON_ONHOLD_BLACK : FAV_ICON_OFFHOOK_BLACK;
        send_led_update(pte, LED_SPEAKER_OFF);
        send_led_update(pte, LED_HEADPHONE_OFF);
    } else if (output == OUTPUT_HEADPHONE) {
        mute_icon = (mute == MUTE_ON)? FAV_ICON_HEADPHONES_ONHOLD : FAV_ICON_HEADPHONES;
        send_led_update(pte, LED_SPEAKER_OFF);
        send_led_update(pte, LED_HEADPHONE_ON);
    } else if (output == OUTPUT_SPEAKER) {
        send_led_update(pte, LED_SPEAKER_ON);
        send_led_update(pte, LED_HEADPHONE_OFF);
        if (pte->device->receiver_state == STATE_OFFHOOK) {
            mute_icon = (mute == MUTE_ON)? FAV_ICON_SPEAKER_ONHOLD_BLACK : FAV_ICON_SPEAKER_ONHOOK_BLACK;
        } else {
            mute_icon = (mute == MUTE_ON)? FAV_ICON_SPEAKER_ONHOLD_BLACK : FAV_ICON_SPEAKER_OFFHOOK_BLACK;
        }
    } else {
        ast_log(LOG_WARNING, "Invalid output (%d)\n", output);
    }
    if (mute_icon != -1) {
        change_favorite_icon(pte, mute_icon);
    }
    if (output != pte->device->output) {
        pte->device->previous_output = pte->device->output;
    }
    pte->device->output = output;
}
static void send_ring(struct unistimsession *pte, signed char volume, signed char style)
{
    BUFFSEND;
    if (unistimdebug) {
        ast_verb(0, "Sending ring packet\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_ring, sizeof(packet_send_ring));
    buffsend[24] = style + 0x10;
    buffsend[29] = volume * 0x10;
    send_client(SIZE_HEADER + sizeof(packet_send_ring), buffsend, pte);
}
 
static void send_no_ring(struct unistimsession *pte)
{
    BUFFSEND;
    if (unistimdebug) {
        ast_verb(0, "Sending no ring packet\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_no_ring, sizeof(packet_send_no_ring));
    send_client(SIZE_HEADER + sizeof(packet_send_no_ring), buffsend, pte);
}
 
static void send_texttitle(struct unistimsession *pte, const char *text)
{
    BUFFSEND;
    int i;
    if (unistimdebug) {
        ast_verb(0, "Sending title text\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_title, sizeof(packet_send_title));
    i = strlen(text);
    if (i > 12) {
        i = 12;
    }
    memcpy(buffsend + 10, text, i);
    send_client(SIZE_HEADER + sizeof(packet_send_title), buffsend, pte);
}
 
static void send_idle_clock(struct unistimsession *pte)
{
    send_text(TEXT_LINE0, TEXT_NORMAL, pte, "");
}
 
static void send_month_labels(struct unistimsession *pte, int month)
{
    BUFFSEND;
    char month_name[MONTH_LABEL_SIZE + 1];
    int i = 0;
    if (unistimdebug) {
            ast_verb(0, "Sending Month Labels\n");
    }
    month_name[MONTH_LABEL_SIZE] = '\0';
    memcpy(buffsend + SIZE_HEADER, packet_send_monthlabels_download, sizeof(packet_send_monthlabels_download));
    while (i < 2) {
        memcpy(month_name, &monthlabels[month * MONTH_LABEL_SIZE], MONTH_LABEL_SIZE);
        memcpy(buffsend + SIZE_HEADER + 3 + i*MONTH_LABEL_SIZE, ustmtext(month_name, pte), MONTH_LABEL_SIZE);
        ast_log(LOG_WARNING,"%s\n", month_name);
        ast_log(LOG_WARNING,"%s\n", ustmtext(month_name, pte));
        month = (month + 1)%12;
        i++;
    }
    send_client(SIZE_HEADER + sizeof(packet_send_monthlabels_download), buffsend, pte);
}
 
 
static void send_date_time(struct unistimsession *pte)
{
    BUFFSEND;
    struct timeval now = ast_tvnow();
    struct ast_tm atm = { 0, };
 
    if (unistimdebug) {
        ast_verb(0, "Sending Time & Date\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_date_time, sizeof(packet_send_date_time));
    ast_localtime(&now, &atm, NULL);
    buffsend[10] = (unsigned char) atm.tm_mon + 1;
    buffsend[11] = (unsigned char) atm.tm_mday;
    buffsend[12] = (unsigned char) atm.tm_hour;
    buffsend[13] = (unsigned char) atm.tm_min;
    send_client(SIZE_HEADER + sizeof(packet_send_date_time), buffsend, pte);
    send_month_labels(pte, atm.tm_mon);
}
 
static void send_date_time2(struct unistimsession *pte)
{
    BUFFSEND;
    struct timeval now = ast_tvnow();
    struct ast_tm atm = { 0, };
 
    if (unistimdebug) {
        ast_verb(0, "Sending Time & Date #2\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_date_time2, sizeof(packet_send_date_time2));
    ast_localtime(&now, &atm, NULL);
    if (pte->device) {
        buffsend[9] = pte->device->datetimeformat;
    } else {
        buffsend[9] = 61;
    }
    buffsend[14] = (unsigned char) atm.tm_mon + 1;
    buffsend[15] = (unsigned char) atm.tm_mday;
    buffsend[16] = (unsigned char) atm.tm_hour;
    buffsend[17] = (unsigned char) atm.tm_min;
    send_client(SIZE_HEADER + sizeof(packet_send_date_time2), buffsend, pte);
}
 
static void send_date_time3(struct unistimsession *pte)
{
    BUFFSEND;
    struct timeval now = ast_tvnow();
    struct ast_tm atm = { 0, };
 
    if (unistimdebug) {
        ast_verb(0, "Sending Time & Date #3\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_date_time3, sizeof(packet_send_date_time3));
    ast_localtime(&now, &atm, NULL);
    buffsend[10] = (unsigned char) atm.tm_mon + 1;
    buffsend[11] = (unsigned char) atm.tm_mday;
    buffsend[12] = (unsigned char) atm.tm_hour;
    buffsend[13] = (unsigned char) atm.tm_min;
    send_client(SIZE_HEADER + sizeof(packet_send_date_time3), buffsend, pte);
}
 
static void send_blink_cursor(struct unistimsession *pte)
{
    BUFFSEND;
    if (unistimdebug) {
        ast_verb(0, "Sending set blink\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_blink_cursor, sizeof(packet_send_blink_cursor));
    send_client(SIZE_HEADER + sizeof(packet_send_blink_cursor), buffsend, pte);
    return;
}
 
/* pos : 0xab (a=0/2/4 = line ; b = row) */
static void send_cursor_pos(struct unistimsession *pte, unsigned char pos)
{
    BUFFSEND;
    if (unistimdebug) {
        ast_verb(0, "Sending set cursor position\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_set_pos_cursor,
           sizeof(packet_send_set_pos_cursor));
    buffsend[11] = pos;
    send_client(SIZE_HEADER + sizeof(packet_send_set_pos_cursor), buffsend, pte);
    return;
}
 
static void send_charset_update(struct unistimsession *pte, int charset)
{
    const unsigned char* packet_send_charset;
    int packet_size;
    BUFFSEND;
    if (unistimdebug) {
        ast_verb(0, "Sending set default charset\n");
    }
    if (charset == LANG_DEFAULT) {
        charset = options_languages[find_language(pte->device->language)].encoding;
    }
    switch (charset) {
    case ISO_8859_2:
        packet_send_charset = packet_send_charset_iso_8859_2;
        packet_size = sizeof(packet_send_charset_iso_8859_2);
        break;
    case ISO_8859_4:
        packet_send_charset = packet_send_charset_iso_8859_4;
        packet_size = sizeof(packet_send_charset_iso_8859_4);
        break;
    case ISO_8859_5:
        packet_send_charset = packet_send_charset_iso_8859_5;
        packet_size = sizeof(packet_send_charset_iso_8859_5);
        break;
    case ISO_2022_JP:
        packet_send_charset = packet_send_charset_iso_2022_jp;
        packet_size = sizeof(packet_send_charset_iso_2022_jp);
        break;
    case ISO_8859_1:
    default:
        packet_send_charset = packet_send_charset_iso_8859_1;
        packet_size = sizeof(packet_send_charset_iso_8859_1);
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_charset, packet_size);
    send_client(SIZE_HEADER + packet_size, buffsend, pte);
    return;
}
 
static void rcv_resume_connection_with_server(struct unistimsession *pte)
{
    BUFFSEND;
    if (unistimdebug) {
        ast_verb(0, "ResumeConnectionWithServer received\n");
        ast_verb(0, "Sending packet_send_query_mac_address\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_query_mac_address,
           sizeof(packet_send_query_mac_address));
    send_client(SIZE_HEADER + sizeof(packet_send_query_mac_address), buffsend, pte);
    return;
}
 
static int unistim_register(struct unistimsession *s)
{
    struct unistim_device *d;
 
    ast_mutex_lock(&devicelock);
    d = devices;
    while (d) {
        if (!strcasecmp(s->macaddr, d->id)) {
            /* XXX Deal with IP authentication */
            s->device = d;
            d->session = s;
            d->codec_number = DEFAULT_CODEC;
            d->missed_call = 0;
            d->receiver_state = STATE_ONHOOK;
            break;
        }
        d = d->next;
    }
    ast_mutex_unlock(&devicelock);
 
    if (!d) {
        return 0;
    }
 
    return 1;
}
 
static void unistim_line_copy(struct unistim_line *dst, struct unistim_line *src)
{
    struct ast_format_cap *tmp = src->cap;
    memcpy(dst, src, sizeof(*dst)); /* this over writes the cap ptr, so we have to reset it */
    src->cap = tmp;
    ast_format_cap_append_from_cap(src->cap, dst->cap, AST_MEDIA_TYPE_UNKNOWN);
}
 
static struct unistim_line *unistim_line_destroy(struct unistim_line *l)
{
    if (!l) {
        return NULL;
    }
    ao2_ref(l->cap, -1);
    ast_free(l);
    return NULL;
}
 
static struct unistim_line *unistim_line_alloc(void)
{
    struct unistim_line *l;
    if (!(l = ast_calloc(1, sizeof(*l)))) {
        return NULL;
    }
 
    if (!(l->cap = ast_format_cap_alloc(AST_FORMAT_CAP_FLAG_DEFAULT))) {
        ast_free(l);
        return NULL;
    }
    return l;
}
 
static int unistim_free_sub(struct unistim_subchannel *sub) {
    if (unistimdebug) {
        ast_debug(1, "Released sub %u of channel %s@%s\n", sub->subtype, sub->parent->name, sub->parent->parent->name);
    }
    ast_mutex_destroy(&sub->lock);
    ast_free(sub);
    return 0;
}
 
static struct unistim_subchannel *unistim_alloc_sub(struct unistim_device *d, int x)
{
    struct unistim_subchannel *sub;
    if (!(sub = ast_calloc(1, sizeof(*sub)))) {
        return NULL;
    }
 
    if (unistimdebug) {
        ast_verb(3, "Allocating UNISTIM subchannel #%d on %s ptr=%p\n", x, d->name, sub);
    }
    sub->ss_thread = AST_PTHREADT_NULL;
    sub->subtype = x;
    AST_LIST_LOCK(&d->subs);
    AST_LIST_INSERT_TAIL(&d->subs, sub, list);
    AST_LIST_UNLOCK(&d->subs);
    ast_mutex_init(&sub->lock);
    return sub;
}
 
static int unistim_unalloc_sub(struct unistim_device *d, struct unistim_subchannel *sub)
{
    struct unistim_subchannel *s;
 
    AST_LIST_LOCK(&d->subs);
    AST_LIST_TRAVERSE_SAFE_BEGIN(&d->subs, s, list) {
        if (!s) {
            continue;
        }
        if (s != sub) {
            continue;
        }
        AST_LIST_REMOVE_CURRENT(list);
        unistim_free_sub(sub);
    }
    AST_LIST_TRAVERSE_SAFE_END;
    AST_LIST_UNLOCK(&d->subs);
    return 0;
}
 
static const char *subtype_tostr(const int type)
{
    switch (type) {
    case SUB_REAL:
        return "REAL";
    case SUB_RING:
        return "RINGING";
    case SUB_THREEWAY:
        return "THREEWAY";
    }
    return "UNKNOWN";
}
 
static const char *ptestate_tostr(const int type)
{
    switch (type) {
    case STATE_INIT:
        return "INIT";
    case STATE_AUTHDENY:
        return "AUTHDENY";
    case STATE_MAINPAGE:
        return "MAINPAGE";
    case STATE_EXTENSION:
        return "EXTENSION";
    case STATE_DIALPAGE:
        return "DIALPAGE";
    case STATE_RINGING:
        return "RINGING";
    case STATE_CALL:
        return "CALL";
    case STATE_SELECTOPTION:
        return "SELECTOPTION";
    case STATE_SELECTCODEC:
        return "SELECTCODEC";
    case STATE_SELECTLANGUAGE:
        return "SELECTLANGUAGE";
    case STATE_CLEANING:
        return "CLEARING";
    case STATE_HISTORY:
        return "HISTORY";
    }
    return "UNKNOWN";
}
 
static void rcv_mac_addr(struct unistimsession *pte, const unsigned char *buf)
{
    BUFFSEND;
    int tmp, i = 0;
    char addrmac[19];
    int res = 0;
    for (tmp = 15; tmp < 15 + SIZE_HEADER; tmp++) {
        sprintf(&addrmac[i], "%02hhx", buf[tmp]);
        i += 2;
    }
    if (unistimdebug) {
        ast_verb(0, "MAC Address received: %s\n", addrmac);
    }
    strcpy(pte->macaddr, addrmac);
    res = unistim_register(pte);
    if (!res) {
        switch (autoprovisioning) {
        case AUTOPROVISIONING_NO:
            ast_log(LOG_WARNING, "No entry found for this phone : %s\n", addrmac);
            pte->state = STATE_AUTHDENY;
            break;
        case AUTOPROVISIONING_YES:
            {
                struct unistim_device *d = NULL, *newd = NULL;
                struct unistim_line *newl = NULL, *l = NULL;
                if (unistimdebug) {
                    ast_verb(0, "New phone, autoprovisioning on\n");
                }
                /* First : locate the [template] section */
                ast_mutex_lock(&devicelock);
                d = devices;
                while (d) {
                    if (strcasecmp(d->name, "template")) {
                        d = d->next;
                        continue;
                    }
                    /* Found, cloning this entry */
                    if (!(newd = ast_malloc(sizeof(*newd)))) {
                        ast_mutex_unlock(&devicelock);
                        return;
                    }
                    memcpy(newd, d, sizeof(*newd));
                    ast_mutex_init(&newd->lock);
                    newd->lines.first = NULL;
                    newd->lines.last = NULL;
                    AST_LIST_LOCK(&d->lines);
                    AST_LIST_TRAVERSE(&d->lines, l, list) {
                        if (!(newl = unistim_line_alloc())) {
                            break;
                        }
                        unistim_line_copy(l, newl);
                        newl->parent = newd;
                        ast_copy_string(newl->name, l->name, sizeof(newl->name));
                        snprintf(newl->fullname, sizeof(newl->fullname), "USTM/%s@%s",
                                 newl->name, newd->name);
                        snprintf(l->name, sizeof(l->name), "%d", atoi(l->name) + 1);
 
                        AST_LIST_LOCK(&newd->lines);
                        AST_LIST_INSERT_TAIL(&newd->lines, newl, list);
                        AST_LIST_UNLOCK(&newd->lines);
                    }
                    AST_LIST_UNLOCK(&d->lines);
                    if (!newl) {
                        ast_free(newd);
                        ast_mutex_unlock(&devicelock);
                    }
 
                    /* Ok, now updating some fields */
                    ast_copy_string(newd->id, addrmac, sizeof(newd->id));
                    ast_copy_string(newd->name, addrmac, sizeof(newd->name));
                    if (newd->extension == EXTENSION_NONE) {
                        newd->extension = EXTENSION_ASK;
                    }
 
                    newd->receiver_state = STATE_ONHOOK;
                    newd->session = pte;
                    newd->language[0] = '\0';
                    newd->to_delete = -1;
                    newd->next = NULL;
                    pte->device = newd;
 
                    /* Go to the end of the linked chain */
                    while (d->next) {
                        d = d->next;
                    }
                    d->next = newd;
                    d = newd;
                    break;
                }
                ast_mutex_unlock(&devicelock);
                if (!d) {
                    ast_log(LOG_WARNING, "No entry [template] found in unistim.conf\n");
                    pte->state = STATE_AUTHDENY;
                }
            }
            break;
        case AUTOPROVISIONING_TN:
            pte->state = STATE_AUTHDENY;
            break;
        default:
            ast_log(LOG_WARNING, "Internal error : unknown autoprovisioning value = %u\n",
                    autoprovisioning);
        }
    }
    if (pte->state != STATE_AUTHDENY) {
        struct unistim_line *line;
        struct unistim_subchannel *sub;
 
        ast_verb(3, "Device '%s' successfuly registered\n", pte->device->name);
 
        AST_LIST_LOCK(&pte->device->subs);
        AST_LIST_TRAVERSE_SAFE_BEGIN(&pte->device->subs, sub, list) {
            if (sub) {
                ast_log(LOG_ERROR, "Subchannel lost sice reboot. Hanged channel may apear!\n");
                AST_LIST_REMOVE_CURRENT(list);
                ast_free(sub);
            }
        }
        AST_LIST_TRAVERSE_SAFE_END;
        AST_LIST_UNLOCK(&pte->device->subs);
 
        switch (pte->device->extension) {
        case EXTENSION_NONE:
            pte->state = STATE_MAINPAGE;
            break;
        case EXTENSION_ASK:
            /* Checking if we already have an extension number */
            if (ast_strlen_zero(pte->device->extension_number)) {
                pte->state = STATE_EXTENSION;
            } else {
                /* Yes, because of a phone reboot. We don't ask again for the TN */
                if (register_extension(pte)) {
                    pte->state = STATE_EXTENSION;
                } else {
                    pte->state = STATE_MAINPAGE;
                }
            }
            break;
        case EXTENSION_LINE:
            line = AST_LIST_FIRST(&pte->device->lines);
            ast_copy_string(pte->device->extension_number, line->name,
                            sizeof(pte->device->extension_number));
            if (register_extension(pte)) {
                pte->state = STATE_EXTENSION;
            } else {
                pte->state = STATE_MAINPAGE;
            }
            break;
        case EXTENSION_TN:
            /* If we are here, it's because of a phone reboot */
            pte->state = STATE_MAINPAGE;
            break;
        default:
            ast_log(LOG_WARNING, "Internal error, extension value unknown : %u\n",
                    pte->device->extension);
            pte->state = STATE_AUTHDENY;
            break;
        }
    }
    if (pte->state == STATE_EXTENSION) {
        if (pte->device->extension != EXTENSION_TN) {
            pte->device->extension = EXTENSION_ASK;
        }
        pte->device->extension_number[0] = '\0';
    }
    if (unistimdebug) {
        ast_verb(0, "\nSending S1\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_S1, sizeof(packet_send_S1));
    send_client(SIZE_HEADER + sizeof(packet_send_S1), buffsend, pte);
 
    if (unistimdebug) {
        ast_verb(0, "Sending query_basic_manager_04\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_query_basic_manager_04,
           sizeof(packet_send_query_basic_manager_04));
    send_client(SIZE_HEADER + sizeof(packet_send_query_basic_manager_04), buffsend, pte);
 
    if (unistimdebug) {
        ast_verb(0, "Sending query_basic_manager_10\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_query_basic_manager_10,
           sizeof(packet_send_query_basic_manager_10));
    send_client(SIZE_HEADER + sizeof(packet_send_query_basic_manager_10), buffsend, pte);
 
    send_date_time(pte);
    return;
}
 
static int write_entry_history(struct unistimsession *pte, FILE * f, char c, char *line1)
{
    if (fwrite(&c, 1, 1, f) != 1) {
        display_last_error("Unable to write history log header.");
        return -1;
    }
    if (fwrite(line1, TEXT_LENGTH_MAX, 1, f) != 1) {
        display_last_error("Unable to write history entry - date.");
        return -1;
    }
    if (fwrite(pte->device->lst_cid, TEXT_LENGTH_MAX, 1, f) != 1) {
        display_last_error("Unable to write history entry - callerid.");
        return -1;
    }
    if (fwrite(pte->device->lst_cnm, TEXT_LENGTH_MAX, 1, f) != 1) {
        display_last_error("Unable to write history entry - callername.");
        return -1;
    }
    return 0;
}
 
static int write_history(struct unistimsession *pte, char way, char ismissed)
{
    char tmp[AST_CONFIG_MAX_PATH], tmp2[AST_CONFIG_MAX_PATH];
    char line1[TEXT_LENGTH_MAX + 1];
    char count = 0, *histbuf;
    int size;
    FILE *f, *f2;
    struct timeval now = ast_tvnow();
    struct ast_tm atm = { 0, };
 
    if (!pte->device) {
        return -1;
    }
    if (!pte->device->callhistory) {
        return 0;
    }
    if (strchr(pte->device->name, '/') || (pte->device->name[0] == '.')) {
        ast_log(LOG_WARNING, "Account code '%s' insecure for writing file\n",
                pte->device->name);
        return -1;
    }
 
    snprintf(tmp, sizeof(tmp), "%s/%s", ast_config_AST_LOG_DIR, USTM_LOG_DIR);
    if (ast_mkdir(tmp, 0770)) {
        ast_log(LOG_WARNING, "Unable to create directory for history\n");
                return -1;
    }
 
    ast_localtime(&now, &atm, NULL);
    if (ismissed) {
        if (way == 'i') {
            ast_copy_string(tmp2, ustmtext("Miss", pte), sizeof(tmp2));
        } else {
            ast_copy_string(tmp2, ustmtext("Fail", pte), sizeof(tmp2));
        }
    } else {
        ast_copy_string(tmp2, ustmtext("Answ", pte), sizeof(tmp2));
    }
    snprintf(line1, sizeof(line1), "%04d/%02d/%02d %02d:%02d:%02d %s",
             atm.tm_year + 1900, atm.tm_mon + 1, atm.tm_mday, atm.tm_hour,
             atm.tm_min, atm.tm_sec, tmp2);
 
    snprintf(tmp, sizeof(tmp), "%s/%s/%s-%c.csv", ast_config_AST_LOG_DIR,
             USTM_LOG_DIR, pte->device->name, way);
    if ((f = fopen(tmp, "r"))) {
        struct stat bufstat;
 
        if (stat(tmp, &bufstat)) {
            display_last_error("Unable to stat history log.");
            fclose(f);
            return -1;
        }
        size = 1 + (MAX_ENTRY_LOG * TEXT_LENGTH_MAX * 3);
        if (bufstat.st_size != size) {
            ast_log(LOG_WARNING,
                    "History file %s has an incorrect size (%d instead of %d). It will be replaced by a new one.",
                    tmp, (int) bufstat.st_size, size);
            fclose(f);
            f = NULL;
            count = 1;
        }
    }
 
    /* If we can't open the log file, we create a brand new one */
    if (!f) {
        char c = 1;
        int i;
 
        if ((errno != ENOENT) && (count == 0)) {
            display_last_error("Unable to open history log.");
            return -1;
        }
        f = fopen(tmp, "w");
        if (!f) {
            display_last_error("Unable to create history log.");
            return -1;
        }
        if (write_entry_history(pte, f, c, line1)) {
            fclose(f);
            return -1;
        }
        memset(line1, ' ', TEXT_LENGTH_MAX);
        for (i = 3; i < MAX_ENTRY_LOG * 3; i++) {
            if (fwrite(line1, TEXT_LENGTH_MAX, 1, f) != 1) {
                display_last_error("Unable to write history entry - stuffing.");
                fclose(f);
                return -1;
            }
        }
        if (fclose(f)) {
            display_last_error("Unable to close history - creation.");
        }
        return 0;
    }
    /* We can open the log file, we create a temporary one, we add our entry and copy the rest */
    if (fread(&count, 1, 1, f) != 1) {
        display_last_error("Unable to read history header.");
        fclose(f);
        return -1;
    }
    if (count > MAX_ENTRY_LOG) {
        ast_log(LOG_WARNING, "Invalid count in history header of %s (%d max %d)\n", tmp,
                count, MAX_ENTRY_LOG);
        fclose(f);
        return -1;
    }
    snprintf(tmp2, sizeof(tmp2), "%s/%s/%s-%c.csv.tmp", ast_config_AST_LOG_DIR,
             USTM_LOG_DIR, pte->device->name, way);
    if (!(f2 = fopen(tmp2, "w"))) {
        display_last_error("Unable to create temporary history log.");
        fclose(f);
        return -1;
    }
 
    if (++count > MAX_ENTRY_LOG) {
        count = MAX_ENTRY_LOG;
    }
    if (write_entry_history(pte, f2, count, line1)) {
        fclose(f);
        fclose(f2);
        return -1;
    }
    size = (MAX_ENTRY_LOG - 1) * TEXT_LENGTH_MAX * 3;
    if (!(histbuf = ast_malloc(size))) {
        fclose(f);
        fclose(f2);
        return -1;
    }
 
    if (fread(histbuf, size, 1, f) != 1) {
        ast_free(histbuf);
        fclose(f);
        fclose(f2);
        display_last_error("Unable to read previous history entries.");
        return -1;
    }
    if (fwrite(histbuf, size, 1, f2) != 1) {
        ast_free(histbuf);
        fclose(f);
        fclose(f2);
        display_last_error("Unable to write previous history entries.");
        return -1;
    }
    ast_free(histbuf);
    if (fclose(f)) {
        display_last_error("Unable to close history log.");
    }
    if (fclose(f2)) {
        display_last_error("Unable to close temporary history log.");
    }
    if (unlink(tmp)) {
        display_last_error("Unable to remove old history log.");
    }
    if (rename(tmp2, tmp)) {
        display_last_error("Unable to rename new history log.");
    }
    return 0;
}
 
static int attempt_transfer(struct unistim_subchannel *p1, struct unistim_subchannel *p2)
{
    RAII_VAR(struct ast_channel *, chana, NULL, ast_channel_unref);
    RAII_VAR(struct ast_channel *, chanb, NULL, ast_channel_unref);
 
    if (!p1->owner || !p2->owner) {
        ast_log(LOG_WARNING, "Transfer attempted without dual ownership?\n");
        return -1;
    }
    chana = ast_channel_ref(p1->owner);
    chanb = ast_channel_ref(p2->owner);
 
    switch (ast_bridge_transfer_attended(chana, chanb)) {
    case AST_BRIDGE_TRANSFER_INVALID:
        ast_log(LOG_WARNING, "Transfer failed. Invalid bridge setup\n");
        break;
    case AST_BRIDGE_TRANSFER_NOT_PERMITTED:
        ast_log(LOG_WARNING, "Transfer not permitted\n");
        break;
    case AST_BRIDGE_TRANSFER_FAIL:
        ast_log(LOG_WARNING, "Transfer encountered internal error\n");
        break;
    case AST_BRIDGE_TRANSFER_SUCCESS:
        return 0;
    }
 
    /* Control only reaches this point if transfer has failed */
    ast_softhangup_nolock(chana, AST_SOFTHANGUP_DEV);
    ast_softhangup_nolock(chanb, AST_SOFTHANGUP_DEV);
    return -1;
}
 
void change_callerid(struct unistimsession *pte, int type, char *callerid)
{
    char *data;
    int size;
 
    if (type) {
        data = pte->device->lst_cnm;
    } else {
        data = pte->device->lst_cid;
    }
 
    /* This is very nearly strncpy(), except that the remaining buffer
     * is padded with ' ', instead of '\0' */
    memset(data, ' ', TEXT_LENGTH_MAX);
    size = strlen(callerid);
    if (size > TEXT_LENGTH_MAX) {
        size = TEXT_LENGTH_MAX;
    }
    memcpy(data, callerid, size);
}
 
static struct unistim_subchannel* get_sub(struct unistim_device *device, int type)
{
    struct unistim_subchannel *sub = NULL;
 
    AST_LIST_LOCK(&device->subs);
    AST_LIST_TRAVERSE(&device->subs, sub, list) {
        if (!sub) {
            continue;
        }
        if (sub->subtype == type) {
            break;
        }
    }
    AST_LIST_UNLOCK(&device->subs);
 
    return sub;
}
 
static struct unistim_subchannel* get_sub_holding(struct unistim_device *device, int type, int holding)
{
    struct unistim_subchannel *sub = NULL;
 
    AST_LIST_LOCK(&device->subs);
    AST_LIST_TRAVERSE(&device->subs, sub, list) {
        if (!sub) {
            continue;
        }
        if (sub->subtype == type && sub->holding == holding) {
            break;
        }
    }
    AST_LIST_UNLOCK(&device->subs);
 
    return sub;
}
 
static void sub_start_silence(struct unistimsession *pte, struct unistim_subchannel *sub)
{
    /* Silence our channel */
    if (!pte->device->silence_generator) {
        pte->device->silence_generator =
            ast_channel_start_silence_generator(sub->owner);
        if (pte->device->silence_generator == NULL) {
            ast_log(LOG_WARNING, "Unable to start a silence generator.\n");
        } else if (unistimdebug) {
            ast_verb(0, "Starting silence generator\n");
        }
    }
 
}
 
static void sub_stop_silence(struct unistimsession *pte, struct unistim_subchannel *sub)
{
    /* Stop the silence generator */
    if (pte->device->silence_generator) {
        if (unistimdebug) {
            ast_verb(0, "Stopping silence generator\n");
        }
        if (sub->owner) {
            ast_channel_stop_silence_generator(sub->owner, pte->device->silence_generator);
        } else {
            ast_log(LOG_WARNING, "Trying to stop silence generator on a null channel!\n");
        }
        pte->device->silence_generator = NULL;
    }
}
 
static void sub_hold(struct unistimsession *pte, struct unistim_subchannel *sub)
{
    if (!sub) {
        return;
    }
    sub->moh = 1;
    sub->holding = 1;
    send_favorite_short(sub->softkey, FAV_ICON_ONHOLD_BLACK + FAV_BLINK_SLOW, pte);
    send_select_output(pte, pte->device->output, pte->device->volume, MUTE_ON);
    send_stop_timer(pte);
    if (sub->owner) {
        ast_queue_hold(sub->owner, NULL);
    }
    return;
}
 
static void sub_unhold(struct unistimsession *pte, struct unistim_subchannel *sub)
{
    struct unistim_subchannel *sub_real;
 
    sub_real = get_sub(pte->device, SUB_REAL);
    if (sub_real) {
        sub_hold(pte, sub_real);
    }
 
    sub->moh = 0;
    sub->holding = 0;
    send_favorite_short(sub->softkey, FAV_ICON_OFFHOOK_BLACK, pte);
    send_select_output(pte, pte->device->output, pte->device->volume, MUTE_OFF);
    send_start_timer(pte);
    if (sub->owner) {
        ast_queue_unhold(sub->owner);
        if (sub->rtp) {
            send_start_rtp(sub);
        }
    }
    return;
}
 
static void close_call(struct unistimsession *pte)
{
    struct unistim_subchannel *sub, *sub_transf;
 
    sub = get_sub(pte->device, SUB_REAL);
    sub_transf = get_sub(pte->device, SUB_THREEWAY);
    send_stop_timer(pte);
    if (!sub) {
        ast_log(LOG_WARNING, "Close call without sub\n");
        return;
    }
    send_favorite_short(sub->softkey, FAV_LINE_ICON, pte);
    if (sub->owner) {
        sub->alreadygone = 1;
        if (sub_transf) {
            sub_transf->alreadygone = 1;
            if (attempt_transfer(sub, sub_transf) < 0) {
                ast_verb(0, "attempt_transfer failed.\n");
            }
        } else {
            ast_queue_hangup(sub->owner);
        }
    } else {
        if (sub_transf) {
            if (sub_transf->owner) {
                ast_queue_hangup_with_cause(sub_transf->owner, AST_CAUSE_NORMAL_CLEARING);
            } else {
                ast_log(LOG_WARNING, "threeway sub without owner\n");
            }
        } else {
            ast_verb(0, "USTM(%s@%s-%d) channel already destroyed\n", sub->parent->name,
                        pte->device->name, sub->softkey);
        }
    }
    change_callerid(pte, 0, pte->device->redial_number);
    change_callerid(pte, 1, "");
    write_history(pte, 'o', pte->device->missed_call);
    pte->device->missed_call = 0;
    show_main_page(pte);
    return;
}
 
static void ignore_call(struct unistimsession *pte)
{
    send_no_ring(pte);
    return;
}
 
static void discard_call(struct unistimsession *pte)
{
    struct unistim_subchannel* sub;
    sub = get_sub(pte->device, SUB_RING);
    if (!sub) {
        return;
    }
 
    ast_queue_hangup_with_cause(sub->owner, AST_CAUSE_NORMAL_CLEARING);
    return;
}
 
static void *unistim_ss(void *data)
{
    struct ast_channel *chan = data;
    struct unistim_subchannel *sub = ast_channel_tech_pvt(chan);
    struct unistim_line *l = sub->parent;
    struct unistimsession *s = l->parent->session;
    int res;
 
    if (!s) {
        return NULL;
    }
    ast_verb(3, "Starting switch on '%s@%s-%d' to %s\n", l->name, l->parent->name, sub->softkey, s->device->phone_number);
    ast_channel_lock(chan);
    ast_channel_exten_set(chan, s->device->phone_number);
    ast_setstate(chan, AST_STATE_RING);
    ast_channel_unlock(chan);
    ast_copy_string(s->device->redial_number, s->device->phone_number,
                    sizeof(s->device->redial_number));
    res = ast_pbx_run(chan);
    if (res) {
        ast_log(LOG_WARNING, "PBX exited non-zero\n");
        send_tone(s, 1000, 0);
    }
    return NULL;
}
 
static int find_rtp_port(struct unistim_subchannel *s)
{
    struct unistim_subchannel *sub = NULL;
    int rtp_start = s->parent->parent->rtp_port;
    struct ast_sockaddr us_tmp;
    struct sockaddr_in us = { 0, };
 
    AST_LIST_LOCK(&s->parent->parent->subs);
    AST_LIST_TRAVERSE(&s->parent->parent->subs, sub, list) {
        if (!sub) {
            continue;
        }
        if (sub->rtp) {
            ast_rtp_instance_get_remote_address(sub->rtp, &us_tmp);
            ast_sockaddr_to_sin(&us_tmp, &us);
            if (htons(us.sin_port)) {
                rtp_start = htons(us.sin_port) + 1;
                break;
            }
        }
    }
    AST_LIST_UNLOCK(&s->parent->parent->subs);
    return rtp_start;
}
 
static void send_start_rtp(struct unistim_subchannel *sub)
{
    BUFFSEND;
 
    int codec;
    struct sockaddr_in public = { 0, };
    struct sockaddr_in us = { 0, };
    struct sockaddr_in sin = { 0, };
    struct ast_sockaddr us_tmp;
    struct ast_sockaddr sin_tmp;
    struct unistimsession *pte;
 
    ast_rtp_instance_get_local_address(sub->rtp, &us_tmp);
    ast_sockaddr_to_sin(&us_tmp, &us);
    ast_rtp_instance_get_remote_address(sub->rtp, &sin_tmp);
    ast_sockaddr_to_sin(&sin_tmp, &sin);
 
    /* Setting up RTP of the phone */
    if (public_ip.sin_family == 0) {  /* NAT IP override ?   */
        memcpy(&public, &us, sizeof(public));   /* No defined, using IP from recvmsg  */
    } else {
        memcpy(&public, &public_ip, sizeof(public));    /* override  */
    }
    if (unistimdebug) {
        ast_verb(0, "RTP started : Our IP/port is : %s:%hd with codec %s\n",
             ast_inet_ntoa(us.sin_addr),
             htons(us.sin_port), ast_format_get_name(ast_channel_readformat(sub->owner)));
        ast_verb(0, "Starting phone RTP stack. Our public IP is %s\n",
                    ast_inet_ntoa(public.sin_addr));
    }
 
    pte = sub->parent->parent->session;
    codec = ast_rtp_codecs_payload_code_tx(ast_rtp_instance_get_codecs(sub->rtp),
        1, ast_channel_readformat(sub->owner), 0);
    if ((ast_format_cmp(ast_channel_readformat(sub->owner), ast_format_ulaw) == AST_FORMAT_CMP_EQUAL) ||
        (ast_format_cmp(ast_channel_readformat(sub->owner), ast_format_alaw) == AST_FORMAT_CMP_EQUAL)) {
        if (unistimdebug) {
            ast_verb(0, "Sending packet_send_rtp_packet_size for codec %d\n", codec);
        }
        memcpy(buffsend + SIZE_HEADER, packet_send_rtp_packet_size,
               sizeof(packet_send_rtp_packet_size));
        buffsend[10] = (int) codec & 0xffffffffLL;
        send_client(SIZE_HEADER + sizeof(packet_send_rtp_packet_size), buffsend, pte);
    }
    if (unistimdebug) {
        ast_verb(0, "Sending Jitter Buffer Parameters Configuration\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_jitter_buffer_conf,
           sizeof(packet_send_jitter_buffer_conf));
    send_client(SIZE_HEADER + sizeof(packet_send_jitter_buffer_conf), buffsend, pte);
    if (pte->device->rtp_method != 0) {
        uint16_t rtcpsin_port = ntohs(us.sin_port) + 1; /* RTCP port is RTP + 1 */
 
        if (unistimdebug) {
            ast_verb(0, "Sending OpenAudioStreamTX using method #%d\n", pte->device->rtp_method);
        }
        if (pte->device->rtp_method == 3) {
            memcpy(buffsend + SIZE_HEADER, packet_send_open_audio_stream_tx3,
                   sizeof(packet_send_open_audio_stream_tx3));
        } else {
            memcpy(buffsend + SIZE_HEADER, packet_send_open_audio_stream_tx,
                   sizeof(packet_send_open_audio_stream_tx));
        }
        if (pte->device->rtp_method != 2) {
            memcpy(buffsend + 28, &public.sin_addr, sizeof(public.sin_addr));
            put_unaligned_uint16(&buffsend[20], sin.sin_port);
            put_unaligned_uint16(&buffsend[22], htons(rtcpsin_port));
            put_unaligned_uint16(&buffsend[24], us.sin_port);
            put_unaligned_uint16(&buffsend[26], htons(rtcpsin_port));
        } else {
            memcpy(buffsend + 23, &public.sin_addr, sizeof(public.sin_addr));
            put_unaligned_uint16(&buffsend[15], sin.sin_port);
            put_unaligned_uint16(&buffsend[19], us.sin_port);
        }
        buffsend[11] = codec; /* rx */
        buffsend[12] = codec; /* tx */
        send_client(SIZE_HEADER + sizeof(packet_send_open_audio_stream_tx), buffsend, pte);
 
        if (unistimdebug) {
            ast_verb(0, "Sending OpenAudioStreamRX\n");
        }
        if (pte->device->rtp_method == 3) {
            memcpy(buffsend + SIZE_HEADER, packet_send_open_audio_stream_rx3,
                   sizeof(packet_send_open_audio_stream_rx3));
        } else {
            memcpy(buffsend + SIZE_HEADER, packet_send_open_audio_stream_rx,
                   sizeof(packet_send_open_audio_stream_rx));
        }
        if (pte->device->rtp_method != 2) {
            memcpy(buffsend + 28, &public.sin_addr, sizeof(public.sin_addr));
            put_unaligned_uint16(&buffsend[20], sin.sin_port);
            put_unaligned_uint16(&buffsend[22], htons(rtcpsin_port));
            put_unaligned_uint16(&buffsend[24], us.sin_port);
            put_unaligned_uint16(&buffsend[26], htons(rtcpsin_port));
        } else {
            memcpy(buffsend + 23, &public.sin_addr, sizeof(public.sin_addr));
            put_unaligned_uint16(&buffsend[15], sin.sin_port);
            put_unaligned_uint16(&buffsend[19], us.sin_port);
        }
        buffsend[11] = codec; /* rx */
        buffsend[12] = codec; /* tx */
        send_client(SIZE_HEADER + sizeof(packet_send_open_audio_stream_rx), buffsend, pte);
    } else {
        uint16_t rtcpsin_port = htons(us.sin_port) + 1; /* RTCP port is RTP + 1 */
 
        if (unistimdebug) {
            ast_verb(0, "Sending packet_send_call default method\n");
        }
 
        memcpy(buffsend + SIZE_HEADER, packet_send_call, sizeof(packet_send_call));
        memcpy(buffsend + 53, &public.sin_addr, sizeof(public.sin_addr));
        /* Destination port when sending RTP */
        put_unaligned_uint16(&buffsend[49], us.sin_port);
        /* Destination port when sending RTCP */
        put_unaligned_uint16(&buffsend[51], htons(rtcpsin_port));
        /* Codec */
        buffsend[40] = codec;
        buffsend[41] = codec;
        if (ast_format_cmp(ast_channel_readformat(sub->owner), ast_format_ulaw) == AST_FORMAT_CMP_EQUAL) {
            buffsend[42] = 1;       /* 1 = 20ms (160 bytes), 2 = 40ms (320 bytes) */
        } else if (ast_format_cmp(ast_channel_readformat(sub->owner), ast_format_alaw) == AST_FORMAT_CMP_EQUAL) {
            buffsend[42] = 1;       /* 1 = 20ms (160 bytes), 2 = 40ms (320 bytes) */
        } else if (ast_format_cmp(ast_channel_readformat(sub->owner), ast_format_g723) == AST_FORMAT_CMP_EQUAL) {
            buffsend[42] = 2;       /* 1 = 30ms (24 bytes), 2 = 60 ms (48 bytes) */
        } else if (ast_format_cmp(ast_channel_readformat(sub->owner), ast_format_g729) == AST_FORMAT_CMP_EQUAL) {
            buffsend[42] = 2;       /* 1 = 10ms (10 bytes), 2 = 20ms (20 bytes) */
        } else {
            ast_log(LOG_WARNING, "Unsupported codec %s!\n",
                ast_format_get_name(ast_channel_readformat(sub->owner)));
        }
        /* Source port for transmit RTP and Destination port for receiving RTP */
        put_unaligned_uint16(&buffsend[45], sin.sin_port);
        put_unaligned_uint16(&buffsend[47], htons(rtcpsin_port));
        send_client(SIZE_HEADER + sizeof(packet_send_call), buffsend, pte);
    }
}
 
static void start_rtp(struct unistim_subchannel *sub)
{
    struct sockaddr_in sin = { 0, };
    struct sockaddr_in sout = { 0, };
    struct ast_sockaddr sin_tmp;
    struct ast_sockaddr sout_tmp;
 
    /* Sanity checks */
    if (!sub) {
        ast_log(LOG_WARNING, "start_rtp with a null subchannel !\n");
        return;
    }
    if (!sub->parent) {
        ast_log(LOG_WARNING, "start_rtp with a null line!\n");
        return;
    }
    if (!sub->parent->parent) {
        ast_log(LOG_WARNING, "start_rtp with a null device!\n");
        return;
    }
    if (!sub->parent->parent->session) {
        ast_log(LOG_WARNING, "start_rtp with a null session!\n");
        return;
    }
    if (!sub->owner) {
        ast_log(LOG_WARNING, "start_rtp with a null asterisk channel!\n");
        return;
    }
    sout = sub->parent->parent->session->sout;
    ast_mutex_lock(&sub->lock);
    /* Allocate the RTP */
    if (unistimdebug) {
        ast_verb(0, "Starting RTP. Bind on %s\n", ast_inet_ntoa(sout.sin_addr));
    }
    ast_sockaddr_from_sin(&sout_tmp, &sout);
    sub->rtp = ast_rtp_instance_new("asterisk", sched, &sout_tmp, NULL);
    if (!sub->rtp) {
        ast_log(LOG_WARNING, "Unable to create RTP session: %s binaddr=%s\n",
                strerror(errno), ast_inet_ntoa(sout.sin_addr));
        ast_mutex_unlock(&sub->lock);
        return;
    }
    ast_rtp_instance_set_prop(sub->rtp, AST_RTP_PROPERTY_RTCP, 1);
    ast_rtp_instance_set_channel_id(sub->rtp, ast_channel_uniqueid(sub->owner));
    ast_channel_internal_fd_set(sub->owner, 0, ast_rtp_instance_fd(sub->rtp, 0));
    ast_channel_internal_fd_set(sub->owner, 1, ast_rtp_instance_fd(sub->rtp, 1));
    ast_rtp_instance_set_qos(sub->rtp, qos.tos_audio, qos.cos_audio, "UNISTIM RTP");
    ast_rtp_instance_set_prop(sub->rtp, AST_RTP_PROPERTY_NAT, sub->parent->parent->nat);
 
    /* Create the RTP connection */
    sin.sin_family = AF_INET;
    /* Setting up RTP for our side */
    memcpy(&sin.sin_addr, &sub->parent->parent->session->sin.sin_addr,
           sizeof(sin.sin_addr));
 
    sin.sin_port = htons(find_rtp_port(sub));
    ast_sockaddr_from_sin(&sin_tmp, &sin);
    ast_rtp_instance_set_remote_address(sub->rtp, &sin_tmp);
    if (ast_format_cap_iscompatible_format(ast_channel_nativeformats(sub->owner), ast_channel_readformat(sub->owner)) == AST_FORMAT_CMP_NOT_EQUAL) {
        struct ast_format *tmpfmt;
        struct ast_str *cap_buf = ast_str_alloca(AST_FORMAT_CAP_NAMES_LEN);
 
        tmpfmt = ast_format_cap_get_format(ast_channel_nativeformats(sub->owner), 0);
        ast_log(LOG_WARNING,
                "Our read/writeformat has been changed to something incompatible: %s, using %s best codec from %s\n",
                ast_format_get_name(ast_channel_readformat(sub->owner)),
                ast_format_get_name(tmpfmt),
                ast_format_cap_get_names(ast_channel_nativeformats(sub->owner), &cap_buf));
 
        ast_channel_set_readformat(sub->owner, tmpfmt);
        ast_channel_set_writeformat(sub->owner, tmpfmt);
        ao2_ref(tmpfmt, -1);
    }
    send_start_rtp(sub);
    ast_mutex_unlock(&sub->lock);
}
 
static void send_dial_tone(struct unistimsession *pte)
{
    struct ast_tone_zone_sound *ts = NULL;
    struct ast_tone_zone_part tone_data;
    char *s = NULL;
    char *ind;
 
    if ((ts = ast_get_indication_tone(pte->device->tz, "dial"))) {
        ind = ast_strdupa(ts->data);
        s = strsep(&ind, ",");
        ast_tone_zone_part_parse(s, &tone_data);
        send_tone(pte, tone_data.freq1, tone_data.freq2);
        if (unistimdebug) {
            ast_verb(0, "Country code found (%s), freq1=%u freq2=%u\n",
                            pte->device->tz->country, tone_data.freq1, tone_data.freq2);
        }
        ts = ast_tone_zone_sound_unref(ts);
    }
}
 
static void show_phone_number(struct unistimsession *pte)
{
    char tmp[TEXT_LENGTH_MAX + 1];
    const char *tmp_number = ustmtext("Number:", pte);
    int line, tmp_copy, offset = 0, i;
 
    pte->device->phone_number[pte->device->size_phone_number] = '\0';
    if  (pte->device->size_phone_number > MAX_SCREEN_NUMBER) {
        offset = pte->device->size_phone_number - MAX_SCREEN_NUMBER - 1;
        if (offset > strlen(tmp_number)) {
            offset = strlen(tmp_number);
        }
        tmp_copy = strlen(tmp_number) - offset + 1;
        if (tmp_copy > sizeof(tmp)) {
            tmp_copy = sizeof(tmp);
        }
        memcpy(tmp, tmp_number + offset, tmp_copy);
    } else {
        ast_copy_string(tmp, tmp_number, sizeof(tmp));
    }
 
    offset = (pte->device->size_phone_number >= TEXT_LENGTH_MAX) ? (pte->device->size_phone_number - TEXT_LENGTH_MAX +1) : 0;
    if (pte->device->size_phone_number) {
        memcpy(tmp + strlen(tmp), pte->device->phone_number + offset, pte->device->size_phone_number - offset + 1);
    }
    offset = strlen(tmp);
 
    for (i = strlen(tmp); i < TEXT_LENGTH_MAX; i++) {
        tmp[i] = '.';
    }
    tmp[i] = '\0';
 
    line = (pte->device->height == 1) ? TEXT_LINE0 : TEXT_LINE2;
    send_text(line, TEXT_NORMAL, pte, tmp);
    send_blink_cursor(pte);
    send_cursor_pos(pte, (unsigned char) (line + offset));
    send_led_update(pte, LED_BAR_OFF);
}
 
static void handle_dial_page(struct unistimsession *pte)
{
    pte->state = STATE_DIALPAGE;
    if (pte->device->call_forward[0] == -1) {
        send_text(TEXT_LINE0, TEXT_NORMAL, pte, "");
        send_text(TEXT_LINE1, TEXT_NORMAL, pte, ustmtext("Enter forward", pte));
        send_text_status(pte, ustmtext("Fwd    Cancel BackSp Erase", pte));
        if (pte->device->call_forward[1] != 0) {
            ast_copy_string(pte->device->phone_number, pte->device->call_forward + 1,
                            sizeof(pte->device->phone_number));
            show_phone_number(pte);
            send_led_update(pte, LED_BAR_OFF);
            return;
        }
    } else {
        if ((pte->device->output == OUTPUT_HANDSET) &&
            (pte->device->receiver_state == STATE_ONHOOK)) {
            send_select_output(pte, OUTPUT_SPEAKER, pte->device->volume, MUTE_OFF);
        } else {
            send_select_output(pte, pte->device->output, pte->device->volume, MUTE_OFF);
        }
        send_dial_tone(pte);
 
        if (pte->device->height > 1) {
            send_text(TEXT_LINE0, TEXT_NORMAL, pte, ustmtext("Enter the number to dial", pte));
            send_text(TEXT_LINE1, TEXT_NORMAL, pte, ustmtext("and press Call", pte));
        }
        if (ast_strlen_zero(pte->device->redial_number)) {
            send_text_status(pte, ustmtext("Call          BackSp Erase", pte));
        } else {
            send_text_status(pte, ustmtext("Call   Redial BackSp Erase", pte));
        }
    }
 
    pte->device->size_phone_number = 0;
    pte->device->phone_number[0] = 0;
    show_phone_number(pte);
    change_favorite_icon(pte, FAV_ICON_PHONE_BLACK);
    send_icon(TEXT_LINE0, FAV_ICON_NONE, pte);
    pte->device->missed_call = 0;
    send_led_update(pte, LED_BAR_OFF);
    pte->device->lastmsgssent = -1;
    return;
}
 
static void swap_subs(struct unistim_subchannel *a, struct unistim_subchannel *b)
{
    struct ast_rtp_instance *rtp;
    int fds;
 
    if (unistimdebug) {
        ast_verb(0, "Swapping %p and %p\n", a, b);
    }
    if ((!a->owner) || (!b->owner)) {
        ast_log(LOG_WARNING,
                "Attempted to swap subchannels with a null owner : sub #%p=%p sub #%p=%p\n",
                a, a->owner, b, b->owner);
        return;
    }
    rtp = a->rtp;
    a->rtp = b->rtp;
    b->rtp = rtp;
 
    fds = ast_channel_fd(a->owner, 0);
    ast_channel_internal_fd_set(a->owner, 0, ast_channel_fd(b->owner, 0));
    ast_channel_internal_fd_set(b->owner, 0, fds);
 
    fds = ast_channel_fd(a->owner, 1);
    ast_channel_internal_fd_set(a->owner, 1, ast_channel_fd(b->owner, 1));
    ast_channel_internal_fd_set(b->owner, 1, fds);
}
 
/* Step 1 : Music On Hold for peer, Dialing screen for us */
static void transfer_call_step1(struct unistimsession *pte)
{
    struct unistim_subchannel *sub /*, *sub_trans */;
    struct unistim_device *d = pte->device;
 
    sub = get_sub(d, SUB_REAL);
    /* sub_trans = get_sub(d, SUB_THREEWAY); */
 
    if (!sub || !sub->owner) {
        ast_log(LOG_WARNING, "Unable to find subchannel for music on hold\n");
        return;
    }
    /* Start music on hold if appropriate */
    if (sub->moh) {
        ast_log(LOG_WARNING, "Transfer with peer already listening music on hold\n");
    } else {
        ast_queue_hold(sub->owner, sub->parent->musicclass);
        sub->moh = 1;
        sub->subtype = SUB_THREEWAY;
    }
    sub_start_silence(pte, sub);
    handle_dial_page(pte);
}
 
static void transfer_cancel_step2(struct unistimsession *pte)
{
    struct unistim_subchannel *sub, *sub_trans;
    struct unistim_device *d = pte->device;
 
    sub = get_sub(d, SUB_REAL);
    sub_trans = get_sub(d, SUB_THREEWAY);
 
    if (!sub || !sub->owner) {
        ast_log(LOG_WARNING, "Unable to find subchannel for music on hold\n");
        return;
    }
    if (sub_trans) {
        if (unistimdebug) {
            ast_verb(0, "Transfer canceled, hangup our threeway channel\n");
        }
        if (sub->owner) {
            swap_subs(sub, sub_trans);
            ast_queue_unhold(sub_trans->owner);
            sub_trans->moh = 0;
            sub_trans->subtype = SUB_REAL;
            sub->subtype = SUB_THREEWAY;
            ast_queue_hangup_with_cause(sub->owner, AST_CAUSE_NORMAL_CLEARING);
        } else {
            ast_log(LOG_WARNING, "Canceling a threeway channel without owner\n");
        }
        return;
    }
}
 
/* From phone to PBX */
static void handle_call_outgoing(struct unistimsession *s)
{
    struct ast_channel *c;
    struct unistim_subchannel *sub;
    int softkey;
 
    s->state = STATE_CALL;
 
    sub = get_sub(s->device, SUB_THREEWAY);
    if (sub) {
        /* If sub for threway call created than we use transfer behavior */
        struct unistim_subchannel *sub_trans = NULL;
        struct unistim_device *d = s->device;
 
        sub_trans = get_sub(d, SUB_REAL);
        if (sub_trans) {
            ast_log(LOG_WARNING, "Can't transfer while active subchannel exists!\n");
            return;
        }
        if (!sub->owner) {
            ast_log(LOG_WARNING, "Unable to find subchannel with music on hold\n");
            return;
        }
 
        sub_trans = unistim_alloc_sub(d, SUB_REAL);
        if (!sub_trans) {
            ast_log(LOG_WARNING, "Unable to allocate three-way subchannel\n");
            return;
        }
        sub_trans->parent = sub->parent;
        sub_stop_silence(s, sub);
        send_tone(s, 0, 0);
        /* Make new channel */
        c = unistim_new(sub_trans, AST_STATE_DOWN, NULL, NULL);
        if (!c) {
            ast_log(LOG_WARNING, "Cannot allocate new structure on channel %p\n", sub->parent);
            return;
        }
        /* Swap things around between the three-way and real call */
        swap_subs(sub, sub_trans);
        send_select_output(s, s->device->output, s->device->volume, MUTE_OFF);
        if (s->device->height == 1) {
            send_text(TEXT_LINE0, TEXT_NORMAL, s, s->device->phone_number);
        } else {
            send_text(TEXT_LINE0, TEXT_NORMAL, s, ustmtext("Calling (pre-transfer)", s));
            send_text(TEXT_LINE1, TEXT_NORMAL, s, s->device->phone_number);
            send_text(TEXT_LINE2, TEXT_NORMAL, s, ustmtext("Dialing...", s));
        }
        send_text_status(s, ustmtext("TransfrCancel", s));
 
        if (ast_pthread_create(&sub->ss_thread, NULL, unistim_ss, c)) {
            ast_log(LOG_WARNING, "Unable to start simple switch on channel %p\n", c);
            sub->ss_thread = AST_PTHREADT_NULL;
            ast_hangup(c);
            return;
        }
        if (unistimdebug) {
            ast_verb(0, "Started three way call on channel %p (%s) subchan %u\n",
                 sub_trans->owner, ast_channel_name(sub_trans->owner), sub_trans->subtype);
        }
        return;
    }
 
    softkey = get_avail_softkey(s, NULL);
    if (softkey == -1) {
        ast_log(LOG_WARNING, "Have no avail softkey for calling\n");
        return;
    }
    sub = get_sub(s->device, SUB_REAL);
    if (sub) { /* have already call assigned */
        sub_hold(s, sub); /* Need to put on hold */
    }
    if (!(sub = unistim_alloc_sub(s->device, SUB_REAL))) {
        ast_log(LOG_WARNING, "Unable to allocate subchannel!\n");
        return;
    }
    sub->parent = s->device->sline[softkey];
    s->device->ssub[softkey] = sub;
    sub->softkey = softkey;
 
    if (unistimdebug) {
        ast_verb(0, "Using softkey %d, line %p\n", sub->softkey, sub->parent);
    }
    send_favorite_short(sub->softkey, FAV_ICON_OFFHOOK_BLACK, s);
    s->device->selected = -1;
    if (!sub->owner) {            /* A call is already in progress ? */
        RAII_VAR(struct ast_features_pickup_config *, pickup_cfg, NULL, ao2_cleanup);
        const char *pickupexten;
 
        c = unistim_new(sub, AST_STATE_DOWN, NULL, NULL);   /* No, starting a new one */
        if (!sub->rtp) { /* Need to start RTP before calling ast_pbx_run */
            start_rtp(sub);
        }
        if (c) {
            ast_channel_lock(c);
            pickup_cfg = ast_get_chan_features_pickup_config(c);
            if (!pickup_cfg) {
                ast_log(LOG_ERROR, "Unable to retrieve pickup configuration options. Unable to detect call pickup extension\n");
                pickupexten = "";
            } else {
                pickupexten = ast_strdupa(pickup_cfg->pickupexten);
            }
            ast_channel_unlock(c);
        }
        if (c && !strcmp(s->device->phone_number, pickupexten)) {
            if (unistimdebug) {
                ast_verb(0, "Try to pickup in unistim_new\n");
            }
            send_text(TEXT_LINE0, TEXT_NORMAL, s, "");
            send_text_status(s, ustmtext("       Transf        Hangup", s));
            send_start_timer(s);
            if (ast_pickup_call(c)) {
                ast_log(LOG_NOTICE, "Nothing to pick up\n");
                ast_channel_hangupcause_set(c, AST_CAUSE_CALL_REJECTED);
            } else {
                ast_channel_hangupcause_set(c, AST_CAUSE_NORMAL_CLEARING);
            }
            ast_hangup(c);
            c = NULL;
                } else if (c) {
            send_select_output(s, s->device->output, s->device->volume, MUTE_OFF);
            send_tone(s, 0, 0); /* Dialing empty number should also stop dial tone */
            if (s->device->height == 1) {
                if (strlen(s->device->phone_number) > 0) {
                    send_text(TEXT_LINE0, TEXT_NORMAL, s, s->device->phone_number);
                } else {
                    send_text(TEXT_LINE0, TEXT_NORMAL, s, ustmtext("Calling...", s));
                }
            } else {
                send_text(TEXT_LINE0, TEXT_NORMAL, s, ustmtext("Calling :", s));
                send_text(TEXT_LINE1, TEXT_NORMAL, s, s->device->phone_number);
                send_text(TEXT_LINE2, TEXT_NORMAL, s, ustmtext("Dialing...", s));
            }
            send_text_status(s, ustmtext("                     Hangup", s));
 
            /* start switch */
            if (ast_pthread_create(&sub->ss_thread, NULL, unistim_ss, c)) {
                ast_log(LOG_WARNING, "Unable to create switch thread\n");
                sub->ss_thread = AST_PTHREADT_NULL;
                ast_queue_hangup_with_cause(c, AST_CAUSE_SWITCH_CONGESTION);
            }
        } else
            ast_log(LOG_WARNING, "Unable to create channel for %s@%s\n",
                    sub->parent->name, s->device->name);
    } else {
        ast_debug(1, "Current sub [%s] already has owner\n", ast_channel_name(sub->owner));
    }
    return;
}
 
/* From PBX to phone */
static void handle_call_incoming(struct unistimsession *s)
{
    struct unistim_subchannel *sub = NULL;
    int i;
 
    s->state = STATE_CALL;
    s->device->missed_call = 0;
    send_no_ring(s);
    sub = get_sub(s->device, SUB_RING); /* Put other SUB_REAL call on hold */
    if (!sub) {
        ast_log(LOG_WARNING, "No ringing lines on: %s\n", s->device->name);
        return;
    }
    /* Change icons for all ringing keys */
    for (i = 0; i < FAVNUM; i++) {
        if (!s->device->ssub[i]) { /* No sub assigned - skip */
            continue;
        }
        if (s->device->ssub[i]->subtype == SUB_REAL) {
            sub_hold(s, s->device->ssub[i]);
        }
        if (s->device->ssub[i] != sub) {
            continue;
        }
        if (sub->softkey == i) { /* If softkey assigned at this moment - do not erase */
            continue;
        }
        if (sub->softkey < 0) { /* If softkey not defined - first one used */
            sub->softkey = i;
            continue;
        }
        send_favorite_short(i, FAV_LINE_ICON, s);
        s->device->ssub[i] = NULL;
    }
    if (sub->softkey < 0) {
        ast_log(LOG_WARNING, "Can not assign softkey for incoming call on: %s\n", s->device->name);
        return;
    }
    send_favorite_short(sub->softkey, FAV_ICON_OFFHOOK_BLACK, s);
    sub->parent = s->device->sline[sub->softkey];
    sub->subtype = SUB_REAL;
    if (unistimdebug) {
        ast_verb(0, "Handle Call Incoming for %s@%s\n", sub->parent->name,
                    s->device->name);
    }
    start_rtp(sub);
    if (!sub->rtp) {
        ast_log(LOG_WARNING, "Unable to create channel for %s@%s\n", sub->parent->name, s->device->name);
        return;
    }
    if (sub->owner) {
        ast_queue_control(sub->owner, AST_CONTROL_ANSWER);
    }
    send_text(TEXT_LINE2, TEXT_NORMAL, s, ustmtext("is on-line", s));
    send_text_status(s, ustmtext("       Transf        Hangup", s));
    send_start_timer(s);
 
    if ((s->device->output == OUTPUT_HANDSET) &&
        (s->device->receiver_state == STATE_ONHOOK)) {
        send_select_output(s, OUTPUT_SPEAKER, s->device->volume, MUTE_OFF);
    } else {
        send_select_output(s, s->device->output, s->device->volume, MUTE_OFF);
    }
    write_history(s, 'i', 0);
    return;
}
 
static int send_dtmf_tone(struct unistimsession *pte, char digit)
{
    int row, col;
 
    if (unistimdebug) {
        ast_verb(0, "Phone Play Digit %c\n", digit);
    }
    if (pte->device->dtmfduration > 0) {
        row = (digit - '1') % 3;
        col = (digit - '1' - row) / 3;
        if (digit >= '1' && digit <='9') {
            send_tone(pte, dtmf_row[row], dtmf_col[col]);
        } else if (digit >= 'A' && digit <= 'D') {
            send_tone(pte, dtmf_row[digit-'A'], dtmf_col[3]);
        } else if (digit == '*') {
            send_tone(pte, dtmf_row[3], dtmf_col[0]);
        } else if (digit == '0') {
            send_tone(pte, dtmf_row[3], dtmf_col[1]);
        } else if (digit == '#') {
            send_tone(pte, dtmf_row[3], dtmf_col[2]);
        } else {
            send_tone(pte, 500, 2000);
        }
    }
    return 0;
}
 
static int unistim_do_senddigit(struct unistimsession *pte, char digit)
{
    struct ast_frame f = { .frametype = AST_FRAME_DTMF, .subclass.integer = digit, .src = "unistim" };
    struct unistim_subchannel *sub;
 
    sub = get_sub(pte->device, SUB_REAL);
    if (!sub || !sub->owner || sub->alreadygone) {
        ast_log(LOG_WARNING, "Unable to find subchannel in dtmf senddigit\n");
        return -1;
    }
 
    /* Send DTMF indication _before_ playing sounds */
    ast_queue_frame(sub->owner, &f);
    if (pte->device->dtmfduration > 0) {
        if (unistimdebug) {
            ast_verb(0, "Send Digit %c (%i ms)\n", digit, pte->device->dtmfduration);
        }
        send_dtmf_tone(pte, digit);
        usleep(pte->device->dtmfduration * 1000);    /* XXX Less than perfect, blocking an important thread is not a good idea */
        send_tone(pte, 0, 0);
    }
    return 0;
}
 
static void handle_key_fav(struct unistimsession *pte, char keycode)
{
    int keynum = keycode - KEY_FAV0;
    struct unistim_subchannel *sub, *sub_key = NULL;
    sub = get_sub_holding(pte->device, SUB_REAL, 0);
 
    /* Make an action on selected favorite key */
    if (!pte->device->ssub[keynum]) { /* Key have no assigned call */
        sub = get_sub_holding(pte->device, SUB_REAL, 0);
        send_favorite_selected(FAV_LINE_ICON, pte);
        if (is_key_line(pte->device, keynum)) {
            if (unistimdebug) {
                ast_verb(0, "Handle line w/o sub - dialpage\n");
            }
            pte->device->selected = keynum;
            sub_hold(pte, sub); /* Put active call on hold */
            send_stop_timer(pte);
            handle_dial_page(pte);
        } else if (is_key_favorite(pte->device, keynum)) {
            /* Put active call on hold in handle_call_outgoing function, after preparation and
             checking if lines available for calling */
            if (unistimdebug) {
                ast_verb(0, "Handle favorite w/o sub - dialing\n");
            }
            if ((pte->device->output == OUTPUT_HANDSET) &&
                (pte->device->receiver_state == STATE_ONHOOK)) {
                send_select_output(pte, OUTPUT_SPEAKER, pte->device->volume, MUTE_OFF);
            } else {
                send_select_output(pte, pte->device->output, pte->device->volume, MUTE_OFF);
            }
            key_favorite(pte, keycode);
        }
    } else {
        sub_key = pte->device->ssub[keynum];
        /* Favicon have assigned sub, activate it and put current on hold */
        if (sub_key->subtype == SUB_REAL && !sub_key->holding) {
            sub_hold(pte, sub_key);
            show_main_page(pte);
        } else if (sub_key->subtype == SUB_REAL && sub_key->holding) {
            /* We are going to unhold line (we should put active line on hold, of any) */
            if (pte->state == STATE_DIALPAGE){
                send_tone(pte, 0, 0);
            }
            sub_hold(pte, sub);
            send_callerid_screen(pte, sub_key);
            sub_unhold(pte, sub_key);
            pte->state = STATE_CALL;
        } else if (sub_key->subtype == SUB_RING) {
            sub_hold(pte, sub);
            sub_key->softkey = keynum;
            handle_call_incoming(pte);
        }
    }
}
 
static void key_call(struct unistimsession *pte, char keycode)
{
    struct unistim_subchannel *sub = get_sub(pte->device, SUB_REAL);
    struct unistim_subchannel *sub_3way = get_sub(pte->device, SUB_THREEWAY);
 
    if (!sub) {
        return;
    }
    if ((keycode >= KEY_0) && (keycode <= KEY_SHARP)) {
        if (keycode == KEY_SHARP) {
            keycode = '#';
        } else if (keycode == KEY_STAR) {
            keycode = '*';
        } else {
            keycode -= 0x10;
        }
        unistim_do_senddigit(pte, keycode);
        return;
    }
    switch (keycode) {
    case KEY_FUNC1:
        if (sub->owner && ast_channel_state(sub->owner) == AST_STATE_UP) {
            if (sub_3way) {
                close_call(pte);
            }
        }
        break;
    case KEY_FUNC2:
        if (sub_3way) {
            transfer_cancel_step2(pte);
        } else if (ast_channel_state(sub->owner) == AST_STATE_UP) {
            transfer_call_step1(pte);
        }
        break;
    case KEY_HANGUP:
    case KEY_FUNC4:
        if (!sub_3way) {
            close_call(pte);
        }
        break;
    case KEY_FAV0:
    case KEY_FAV1:
    case KEY_FAV2:
    case KEY_FAV3:
    case KEY_FAV4:
    case KEY_FAV5:
        handle_key_fav(pte, keycode);
        break;
    case KEY_HEADPHN:
        if (pte->device->output == OUTPUT_HEADPHONE) {
            send_select_output(pte, OUTPUT_HANDSET, pte->device->volume, MUTE_OFF);
        } else {
            send_select_output(pte, OUTPUT_HEADPHONE, pte->device->volume, MUTE_OFF);
        }
        break;
    case KEY_LOUDSPK:
        if (pte->device->output != OUTPUT_SPEAKER)
            send_select_output(pte, OUTPUT_SPEAKER, pte->device->volume, MUTE_OFF);
        else
            send_select_output(pte, pte->device->previous_output, pte->device->volume,
                             MUTE_OFF);
        break;
    case KEY_ONHOLD:
        if (!sub) {
            if(pte->device->ssub[pte->device->selected]) {
                sub = pte->device->ssub[pte->device->selected];
            } else {
                break;
            }
        }
        if (sub->holding) {
            sub_unhold(pte, sub);
        } else {
            sub_hold(pte, sub);
        }
        break;
    }
    return;
}
 
static void key_ringing(struct unistimsession *pte, char keycode)
{
    switch (keycode) {
    case KEY_FAV0:
    case KEY_FAV1:
    case KEY_FAV2:
    case KEY_FAV3:
    case KEY_FAV4:
    case KEY_FAV5:
        handle_key_fav(pte, keycode);
        break;
    case KEY_FUNC3:
        ignore_call(pte);
        break;
    case KEY_HANGUP:
    case KEY_FUNC4:
        discard_call(pte);
        break;
    case KEY_LOUDSPK:
        pte->device->output = OUTPUT_SPEAKER;
        handle_call_incoming(pte);
        break;
    case KEY_HEADPHN:
        pte->device->output = OUTPUT_HEADPHONE;
        handle_call_incoming(pte);
        break;
    case KEY_FUNC1:
        handle_call_incoming(pte);
        break;
    }
    return;
}
 
static void key_favorite(struct unistimsession *pte, char keycode)
{
    int fav = keycode - KEY_FAV0;
    if (!is_key_favorite(pte->device, fav)) {
        ast_log(LOG_WARNING, "It's not a favorite key\n");
        return;
    }
    ast_copy_string(pte->device->phone_number, pte->device->softkeynumber[fav],
                    sizeof(pte->device->phone_number));
    handle_call_outgoing(pte);
    return;
}
 
static void key_dial_page(struct unistimsession *pte, char keycode)
{
    struct unistim_subchannel *sub = get_sub(pte->device, SUB_THREEWAY);
 
    pte->device->nextdial = 0;
    if (keycode == KEY_FUNC3) {
        if (pte->device->size_phone_number <= 1) {
            keycode = KEY_FUNC4;
        } else {
            pte->device->size_phone_number -= 2;
            keycode = pte->device->phone_number[pte->device->size_phone_number] + 0x10;
        }
    }
    if (keycode == KEY_SHARP && pte->device->sharp_dial == 1) {
        keycode = KEY_FUNC1;
    }
    if ((keycode >= KEY_0) && (keycode <= KEY_SHARP)) {
        int i = pte->device->size_phone_number;
 
        if (pte->device->size_phone_number == 0) {
            send_tone(pte, 0, 0);
        }
        if (keycode == KEY_SHARP) {
            keycode = '#';
        } else if (keycode == KEY_STAR) {
            keycode = '*';
        } else {
            keycode -= 0x10;
        }
        pte->device->phone_number[i] = keycode;
        pte->device->size_phone_number++;
        pte->device->phone_number[i + 1] = 0;
        show_phone_number(pte);
 
        if (ast_exists_extension(NULL, pte->device->context, pte->device->phone_number, 1, NULL) &&
            !ast_matchmore_extension(NULL, pte->device->context, pte->device->phone_number, 1, NULL)) {
            keycode = KEY_FUNC1;
        } else {
            if (pte->device->interdigit_timer) {
                pte->device->nextdial = get_tick_count() + pte->device->interdigit_timer;
            }
        }
    }
    if (keycode == KEY_FUNC4) {
        pte->device->size_phone_number = 0;
        show_phone_number(pte);
        return;
    }
 
    if (pte->device->call_forward[0] == -1) {
        if (keycode == KEY_FUNC1) {
            ast_copy_string(pte->device->call_forward, pte->device->phone_number,
                            sizeof(pte->device->call_forward));
            show_main_page(pte);
        } else if ((keycode == KEY_FUNC2) || (keycode == KEY_HANGUP)) {
            pte->device->call_forward[0] = '\0';
            send_led_update(pte, LED_SPEAKER_OFF);
            send_led_update(pte, LED_HEADPHONE_OFF);
            show_main_page(pte);
        }
        return;
    }
    switch (keycode) {
    case KEY_FUNC2:
        if (ast_strlen_zero(pte->device->redial_number)) {
            break;
        }
        ast_copy_string(pte->device->phone_number, pte->device->redial_number,
                        sizeof(pte->device->phone_number));
    case KEY_FUNC1:
        handle_call_outgoing(pte);
        break;
    case KEY_HANGUP:
        if (sub && sub->owner) {
            sub_stop_silence(pte, sub);
            send_tone(pte, 0, 0);
            ast_queue_unhold(sub->owner);
            sub->moh = 0;
            sub->subtype = SUB_REAL;
            pte->state = STATE_CALL;
 
            send_text_status(pte, ustmtext("       Transf        Hangup", pte));
            send_callerid_screen(pte, sub);
        } else {
            send_led_update(pte, LED_SPEAKER_OFF);
            send_led_update(pte, LED_HEADPHONE_OFF);
            show_main_page(pte);
        }
        break;
    case KEY_FAV0:
    case KEY_FAV1:
    case KEY_FAV2:
    case KEY_FAV3:
    case KEY_FAV4:
    case KEY_FAV5:
        send_favorite_selected(FAV_LINE_ICON, pte);
        pte->device->selected = -1;
        handle_key_fav(pte, keycode);
        break;
    case KEY_LOUDSPK:
        if (pte->device->output == OUTPUT_SPEAKER) {
            if (pte->device->receiver_state == STATE_OFFHOOK) {
                send_select_output(pte, pte->device->previous_output, pte->device->volume,
                                 MUTE_OFF);
            } else {
                show_main_page(pte);
            }
        } else {
            send_select_output(pte, OUTPUT_SPEAKER, pte->device->volume, MUTE_OFF);
        }
        break;
    case KEY_HEADPHN:
        if (pte->device->output == OUTPUT_HEADPHONE) {
            if (pte->device->receiver_state == STATE_OFFHOOK) {
                send_select_output(pte, OUTPUT_HANDSET, pte->device->volume, MUTE_OFF);
            } else {
                show_main_page(pte);
            }
        } else {
            send_select_output(pte, OUTPUT_HEADPHONE, pte->device->volume, MUTE_OFF);
        }
        break;
    }
    return;
}
 
static void handle_select_option(struct unistimsession *pte)
{
    char tmp[128];
 
    if (pte->state != STATE_SELECTOPTION) {
        pte->state = STATE_SELECTOPTION;
        pte->size_buff_entry = 1;
        pte->buff_entry[0] = 0; /* Position in menu */
    }
    snprintf(tmp, sizeof(tmp), "%d. %s", pte->buff_entry[0] + 1, ustmtext(options_menu[(int)pte->buff_entry[0]].label, pte));
    send_text(TEXT_LINE0, TEXT_NORMAL, pte, tmp);
    send_text_status(pte, ustmtext("Select               Cancel", pte));
    return;
}
 
static void key_select_option(struct unistimsession *pte, char keycode)
{
    switch (keycode) {
    case KEY_DOWN:
        pte->buff_entry[0]++;
        if (options_menu[(int)pte->buff_entry[0]].label == NULL) {
            pte->buff_entry[0]--;
        }
        break;
    case KEY_UP:
        if (pte->buff_entry[0] > 0) {
            pte->buff_entry[0]--;
        }
        break;
    case KEY_FUNC1:
        options_menu[(int)pte->buff_entry[0]].handle_option(pte);
        return;
    case KEY_HANGUP:
    case KEY_FUNC4:
        show_main_page(pte);
        return;
    }
 
    handle_select_option(pte);
    return;
}
 
#define SELECTCODEC_START_ENTRY_POS 15
#define SELECTCODEC_MAX_LENGTH 2
#define SELECTCODEC_MSG "Codec number : .."
static void handle_select_codec(struct unistimsession *pte)
{
    char buf[30], buf2[6];
 
    pte->state = STATE_SELECTCODEC;
    ast_copy_string(buf, ustmtext("Using codec", pte), sizeof(buf));
    snprintf(buf2, sizeof(buf2), " %d", pte->device->codec_number);
    strcat(buf, buf2);
    strcat(buf, " (G711u=0,");
 
    send_text(TEXT_LINE0, TEXT_NORMAL, pte, buf);
    send_text(TEXT_LINE1, TEXT_NORMAL, pte, "G723=4,G711a=8,G729A=18)");
    send_text(TEXT_LINE2, TEXT_INVERSE, pte, SELECTCODEC_MSG);
    send_blink_cursor(pte);
    send_cursor_pos(pte, TEXT_LINE2 + SELECTCODEC_START_ENTRY_POS);
    pte->size_buff_entry = 0;
    send_text_status(pte, ustmtext("Select BackSp Erase  Cancel", pte));
    return;
}
 
static void key_select_codec(struct unistimsession *pte, char keycode)
{
    if (keycode == KEY_FUNC2) {
        if (pte->size_buff_entry <= 1) {
            keycode = KEY_FUNC3;
        } else {
            pte->size_buff_entry -= 2;
            keycode = pte->buff_entry[pte->size_buff_entry] + 0x10;
        }
    }
    if ((keycode >= KEY_0) && (keycode <= KEY_9)) {
        char tmpbuf[] = SELECTCODEC_MSG;
        int i = 0;
 
        if (pte->size_buff_entry >= SELECTCODEC_MAX_LENGTH) {
            return;
        }
        while (i < pte->size_buff_entry) {
            tmpbuf[i + SELECTCODEC_START_ENTRY_POS] = pte->buff_entry[i];
            i++;
        }
        tmpbuf[i + SELECTCODEC_START_ENTRY_POS] = keycode - 0x10;
        pte->buff_entry[i] = keycode - 0x10;
        pte->size_buff_entry++;
        send_text(TEXT_LINE2, TEXT_INVERSE, pte, tmpbuf);
        send_blink_cursor(pte);
        send_cursor_pos(pte,
                      (unsigned char) (TEXT_LINE2 + SELECTCODEC_START_ENTRY_POS + 1 + i));
        return;
    }
 
    switch (keycode) {
    case KEY_FUNC1:
        if (pte->size_buff_entry == 1) {
            pte->device->codec_number = pte->buff_entry[0] - 48;
        } else if (pte->size_buff_entry == 2) {
            pte->device->codec_number =
                ((pte->buff_entry[0] - 48) * 10) + (pte->buff_entry[1] - 48);
        }
        show_main_page(pte);
        break;
    case KEY_FUNC3:
        pte->size_buff_entry = 0;
        send_text(TEXT_LINE2, TEXT_INVERSE, pte, SELECTCODEC_MSG);
        send_blink_cursor(pte);
        send_cursor_pos(pte, TEXT_LINE2 + SELECTCODEC_START_ENTRY_POS);
        break;
    case KEY_HANGUP:
    case KEY_FUNC4:
        show_main_page(pte);
        break;
    }
    return;
}
 
static int find_language(const char* lang)
{
    int i = 0;
    while (options_languages[i].lang_short != NULL) {
        if(!strcmp(options_languages[i].lang_short, lang)) {
            return i;
        }
        i++;
    }
    return 0;
}
 
static void handle_select_language(struct unistimsession *pte)
{
    char tmp_language[40];
    struct unistim_languages lang;
 
    if (pte->state != STATE_SELECTLANGUAGE) {
        pte->state = STATE_SELECTLANGUAGE;
        pte->size_buff_entry = 1;
        pte->buff_entry[0] = find_language(pte->device->language);
    }
    lang = options_languages[(int)pte->buff_entry[0]];
    ast_copy_string(tmp_language, pte->device->language, sizeof(tmp_language));
    ast_copy_string(pte->device->language, lang.lang_short, sizeof(pte->device->language));
    send_charset_update(pte, lang.encoding);
    send_text(TEXT_LINE0, TEXT_NORMAL, pte, ustmtext(lang.label, pte));
 
    ast_copy_string(pte->device->language, tmp_language, sizeof(pte->device->language));
    lang = options_languages[find_language(pte->device->language)];
    send_charset_update(pte, lang.encoding);
    send_text_status(pte, ustmtext("Select               Cancel", pte));
    return;
}
 
static void key_select_language(struct unistimsession *pte, char keycode)
{
    switch (keycode) {
    case KEY_DOWN:
        pte->buff_entry[0]++;
        if (options_languages[(int)pte->buff_entry[0]].label == NULL) {
            pte->buff_entry[0]--;
        }
        break;
    case KEY_UP:
        if (pte->buff_entry[0] > 0) {
            pte->buff_entry[0]--;
        }
        break;
    case KEY_FUNC1:
        ast_copy_string(pte->device->language, options_languages[(int)pte->buff_entry[0]].lang_short, sizeof(pte->device->language));
        send_charset_update(pte, options_languages[(int)pte->buff_entry[0]].encoding);
        refresh_all_favorite(pte);
        show_main_page(pte);
        return;
    case KEY_HANGUP:
    case KEY_FUNC4:
        handle_select_option(pte);
        return;
    }
 
    handle_select_language(pte);
    return;
}
 
 
#define SELECTEXTENSION_START_ENTRY_POS 0
#define SELECTEXTENSION_MAX_LENGTH 10
#define SELECTEXTENSION_MSG ".........."
static void show_extension_page(struct unistimsession *pte)
{
    pte->state = STATE_EXTENSION;
 
    send_text(TEXT_LINE0, TEXT_NORMAL, pte, ustmtext("Please enter a Terminal", pte));
    send_text(TEXT_LINE1, TEXT_NORMAL, pte, ustmtext("Number (TN) :", pte));
    send_text(TEXT_LINE2, TEXT_NORMAL, pte, SELECTEXTENSION_MSG);
    send_blink_cursor(pte);
    send_cursor_pos(pte, TEXT_LINE2 + SELECTEXTENSION_START_ENTRY_POS);
    send_text_status(pte, ustmtext("Enter  BackSpcErase", pte));
    pte->size_buff_entry = 0;
    return;
}
 
static void key_select_extension(struct unistimsession *pte, char keycode)
{
    if (keycode == KEY_FUNC2) {
        if (pte->size_buff_entry <= 1) {
            keycode = KEY_FUNC3;
        } else {
            pte->size_buff_entry -= 2;
            keycode = pte->buff_entry[pte->size_buff_entry] + 0x10;
        }
    }
    if ((keycode >= KEY_0) && (keycode <= KEY_9)) {
        char tmpbuf[] = SELECTEXTENSION_MSG;
        int i = 0;
 
        if (pte->size_buff_entry >= SELECTEXTENSION_MAX_LENGTH) {
            return;
        }
        while (i < pte->size_buff_entry) {
            tmpbuf[i + SELECTEXTENSION_START_ENTRY_POS] = pte->buff_entry[i];
            i++;
        }
        tmpbuf[i + SELECTEXTENSION_START_ENTRY_POS] = keycode - 0x10;
        pte->buff_entry[i] = keycode - 0x10;
        pte->size_buff_entry++;
        send_text(TEXT_LINE2, TEXT_NORMAL, pte, tmpbuf);
        send_blink_cursor(pte);
        send_cursor_pos(pte, (unsigned char) (TEXT_LINE2 + SELECTEXTENSION_START_ENTRY_POS + 1 + i));
        return;
    }
 
    switch (keycode) {
    case KEY_FUNC1:
        if (pte->size_buff_entry < 1) {
            return;
        }
        if (autoprovisioning == AUTOPROVISIONING_TN) {
            struct unistim_device *d;
 
            /* First step : looking for this TN in our device list */
            ast_mutex_lock(&devicelock);
            d = devices;
            pte->buff_entry[pte->size_buff_entry] = '\0';
            while (d) {
                if (d->id[0] == 'T') {  /* It's a TN device ? */
                    /* It's the TN we're looking for ? */
                    if (!strcmp((d->id) + 1, pte->buff_entry)) {
                        pte->device = d;
                        d->session = pte;
                        d->codec_number = DEFAULT_CODEC;
                        d->missed_call = 0;
                        d->receiver_state = STATE_ONHOOK;
                        strcpy(d->id, pte->macaddr);
                        pte->device->extension_number[0] = 'T';
                        pte->device->extension = EXTENSION_TN;
                        ast_copy_string((pte->device->extension_number) + 1,
                                        pte->buff_entry, pte->size_buff_entry + 1);
                        ast_mutex_unlock(&devicelock);
                        show_main_page(pte);
                        refresh_all_favorite(pte);
                        return;
                    }
                }
                d = d->next;
            }
            ast_mutex_unlock(&devicelock);
            send_text(TEXT_LINE0, TEXT_NORMAL, pte, ustmtext("Invalid Terminal Number.", pte));
            send_text(TEXT_LINE1, TEXT_NORMAL, pte, ustmtext("Please try again :", pte));
            send_cursor_pos(pte, (unsigned char) (TEXT_LINE2 + SELECTEXTENSION_START_ENTRY_POS +
                                           pte->size_buff_entry));
            send_blink_cursor(pte);
        } else {
            ast_copy_string(pte->device->extension_number, pte->buff_entry,
                            pte->size_buff_entry + 1);
            if (register_extension(pte)) {
                send_text(TEXT_LINE0, TEXT_NORMAL, pte, ustmtext("Invalid extension.", pte));
                send_text(TEXT_LINE1, TEXT_NORMAL, pte, ustmtext("Please try again :", pte));
                send_cursor_pos(pte, (unsigned char) (TEXT_LINE2 +
                                           SELECTEXTENSION_START_ENTRY_POS +
                                           pte->size_buff_entry));
                send_blink_cursor(pte);
            } else
                show_main_page(pte);
        }
        break;
    case KEY_FUNC3:
        pte->size_buff_entry = 0;
        send_text(TEXT_LINE2, TEXT_NORMAL, pte, SELECTEXTENSION_MSG);
        send_blink_cursor(pte);
        send_cursor_pos(pte, TEXT_LINE2 + SELECTEXTENSION_START_ENTRY_POS);
        break;
    }
    return;
}
 
static void show_entry_history(struct unistimsession *pte, FILE ** f)
{
    char line[TEXT_LENGTH_MAX + 1], status[STATUS_LENGTH_MAX + 1], func1[10], func2[10],
        func3[10];
 
    /* Display date/time and call status */
    if (fread(line, TEXT_LENGTH_MAX, 1, *f) != 1) {
        display_last_error("Can't read history date entry");
        fclose(*f);
        return;
    }
    line[sizeof(line) - 1] = '\0';
    if (pte->device->height == 1) {
        if (pte->buff_entry[3] == 1) {
            send_text(TEXT_LINE0, TEXT_NORMAL, pte, line);
        }
    } else {
        send_text(TEXT_LINE0, TEXT_NORMAL, pte, line);
    }
    /* Display number */
    if (fread(line, TEXT_LENGTH_MAX, 1, *f) != 1) {
        display_last_error("Can't read callerid entry");
        fclose(*f);
        return;
    }
    line[sizeof(line) - 1] = '\0';
    ast_copy_string(pte->device->lst_cid, line, sizeof(pte->device->lst_cid));
    ast_trim_blanks(pte->device->lst_cid);
    if (pte->device->height == 1) {
        if (pte->buff_entry[3] == 2) {
            send_text(TEXT_LINE0, TEXT_NORMAL, pte, line);
        }
    } else {
        send_text(TEXT_LINE1, TEXT_NORMAL, pte, line);
    }
    /* Display name */
    if (fread(line, TEXT_LENGTH_MAX, 1, *f) != 1) {
        display_last_error("Can't read callername entry");
        fclose(*f);
        return;
    }
    line[sizeof(line) - 1] = '\0';
    if (pte->device->height == 1) {
        if (pte->buff_entry[3] == 3) {
            send_text(TEXT_LINE0, TEXT_NORMAL, pte, line);
        }
        } else {
                send_text(TEXT_LINE2, TEXT_NORMAL, pte, line);
        }
    fclose(*f);
 
    snprintf(line, sizeof(line), "%s %03d/%03d", ustmtext("Call", pte), pte->buff_entry[2],
             pte->buff_entry[1]);
    send_texttitle(pte, line);
 
    if (pte->buff_entry[2] == 1) {
        ast_copy_string(func1, "       ", sizeof(func1));
    } else {
        ast_copy_string(func1, ustmtext("Prev   ", pte), sizeof(func1));
    }
    if (pte->buff_entry[2] >= pte->buff_entry[1]) {
        ast_copy_string(func2, "       ", sizeof(func2));
    } else {
        ast_copy_string(func2, ustmtext("Next   ", pte), sizeof(func2));
    }
    if (strlen(pte->device->lst_cid)) {
        ast_copy_string(func3, ustmtext("Redial ", pte), sizeof(func3));
    } else {
        ast_copy_string(func3, "       ", sizeof(func3));
    }
    snprintf(status, sizeof(status), "%s%s%s%s", func1, func2, func3, ustmtext("Cancel", pte));
    send_text_status(pte, status);
}
 
static char open_history(struct unistimsession *pte, char way, FILE ** f)
{
    char tmp[AST_CONFIG_MAX_PATH];
    char count;
 
    snprintf(tmp, sizeof(tmp), "%s/%s/%s-%c.csv", ast_config_AST_LOG_DIR,
             USTM_LOG_DIR, pte->device->name, way);
    *f = fopen(tmp, "r");
    if (!*f) {
        display_last_error("Unable to open history file");
        return 0;
    }
    if (fread(&count, 1, 1, *f) != 1) {
        display_last_error("Unable to read history header - display.");
        fclose(*f);
        *f = NULL;
        return 0;
    }
    if (count > MAX_ENTRY_LOG) {
        ast_log(LOG_WARNING, "Invalid count in history header of %s (%d max %d)\n", tmp,
                count, MAX_ENTRY_LOG);
        fclose(*f);
        *f = NULL;
        return 0;
    }
    return count;
}
 
static void show_history(struct unistimsession *pte, char way)
{
    FILE *f;
    char count;
 
    if (!pte->device) {
        return;
    }
    if (!pte->device->callhistory) {
        return;
    }
    count = open_history(pte, way, &f);
    if (!count) {
        return;
    }
    pte->buff_entry[0] = way;
    pte->buff_entry[1] = count;
    pte->buff_entry[2] = 1;
    pte->buff_entry[3] = 1;
    show_entry_history(pte, &f);
    pte->state = STATE_HISTORY;
}
 
static void show_main_page(struct unistimsession *pte)
{
    char tmpbuf[TEXT_LENGTH_MAX + 1];
    const char *text;
 
    if ((pte->device->extension == EXTENSION_ASK) &&
        (ast_strlen_zero(pte->device->extension_number))) {
        show_extension_page(pte);
        return;
    }
 
    pte->state = STATE_MAINPAGE;
    send_led_update(pte, LED_BAR_OFF);
    pte->device->lastmsgssent = -1;
 
    send_tone(pte, 0, 0);
    send_stop_timer(pte); /* case of holding call */
    send_select_output(pte, pte->device->output, pte->device->volume, MUTE_ON_DISCRET);
    send_led_update(pte, LED_SPEAKER_OFF);
    send_led_update(pte, LED_HEADPHONE_OFF);
 
    if (!ast_strlen_zero(pte->device->call_forward)) {
        if (pte->device->height == 1) {
            char tmp_field[100];
            snprintf(tmp_field, sizeof(tmp_field), "%s %s", ustmtext("Fwd to:", pte), pte->device->call_forward);
            send_text(TEXT_LINE0, TEXT_NORMAL, pte, tmp_field);
        } else {
            send_text(TEXT_LINE0, TEXT_NORMAL, pte, ustmtext("Call forwarded to :", pte));
            send_text(TEXT_LINE1, TEXT_NORMAL, pte, pte->device->call_forward);
        }
        send_icon(TEXT_LINE0, FAV_ICON_REFLECT + FAV_BLINK_SLOW, pte);
        if (ast_strlen_zero(pte->device->redial_number)) {
            send_text_status(pte, ustmtext("Dial          NoFwd  ", pte));
        } else {
            send_text_status(pte, ustmtext("Dial   Redial NoFwd  ", pte));
        }
    } else {
        if ((pte->device->extension == EXTENSION_ASK) || (pte->device->extension == EXTENSION_TN)) {
            if (ast_strlen_zero(pte->device->redial_number)) {
                send_text_status(pte, ustmtext("Dial          Fwd    Unregis", pte));
            } else {
                send_text_status(pte, ustmtext("Dial   Redial Fwd    Unregis", pte));
            }
        } else {
            if (ast_strlen_zero(pte->device->redial_number)) {
                send_text_status(pte, ustmtext("Dial          Fwd    Pickup", pte));
            } else {
                send_text_status(pte, ustmtext("Dial   Redial Fwd    Pickup", pte));
            }
        }
        send_text(TEXT_LINE1, TEXT_NORMAL, pte, pte->device->maintext1);
        if (pte->device->missed_call == 0) {
            send_date_time2(pte);
            send_idle_clock(pte);
            if (strlen(pte->device->maintext0)) {
                send_text(TEXT_LINE0, TEXT_NORMAL, pte, ustmtext(pte->device->maintext0, pte));
            }
        } else {
            if (pte->device->missed_call == 1) {
                text = ustmtext("unanswered call", pte);
            } else {
                text = ustmtext("unanswered calls", pte);
            }
            snprintf(tmpbuf, sizeof(tmpbuf), "%d %s", pte->device->missed_call, text);
            send_text(TEXT_LINE0, TEXT_NORMAL, pte, tmpbuf);
            send_icon(TEXT_LINE0, FAV_ICON_CALL_CENTER + FAV_BLINK_SLOW, pte);
        }
    }
    if (pte->device->height > 1) {
        if (ast_strlen_zero(pte->device->maintext2)) {
            strcpy(tmpbuf, "IP : ");
            strcat(tmpbuf, ast_inet_ntoa(pte->sin.sin_addr));
            send_text(TEXT_LINE2, TEXT_NORMAL, pte, tmpbuf);
        } else {
            send_text(TEXT_LINE2, TEXT_NORMAL, pte, ustmtext(pte->device->maintext2, pte));
        }
    }
 
    send_texttitle(pte, ustmtext(pte->device->titledefault, pte));
    change_favorite_icon(pte, FAV_LINE_ICON);
}
 
static void key_main_page(struct unistimsession *pte, char keycode)
{
    if (pte->device->missed_call) {
        send_icon(TEXT_LINE0, FAV_ICON_NONE, pte);
        pte->device->missed_call = 0;
    }
    if ((keycode >= KEY_0) && (keycode <= KEY_SHARP)) {
        handle_dial_page(pte);
        key_dial_page(pte, keycode);
        return;
    }
    switch (keycode) {
    case KEY_FUNC1:
        pte->device->selected = get_avail_softkey(pte, NULL);
        handle_dial_page(pte);
        break;
    case KEY_FUNC2:
        if (ast_strlen_zero(pte->device->redial_number)) {
            break;
        }
        if ((pte->device->output == OUTPUT_HANDSET) &&
            (pte->device->receiver_state == STATE_ONHOOK)) {
            send_select_output(pte, OUTPUT_SPEAKER, pte->device->volume, MUTE_OFF);
        } else {
            send_select_output(pte, pte->device->output, pte->device->volume, MUTE_OFF);
        }
        ast_copy_string(pte->device->phone_number, pte->device->redial_number,
                        sizeof(pte->device->phone_number));
        handle_call_outgoing(pte);
        break;
    case KEY_FUNC3:
        if (!ast_strlen_zero(pte->device->call_forward)) {
            /* Cancel call forwarding */
            memmove(pte->device->call_forward + 1, pte->device->call_forward,
                    sizeof(pte->device->call_forward) - 1);
            pte->device->call_forward[0] = '\0';
            send_icon(TEXT_LINE0, FAV_ICON_NONE, pte);
            pte->device->output = OUTPUT_HANDSET;   /* Seems to be reseted somewhere */
            show_main_page(pte);
            break;
        }
        pte->device->call_forward[0] = -1;
        handle_dial_page(pte);
        break;
    case KEY_FUNC4:
        if (pte->device->extension == EXTENSION_ASK) {
            unregister_extension(pte);
            pte->device->extension_number[0] = '\0';
            show_extension_page(pte);
        } else if (pte->device->extension == EXTENSION_TN) {
            ast_mutex_lock(&devicelock);
            strcpy(pte->device->id, pte->device->extension_number);
            pte->buff_entry[0] = '\0';
            pte->size_buff_entry = 0;
            pte->device->session = NULL;
            pte->device = NULL;
            ast_mutex_unlock(&devicelock);
            show_extension_page(pte);
        } else { /* Pickup function */
            /* XXX Is there a way to get a specific channel here? */
            RAII_VAR(struct ast_features_pickup_config *, pickup_cfg,
                    ast_get_chan_features_pickup_config(NULL), ao2_cleanup);
 
            if (!pickup_cfg) {
                ast_log(LOG_ERROR, "Unable to retrieve pickup configuration options. Unable to detect call pickup extension\n");
                break;
            }
 
            pte->device->selected = -1;
            ast_copy_string(pte->device->phone_number, pickup_cfg->pickupexten,
                        sizeof(pte->device->phone_number));
            handle_call_outgoing(pte);
                }
        break;
    case KEY_FAV0:
    case KEY_FAV1:
    case KEY_FAV2:
    case KEY_FAV3:
    case KEY_FAV4:
    case KEY_FAV5:
        handle_key_fav(pte, keycode);
        break;
    case KEY_CONF:
        handle_select_option(pte);
        break;
    case KEY_LOUDSPK:
        send_select_output(pte, OUTPUT_SPEAKER, pte->device->volume, MUTE_OFF);
        handle_dial_page(pte);
        break;
    case KEY_HEADPHN:
        send_select_output(pte, OUTPUT_HEADPHONE, pte->device->volume, MUTE_OFF);
        handle_dial_page(pte);
        break;
    case KEY_SNDHIST:
        show_history(pte, 'o');
        break;
    case KEY_RCVHIST:
        show_history(pte, 'i');
        break;
    }
    return;
}
 
static void key_history(struct unistimsession *pte, char keycode)
{
    FILE *f;
    char count;
    long offset;
    int flag = 0;
 
    switch (keycode) {
    case KEY_LEFT:
        if (pte->device->height == 1) {
            if (pte->buff_entry[3] <= 1) {
                return;
            }
            pte->buff_entry[3]--;
            flag = 1;
            break;
        }
    case KEY_UP:
    case KEY_FUNC1:
        if (pte->buff_entry[2] <= 1) {
            return;
        }
        pte->buff_entry[2]--;
        flag = 1;
        break;
    case KEY_RIGHT:
        if (pte->device->height == 1) {
            if (pte->buff_entry[3] == 3) {
                return;
            }
            pte->buff_entry[3]++;
            flag = 1;
            break;
        }
    case KEY_DOWN:
    case KEY_FUNC2:
        if (pte->buff_entry[2] >= pte->buff_entry[1]) {
            return;
        }
        pte->buff_entry[2]++;
        flag = 1;
        break;
    case KEY_FUNC3:
        if (ast_strlen_zero(pte->device->lst_cid)) {
            break;
        }
        ast_copy_string(pte->device->redial_number, pte->device->lst_cid,
                        sizeof(pte->device->redial_number));
        key_main_page(pte, KEY_FUNC2);
        break;
    case KEY_FUNC4:
    case KEY_HANGUP:
        show_main_page(pte);
        break;
    case KEY_SNDHIST:
        if (pte->buff_entry[0] == 'i') {
            show_history(pte, 'o');
        } else {
            show_main_page(pte);
        }
        break;
    case KEY_RCVHIST:
        if (pte->buff_entry[0] == 'i') {
            show_main_page(pte);
        } else {
            show_history(pte, 'i');
        }
        break;
    }
 
    if (flag) {
        count = open_history(pte, pte->buff_entry[0], &f);
        if (!count) {
            return;
        }
        offset = ((pte->buff_entry[2] - 1) * TEXT_LENGTH_MAX * 3);
        if (fseek(f, offset, SEEK_CUR)) {
            display_last_error("Unable to seek history entry.");
            fclose(f);
            return;
        }
        show_entry_history(pte, &f);
    }
 
    return;
}
 
static void init_phone_step2(struct unistimsession *pte)
{
    BUFFSEND;
    if (unistimdebug) {
        ast_verb(0, "Sending S4\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_s4, sizeof(packet_send_s4));
    send_client(SIZE_HEADER + sizeof(packet_send_s4), buffsend, pte);
    send_date_time2(pte);
    send_date_time3(pte);
    if (unistimdebug) {
        ast_verb(0, "Sending S7\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_S7, sizeof(packet_send_S7));
    send_client(SIZE_HEADER + sizeof(packet_send_S7), buffsend, pte);
    if (unistimdebug) {
        ast_verb(0, "Sending Contrast\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_Contrast, sizeof(packet_send_Contrast));
    if (pte->device != NULL) {
        buffsend[9] = pte->device->contrast;
    }
    send_client(SIZE_HEADER + sizeof(packet_send_Contrast), buffsend, pte);
 
    if (unistimdebug) {
        ast_verb(0, "Sending S9\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_s9, sizeof(packet_send_s9));
    send_client(SIZE_HEADER + sizeof(packet_send_s9), buffsend, pte);
    send_no_ring(pte);
 
    if (unistimdebug) {
        ast_verb(0, "Sending S7\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_S7, sizeof(packet_send_S7));
    send_client(SIZE_HEADER + sizeof(packet_send_S7), buffsend, pte);
    send_led_update(pte, LED_BAR_OFF);
    send_ping(pte);
    if (unistimdebug) {
        ast_verb(0, "Sending init language\n");
    }
    if (pte->device) {
        send_charset_update(pte, options_languages[find_language(pte->device->language)].encoding);
    }
    if (pte->state < STATE_MAINPAGE) {
        if (autoprovisioning == AUTOPROVISIONING_TN) {
            show_extension_page(pte);
            return;
        } else {
            int i;
            char tmp[30];
 
            for (i = 1; i < FAVNUM; i++) {
                send_favorite(i, 0, pte, "");
            }
            send_text(TEXT_LINE0, TEXT_NORMAL, pte, ustmtext("Phone is not registered", pte));
            send_text(TEXT_LINE1, TEXT_NORMAL, pte, ustmtext("in unistim.conf", pte));
            strcpy(tmp, "MAC = ");
            strcat(tmp, pte->macaddr);
            send_text(TEXT_LINE2, TEXT_NORMAL, pte, tmp);
            send_text_status(pte, "");
            send_texttitle(pte, ustmtext("UNISTIM for*", pte));
            return;
        }
    }
    show_main_page(pte);
    refresh_all_favorite(pte);
    if (unistimdebug) {
        ast_verb(0, "Sending arrow\n");
    }
    memcpy(buffsend + SIZE_HEADER, packet_send_arrow, sizeof(packet_send_arrow));
    send_client(SIZE_HEADER + sizeof(packet_send_arrow), buffsend, pte);
    return;
}
 
/* Toggles the state of microphone muting */
static void microphone_mute_toggle(struct unistimsession *pte)
{
    if (pte->device->microphone == MUTE_OFF) {
        pte->device->microphone = MUTE_ON;
        send_led_update(pte, LED_MUTE_ON);
    } else if (pte->device->microphone == MUTE_ON) {
        pte->device->microphone = MUTE_OFF;
        send_led_update(pte, LED_MUTE_OFF);
    }
    send_mute(pte, (pte->device->microphone & 0x01));
}
 
static void process_request(int size, unsigned char *buf, struct unistimsession *pte)
{
    char tmpbuf[255];
    if (memcmp
        (buf + SIZE_HEADER, packet_recv_resume_connection_with_server,
         sizeof(packet_recv_resume_connection_with_server)) == 0) {
        rcv_resume_connection_with_server(pte);
        return;
    }
    if (memcmp(buf + SIZE_HEADER, packet_recv_firm_version, sizeof(packet_recv_firm_version)) == 0) {
        buf[size] = 0;
        if (unistimdebug) {
            ast_verb(0, "Got the firmware version : '%s'\n", buf + 13);
        }
        ast_copy_string(pte->firmware, (char *) (buf + 13), sizeof(pte->firmware));
        init_phone_step2(pte);
        return;
    }
    if (memcmp(buf + SIZE_HEADER, packet_recv_it_type, sizeof(packet_recv_it_type)) == 0) {
        char type = buf[13];
        if (unistimdebug) {
            ast_verb(0, "Got the equipment type: '%d'\n", type);
        }
        switch (type) {
        case 0x03: /* i2002 */
            if (pte->device) {
                pte->device->height = 1;
            }
            break;
        }
        return;
    }
    if (memcmp(buf + SIZE_HEADER, packet_recv_mac_addr, sizeof(packet_recv_mac_addr)) == 0) {
        rcv_mac_addr(pte, buf);
        return;
    }
    if (memcmp(buf + SIZE_HEADER, packet_recv_r2, sizeof(packet_recv_r2)) == 0) {
        if (unistimdebug) {
            ast_verb(0, "R2 received\n");
        }
        return;
    }
 
    if (pte->state < STATE_MAINPAGE) {
        if (unistimdebug) {
            ast_verb(0, "Request not authorized in this state\n");
        }
        return;
    }
    if (!memcmp(buf + SIZE_HEADER, packet_recv_expansion_pressed_key, sizeof(packet_recv_expansion_pressed_key))) {
        char keycode = buf[13];
 
        if (unistimdebug) {
            ast_verb(0, "Expansion key pressed: keycode = 0x%02hhx - current state: %s\n", (unsigned char)keycode,
                        ptestate_tostr(pte->state));
        }
    }
    if (!memcmp(buf + SIZE_HEADER, packet_recv_pressed_key, sizeof(packet_recv_pressed_key))) {
        char keycode = buf[13];
 
        if (unistimdebug) {
            ast_verb(0, "Key pressed: keycode = 0x%02hhx - current state: %s\n", (unsigned char)keycode,
                        ptestate_tostr(pte->state));
        }
        if (keycode == KEY_MUTE) {
            microphone_mute_toggle(pte);
        }
        switch (pte->state) {
        case STATE_INIT:
            if (unistimdebug) {
                ast_verb(0, "No keys allowed in the init state\n");
            }
            break;
        case STATE_AUTHDENY:
            if (unistimdebug) {
                ast_verb(0, "No keys allowed in authdeny state\n");
            }
            break;
        case STATE_MAINPAGE:
            key_main_page(pte, keycode);
            break;
        case STATE_DIALPAGE:
            key_dial_page(pte, keycode);
            break;
        case STATE_RINGING:
            key_ringing(pte, keycode);
            break;
        case STATE_CALL:
            key_call(pte, keycode);
            break;
        case STATE_EXTENSION:
            key_select_extension(pte, keycode);
            break;
        case STATE_SELECTOPTION:
            key_select_option(pte, keycode);
            break;
        case STATE_SELECTCODEC:
            key_select_codec(pte, keycode);
            break;
        case STATE_SELECTLANGUAGE:
            key_select_language(pte, keycode);
            break;
        case STATE_HISTORY:
            key_history(pte, keycode);
            break;
        default:
            ast_log(LOG_WARNING, "Key : Unknown state\n");
        }
        return;
    }
    if (memcmp(buf + SIZE_HEADER, packet_recv_pick_up, sizeof(packet_recv_pick_up)) == 0) {
        if (unistimdebug) {
            ast_verb(0, "Handset off hook, current state: %s\n", ptestate_tostr(pte->state));
        }
        if (!pte->device) {        /* We are not yet registered (asking for a TN in AUTOPROVISIONING_TN) */
            return;
        }
        pte->device->receiver_state = STATE_OFFHOOK;
        if (pte->device->output == OUTPUT_HEADPHONE) {
            send_select_output(pte, OUTPUT_HEADPHONE, pte->device->volume, MUTE_OFF);
        } else {
            send_select_output(pte, OUTPUT_HANDSET, pte->device->volume, MUTE_OFF);
        }
        if (pte->state == STATE_RINGING) {
            handle_call_incoming(pte);
        } else if ((pte->state == STATE_DIALPAGE) || (pte->state == STATE_CALL)) {
            send_select_output(pte, OUTPUT_HANDSET, pte->device->volume, MUTE_OFF);
        } else if (pte->state == STATE_EXTENSION) { /* We must have a TN before calling */
            return;
        } else {
            pte->device->selected = get_avail_softkey(pte, NULL);
            send_select_output(pte, OUTPUT_HANDSET, pte->device->volume, MUTE_OFF);
            handle_dial_page(pte);
        }
        return;
    }
    if (memcmp(buf + SIZE_HEADER, packet_recv_hangup, sizeof(packet_recv_hangup)) == 0) {
        if (unistimdebug) {
            ast_verb(0, "Handset on hook, current state: %s\n", ptestate_tostr(pte->state));
        }
        if (!pte->device) {
            return;
        }
        pte->device->receiver_state = STATE_ONHOOK;
        if (pte->state == STATE_CALL) {
            if (pte->device->output != OUTPUT_SPEAKER) {
                close_call(pte);
            }
        } else if (pte->state == STATE_EXTENSION) {
            return;
        } else {
            pte->device->nextdial = 0;
            show_main_page(pte);
        }
        return;
    }
    strcpy(tmpbuf, ast_inet_ntoa(pte->sin.sin_addr));
    strcat(tmpbuf, " Unknown request packet\n");
    if (unistimdebug) {
        ast_debug(1, "%s", tmpbuf);
    }
    return;
}
 
static void parsing(int size, unsigned char *buf, struct unistimsession *pte,
    struct sockaddr_in *addr_from)
{
    unsigned short *sbuf = (unsigned short *) buf;
    unsigned short seq;
    char tmpbuf[255];
 
    strcpy(tmpbuf, ast_inet_ntoa(addr_from->sin_addr));
 
    if (size < 10) {
        if (size == 0) {
            ast_log(LOG_WARNING, "%s Read error\n", tmpbuf);
        } else {
            ast_log(LOG_NOTICE, "%s Packet too short - ignoring\n", tmpbuf);
        }
        return;
    }
    if (sbuf[0] == 0xffff) {    /* Starting with 0xffff ? *//* Yes, discovery packet ? */
        if (size != sizeof(packet_rcv_discovery)) {
            ast_log(LOG_NOTICE, "%s Invalid size of a discovery packet\n", tmpbuf);
        } else {
            if (memcmp(buf, packet_rcv_discovery, sizeof(packet_rcv_discovery)) == 0) {
                if (unistimdebug) {
                    ast_verb(0, "Discovery packet received - Sending Discovery ACK\n");
                }
                if (pte) {        /* A session was already active for this IP ? */
                    if (pte->state == STATE_INIT) { /* Yes, but it's a dupe */
                        if (unistimdebug) {
                            ast_verb(1, "Duplicated Discovery packet\n");
                        }
                        send_raw_client(sizeof(packet_send_discovery_ack),
                                      packet_send_discovery_ack, addr_from, &pte->sout);
                        pte->seq_phone = (short) 0x0000;    /* reset sequence number */
                    } else {    /* No, probably a reboot, phone side */
                        close_client(pte);       /* Cleanup the previous session */
                        if (create_client(addr_from)) {
                            send_raw_client(sizeof(packet_send_discovery_ack),
                                          packet_send_discovery_ack, addr_from, &pte->sout);
                        }
                    }
                } else {
                    /* Creating new entry in our phone list */
                    if ((pte = create_client(addr_from))) {
                        send_raw_client(sizeof(packet_send_discovery_ack),
                                      packet_send_discovery_ack, addr_from, &pte->sout);
                    }
                }
                return;
            }
            ast_log(LOG_NOTICE, "%s Invalid discovery packet\n", tmpbuf);
        }
        return;
    }
    if (!pte) {
        if (unistimdebug) {
            ast_verb(0, "%s Not a discovery packet from an unknown source : ignoring\n", tmpbuf);
        }
        return;
    }
 
    if (sbuf[0] != 0) {          /* Starting with something else than 0x0000 ? */
        ast_log(LOG_NOTICE, "Unknown packet received - ignoring\n");
        return;
    }
    if (buf[5] != 2) {
        ast_log(LOG_NOTICE, "%s Wrong direction : got 0x%02hhx expected 0x02\n", tmpbuf, buf[5]);
        return;
    }
    seq = ntohs(sbuf[1]);
    if (buf[4] == 1) {
        ast_mutex_lock(&pte->lock);
        if (unistimdebug) {
            ast_verb(0, "ACK received for packet #0x%04x\n", (unsigned)seq);
        }
        pte->nb_retransmit = 0;
 
        if ((pte->last_seq_ack) + 1 == seq) {
            pte->last_seq_ack++;
            check_send_queue(pte);
            ast_mutex_unlock(&pte->lock);
            return;
        }
        if (pte->last_seq_ack > seq) {
            if (pte->last_seq_ack == 0xffff) {
                ast_verb(0, "ACK at 0xffff, restarting counter.\n");
                pte->last_seq_ack = 0;
            } else {
                ast_log(LOG_NOTICE,
                        "%s Warning : ACK received for an already ACKed packet : #0x%04x we are at #0x%04x\n",
                        tmpbuf, (unsigned)seq, (unsigned)pte->last_seq_ack);
            }
            ast_mutex_unlock(&pte->lock);
            return;
        }
        if (pte->seq_server < seq) {
            ast_log(LOG_NOTICE,
                    "%s Error : ACK received for a non-existent packet : #0x%04x\n",
                    tmpbuf, (unsigned)pte->seq_server);
            ast_mutex_unlock(&pte->lock);
            return;
        }
        if (unistimdebug) {
            ast_verb(0, "%s ACK gap : Received ACK #0x%04x, previous was #0x%04x\n",
                        tmpbuf, (unsigned)seq, (unsigned)pte->last_seq_ack);
        }
        pte->last_seq_ack = seq;
        check_send_queue(pte);
        ast_mutex_unlock(&pte->lock);
        return;
    }
    if (buf[4] == 2) {
        if (unistimdebug) {
            ast_verb(0, "Request received\n");
        }
        if (pte->seq_phone == seq) {
            /* Send ACK */
            buf[4] = 1;
            buf[5] = 1;
            send_raw_client(SIZE_HEADER, buf, addr_from, &pte->sout);
            pte->seq_phone++;
 
            process_request(size, buf, pte);
            return;
        }
        if (pte->seq_phone > seq) {
            ast_log(LOG_NOTICE,
                    "%s Warning : received a retransmitted packet : #0x%04x (we are at #0x%04x)\n",
                    tmpbuf, (unsigned)seq, (unsigned)pte->seq_phone);
            /* BUG ? pte->device->seq_phone = seq; */
            /* Send ACK */
            buf[4] = 1;
            buf[5] = 1;
            send_raw_client(SIZE_HEADER, buf, addr_from, &pte->sout);
            return;
        }
        ast_log(LOG_NOTICE,
                "%s Warning : we lost a packet : received #0x%04x (we are at #0x%04x)\n",
                tmpbuf, (unsigned)seq, (unsigned)pte->seq_phone);
        return;
    }
    if (buf[4] == 0) {
        ast_log(LOG_NOTICE, "%s Retransmit request for packet #0x%04x\n", tmpbuf, (unsigned)seq);
        if (pte->last_seq_ack > seq) {
            ast_log(LOG_NOTICE,
                    "%s Error : received a request for an already ACKed packet : #0x%04x\n",
                    tmpbuf, (unsigned)pte->last_seq_ack);
            return;
        }
        if (pte->seq_server < seq) {
            ast_log(LOG_NOTICE,
                    "%s Error : received a request for a non-existent packet : #0x%04x\n",
                    tmpbuf, (unsigned)pte->seq_server);
            return;
        }
        send_retransmit(pte);
        return;
    }
    ast_log(LOG_NOTICE, "%s Unknown request : got 0x%02hhx expected 0x00,0x01 or 0x02\n", tmpbuf, buf[4]);
    return;
}
 
static struct unistimsession *channel_to_session(struct ast_channel *ast)
{
    struct unistim_subchannel *sub;
    if (!ast) {
        ast_log(LOG_WARNING, "Unistim callback function called with a null channel\n");
        return NULL;
    }
    if (!ast_channel_tech_pvt(ast)) {
        ast_log(LOG_WARNING, "Unistim callback function called without a tech_pvt\n");
        return NULL;
    }
    sub = ast_channel_tech_pvt(ast);
 
    if (!sub->parent) {
        ast_log(LOG_WARNING, "Unistim callback function called without a line\n");
        return NULL;
    }
    if (!sub->parent->parent) {
        ast_log(LOG_WARNING, "Unistim callback function called without a device\n");
        return NULL;
    }
    ast_mutex_lock(&sub->parent->parent->lock);
    if (!sub->parent->parent->session) {
        ast_log(LOG_WARNING, "Unistim callback function called without a session\n");
        ast_mutex_unlock(&sub->parent->parent->lock);
        return NULL;
    }
    ast_mutex_unlock(&sub->parent->parent->lock);
    return sub->parent->parent->session;
}
 
static void send_callerid_screen(struct unistimsession *pte, struct unistim_subchannel *sub)
{
    char *cidname_str;
    char *cidnum_str;
 
    if (!sub) {
        return;
    }
    if (sub->owner) {
        if (ast_channel_connected(sub->owner)->id.number.valid && ast_channel_connected(sub->owner)->id.number.str) {
            cidnum_str = ast_channel_connected(sub->owner)->id.number.str;
        } else {
            cidnum_str = DEFAULTCALLERID;
        }
        change_callerid(pte, 0, cidnum_str);
        if (strlen(cidnum_str) == 0) {
            cidnum_str = DEFAULTCALLERID;
        }
 
        if (ast_channel_connected(sub->owner)->id.name.valid && ast_channel_connected(sub->owner)->id.name.str) {
            cidname_str = ast_channel_connected(sub->owner)->id.name.str;
        } else {
            cidname_str = DEFAULTCALLERNAME;
        }
        change_callerid(pte, 1, cidname_str);
        if (strlen(cidname_str) == 0) {
            cidname_str = DEFAULTCALLERNAME;
        }
 
        if (pte->device->height == 1) {
            char tmpstr[256];
            snprintf(tmpstr, sizeof(tmpstr), "%s %s", cidnum_str, ustmtext(cidname_str, pte));
            send_text(TEXT_LINE0, TEXT_NORMAL, pte, tmpstr);
        } else {
            send_text(TEXT_LINE0, TEXT_NORMAL, pte, cidname_str);
            send_text(TEXT_LINE1, TEXT_NORMAL, pte, ustmtext(cidnum_str, pte));
        }
    }
}
 
/*--- unistim_call: Initiate UNISTIM call from PBX ---*/
/*      used from the dial() application      */
static int unistim_call(struct ast_channel *ast, const char *dest, int timeout)
{
    int res = 0, i;
    struct unistim_subchannel *sub, *sub_real;
    struct unistimsession *session;
    signed char ringstyle, ringvolume;
 
    session = channel_to_session(ast);
    if (!session) {
        ast_log(LOG_ERROR, "Device not registered, cannot call %s\n", dest);
        return -1;
    }
    sub = ast_channel_tech_pvt(ast);
    sub_real = get_sub(session->device, SUB_REAL);
    if ((ast_channel_state(ast) != AST_STATE_DOWN) && (ast_channel_state(ast) != AST_STATE_RESERVED)) {
        ast_log(LOG_WARNING, "unistim_call called on %s, neither down nor reserved\n",
                ast_channel_name(ast));
        return -1;
    }
 
    if (unistimdebug) {
        ast_verb(3, "unistim_call(%s)\n", ast_channel_name(ast));
    }
    session->state = STATE_RINGING;
    send_callerid_screen(session, sub);
    if (ast_strlen_zero(ast_channel_call_forward(ast))) { /* Send ring only if no call forward, otherwise short ring will apear */
        send_text(TEXT_LINE2, TEXT_NORMAL, session, ustmtext("is calling you.", session));
        send_text_status(session, ustmtext("Accept        Ignore Hangup", session));
 
        if (sub_real) {
            ringstyle = session->device->cwstyle;
            ringvolume = session->device->cwvolume;
        } else {
            ringstyle = (sub->ringstyle == -1) ? session->device->ringstyle : sub->ringstyle;
            ringvolume = (sub->ringvolume == -1) ? session->device->ringvolume : sub->ringvolume;
        }
        send_ring(session, ringvolume, ringstyle);
        change_favorite_icon(session, FAV_ICON_SPEAKER_ONHOOK_BLACK + FAV_BLINK_FAST);
        /* Send call identification to all */
        for (i = 0; i < FAVNUM; i++) {
            if (!soft_key_visible(session->device, i)) {
                continue;
            }
            if (session->device->ssub[i]) {
                continue;
            }
            if (is_key_line(session->device, i) && !strcmp(sub->parent->name, session->device->sline[i]->name)) {
                if (unistimdebug) {
                    ast_verb(0, "Found softkey %d for line %s\n", i, sub->parent->name);
                }
                send_favorite_short(i, FAV_ICON_SPEAKER_ONHOOK_BLACK + FAV_BLINK_FAST, session);
                session->device->ssub[i] = sub;
            }
        }
    }
    ast_setstate(ast, AST_STATE_RINGING);
    ast_queue_control(ast, AST_CONTROL_RINGING);
    return res;
}
 
static int unistim_hangup_clean(struct ast_channel *ast, struct unistim_subchannel *sub) {
    ast_mutex_lock(&sub->lock);
    ast_channel_tech_pvt_set(ast, NULL);
    unistim_set_owner(sub, NULL);
    sub->alreadygone = 0;
    if (sub->rtp) {
        if (unistimdebug) {
            ast_verb(0, "Destroying RTP session\n");
        }
        ast_rtp_instance_stop(sub->rtp);
        ast_rtp_instance_destroy(sub->rtp);
        sub->rtp = NULL;
    }
    ast_mutex_unlock(&sub->lock);
    return 0;
}
 
/*--- unistim_hangup: Hangup UNISTIM call */
static int unistim_hangup(struct ast_channel *ast)
{
    struct unistim_subchannel *sub = NULL, *sub_real = NULL, *sub_trans = NULL;
    struct unistim_line *l;
    struct unistim_device *d;
    struct unistimsession *s;
    int i,end_call = 1;
 
    s = channel_to_session(ast);
    sub = ast_channel_tech_pvt(ast);
    l = sub->parent;
    d = l->parent;
    if (!s) {
        ast_debug(1, "Asked to hangup channel not connected\n");
        unistim_hangup_clean(ast, sub);
        return 0;
    }
    if (unistimdebug) {
        ast_verb(0, "unistim_hangup(%s) on %s@%s (STATE_%s)\n", ast_channel_name(ast), l->name, l->parent->name, ptestate_tostr(s->state));
    }
    sub_trans = get_sub(d, SUB_THREEWAY);
    sub_real = get_sub(d, SUB_REAL);
    if (sub_trans && (sub_trans->owner) && (sub->subtype == SUB_REAL)) { /* 3rd party busy or congested and transfer_cancel_step2 does not called */
        if (unistimdebug) {
            ast_verb(0, "Threeway call disconnected, switching to real call\n");
        }
        ast_queue_unhold(sub_trans->owner);
        sub_trans->moh = 0;
        sub_trans->subtype = SUB_REAL;
        swap_subs(sub_trans, sub);
        send_text_status(s, ustmtext("       Transf        Hangup", s));
        send_callerid_screen(s, sub_trans);
        unistim_hangup_clean(ast, sub);
        unistim_unalloc_sub(d, sub);
        return 0;
    }
    if (sub_real && (sub_real->owner) && (sub->subtype == SUB_THREEWAY) && (s->state == STATE_CALL)) { /* 3way call cancelled by softkey pressed */
        if (unistimdebug) {
            ast_verb(0, "Real call disconnected, stay in call\n");
        }
        send_text_status(s, ustmtext("       Transf        Hangup", s));
        send_callerid_screen(s, sub_real);
        unistim_hangup_clean(ast, sub);
        unistim_unalloc_sub(d, sub);
        return 0;
    }
    if (sub->subtype == SUB_REAL) {
        sub_stop_silence(s, sub);
    } else if (sub->subtype == SUB_RING) {
        send_no_ring(s);
        for (i = 0; i < FAVNUM; i++) {
            if (!soft_key_visible(s->device, i)) {
                continue;
            }
            if (d->ssub[i] != sub) {
                if (d->ssub[i] != NULL) { /* Found other subchannel active other than hangup'ed one */
                    end_call = 0;
                }
                continue;
            }
            if (is_key_line(d, i) && !strcmp(l->name, d->sline[i]->name)) {
                send_favorite_short(i, FAV_LINE_ICON, s);
                d->ssub[i] = NULL;
                continue;
            }
        }
    }
    if (end_call) {
        send_end_call(s); /* Send end call packet only if ending active call, in other way sound should be loosed */
    }
    sub->moh = 0;
    if (sub->softkey >= 0) {
        send_favorite_short(sub->softkey, FAV_LINE_ICON, s);
    }
    /* Delete assign sub to softkey */
    for (i = 0; i < FAVNUM; i++) {
        if (d->ssub[i] == sub) {
            d->ssub[i] = NULL;
            break;
        }
    }
    /*refresh_all_favorite(s); */ /* TODO: Update favicons in case of DND keys */
    if (s->state == STATE_RINGING && sub->subtype == SUB_RING) {
        send_no_ring(s);
        if (ast_channel_hangupcause(ast) != AST_CAUSE_ANSWERED_ELSEWHERE) {
            d->missed_call++;
            write_history(s, 'i', 1);
        }
        if (!sub_real) {
            show_main_page(s);
        } else { /* hangup on a ringing line: reset status to reflect that we're still on an active call */
                s->state = STATE_CALL;
                send_callerid_screen(s, sub_real);
                send_text(TEXT_LINE2, TEXT_NORMAL, s, ustmtext("is on-line", s));
                send_text_status(s, ustmtext("       Transf        Hangup", s));
                send_favorite_short(sub->softkey, FAV_ICON_OFFHOOK_BLACK, s);
 
        }
    }
    if (s->state == STATE_CALL && sub->subtype == SUB_REAL) {
        close_call(s);
    }
    sub->softkey = -1;
    unistim_hangup_clean(ast, sub);
    unistim_unalloc_sub(d, sub);
    return 0;
}
 
/*--- unistim_answer: Answer UNISTIM call */
static int unistim_answer(struct ast_channel *ast)
{
    int res = 0;
    struct unistim_subchannel *sub;
    struct unistim_line *l;
    struct unistim_device *d;
    struct unistimsession *s;
 
    s = channel_to_session(ast);
    if (!s) {
        ast_log(LOG_WARNING, "unistim_answer on a disconnected device ?\n");
        return -1;
    }
    sub = ast_channel_tech_pvt(ast);
    l = sub->parent;
    d = l->parent;
 
    if (unistimdebug) {
        ast_verb(0, "unistim_answer(%s) on %s@%s-%d\n", ast_channel_name(ast), l->name,
                    l->parent->name, sub->softkey);
    }
    send_text(TEXT_LINE2, TEXT_NORMAL, s, ustmtext("is now on-line", s));
    if (get_sub(d, SUB_THREEWAY)) {
        send_text_status(s, ustmtext("Transf Cancel", s));
    } else {
        send_text_status(s, ustmtext("       Transf        Hangup", s));
    }
    send_start_timer(s);
    if (ast_channel_state(ast) != AST_STATE_UP)
        ast_setstate(ast, AST_STATE_UP);
    return res;
}
 
/*--- unistimsock_read: Read data from UNISTIM socket ---*/
/*    Successful messages is connected to UNISTIM call and forwarded to parsing() */
static int unistimsock_read(int *id, int fd, short events, void *ignore)
{
    struct sockaddr_in addr_from = { 0, };
    struct unistimsession *cur = NULL;
    int found = 0;
    int tmp = 0;
    int dw_num_bytes_rcvd;
    unsigned int size_addr_from;
#ifdef DUMP_PACKET
    int dw_num_bytes_rcvdd;
#endif
 
    size_addr_from = sizeof(addr_from);
    dw_num_bytes_rcvd =
        recvfrom(unistimsock, buff, SIZE_PAGE, 0, (struct sockaddr *) &addr_from,
                 &size_addr_from);
    if (dw_num_bytes_rcvd == -1) {
        if (errno == EAGAIN) {
            ast_log(LOG_NOTICE, "UNISTIM: Received packet with bad UDP checksum\n");
        } else if (errno != ECONNREFUSED) {
            ast_log(LOG_WARNING, "Recv error %d (%s)\n", errno, strerror(errno));
        }
        return 1;
    }
 
    /* Looking in the phone list if we already have a registration for him */
    ast_mutex_lock(&sessionlock);
    cur = sessions;
    while (cur) {
        if (cur->sin.sin_addr.s_addr == addr_from.sin_addr.s_addr) {
            found = 1;
            break;
        }
        tmp++;
        cur = cur->next;
    }
    ast_mutex_unlock(&sessionlock);
 
#ifdef DUMP_PACKET
    if (unistimdebug)
        ast_verb(0, "\n*** Dump %d bytes from %s - phone_table[%d] ***\n",
                    dw_num_bytes_rcvd, ast_inet_ntoa(addr_from.sin_addr), tmp);
    for (dw_num_bytes_rcvdd = 0; dw_num_bytes_rcvdd < dw_num_bytes_rcvd;
         dw_num_bytes_rcvdd++)
        ast_verb(0, "%02hhx ", buff[dw_num_bytes_rcvdd]);
    ast_verb(0, "\n******************************************\n");
#endif
 
    if (!found) {
        if (unistimdebug) {
            ast_verb(0, "Received a packet from an unknown source\n");
        }
        parsing(dw_num_bytes_rcvd, buff, NULL, (struct sockaddr_in *) &addr_from);
 
    } else {
        parsing(dw_num_bytes_rcvd, buff, cur, (struct sockaddr_in *) &addr_from);
    }
    return 1;
}
 
static struct ast_frame *unistim_rtp_read(const struct ast_channel *ast,
    const struct unistim_subchannel *sub)
{
    /* Retrieve audio/etc from channel.  Assumes sub->lock is already held. */
    struct ast_frame *f;
 
    if (!ast) {
        ast_log(LOG_WARNING, "Channel NULL while reading\n");
        return &ast_null_frame;
    }
 
    if (!sub->rtp) {
        ast_log(LOG_WARNING, "RTP handle NULL while reading on subchannel %u\n",
                sub->subtype);
        return &ast_null_frame;
    }
 
    switch (ast_channel_fdno(ast)) {
    case 0:
        f = ast_rtp_instance_read(sub->rtp, 0);     /* RTP Audio */
        break;
    case 1:
        f = ast_rtp_instance_read(sub->rtp, 1);    /* RTCP Control Channel */
        break;
    default:
        f = &ast_null_frame;
    }
 
    if (sub->owner) {
        /* We already hold the channel lock */
        if (f->frametype == AST_FRAME_VOICE) {
            if (ast_format_cap_iscompatible_format(ast_channel_nativeformats(sub->owner), f->subclass.format) == AST_FORMAT_CMP_NOT_EQUAL) {
                struct ast_str *cap_buf = ast_str_alloca(AST_FORMAT_CAP_NAMES_LEN);
                struct ast_format_cap *caps;
 
                ast_debug(1,
                        "Oooh, format changed from %s to %s\n",
                        ast_format_cap_get_names(ast_channel_nativeformats(sub->owner), &cap_buf),
                        ast_format_get_name(f->subclass.format));
 
                caps = ast_format_cap_alloc(AST_FORMAT_CAP_FLAG_DEFAULT);
                if (caps) {
                    ast_format_cap_append(caps, f->subclass.format, 0);
                    ast_channel_nativeformats_set(sub->owner, caps);
                    ao2_ref(caps, -1);
                }
                ast_set_read_format(sub->owner, ast_channel_readformat(sub->owner));
                ast_set_write_format(sub->owner, ast_channel_writeformat(sub->owner));
            }
        }
    }
 
    return f;
}
 
static struct ast_frame *unistim_read(struct ast_channel *ast)
{
    struct ast_frame *fr;
    struct unistim_subchannel *sub = ast_channel_tech_pvt(ast);
 
    ast_mutex_lock(&sub->lock);
    fr = unistim_rtp_read(ast, sub);
    ast_mutex_unlock(&sub->lock);
 
    return fr;
}
 
static int unistim_write(struct ast_channel *ast, struct ast_frame *frame)
{
    struct unistim_subchannel *sub = ast_channel_tech_pvt(ast);
    int res = 0;
 
    if (frame->frametype != AST_FRAME_VOICE) {
        if (frame->frametype == AST_FRAME_IMAGE) {
            return 0;
        } else {
            ast_log(LOG_WARNING, "Can't send %u type frames with unistim_write\n",
                    frame->frametype);
            return 0;
        }
    } else {
        if (ast_format_cap_iscompatible_format(ast_channel_nativeformats(ast), frame->subclass.format) == AST_FORMAT_CMP_NOT_EQUAL) {
            struct ast_str *cap_buf = ast_str_alloca(AST_FORMAT_CAP_NAMES_LEN);
 
            ast_log(LOG_WARNING,
                    "Asked to transmit frame type %s, while native formats is %s (read/write = (%s/%s)\n",
                    ast_format_get_name(frame->subclass.format),
                    ast_format_cap_get_names(ast_channel_nativeformats(ast), &cap_buf),
                    ast_format_get_name(ast_channel_readformat(ast)),
                    ast_format_get_name(ast_channel_writeformat(ast)));
            return -1;
        }
    }
 
    if (sub) {
        ast_mutex_lock(&sub->lock);
        if (sub->rtp) {
            res = ast_rtp_instance_write(sub->rtp, frame);
        }
        ast_mutex_unlock(&sub->lock);
    }
 
    return res;
}
 
static int unistim_fixup(struct ast_channel *oldchan, struct ast_channel *newchan)
{
    struct unistim_subchannel *p = ast_channel_tech_pvt(newchan);
    struct unistim_line *l = p->parent;
 
    ast_mutex_lock(&p->lock);
 
    ast_debug(1, "New owner for channel USTM/%s@%s-%u is %s\n", l->name,
            l->parent->name, p->subtype, ast_channel_name(newchan));
 
    if (p->owner != oldchan) {
        ast_log(LOG_WARNING, "old channel wasn't %s (%p) but was %s (%p)\n",
                ast_channel_name(oldchan), oldchan, ast_channel_name(p->owner), p->owner);
        ast_mutex_unlock(&p->lock);
        return -1;
    }
 
    unistim_set_owner(p, newchan);
 
    ast_mutex_unlock(&p->lock);
 
    return 0;
 
}
 
static char *control2str(int ind)
{
    switch (ind) {
    case AST_CONTROL_HANGUP:
        return "Other end has hungup";
    case AST_CONTROL_RING:
        return "Local ring";
    case AST_CONTROL_RINGING:
        return "Remote end is ringing";
    case AST_CONTROL_ANSWER:
        return "Remote end has answered";
    case AST_CONTROL_BUSY:
        return "Remote end is busy";
    case AST_CONTROL_TAKEOFFHOOK:
        return "Make it go off hook";
    case AST_CONTROL_OFFHOOK:
        return "Line is off hook";
    case AST_CONTROL_CONGESTION:
        return "Congestion (circuits busy)";
    case AST_CONTROL_FLASH:
        return "Flash hook";
    case AST_CONTROL_WINK:
        return "Wink";
    case AST_CONTROL_OPTION:
        return "Set a low-level option";
    case AST_CONTROL_RADIO_KEY:
        return "Key Radio";
    case AST_CONTROL_RADIO_UNKEY:
        return "Un-Key Radio";
    case AST_CONTROL_CONNECTED_LINE:
        return "Remote end changed";
    case AST_CONTROL_SRCCHANGE:
        return "RTP source updated";
    case AST_CONTROL_SRCUPDATE:
        return "Source of media changed";
    case -1:
        return "Stop tone";
    }
    return "UNKNOWN";
}
 
static void in_band_indication(struct ast_channel *ast, const struct ast_tone_zone *tz,
    const char *indication)
{
    struct ast_tone_zone_sound *ts = NULL;
 
    if ((ts = ast_get_indication_tone(tz, indication))) {
        ast_playtones_start(ast, 0, ts->data, 1);
        ts = ast_tone_zone_sound_unref(ts);
    } else {
        ast_log(LOG_WARNING, "Unable to get indication tone for %s\n", indication);
    }
}
 
static int unistim_indicate(struct ast_channel *ast, int ind, const void *data, size_t datalen)
{
    struct unistim_subchannel *sub;
    struct unistim_line *l;
    struct unistimsession *s;
 
    if (unistimdebug) {
        ast_verb(3, "Asked to indicate '%s' (%d) condition on channel %s\n",
                    control2str(ind), ind, ast_channel_name(ast));
    }
 
    s = channel_to_session(ast);
    if (!s) {
        return -1;
    }
    sub = ast_channel_tech_pvt(ast);
    l = sub->parent;
 
    switch (ind) {
    case AST_CONTROL_RINGING:
        if (ast_channel_state(ast) != AST_STATE_UP) {
            send_text(TEXT_LINE2, TEXT_NORMAL, s, ustmtext("Ringing...", s));
            in_band_indication(ast, l->parent->tz, "ring");
            s->device->missed_call = -1;
            break;
        }
        return -1;
    case AST_CONTROL_BUSY:
        if (ast_channel_state(ast) != AST_STATE_UP) {
            sub->alreadygone = 1;
            send_text(TEXT_LINE2, TEXT_NORMAL, s, ustmtext("Busy", s));
            in_band_indication(ast, l->parent->tz, "busy");
            s->device->missed_call = -1;
            break;
        }
        return -1;
    case AST_CONTROL_INCOMPLETE:
        /* Overlapped dialing is not currently supported for UNIStim.  Treat an indication
         * of incomplete as congestion
         */
    case AST_CONTROL_CONGESTION:
        if (ast_channel_state(ast) != AST_STATE_UP) {
            sub->alreadygone = 1;
            send_text(TEXT_LINE2, TEXT_NORMAL, s, ustmtext("Congestion", s));
            in_band_indication(ast, l->parent->tz, "congestion");
            s->device->missed_call = -1;
            break;
        }
        return -1;
    case AST_CONTROL_HOLD:
        ast_moh_start(ast, data, NULL);
        break;
    case AST_CONTROL_UNHOLD:
        ast_moh_stop(ast);
        break;
    case AST_CONTROL_PROGRESS:
    case AST_CONTROL_SRCUPDATE:
    case AST_CONTROL_PROCEEDING:
    case AST_CONTROL_UPDATE_RTP_PEER:
        break;
    case -1:
        ast_playtones_stop(ast);
        s->device->missed_call = 0;
        break;
        case AST_CONTROL_CONNECTED_LINE:
        ast_log(LOG_NOTICE, "Connected party is now %s <%s>\n",
        S_COR(ast_channel_connected(ast)->id.name.valid, ast_channel_connected(ast)->id.name.str, ""),
        S_COR(ast_channel_connected(ast)->id.number.valid, ast_channel_connected(ast)->id.number.str, ""));
        if (sub->subtype == SUB_REAL) {
            send_callerid_screen(s, sub);
        }
        break;
    case AST_CONTROL_SRCCHANGE:
        if (sub->rtp) {
            ast_rtp_instance_change_source(sub->rtp);
        }
        break;
    default:
        ast_log(LOG_WARNING, "Don't know how to indicate condition %d\n", ind);
        /* fallthrough */
    case AST_CONTROL_PVT_CAUSE_CODE:
    case AST_CONTROL_MASQUERADE_NOTIFY:
        return -1;
    }
 
    return 0;
}
 
static struct unistim_subchannel *find_subchannel_by_name(const char *dest)
{
    struct unistim_line *l;
    struct unistim_device *d;
    struct unistim_subchannel *sub = NULL;
    char line[256];
    char *at;
    char *device;
 
    ast_copy_string(line, dest, sizeof(line));
    at = strchr(line, '@');
    if (!at) {
        ast_log(LOG_NOTICE, "Device '%s' has no @ (at) sign!\n", dest);
        return NULL;
    }
    *at = '\0';
    at++;
    device = at;
    ast_mutex_lock(&devicelock);
    d = devices;
    at = strchr(device, '/');       /* Extra options ? */
    if (at) {
        *at = '\0';
    }
    while (d) {
        if (!strcasecmp(d->name, device)) {
            if (unistimdebug) {
                ast_verb(0, "Found device: %s\n", d->name);
            }
            /* Found the device */
            AST_LIST_LOCK(&d->lines);
            AST_LIST_TRAVERSE(&d->lines, l, list) {
                /* Search for the right line */
                if (!strcasecmp(l->name, line)) {
                    if (unistimdebug) {
                        ast_verb(0, "Found line: %s\n", l->name);
                    }
                    sub = get_sub(d, SUB_REAL);
                    if (!sub) {
                        sub = unistim_alloc_sub(d, SUB_REAL);
                    }
                    if (sub->owner) {
                        /* Allocate additional channel if asterisk channel already here */
                        sub = unistim_alloc_sub(d, SUB_REAL);
                        sub->holding = 1;
                    }
                    sub->ringvolume = -1;
                    sub->ringstyle = -1;
                    if (at) {       /* Other options ? */
                        at++;   /* Skip slash */
                        if (*at == 'r') {       /* distinctive ring */
                            at++;
                            if ((*at < '0') || (*at > '7')) { /* ring style */
                                ast_log(LOG_WARNING, "Invalid ring selection (%s)", at);
                            } else {
                                signed char ring_volume = -1;
                                signed char ring_style = *at - '0';
                                at++;
                                if ((*at >= '0') && (*at <= '3')) {      /* ring volume */
                                    ring_volume = *at - '0';
                                }
                                if (unistimdebug) {
                                    ast_verb(0, "Distinctive ring: style #%d volume %d\n",
                                         ring_style, ring_volume);
                                }
                                sub->ringvolume = ring_volume;
                                sub->ringstyle = ring_style;
                            }
                        }
                    }
                    sub->parent = l;
                    break;
                }
            }
            AST_LIST_UNLOCK(&d->lines);
            if (sub) {
                ast_mutex_unlock(&devicelock);
                return sub;
            }
        }
        d = d->next;
    }
    /* Device not found */
    ast_mutex_unlock(&devicelock);
 
    return NULL;
}
 
static int unistim_senddigit_begin(struct ast_channel *ast, char digit)
{
    struct unistimsession *pte = channel_to_session(ast);
 
    if (!pte) {
        return -1;
    }
    return send_dtmf_tone(pte, digit);
}
 
static int unistim_senddigit_end(struct ast_channel *ast, char digit, unsigned int duration)
{
    struct unistimsession *pte = channel_to_session(ast);
 
    if (!pte) {
        return -1;
    }
 
    if (unistimdebug) {
        ast_verb(0, "Send Digit off %c (duration %d)\n", digit, duration);
    }
    send_tone(pte, 0, 0);
    return 0;
}
 
/*--- unistim_sendtext: Display a text on the phone screen ---*/
/*      Called from PBX core text message functions */
static int unistim_sendtext(struct ast_channel *ast, const char *text)
{
    struct unistimsession *pte = channel_to_session(ast);
    int size;
    char tmp[TEXT_LENGTH_MAX + 1];
 
    if (unistimdebug) {
        ast_verb(0, "unistim_sendtext called\n");
    }
    if (!text) {
        ast_log(LOG_WARNING, "unistim_sendtext called with a null text\n");
        return -1;
    }
 
    if (!pte) {
        return -1;
    }
 
    size = strlen(text);
    if (text[0] == '@') {
        int pos = 0, i = 1, tok = 0, sz = 0;
        char label[11];
        char number[16];
        char icon = '\0';
        char cur = '\0';
 
        memset(label, 0, 11);
        memset(number, 0, 16);
        while (text[i]) {
            cur = text[i++];
            switch (tok) {
            case 0:
                if ((cur < '0') && (cur > '5')) {
                    ast_log(LOG_WARNING,
                            "sendtext failed : position must be a number beetween 0 and 5\n");
                    return 1;
                }
                pos = cur - '0';
                tok = 1;
                continue;
            case 1:
                if (cur != '@') {
                    ast_log(LOG_WARNING, "sendtext failed : invalid position\n");
                    return 1;
                }
                tok = 2;
                continue;
            case 2:
                if ((cur < '3') && (cur > '6')) {
                    ast_log(LOG_WARNING,
                            "sendtext failed : icon must be a number beetween 32 and 63 (first digit invalid)\n");
                    return 1;
                }
                icon = (cur - '0') * 10;
                tok = 3;
                continue;
            case 3:
                if ((cur < '0') && (cur > '9')) {
                    ast_log(LOG_WARNING,
                            "sendtext failed : icon must be a number beetween 32 and 63 (second digit invalid)\n");
                    return 1;
                }
                icon += (cur - '0');
                tok = 4;
                continue;
            case 4:
                if (cur != '@') {
                    ast_log(LOG_WARNING,
                            "sendtext failed : icon must be a number beetween 32 and 63 (too many digits)\n");
                    return 1;
                }
                tok = 5;
                continue;
            case 5:
                if (cur == '@') {
                    tok = 6;
                    sz = 0;
                    continue;
                }
                if (sz > 10) {
                    continue;
                }
                label[sz] = cur;
                sz++;
                continue;
            case 6:
                if (sz > 15) {
                    ast_log(LOG_WARNING,
                            "sendtext failed : extension too long = %d (15 car max)\n",
                            sz);
                    return 1;
                }
                number[sz] = cur;
                sz++;
                continue;
            }
        }
        if (tok != 6) {
            ast_log(LOG_WARNING, "sendtext failed : incomplet command\n");
            return 1;
        }
        if (!pte->device) {
            ast_log(LOG_WARNING, "sendtext failed : no device ?\n");
            return 1;
        }
        strcpy(pte->device->softkeylabel[pos], label);
        strcpy(pte->device->softkeynumber[pos], number);
        pte->device->softkeyicon[pos] = icon;
        send_favorite(pos, icon, pte, label);
        return 0;
    }
 
    if (size <= TEXT_LENGTH_MAX * 2) {
        if (pte->device->height == 1) {
            send_text(TEXT_LINE0, TEXT_NORMAL, pte, text);
        } else {
            send_text(TEXT_LINE0, TEXT_NORMAL, pte, ustmtext("Message :", pte));
            send_text(TEXT_LINE1, TEXT_NORMAL, pte, text);
        }
        if (size <= TEXT_LENGTH_MAX) {
            send_text(TEXT_LINE2, TEXT_NORMAL, pte, "");
            return 0;
        }
        memcpy(tmp, text + TEXT_LENGTH_MAX, TEXT_LENGTH_MAX);
        tmp[sizeof(tmp) - 1] = '\0';
        send_text(TEXT_LINE2, TEXT_NORMAL, pte, tmp);
        return 0;
    }
    send_text(TEXT_LINE0, TEXT_NORMAL, pte, text);
    memcpy(tmp, text + TEXT_LENGTH_MAX, TEXT_LENGTH_MAX);
    tmp[sizeof(tmp) - 1] = '\0';
    send_text(TEXT_LINE1, TEXT_NORMAL, pte, tmp);
    memcpy(tmp, text + TEXT_LENGTH_MAX * 2, TEXT_LENGTH_MAX);
    tmp[sizeof(tmp) - 1] = '\0';
    send_text(TEXT_LINE2, TEXT_NORMAL, pte, tmp);
    return 0;
}
 
/*--- unistim_send_mwi_to_peer: Send message waiting indication ---*/
static int unistim_send_mwi_to_peer(struct unistim_line *peer, unsigned int tick)
{
    int new;
    RAII_VAR(struct stasis_message *, msg, NULL, ao2_cleanup);
 
    msg = stasis_cache_get(ast_mwi_state_cache(), ast_mwi_state_type(), peer->mailbox);
    if (msg) {
        struct ast_mwi_state *mwi_state = stasis_message_data(msg);
        new = mwi_state->new_msgs;
    } else { /* Fall back on checking the mailbox directly */
        new = ast_app_has_voicemail(peer->mailbox, NULL);
    }
    ast_debug(3, "MWI Status for mailbox %s is %d, lastmsgsent:%d\n",
        peer->mailbox, new, peer->parent->lastmsgssent);
    peer->parent->nextmsgcheck = tick + TIMER_MWI;
 
    /* Return now if it's the same thing we told them last time */
    if ((peer->parent->session->state != STATE_MAINPAGE) || (new == peer->parent->lastmsgssent)) {
        return 0;
    }
 
    peer->parent->lastmsgssent = new;
    send_led_update(peer->parent->session, (new > 0)?LED_BAR_ON:LED_BAR_OFF);
 
    return 0;
}
 
/*--- unistim_new: Initiate a call in the UNISTIM channel */
/*      called from unistim_request (calls from the pbx ) */
static struct ast_channel *unistim_new(struct unistim_subchannel *sub, int state, const struct ast_assigned_ids *assignedids, const struct ast_channel *requestor)
{
    struct ast_format_cap *caps;
    struct ast_channel *tmp;
    struct unistim_line *l;
    struct ast_format *tmpfmt;
 
    if (!sub) {
        ast_log(LOG_WARNING, "subchannel null in unistim_new\n");
        return NULL;
    }
    if (!sub->parent) {
        ast_log(LOG_WARNING, "no line for subchannel %p\n", sub);
        return NULL;
    }
 
    caps = ast_format_cap_alloc(AST_FORMAT_CAP_FLAG_DEFAULT);
    if (!caps) {
        return NULL;
    }
 
    l = sub->parent;
    tmp = ast_channel_alloc(1, state, l->cid_num, NULL, l->accountcode, l->exten,
        l->parent->context, assignedids, requestor, l->amaflags, "USTM/%s@%s-%p", l->name, l->parent->name, sub);
    if (unistimdebug) {
        ast_verb(0, "unistim_new sub=%u (%p) chan=%p line=%s\n", sub->subtype, sub, tmp, l->name);
    }
    if (!tmp) {
        ast_log(LOG_WARNING, "Unable to allocate channel structure\n");
        ao2_ref(caps, -1);
        return NULL;
    }
 
    ast_channel_stage_snapshot(tmp);
 
    if (ast_format_cap_count(l->cap)) {
        ast_format_cap_append_from_cap(caps, l->cap, AST_MEDIA_TYPE_UNKNOWN);
    } else {
        ast_format_cap_append_from_cap(caps, global_cap, AST_MEDIA_TYPE_UNKNOWN);
    }
    ast_channel_nativeformats_set(tmp, caps);
    ao2_ref(caps, -1);
 
    tmpfmt = ast_format_cap_get_format(ast_channel_nativeformats(tmp), 0);
 
    if (unistimdebug) {
        struct ast_str *native_buf = ast_str_alloca(AST_FORMAT_CAP_NAMES_LEN);
        struct ast_str *cap_buf = ast_str_alloca(AST_FORMAT_CAP_NAMES_LEN);
        struct ast_str *global_buf = ast_str_alloca(AST_FORMAT_CAP_NAMES_LEN);
 
        ast_verb(0, "Best codec = %s from nativeformats %s (line cap=%s global=%s)\n",
            ast_format_get_name(tmpfmt),
            ast_format_cap_get_names(ast_channel_nativeformats(tmp), &native_buf),
            ast_format_cap_get_names(l->cap, &cap_buf),
            ast_format_cap_get_names(global_cap, &global_buf));
    }
    if ((sub->rtp) && (sub->subtype == 0)) {
        if (unistimdebug) {
            ast_verb(0, "New unistim channel with a previous rtp handle ?\n");
        }
        ast_channel_internal_fd_set(tmp, 0, ast_rtp_instance_fd(sub->rtp, 0));
        ast_channel_internal_fd_set(tmp, 1, ast_rtp_instance_fd(sub->rtp, 1));
    }
    if (sub->rtp) {
        ast_jb_configure(tmp, &global_jbconf);
    }
/*      tmp->type = type; */
    ast_setstate(tmp, state);
    if (state == AST_STATE_RING) {
        ast_channel_rings_set(tmp, 1);
    }
    ast_channel_adsicpe_set(tmp, AST_ADSI_UNAVAILABLE);
 
    ast_channel_set_writeformat(tmp, tmpfmt);
    ast_channel_set_rawwriteformat(tmp, tmpfmt);
    ast_channel_set_readformat(tmp, tmpfmt);
    ast_channel_set_rawreadformat(tmp, tmpfmt);
    ao2_ref(tmpfmt, -1);
 
    ast_channel_tech_pvt_set(tmp, sub);
    ast_channel_tech_set(tmp, &unistim_tech);
 
    if (!ast_strlen_zero(l->parent->language)) {
        ast_channel_language_set(tmp, l->parent->language);
    }
    unistim_set_owner(sub, tmp);
    ast_update_use_count();
    ast_channel_callgroup_set(tmp, l->callgroup);
    ast_channel_pickupgroup_set(tmp, l->pickupgroup);
    ast_channel_call_forward_set(tmp, l->parent->call_forward);
    if (!ast_strlen_zero(l->cid_num)) {
        char *name, *loc, *instr;
        instr = ast_strdup(l->cid_num);
        if (instr) {
            ast_callerid_parse(instr, &name, &loc);
            ast_channel_caller(tmp)->id.number.valid = 1;
            ast_free(ast_channel_caller(tmp)->id.number.str);
            ast_channel_caller(tmp)->id.number.str = ast_strdup(loc);
            ast_channel_caller(tmp)->id.name.valid = 1;
            ast_free(ast_channel_caller(tmp)->id.name.str);
            ast_channel_caller(tmp)->id.name.str = ast_strdup(name);
            ast_free(instr);
        }
    }
    ast_channel_priority_set(tmp, 1);
 
    ast_channel_stage_snapshot_done(tmp);
    ast_channel_unlock(tmp);
 
    if (state != AST_STATE_DOWN) {
        if (unistimdebug) {
            ast_verb(0, "Starting pbx in unistim_new\n");
        }
        if (ast_pbx_start(tmp)) {
            ast_log(LOG_WARNING, "Unable to start PBX on %s\n", ast_channel_name(tmp));
            ast_hangup(tmp);
            tmp = NULL;
        }
    }
 
    return tmp;
}
 
static void unistim_set_owner(struct unistim_subchannel *sub, struct ast_channel *chan)
{
    sub->owner = chan;
    if (sub->rtp) {
        ast_rtp_instance_set_channel_id(sub->rtp, sub->owner ? ast_channel_uniqueid(sub->owner) : "");
    }
}
 
static void *do_monitor(void *data)
{
    struct unistimsession *cur = NULL;
    unsigned int dw_timeout = 0;
    unsigned int tick;
    int res;
    int reloading;
 
    /* Add an I/O event to our UDP socket */
    if (unistimsock > -1) {
        ast_io_add(io, unistimsock, unistimsock_read, AST_IO_IN, NULL);
    }
    /* This thread monitors our UDP socket and timers */
    for (;;) {
        /* This loop is executed at least every IDLE_WAITus (1s) or every time a packet is received */
        /* Looking for the smallest time-out value */
        tick = get_tick_count();
        dw_timeout = UINT_MAX;
        ast_mutex_lock(&sessionlock);
        cur = sessions;
        DEBUG_TIMER("checking timeout for session %p with tick = %u\n", cur, tick);
        while (cur) {
            DEBUG_TIMER("checking timeout for session %p timeout = %u\n", cur,
                        cur->timeout);
            /* Check if we have miss something */
            if (cur->timeout <= tick) {
                DEBUG_TIMER("Event for session %p\n", cur);
                /* If the queue is empty, send a ping */
                if (cur->last_buf_available == 0) {
                    send_ping(cur);
                } else {
                    if (send_retransmit(cur)) {
                        DEBUG_TIMER("The chained link was modified, restarting...\n");
                        cur = sessions;
                        dw_timeout = UINT_MAX;
                        continue;
                    }
                }
            }
            if (dw_timeout > cur->timeout - tick) {
                dw_timeout = cur->timeout - tick;
            }
            /* Checking if the phone is logged on for a new MWI */
            if (cur->device) {
                struct unistim_line *l;
                AST_LIST_LOCK(&cur->device->lines);
                AST_LIST_TRAVERSE(&cur->device->lines, l, list) {
                    if ((!ast_strlen_zero(l->mailbox)) && (tick >= l->parent->nextmsgcheck)) {
                        DEBUG_TIMER("Checking mailbox for MWI\n");
                        unistim_send_mwi_to_peer(l, tick);
                        break;
                    }
                }
                AST_LIST_UNLOCK(&cur->device->lines);
                if (cur->device->nextdial && tick >= cur->device->nextdial) {
                    handle_call_outgoing(cur);
                    cur->device->nextdial = 0;
                }
            }
            cur = cur->next;
        }
        ast_mutex_unlock(&sessionlock);
        DEBUG_TIMER("Waiting for %dus\n", dw_timeout);
        res = dw_timeout;
        /* We should not wait more than IDLE_WAIT */
        if ((res < 0) || (res > IDLE_WAIT)) {
            res = IDLE_WAIT;
        }
        /* Wait for UDP messages for a maximum of res us */
        res = ast_io_wait(io, res);     /* This function will call unistimsock_read if a packet is received */
        /* Check for a reload request */
        ast_mutex_lock(&unistim_reload_lock);
        reloading = unistim_reloading;
        unistim_reloading = 0;
        ast_mutex_unlock(&unistim_reload_lock);
        if (reloading) {
            ast_verb(1, "Reloading unistim.conf...\n");
            reload_config();
        }
        pthread_testcancel();
    }
    /* Never reached */
    return NULL;
}
 
/*--- restart_monitor: Start the channel monitor thread ---*/
static int restart_monitor(void)
{
    pthread_attr_t attr;
    /* If we're supposed to be stopped -- stay stopped */
    if (monitor_thread == AST_PTHREADT_STOP) {
        return 0;
    }
    if (ast_mutex_lock(&monlock)) {
        ast_log(LOG_WARNING, "Unable to lock monitor\n");
        return -1;
    }
    if (monitor_thread == pthread_self()) {
        ast_mutex_unlock(&monlock);
        ast_log(LOG_WARNING, "Cannot kill myself\n");
        return -1;
    }
    if (monitor_thread != AST_PTHREADT_NULL) {
        /* Wake up the thread */
        pthread_kill(monitor_thread, SIGURG);
    } else {
        pthread_attr_init(&attr);
        pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_JOINABLE);
        /* Start a new monitor */
        if (ast_pthread_create(&monitor_thread, &attr, do_monitor, NULL) < 0) {
            ast_mutex_unlock(&monlock);
            ast_log(LOG_ERROR, "Unable to start monitor thread.\n");
            return -1;
        }
    }
    ast_mutex_unlock(&monlock);
    return 0;
}
 
/*--- unistim_request: PBX interface function ---*/
/* UNISTIM calls initiated by the PBX arrive here */
static struct ast_channel *unistim_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)
{
    struct unistim_subchannel *sub, *sub_ring, *sub_trans;
    struct unistim_device *d;
    struct ast_channel *tmpc = NULL;
    char tmp[256];
 
    if (!(ast_format_cap_iscompatible(cap, global_cap))) {
        struct ast_str *cap_buf = ast_str_alloca(AST_FORMAT_CAP_NAMES_LEN);
        struct ast_str *global_buf = ast_str_alloca(AST_FORMAT_CAP_NAMES_LEN);
        ast_log(LOG_NOTICE,
                "Asked to get a channel of unsupported format %s while capability is %s\n",
                ast_format_cap_get_names(cap, &cap_buf),
                ast_format_cap_get_names(global_cap, &global_buf));
        return NULL;
    }
 
    ast_copy_string(tmp, dest, sizeof(tmp));
    if (ast_strlen_zero(tmp)) {
        ast_log(LOG_NOTICE, "Unistim channels require a device\n");
        return NULL;
    }
    sub = find_subchannel_by_name(tmp);
    if (!sub) {
        ast_log(LOG_NOTICE, "No available lines on: %s\n", dest);
        *cause = AST_CAUSE_CONGESTION;
        return NULL;
    }
    d = sub->parent->parent;
    sub_ring = get_sub(d, SUB_RING);
    sub_trans = get_sub(d, SUB_THREEWAY);
    /* Another request already in progress */
    if (!d->session) {
        unistim_unalloc_sub(d, sub);
        *cause = AST_CAUSE_CONGESTION;
        return NULL;
    }
    if (sub_ring || sub_trans) {
        if (unistimdebug) {
            ast_verb(0, "Can't create channel, request already in progress: Busy!\n");
        }
        unistim_unalloc_sub(d, sub);
        *cause = AST_CAUSE_BUSY;
        return NULL;
    }
    if (d->session->state == STATE_DIALPAGE) {
        if (unistimdebug) {
            ast_verb(0, "Can't create channel, user on dialpage: Busy!\n");
        }
        unistim_unalloc_sub(d, sub);
        *cause = AST_CAUSE_BUSY;
        return NULL;
    }
 
        if (get_avail_softkey(d->session, sub->parent->name) == -1) {
        if (unistimdebug) {
            ast_verb(0, "Can't create channel for line %s, all lines busy\n", sub->parent->name);
        }
        unistim_unalloc_sub(d, sub);
        *cause = AST_CAUSE_BUSY;
        return NULL;
    }
    sub->subtype = SUB_RING;
    sub->softkey = -1;
 
    ast_format_cap_append_from_cap(sub->parent->cap, cap, AST_MEDIA_TYPE_UNKNOWN);
    tmpc = unistim_new(sub, AST_STATE_DOWN, assignedids, requestor);
    if (!tmpc) {
        ast_log(LOG_WARNING, "Unable to make channel for '%s'\n", tmp);
    }
    if (unistimdebug) {
        ast_verb(0, "unistim_request owner = %p\n", sub->owner);
    }
    restart_monitor();
    /* and finish */
    return tmpc;
}
 
static char *unistim_show_info(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a)
{
    struct unistim_device *device = devices;
    struct unistim_line *line;
    struct unistim_subchannel *sub;
    struct unistimsession *s;
    struct ast_str *cap_buf = ast_str_alloca(AST_FORMAT_CAP_NAMES_LEN);
 
    switch (cmd) {
    case CLI_INIT:
        e->command = "unistim show info";
        e->usage =
            "Usage: unistim show info\n"
            "       Dump internal structures.\n\n"
            "       device\n"
            "       ->line\n"
            "       -->sub\n"
            "       ==>key\n";
        return NULL;
 
    case CLI_GENERATE:
        return NULL;    /* no completion */
    }
 
    if (a->argc != e->args) {
        return CLI_SHOWUSAGE;
    }
    ast_cli(a->fd, "Dumping internal structures:\n");
    ast_mutex_lock(&devicelock);
    while (device) {
        int i;
 
        ast_cli(a->fd, "\nname=%s id=%s ha=%p sess=%p device=%p selected=%d height=%d\n",
                device->name, device->id, device->ha, device->session,
                device, device->selected, device->height);
        AST_LIST_LOCK(&device->lines);
        AST_LIST_TRAVERSE(&device->lines,line,list) {
            ast_cli(a->fd,
                    "->name=%s fullname=%s exten=%s callid=%s cap=%s line=%p\n",
                    line->name, line->fullname, line->exten, line->cid_num,
                    ast_format_cap_get_names(line->cap, &cap_buf), line);
        }
        AST_LIST_UNLOCK(&device->lines);
 
        AST_LIST_LOCK(&device->subs);
        AST_LIST_TRAVERSE(&device->subs, sub, list) {
            if (!sub) {
                continue;
            }
            ast_cli(a->fd,
                    "-->subtype=%s chan=%p rtp=%p line=%p alreadygone=%d softkey=%d\n",
                    subtype_tostr(sub->subtype), sub->owner, sub->rtp, sub->parent,
                    sub->alreadygone, sub->softkey);
        }
        AST_LIST_UNLOCK(&device->subs);
 
        for (i = 0; i < FAVNUM; i++) {
            if (!soft_key_visible(device, i)) {
                continue;
            }
            ast_cli(a->fd, "==> %d. dev=%s icon=%#-4x label=%-10s number=%-5s sub=%p line=%p\n",
                i, device->softkeydevice[i], (unsigned)device->softkeyicon[i], device->softkeylabel[i], device->softkeynumber[i],
                device->ssub[i], device->sline[i]);
        }
        device = device->next;
    }
    ast_mutex_unlock(&devicelock);
    ast_cli(a->fd, "\nSessions:\n");
    ast_mutex_lock(&sessionlock);
    s = sessions;
    while (s) {
        ast_cli(a->fd,
                "sin=%s timeout=%d state=%s macaddr=%s device=%p session=%p\n",
                ast_inet_ntoa(s->sin.sin_addr), s->timeout, ptestate_tostr(s->state), s->macaddr,
                s->device, s);
        s = s->next;
    }
    ast_mutex_unlock(&sessionlock);
 
    return CLI_SUCCESS;
}
 
static char *unistim_show_devices(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a)
{
    struct unistim_device *device = devices;
 
    switch (cmd) {
    case CLI_INIT:
        e->command = "unistim show devices";
        e->usage =
            "Usage: unistim show devices\n"
            "       Lists all known Unistim devices.\n";
        return NULL;
    case CLI_GENERATE:
        return NULL;    /* no completion */
    }
 
    if (a->argc != e->args)
        return CLI_SHOWUSAGE;
 
    ast_cli(a->fd, "%-20.20s %-20.20s %-15.15s %-15.15s %s\n", "Name/username", "MAC", "Host", "Firmware", "Status");
    ast_mutex_lock(&devicelock);
    while (device) {
        ast_cli(a->fd, "%-20.20s %-20.20s %-15.15s %-15.15s %s\n",
            device->name, device->id,
            (!device->session) ? "(Unspecified)" : ast_inet_ntoa(device->session->sin.sin_addr),
            (!device->session) ? "(Unspecified)" : device->session->firmware,
            (!device->session) ? "UNKNOWN" : "OK");
        device = device->next;
    }
    ast_mutex_unlock(&devicelock);
 
    return CLI_SUCCESS;
}
 
static char *unistim_sp(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a)
{
    BUFFSEND;
    struct unistim_subchannel *sub;
    int i, j = 0, len;
    unsigned char c, cc;
    char tmp[256];
 
    switch (cmd) {
    case CLI_INIT:
        e->command = "unistim send packet";
        e->usage =
            "Usage: unistim send packet USTM/line@name hexa\n"
            "       unistim send packet USTM/1000@hans 19040004\n";
        return NULL;
 
    case CLI_GENERATE:
        return NULL;    /* no completion */
    }
 
    if (a->argc < 5) {
        return CLI_SHOWUSAGE;
    }
    if (strlen(a->argv[3]) < 9) {
        return CLI_SHOWUSAGE;
    }
    len = strlen(a->argv[4]);
    if (len % 2) {
        return CLI_SHOWUSAGE;
    }
    ast_copy_string(tmp, a->argv[3] + 5, sizeof(tmp));
    sub = find_subchannel_by_name(tmp);
    if (!sub) {
        ast_cli(a->fd, "Can't find '%s'\n", tmp);
        return CLI_SUCCESS;
    }
    if (!sub->parent->parent->session) {
        ast_cli(a->fd, "'%s' is not connected\n", tmp);
        return CLI_SUCCESS;
    }
    ast_cli(a->fd, "Sending '%s' to %s (%p)\n", a->argv[4], tmp, sub->parent->parent->session);
    for (i = 0; i < len; i++) {
        c = a->argv[4][i];
        if (c >= 'a') {
            c -= 'a' - 10;
        } else {
            c -= '0';
        }
        i++;
        cc = a->argv[4][i];
        if (cc >= 'a') {
            cc -= 'a' - 10;
        } else {
            cc -= '0';
        }
        tmp[j++] = (c << 4) | cc;
    }
    memcpy(buffsend + SIZE_HEADER, tmp, j);
    send_client(SIZE_HEADER + j, buffsend, sub->parent->parent->session);
    return CLI_SUCCESS;
}
 
static char *unistim_do_debug(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a)
{
    switch (cmd) {
    case CLI_INIT:
        e->command = "unistim set debug {on|off}";
        e->usage =
            "Usage: unistim set debug\n"
            "       Display debug messages.\n";
        return NULL;
 
    case CLI_GENERATE:
        return NULL;    /* no completion */
    }
 
    if (a->argc != e->args) {
        return CLI_SHOWUSAGE;
    }
    if (!strcasecmp(a->argv[3], "on")) {
        unistimdebug = 1;
        ast_cli(a->fd, "UNISTIM Debugging Enabled\n");
    } else if (!strcasecmp(a->argv[3], "off")) {
        unistimdebug = 0;
        ast_cli(a->fd, "UNISTIM Debugging Disabled\n");
    } else {
        return CLI_SHOWUSAGE;
    }
    return CLI_SUCCESS;
}
 
/*! \brief --- unistim_reload: Force reload of module from cli ---
 * Runs in the asterisk main thread, so don't do anything useful
 * but setting a flag and waiting for do_monitor to do the job
 * in our thread */
static char *unistim_reload(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a)
{
    switch (cmd) {
    case CLI_INIT:
        e->command = "unistim reload";
        e->usage =
            "Usage: unistim reload\n"
            "       Reloads UNISTIM configuration from unistim.conf\n";
        return NULL;
 
    case CLI_GENERATE:
        return NULL;    /* no completion */
    }
 
    if (e && a && a->argc != e->args) {
        return CLI_SHOWUSAGE;
    }
    reload();
 
    return CLI_SUCCESS;
}
 
static struct ast_cli_entry unistim_cli[] = {
    AST_CLI_DEFINE(unistim_reload, "Reload UNISTIM configuration"),
    AST_CLI_DEFINE(unistim_show_info, "Show UNISTIM info"),
    AST_CLI_DEFINE(unistim_show_devices, "Show UNISTIM devices"),
    AST_CLI_DEFINE(unistim_sp, "Send packet (for reverse engineering)"),
    AST_CLI_DEFINE(unistim_do_debug, "Toggle UNITSTIM debugging"),
};
 
static void unquote(char *out, const char *src, int maxlen)
{
    int len = strlen(src);
    if (!len) {
        return;
    }
    if ((len > 1) && src[0] == '\"') {
        /* This is a quoted string */
        src++;
        /* Don't take more than what's there */
        len--;
        if (maxlen > len - 1) {
            maxlen = len - 1;
        }
        memcpy(out, src, maxlen);
        ((char *) out)[maxlen] = '\0';
    } else {
        memcpy(out, src, maxlen);
    }
    return;
}
 
static int parse_bookmark(const char *text, struct unistim_device *d)
{
    char line[256];
    char *at;
    char *number;
    char *icon;
    int p;
    int len = strlen(text);
 
    ast_copy_string(line, text, sizeof(line));
    /* Position specified ? */
    if ((len > 2) && (line[1] == '@')) {
        p = line[0];
        if ((p >= '0') && (p <= '5')) {
            p -= '0';
        } else {
            ast_log(LOG_WARNING,
                    "Invalid position for bookmark : must be between 0 and 5\n");
            return 0;
        }
        if (d->softkeyicon[p] != 0) {
            ast_log(LOG_WARNING, "Invalid position %d for bookmark : already used:\n", p);
            return 0;
        }
        memmove(line, line + 2, sizeof(line) - 2);
    } else {
        /* No position specified, looking for a free slot */
        for (p = 0; p < FAVNUM; p++) {
            if (!d->softkeyicon[p]) {
                break;
            }
        }
        if (p == FAVNUM) {
            ast_log(LOG_WARNING, "No more free bookmark position\n");
            return 0;
        }
    }
    at = strchr(line, '@');
    if (!at) {
        ast_log(LOG_NOTICE, "Bookmark entry '%s' has no @ (at) sign!\n", text);
        return 0;
    }
    *at = '\0';
    at++;
    number = at;
    at = strchr(at, '@');
    if (ast_strlen_zero(number)) {
        ast_log(LOG_NOTICE, "Bookmark entry '%s' has no number\n", text);
        return 0;
    }
    if (ast_strlen_zero(line)) {
        ast_log(LOG_NOTICE, "Bookmark entry '%s' has no description\n", text);
        return 0;
    }
 
    at = strchr(number, '@');
    if (!at) {
        d->softkeyicon[p] = FAV_ICON_SHARP;     /* default icon */
    } else {
        *at = '\0';
        at++;
        icon = at;
        if (ast_strlen_zero(icon)) {
            ast_log(LOG_NOTICE, "Bookmark entry '%s' has no icon value\n", text);
            return 0;
        }
        if (strncmp(icon, "USTM/", 5)) {
            d->softkeyicon[p] = atoi(icon);
        } else {
            d->softkeyicon[p] = 1;
            ast_copy_string(d->softkeydevice[p], icon + 5, sizeof(d->softkeydevice[p]));
        }
    }
    ast_copy_string(d->softkeylabel[p], line, sizeof(d->softkeylabel[p]));
    ast_copy_string(d->softkeynumber[p], number, sizeof(d->softkeynumber[p]));
    if (unistimdebug) {
        ast_verb(0, "New bookmark at pos %d label='%s' number='%s' icon=%#x\n",
                    p, d->softkeylabel[p], d->softkeynumber[p], (unsigned)d->softkeyicon[p]);
    }
    return 1;
}
 
/* Looking for dynamic icons entries in bookmarks */
static void finish_bookmark(void)
{
    struct unistim_device *d = devices;
    int i;
    ast_mutex_lock(&devicelock);
    while (d) {
        for (i = 0; i < 6; i++) {
            if (d->softkeyicon[i] == 1) {   /* Something for us */
                struct unistim_device *d2 = devices;
                while (d2) {
                    if (!strcmp(d->softkeydevice[i], d2->name)) {
                        d->sp[i] = d2;
                        d->softkeyicon[i] = 0;
                        break;
                    }
                    d2 = d2->next;
                }
                if (d->sp[i] == NULL) {
                    ast_log(LOG_NOTICE, "Bookmark entry with device %s not found\n",
                            d->softkeydevice[i]);
                }
            }
        }
        d = d->next;
    }
    ast_mutex_unlock(&devicelock);
}
 
static struct unistim_line *find_line_by_number(struct unistim_device *d, const char *val) {
    struct unistim_line *l, *ret = NULL;
 
    AST_LIST_LOCK(&d->lines);
    AST_LIST_TRAVERSE(&d->lines, l, list) {
        if (!strcmp(l->name, val)) {
            ret = l;
            break;
        }
    }
    AST_LIST_UNLOCK(&d->lines);
    return ret;
}
 
static void delete_device(struct unistim_device *d)
{
    struct unistim_line *l;
    struct unistim_subchannel *sub;
    struct unistimsession *s;
 
    if (unistimdebug) {
        ast_verb(0, "Removing device '%s'\n", d->name);
    }
    AST_LIST_LOCK(&d->subs);
    AST_LIST_TRAVERSE_SAFE_BEGIN(&d->subs, sub, list){
        if (sub->subtype == SUB_REAL) {
            if (sub->owner) {
                ast_log(LOG_WARNING,
                        "Device '%s' was not deleted : a call is in progress. Try again later.\n",
                        d->name);
                AST_LIST_UNLOCK(&d->subs);
                return;
            }
        }
        if (sub->subtype == SUB_THREEWAY) {
            ast_log(LOG_WARNING,
                    "Device '%s' with threeway call subchannels allocated, aborting.\n",
                    d->name);
            AST_LIST_UNLOCK(&d->subs);
            return;
        }
        AST_LIST_REMOVE_CURRENT(list);
        ast_mutex_destroy(&sub->lock);
        ast_free(sub);
    }
    AST_LIST_TRAVERSE_SAFE_END
    AST_LIST_UNLOCK(&d->subs);
 
 
    AST_LIST_LOCK(&d->lines);
    AST_LIST_TRAVERSE_SAFE_BEGIN(&d->lines, l, list){
        AST_LIST_REMOVE_CURRENT(list);
        ast_mutex_destroy(&l->lock);
        unistim_line_destroy(l);
    }
    AST_LIST_TRAVERSE_SAFE_END
    AST_LIST_UNLOCK(&d->lines);
 
    if (d->session) {
        if (sessions == d->session) {
            sessions = d->session->next;
        } else {
            s = sessions;
            while (s) {
                if (s->next == d->session) {
                    s->next = d->session->next;
                    break;
                }
                s = s->next;
            }
        }
        ast_mutex_destroy(&d->session->lock);
        ast_free(d->session);
    }
    if (devices == d) {
        devices = d->next;
    } else {
        struct unistim_device *d2 = devices;
        while (d2) {
            if (d2->next == d) {
                d2->next = d->next;
                break;
            }
            d2 = d2->next;
        }
    }
    if (d->tz) {
        d->tz = ast_tone_zone_unref(d->tz);
    }
    ast_mutex_destroy(&d->lock);
    ast_free(d);
}
 
static struct unistim_device *build_device(const char *cat, const struct ast_variable *v)
{
    struct unistim_device *d;
    struct unistim_line *l = NULL, *lt = NULL;
    int create = 1;
    int nbsoftkey, dateformat, timeformat, callhistory, sharpdial, linecnt;
    char linelabel[AST_MAX_EXTENSION];
    signed char ringvolume, ringstyle, cwvolume, cwstyle;
 
    /* First, we need to know if we already have this name in our list */
    /* Get a lock for the device chained list */
    ast_mutex_lock(&devicelock);
    d = devices;
    while (d) {
        if (!strcmp(d->name, cat)) {
            /* Yep, we alreay have this one */
            if (unistimsock < 0) {
                /* It's a dupe */
                ast_log(LOG_WARNING, "Duplicate entry found (%s), ignoring.\n", cat);
                ast_mutex_unlock(&devicelock);
                return NULL;
            }
            /* we're reloading right now */
            create = 0;
            break;
        }
        d = d->next;
    }
    ast_mutex_unlock(&devicelock);
    if (!(lt = ast_calloc(1, sizeof(*lt)))) {
        return NULL;
    }
    if (create) {
        if (!(d = ast_calloc(1, sizeof(*d)))) {
            return NULL;
        }
        ast_mutex_init(&d->lock);
        ast_copy_string(d->name, cat, sizeof(d->name));
 
        ast_copy_string(d->context, DEFAULTCONTEXT, sizeof(d->context));
        d->contrast = -1;
        d->output = OUTPUT_HANDSET;
        d->previous_output = OUTPUT_HANDSET;
        d->volume = VOLUME_LOW;
        d->microphone = MUTE_OFF;
        d->height = DEFAULTHEIGHT;
        d->selected = -1;
        d->interdigit_timer = DEFAULT_INTERDIGIT_TIMER;
    } else {
        /* Delete existing line information */
        AST_LIST_LOCK(&d->lines);
        AST_LIST_TRAVERSE_SAFE_BEGIN(&d->lines, l, list){
            AST_LIST_REMOVE_CURRENT(list);
            unistim_line_destroy(l);
        }
        AST_LIST_TRAVERSE_SAFE_END
        AST_LIST_UNLOCK(&d->lines);
 
        /* reset bookmarks */
        memset(d->softkeylabel, 0, sizeof(d->softkeylabel));
        memset(d->softkeynumber, 0, sizeof(d->softkeynumber));
        memset(d->softkeyicon, 0, sizeof(d->softkeyicon));
        memset(d->softkeydevice, 0, sizeof(d->softkeydevice));
        memset(d->ssub, 0, sizeof(d->ssub));
        memset(d->sline, 0, sizeof(d->sline));
        memset(d->sp, 0, sizeof(d->sp));
    }
    linelabel[0] = '\0';
    dateformat = 1;
    timeformat = 1;
    ringvolume = 2;
    cwvolume = 1;
    callhistory = 1;
    sharpdial = 0;
    ringstyle = 3;
    cwstyle = 2;
    nbsoftkey = 0;
    linecnt = 0;
    d->dtmfduration = 0;
    while (v) {
        if (!strcasecmp(v->name, "rtp_port")) {
            d->rtp_port = atoi(v->value);
        } else if (!strcasecmp(v->name, "rtp_method")) {
            d->rtp_method = atoi(v->value);
        } else if (!strcasecmp(v->name, "status_method")) {
            d->status_method = atoi(v->value);
        } else if (!strcasecmp(v->name, "device")) {
            ast_copy_string(d->id, v->value, sizeof(d->id));
        } else if (!strcasecmp(v->name, "tn")) {
            ast_copy_string(d->extension_number, v->value, sizeof(d->extension_number));
        } else if (!strcasecmp(v->name, "permit") || !strcasecmp(v->name, "deny")) {
            int acl_error = 0;
            d->ha = ast_append_ha(v->name, v->value, d->ha, &acl_error);
            if (acl_error) {
                ast_log(LOG_ERROR, "Invalid ACL '%s' specified for device '%s' on line %d. Deleting device\n",
                        v->value, cat, v->lineno);
                delete_device(d);
                return NULL;
            }
        } else if (!strcasecmp(v->name, "context")) {
            ast_copy_string(d->context, v->value, sizeof(d->context));
        } else if (!strcasecmp(v->name, "maintext0")) {
            unquote(d->maintext0, v->value, sizeof(d->maintext0) - 1);
        } else if (!strcasecmp(v->name, "maintext1")) {
            unquote(d->maintext1, v->value, sizeof(d->maintext1) - 1);
        } else if (!strcasecmp(v->name, "maintext2")) {
            unquote(d->maintext2, v->value, sizeof(d->maintext2) - 1);
        } else if (!strcasecmp(v->name, "titledefault")) {
            unquote(d->titledefault, v->value, sizeof(d->titledefault) - 1);
        } else if (!strcasecmp(v->name, "dateformat")) {
            dateformat = atoi(v->value);
        } else if (!strcasecmp(v->name, "timeformat")) {
            timeformat = atoi(v->value);
        } else if (!strcasecmp(v->name, "contrast")) {
            d->contrast = atoi(v->value);
            if ((d->contrast < 0) || (d->contrast > 15)) {
                ast_log(LOG_WARNING, "contrast must be beetween 0 and 15\n");
                d->contrast = 8;
            }
        } else if (!strcasecmp(v->name, "nat")) {
            d->nat = ast_true(v->value);
        } else if (!strcasecmp(v->name, "hasexp")) {
            d->hasexp = ast_true(v->value);
        } else if (!strcasecmp(v->name, "ringvolume")) {
            ringvolume = atoi(v->value);
        } else if (!strcasecmp(v->name, "ringstyle")) {
            ringstyle = atoi(v->value);
        } else if (!strcasecmp(v->name, "cwvolume")) {
            cwvolume = atoi(v->value);
        } else if (!strcasecmp(v->name, "cwstyle")) {
            cwstyle = atoi(v->value);
        } else if (!strcasecmp(v->name, "callhistory")) {
            callhistory = atoi(v->value);
        } else if (!strcasecmp(v->name, "sharpdial")) {
            sharpdial = ast_true(v->value) ? 1 : 0;
        } else if (!strcasecmp(v->name, "interdigit_timer")) {
            d->interdigit_timer = atoi(v->value);
        } else if (!strcasecmp(v->name, "dtmf_duration")) {
            d->dtmfduration = atoi(v->value);
            if (d->dtmfduration > 150) {
                d->dtmfduration = 150;
            }
        } else if (!strcasecmp(v->name, "callerid")) {
            if (!strcasecmp(v->value, "asreceived")) {
                lt->cid_num[0] = '\0';
            } else {
                ast_copy_string(lt->cid_num, v->value, sizeof(lt->cid_num));
            }
        } else if (!strcasecmp(v->name, "language")) {
            ast_copy_string(d->language, v->value, sizeof(d->language));
        } else if (!strcasecmp(v->name, "country")) {
            ast_copy_string(d->country, v->value, sizeof(d->country));
        } else if (!strcasecmp(v->name, "accountcode")) {
            ast_copy_string(lt->accountcode, v->value, sizeof(lt->accountcode));
        } else if (!strcasecmp(v->name, "amaflags")) {
            int y;
            y = ast_channel_string2amaflag(v->value);
            if (y < 0) {
                ast_log(LOG_WARNING, "Invalid AMA flags: %s at line %d\n", v->value,
                        v->lineno);
            } else {
                lt->amaflags = y;
            }
        } else if (!strcasecmp(v->name, "musiconhold")) {
            ast_copy_string(lt->musicclass, v->value, sizeof(lt->musicclass));
        } else if (!strcasecmp(v->name, "callgroup")) {
            lt->callgroup = ast_get_group(v->value);
        } else if (!strcasecmp(v->name, "pickupgroup")) {
            lt->pickupgroup = ast_get_group(v->value);
        } else if (!strcasecmp(v->name, "mailbox")) {
            ast_copy_string(lt->mailbox, v->value, sizeof(lt->mailbox));
        } else if (!strcasecmp(v->name, "parkinglot")) {
            ast_copy_string(lt->parkinglot, v->value, sizeof(lt->parkinglot));
        } else if (!strcasecmp(v->name, "linelabel")) {
            unquote(linelabel, v->value, sizeof(linelabel) - 1);
        } else if (!strcasecmp(v->name, "extension")) {
            if (!strcasecmp(v->value, "none")) {
                d->extension = EXTENSION_NONE;
            } else if (!strcasecmp(v->value, "ask")) {
                d->extension = EXTENSION_ASK;
            } else if (!strcasecmp(v->value, "line")) {
                d->extension = EXTENSION_LINE;
            } else {
                ast_log(LOG_WARNING, "Unknown extension option.\n");
            }
        } else if (!strcasecmp(v->name, "bookmark")) {
            if (nbsoftkey > 5) {
                ast_log(LOG_WARNING,
                        "More than 6 softkeys defined. Ignoring new entries.\n");
            } else {
                if (parse_bookmark(v->value, d)) {
                    nbsoftkey++;
                }
            }
        } else if (!strcasecmp(v->name, "line")) {
            int len = strlen(linelabel);
            int create_line = 0;
 
            l = find_line_by_number(d, v->value);
            if (!l) { /* If line still not exists */
                if (!(l = unistim_line_alloc())) {
                    ast_free(d);
                    ast_free(lt);
                    return NULL;
                }
                lt->cap = l->cap;
                memcpy(l, lt, sizeof(*l));
                ast_mutex_init(&l->lock);
                create_line = 1;
            }
            d->to_delete = 0;
 
            /* Set softkey info for new line*/
            d->sline[nbsoftkey] = l;
            d->softkeyicon[nbsoftkey] = FAV_LINE_ICON;
            if (!len) {       /* label is undefined ? */
                ast_copy_string(d->softkeylabel[nbsoftkey], v->value, sizeof(d->softkeylabel[nbsoftkey]));
            } else {
                int softkeylinepos = 0;
                if ((len > 2) && (linelabel[1] == '@')) {
                    softkeylinepos = linelabel[0];
                    if ((softkeylinepos >= '0') && (softkeylinepos <= '5')) {
                        softkeylinepos -= '0';
                        d->softkeyicon[nbsoftkey] = FAV_ICON_NONE;
                    } else {
                        ast_log(LOG_WARNING,
                                "Invalid position for linelabel : must be between 0 and 5\n");
                    }
                    ast_copy_string(d->softkeylabel[softkeylinepos], linelabel + 2,
                                    sizeof(d->softkeylabel[softkeylinepos]));
                    d->softkeyicon[softkeylinepos] = FAV_LINE_ICON;
                } else {
                    ast_copy_string(d->softkeylabel[nbsoftkey], linelabel,
                                    sizeof(d->softkeylabel[nbsoftkey]));
                }
            }
            nbsoftkey++;
 
            if (create_line) {
                ast_copy_string(l->name, v->value, sizeof(l->name));
                snprintf(l->fullname, sizeof(l->fullname), "USTM/%s@%s", l->name, d->name);
                if (!ast_strlen_zero(l->mailbox)) {
                    if (unistimdebug) {
                        ast_verb(3, "Setting mailbox '%s' on %s@%s\n", l->mailbox, d->name, l->name);
                    }
                }
                ast_format_cap_append_from_cap(l->cap, global_cap, AST_MEDIA_TYPE_UNKNOWN);
                l->parent = d;
                linecnt++;
                AST_LIST_LOCK(&d->lines);
                AST_LIST_INSERT_TAIL(&d->lines, l, list);
                AST_LIST_UNLOCK(&d->lines);
            }
        } else if (!strcasecmp(v->name, "height")) {
            /* Allow the user to lower the expected display lines on the phone
             * For example the Nortel i2001 and i2002 only have one ! */
            d->height = atoi(v->value);
        } else
            ast_log(LOG_WARNING, "Don't know keyword '%s' at line %d\n", v->name,
                    v->lineno);
        v = v->next;
    }
    ast_free(lt);
    if (linecnt == 0) {
        ast_log(LOG_ERROR, "An Unistim device must have at least one line!\n");
        ast_free(d);
        return NULL;
    }
    d->ringvolume = ringvolume;
    d->ringstyle = ringstyle;
    d->cwvolume = cwvolume;
    d->cwstyle = cwstyle;
    d->callhistory = callhistory;
    d->sharp_dial = sharpdial;
    d->tz = ast_get_indication_zone(d->country);
    if ((d->tz == NULL) && !ast_strlen_zero(d->country)) {
        ast_log(LOG_WARNING, "Country '%s' was not found in indications.conf\n",
                d->country);
    }
    d->datetimeformat = 48 + (dateformat * 4);
    d->datetimeformat += timeformat;
    if ((autoprovisioning == AUTOPROVISIONING_TN) &&
        (!ast_strlen_zero(d->extension_number))) {
        d->extension = EXTENSION_TN;
        if (!ast_strlen_zero(d->id)) {
            ast_log(LOG_WARNING,
                    "tn= and device= can't be used together. Ignoring device= entry\n");
        }
        d->id[0] = 'T';      /* magic : this is a tn entry */
        ast_copy_string((d->id) + 1, d->extension_number, sizeof(d->id) - 1);
        d->extension_number[0] = '\0';
    } else if (ast_strlen_zero(d->id)) {
        if (strcmp(d->name, "template")) {
            ast_log(LOG_ERROR, "You must specify the mac address with device=\n");
            if (d->tz) {
                d->tz = ast_tone_zone_unref(d->tz);
            }
            ast_free(d);
            return NULL;
        } else {
            strcpy(d->id, "000000000000");
        }
    }
    if (!d->rtp_port) {
        d->rtp_port = 10000;
    }
    if (d->contrast == -1) {
        d->contrast = 8;
    }
    if (ast_strlen_zero(d->maintext1)) {
        strcpy(d->maintext1, d->name);
    }
    if (ast_strlen_zero(d->titledefault)) {
        struct ast_tm tm = { 0, };
        struct timeval cur_time = ast_tvnow();
 
        if ((ast_localtime(&cur_time, &tm, 0)) == 0 || ast_strlen_zero(tm.tm_zone)) {
            ast_log(LOG_WARNING, "Error in ast_localtime()\n");
            ast_copy_string(d->titledefault, "UNISTIM for*", 12);
        } else {
            if (strlen(tm.tm_zone) < 4) {
                strcpy(d->titledefault, "TimeZone ");
                strcat(d->titledefault, tm.tm_zone);
            } else if (strlen(tm.tm_zone) < 9) {
                strcpy(d->titledefault, "TZ ");
                strcat(d->titledefault, tm.tm_zone);
            } else {
                ast_copy_string(d->titledefault, tm.tm_zone, 12);
            }
        }
    }
    /* Update the chained link if it's a new device */
    if (create) {
        ast_mutex_lock(&devicelock);
        d->next = devices;
        devices = d;
        ast_mutex_unlock(&devicelock);
        ast_verb(3, "Added device '%s'\n", d->name);
    } else {
        ast_verb(3, "Device '%s' reloaded\n", d->name);
    }
    return d;
}
 
/*--- reload_config: Re-read unistim.conf config file ---*/
static int reload_config(void)
{
    struct ast_config *cfg;
    struct ast_variable *v;
    struct sockaddr_in bindaddr = { 0, };
    char *config = "unistim.conf";
    char *cat;
    struct unistim_device *d;
    const int reuseFlag = 1;
    struct unistimsession *s;
    struct ast_flags config_flags = { 0, };
 
    cfg = ast_config_load(config, config_flags);
    /* We *must* have a config file otherwise stop immediately */
    if (!cfg) {
        ast_log(LOG_ERROR, "Unable to load config %s\n", config);
        return -1;
    } else if (cfg == CONFIG_STATUS_FILEINVALID) {
        ast_log(LOG_ERROR, "Config file %s is in an invalid format.  Aborting.\n", config);
        return -1;
    }
 
    /* Copy the default jb config over global_jbconf */
    memcpy(&global_jbconf, &default_jbconf, sizeof(struct ast_jb_conf));
 
    unistim_keepalive = 120;
    unistim_port = 0;
    v = ast_variable_browse(cfg, "general");
    while (v) {
        /* handle jb conf */
        if (!ast_jb_read_conf(&global_jbconf, v->name, v->value)) {
            continue;
        }
        if (!strcasecmp(v->name, "keepalive")) {
            unistim_keepalive = atoi(v->value);
        } else if (!strcasecmp(v->name, "port")) {
            unistim_port = atoi(v->value);
        } else if (!strcasecmp(v->name, "tos")) {
                        if (ast_str2tos(v->value, &qos.tos)) {
                            ast_log(LOG_WARNING, "Invalid tos value at line %d, refer to QoS documentation\n", v->lineno);
            }
                } else if (!strcasecmp(v->name, "tos_audio")) {
                        if (ast_str2tos(v->value, &qos.tos_audio)) {
                            ast_log(LOG_WARNING, "Invalid tos_audio value at line %d, refer to QoS documentation\n", v->lineno);
            }
                } else if (!strcasecmp(v->name, "cos")) {
                        if (ast_str2cos(v->value, &qos.cos)) {
                            ast_log(LOG_WARNING, "Invalid cos value at line %d, refer to QoS documentation\n", v->lineno);
            }
                } else if (!strcasecmp(v->name, "cos_audio")) {
                        if (ast_str2cos(v->value, &qos.cos_audio)) {
                            ast_log(LOG_WARNING, "Invalid cos_audio value at line %d, refer to QoS documentation\n", v->lineno);
            }
        } else if (!strcasecmp(v->name, "debug")) {
            if (!strcasecmp(v->value, "no")) {
                unistimdebug = 0;
            } else if (!strcasecmp(v->value, "yes")) {
                unistimdebug = 1;
            }
        } else if (!strcasecmp(v->name, "autoprovisioning")) {
            if (!strcasecmp(v->value, "no")) {
                autoprovisioning = AUTOPROVISIONING_NO;
            } else if (!strcasecmp(v->value, "yes")) {
                autoprovisioning = AUTOPROVISIONING_YES;
            } else if (!strcasecmp(v->value, "tn")) {
                autoprovisioning = AUTOPROVISIONING_TN;
            } else {
                ast_log(LOG_WARNING, "Unknown autoprovisioning option.\n");
            }
        } else if (!strcasecmp(v->name, "public_ip")) {
            if (!ast_strlen_zero(v->value)) {
                struct ast_sockaddr addr = { {0,} };
                if (ast_sockaddr_resolve_first_af(&addr, v->value, PARSE_PORT_FORBID, AF_INET)) {
                    ast_log(LOG_WARNING, "Invalid address: %s\n", v->value);
                } else {
                    ast_sockaddr_to_sin(&addr, &public_ip);
                }
            }
        }
        v = v->next;
    }
    if ((unistim_keepalive < 10) ||
        (unistim_keepalive >
         255 - (((NB_MAX_RETRANSMIT + 1) * RETRANSMIT_TIMER) / 1000))) {
        ast_log(LOG_ERROR, "keepalive is invalid in %s\n", config);
        ast_config_destroy(cfg);
        return -1;
    }
    packet_send_ping[4] =
        unistim_keepalive + (((NB_MAX_RETRANSMIT + 1) * RETRANSMIT_TIMER) / 1000);
    if ((unistim_port < 1) || (unistim_port > 65535)) {
        ast_log(LOG_ERROR, "port is not set or invalid in %s\n", config);
        ast_config_destroy(cfg);
        return -1;
    }
    unistim_keepalive *= 1000;
 
    ast_mutex_lock(&devicelock);
    d = devices;
    while (d) {
        if (d->to_delete >= 0) {
            d->to_delete = 1;
        }
        d = d->next;
    }
    ast_mutex_unlock(&devicelock);
    /* load the device sections */
    cat = ast_category_browse(cfg, NULL);
    while (cat) {
        if (strcasecmp(cat, "general")) {
            d = build_device(cat, ast_variable_browse(cfg, cat));
        }
        cat = ast_category_browse(cfg, cat);
    }
    ast_mutex_lock(&devicelock);
    d = devices;
    while (d) {
        if (d->to_delete) {
            delete_device(d);
            d = devices;
            continue;
        }
        d = d->next;
    }
    finish_bookmark();
    ast_mutex_unlock(&devicelock);
    ast_config_destroy(cfg);
    ast_mutex_lock(&sessionlock);
    s = sessions;
    while (s) {
        if (s->device) {
            refresh_all_favorite(s);
            if (ast_strlen_zero(s->device->language)) {
                struct unistim_languages lang;
                lang = options_languages[find_language(s->device->language)];
                send_charset_update(s, lang.encoding);
            }
        }
        s = s->next;
    }
    ast_mutex_unlock(&sessionlock);
    /* We don't recreate a socket when reloading (locks would be necessary). */
    if (unistimsock > -1) {
        return 0;
    }
    bindaddr.sin_addr.s_addr = INADDR_ANY;
    bindaddr.sin_port = htons(unistim_port);
    bindaddr.sin_family = AF_INET;
    unistimsock = socket(AF_INET, SOCK_DGRAM, 0);
    if (unistimsock < 0) {
        ast_log(LOG_WARNING, "Unable to create UNISTIM socket: %s\n", strerror(errno));
        return -1;
    }
#ifdef HAVE_PKTINFO
    {
        const int pktinfoFlag = 1;
        setsockopt(unistimsock, IPPROTO_IP, IP_PKTINFO, &pktinfoFlag,
                   sizeof(pktinfoFlag));
    }
#else
    if (public_ip.sin_family == 0) {
        ast_log(LOG_WARNING,
                "Your OS does not support IP_PKTINFO, you must set public_ip.\n");
        unistimsock = -1;
        return -1;
    }
#endif
    setsockopt(unistimsock, SOL_SOCKET, SO_REUSEADDR, (const char *) &reuseFlag,
               sizeof(reuseFlag));
    if (bind(unistimsock, (struct sockaddr *) &bindaddr, sizeof(bindaddr)) < 0) {
        ast_log(LOG_WARNING, "Failed to bind to %s:%d: %s\n",
                ast_inet_ntoa(bindaddr.sin_addr), htons(bindaddr.sin_port),
                strerror(errno));
        close(unistimsock);
        unistimsock = -1;
    } else {
        ast_verb(2, "UNISTIM Listening on %s:%d\n", ast_inet_ntoa(bindaddr.sin_addr), htons(bindaddr.sin_port));
        ast_set_qos(unistimsock, qos.tos, qos.cos, "UNISTIM");
    }
    return 0;
}
 
static enum ast_rtp_glue_result unistim_get_rtp_peer(struct ast_channel *chan, struct ast_rtp_instance **instance)
{
    struct unistim_subchannel *sub = ast_channel_tech_pvt(chan);
 
    if (!sub) {
        return AST_RTP_GLUE_RESULT_FORBID;
    }
    if (!sub->rtp) {
        return AST_RTP_GLUE_RESULT_FORBID;
    }
 
    ao2_ref(sub->rtp, +1);
    *instance = sub->rtp;
 
    return AST_RTP_GLUE_RESULT_LOCAL;
}
 
static int unistim_set_rtp_peer(struct ast_channel *chan, 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 unistim_subchannel *sub = ast_channel_tech_pvt(chan);
    struct sockaddr_in them = { 0, };
    struct sockaddr_in us = { 0, };
 
    if (!rtp) {
        return 0;
    }
 
    sub = (struct unistim_subchannel *) ast_channel_tech_pvt(chan);
    if (!sub) {
        ast_log(LOG_ERROR, "No Private Structure, this is bad\n");
        return -1;
    }
    {
        struct ast_sockaddr tmp;
        ast_rtp_instance_get_remote_address(rtp, &tmp);
        ast_sockaddr_to_sin(&tmp, &them);
        ast_rtp_instance_get_local_address(rtp, &tmp);
        ast_sockaddr_to_sin(&tmp, &us);
    }
 
    /* TODO: Set rtp on phone in case of direct rtp (not implemented) */
 
    return 0;
}
 
static struct ast_rtp_glue unistim_rtp_glue = {
    .type = channel_type,
    .get_rtp_info = unistim_get_rtp_peer,
    .update_peer = unistim_set_rtp_peer,
};
 
/*--- load_module: PBX load module - initialization ---*/
int load_module(void)
{
    int res;
 
    if (!(global_cap = ast_format_cap_alloc(AST_FORMAT_CAP_FLAG_DEFAULT))) {
        goto buff_failed;
    }
    if (!(unistim_tech.capabilities = ast_format_cap_alloc(AST_FORMAT_CAP_FLAG_DEFAULT))) {
        goto buff_failed;
    }
 
    ast_format_cap_append(global_cap, ast_format_ulaw, 0);
    ast_format_cap_append(global_cap, ast_format_alaw, 0);
    ast_format_cap_append_from_cap(unistim_tech.capabilities, global_cap, AST_MEDIA_TYPE_AUDIO);
 
    if (!(buff = ast_malloc(SIZE_PAGE))) {
        goto buff_failed;
    }
 
    io = io_context_create();
    if (!io) {
        ast_log(LOG_ERROR, "Failed to allocate IO context\n");
        goto io_failed;
    }
 
    sched = ast_sched_context_create();
    if (!sched) {
        ast_log(LOG_ERROR, "Failed to allocate scheduler context\n");
        goto sched_failed;
    }
 
    res = reload_config();
    if (res) {
        ao2_ref(unistim_tech.capabilities, -1);
        ao2_ref(global_cap, -1);
        ast_sched_context_destroy(sched);
        io_context_destroy(io);
        return AST_MODULE_LOAD_DECLINE;
    }
    /* Make sure we can register our unistim channel type */
    if (ast_channel_register(&unistim_tech)) {
        ast_log(LOG_ERROR, "Unable to register channel type '%s'\n", channel_type);
        goto chanreg_failed;
    }
 
    ast_rtp_glue_register(&unistim_rtp_glue);
 
    ast_cli_register_multiple(unistim_cli, ARRAY_LEN(unistim_cli));
 
    restart_monitor();
 
    return AST_MODULE_LOAD_SUCCESS;
 
chanreg_failed:
    /*! XXX \todo Leaking anything allocated by reload_config() ... */
    ast_sched_context_destroy(sched);
    sched = NULL;
sched_failed:
    io_context_destroy(io);
    io = NULL;
io_failed:
    ast_free(buff);
    buff = NULL;
buff_failed:
    ao2_cleanup(global_cap);
    global_cap = NULL;
    ao2_cleanup(unistim_tech.capabilities);
    unistim_tech.capabilities = NULL;
    return AST_MODULE_LOAD_DECLINE;
}
 
static int unload_module(void)
{
    /* First, take us out of the channel loop */
    if (sched) {
        ast_sched_context_destroy(sched);
    }
 
    ast_cli_unregister_multiple(unistim_cli, ARRAY_LEN(unistim_cli));
 
    ast_channel_unregister(&unistim_tech);
    ao2_cleanup(unistim_tech.capabilities);
    ast_rtp_glue_unregister(&unistim_rtp_glue);
 
    ast_mutex_lock(&monlock);
    if (monitor_thread && (monitor_thread != AST_PTHREADT_STOP) && (monitor_thread != AST_PTHREADT_NULL)) {
        pthread_cancel(monitor_thread);
        pthread_kill(monitor_thread, SIGURG);
        pthread_join(monitor_thread, NULL);
    }
    monitor_thread = AST_PTHREADT_STOP;
    ast_mutex_unlock(&monlock);
 
    if (buff) {
        ast_free(buff);
    }
    if (unistimsock > -1) {
        close(unistimsock);
    }
    ao2_ref(global_cap, -1);
 
    return 0;
}
 
/*! reload: Part of Asterisk module interface ---*/
int reload(void)
{
    if (unistimdebug) {
        ast_verb(0, "reload unistim\n");
    }
    ast_mutex_lock(&unistim_reload_lock);
    if (!unistim_reloading) {
        unistim_reloading = 1;
    }
    ast_mutex_unlock(&unistim_reload_lock);
 
    restart_monitor();
 
    return 0;
}
 
AST_MODULE_INFO(ASTERISK_GPL_KEY, AST_MODFLAG_DEFAULT, "UNISTIM Protocol (USTM)",
    .support_level = AST_MODULE_SUPPORT_EXTENDED,
    .load = load_module,
    .unload = unload_module,
    .reload = reload,
);