asterisk/channels/chan_dect.c

/*
 * Asterisk DECT Channel driver
 *
 * Copyright (c) 2009 Patrick McHardy <kaber@trash.net>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include "asterisk.h"

ASTERISK_FILE_VERSION(__FILE__, "$Revision")

#include <signal.h>

#include "asterisk/lock.h"
#include "asterisk/channel.h"
#include "asterisk/config.h"
#include "asterisk/module.h"
#include "asterisk/pbx.h"
#include "asterisk/sched.h"
#include "asterisk/io.h"
#include "asterisk/cli.h"
#include "asterisk/astdb.h"
#include "asterisk/causes.h"
#include "asterisk/callerid.h"
#include "asterisk/abstract_jb.h"

#include <linux/dect.h>
#include <linux/dect_netlink.h>
#include <dect/libdect.h>
#include <dect/terminal.h>
#include <dect/debug.h>

#define CONFIG_FILE	"dect.conf"

static const struct ast_channel_tech	dect_tech;
static struct dect_handle		*dh;
static struct sched_context		*sched;
static struct io_context		*io;
static int				access_rights_timer;

static const struct ast_jb_conf dect_default_jbconf = {
	.max_size		= -1,
	.resync_threshold	= -1,
	.impl			= "",
};

static struct dect_fp_capabilities dect_fpc = {
	.hlc	= DECT_HLC_ADPCM_G721_VOICE |
		  DECT_HLC_GAP_PAP_BASIC_SPEECH |
		  DECT_HLC_CISS_SERVICE |
		  DECT_HLC_CLMS_SERVICE |
		  DECT_HLC_LOCATION_REGISTRATION |
		  DECT_HLC_STANDARD_AUTHENTICATION |
		  DECT_HLC_STANDARD_CIPHERING,
	.ehlc2	= DECT_EHLC2_LIST_ACCESS_FEATURES,
};

struct {
	char					cluster[DECTNAMSIZ];
	struct ast_jb_conf			jbconf;
	char					context[AST_MAX_CONTEXT];
	char					language[MAX_LANGUAGE];
	char					regcontext[AST_MAX_CONTEXT];
	unsigned int				regexten_base;
	char					pin[sizeof("00000000")];
} dect_cfg;

static AST_LIST_HEAD_STATIC(dect_pt_list, dect_pt);

struct dect_pt {
	AST_LIST_ENTRY(dect_pt)			list;
	char					name[64];
	char					fullname[64];
	struct dect_ipui			ipui;
	struct dect_tpui			tpui;

	AST_DECLARE_STRING_FIELDS(		AST_STRING_FIELD(regexten);
						AST_STRING_FIELD(context);
						AST_STRING_FIELD(language);
						AST_STRING_FIELD(cid_num);
						AST_STRING_FIELD(cid_name);
						AST_STRING_FIELD(ring_pattern);
	);

	uint8_t					uak[DECT_AUTH_KEY_LEN];
	uint8_t					dck[DECT_CIPHER_KEY_LEN];

	struct dect_ie_terminal_capability	*terminal_capability;
	struct dect_ie_codec_list		*codec_list;
};

struct dect_pvt {
	struct dect_pt				*pt;
	struct dect_call			*call;
	struct ast_channel			*chan;

	struct dect_mm_endpoint			*mme;
	struct dect_ie_collection		*iec;

	/* authentication */
	enum dect_auth_state {
		DECT_AUTH_NONE,
		DECT_AUTH_PT,
		DECT_AUTH_KEY_ALLOCATION,
	}					auth_state;
	uint64_t				rand;
	uint64_t				rs;
	uint8_t					uak[DECT_AUTH_KEY_LEN];
	void					(*auth_cfm)(struct dect_pvt *, bool,
							    struct dect_ie_collection *);

	/* ciphering */
	bool					ciphered;
	void					(*cipher_cfm)(struct dect_pvt *, bool,
							      struct dect_ie_collection *);

	AST_DECLARE_STRING_FIELDS(		AST_STRING_FIELD(cid_num);
						AST_STRING_FIELD(cid_name);
						AST_STRING_FIELD(display);
	);
	int					timer_id;
};

#define dect_ie_update(pos, ie)			\
	do {					\
		if (ie == NULL)			\
			break;			\
		dect_ie_put(dh, pos);		\
		pos = dect_ie_hold(ie);		\
	} while (0)

static void dect_authenticate(struct dect_pvt *pvt,
			      void (*auth_cfm)(struct dect_pvt *, bool,
					       struct dect_ie_collection *),
			      struct dect_ie_collection *iec);

static void dect_cipher(struct dect_pvt *pvt,
			void (*auth_cfm)(struct dect_pvt *, bool,
					 struct dect_ie_collection *),
			struct dect_ie_collection *iec);

static uint64_t dect_random(void)
{
	return (uint64_t)ast_random() << 32 | ast_random();
}

static int dect_release_reason_to_ast(enum dect_release_reasons reason)
{
	switch (reason) {
	case DECT_RELEASE_NORMAL:
		return AST_CAUSE_NORMAL_CLEARING;
	case DECT_RELEASE_UNEXPECTED_MESSAGE:
	case DECT_RELEASE_UNKNOWN_TRANSACTION_IDENTIFIER:
		return AST_CAUSE_INVALID_MSG_UNSPECIFIED;
	case DECT_RELEASE_MANDATORY_IE_MISSING:
		return AST_CAUSE_MANDATORY_IE_MISSING;
	case DECT_RELEASE_INVALID_IE_CONTENTS:
		return AST_CAUSE_INVALID_IE_CONTENTS;
	case DECT_RELEASE_INCOMPATIBLE_SERVICE:
	case DECT_RELEASE_SERVICE_NOT_IMPLEMENTED:
	case DECT_RELEASE_NEGOTIATION_NOT_SUPPORTED:
	case DECT_RELEASE_INVALID_IDENTITY:
	case DECT_RELEASE_AUTHENTICATION_FAILED:
	case DECT_RELEASE_UNKNOWN_IDENTITY:
	case DECT_RELEASE_NEGOTIATION_FAILED:
	case DECT_RELEASE_TIMER_EXPIRY:
	case DECT_RELEASE_PARTIAL_RELEASE:
	case DECT_RELEASE_UNKNOWN:
		return AST_CAUSE_NORMAL;
	/* user values */
	case DECT_RELEASE_USER_DETACHED:
	case DECT_RELEASE_USER_NOT_IN_RANGE:
		return AST_CAUSE_SUBSCRIBER_ABSENT;
	case DECT_RELEASE_USER_UNKNOWN:
		return AST_CAUSE_NO_ROUTE_DESTINATION;
	case DECT_RELEASE_USER_ALREADY_ACTIVE:
	case DECT_RELEASE_USER_BUSY:
		return AST_CAUSE_USER_BUSY;
	case DECT_RELEASE_USER_REJECTION:
		return AST_CAUSE_CALL_REJECTED;
	case DECT_RELEASE_USER_CALL_MODIFY:
	/* external handover values */
	case DECT_RELEASE_EXTERNAL_HANDOVER_NOT_SUPPORTED:
	case DECT_RELEASE_NETWORK_PARAMETERS_MISSING:
	case DECT_RELEASE_EXTERNAL_HANDOVER_RELEASE:
		return AST_CAUSE_NORMAL;
	/* temporary overload values */
	case DECT_RELEASE_OVERLOAD:
	case DECT_RELEASE_INSUFFICIENT_RESOURCES:
	case DECT_RELEASE_INSUFFICIENT_BEARERS_AVAILABLE:
		return AST_CAUSE_NORMAL_CIRCUIT_CONGESTION;
	case DECT_RELEASE_IWU_CONGESTION:
		return AST_CAUSE_SWITCH_CONGESTION;
	default:
		return AST_CAUSE_NORMAL;
	}
}

static enum dect_presentation_indicators dect_ast_presentation_to_dect(int presentation)
{
	presentation &= AST_PRES_NUMBER_TYPE;

	switch (presentation) {
	default:
		ast_log(LOG_WARNING, "Unknown presentation coding %x\n", presentation);
		/* fall through */
	case AST_PRES_ALLOWED:
		return DECT_PRESENTATION_ALLOWED;
	case AST_PRES_RESTRICTED:
		return DECT_PRESENTATION_RESTRICTED;
	case AST_PRES_UNAVAILABLE:
		return DECT_PRESENTATION_NOT_AVAILABLE;
	}
}

static enum dect_screening_indicators dect_ast_screening_to_dect(int screening)
{
	screening &= AST_PRES_RESTRICTION;

	switch (screening) {
	default:
		ast_log(LOG_WARNING, "Unknown screening coding %x\n", screening);
		/* fall through */
	case AST_PRES_USER_NUMBER_UNSCREENED:
		return DECT_SCREENING_USER_PROVIDED_NOT_SCREENED;
	case AST_PRES_USER_NUMBER_PASSED_SCREEN:
		return DECT_SCREENING_USER_PROVIDED_VERIFIED_PASSED;
	case AST_PRES_USER_NUMBER_FAILED_SCREEN:
		return DECT_SCREENING_USER_PROVIDED_VERIFIED_FAILED;
	case AST_PRES_NETWORK_NUMBER:
		return DECT_SCREENING_NETWORK_PROVIDED;
	}
}

static struct dect_pt *dect_pt_get_by_name(const char *name)
{
	struct dect_pt *pt;

	AST_LIST_TRAVERSE(&dect_pt_list, pt, list) {
		if (!strcasecmp(pt->name, name))
			return pt;
	}
	return NULL;
}

static struct dect_pt *dect_pt_get_by_ipui(const struct dect_ipui *ipui)
{
	struct dect_pt *pt;

	AST_LIST_TRAVERSE(&dect_pt_list, pt, list) {
		if (!dect_ipui_cmp(&pt->ipui, ipui))
			return pt;
	}
	return NULL;
}

static void dect_init_tpui(struct dect_tpui *tpui, unsigned int exten)
{
	tpui->ia.digits[0] = exten > 10000 ? exten / 10000 % 10 : 0xb;
	tpui->ia.digits[1] = exten > 1000  ? exten / 1000  % 10 : 0xb;
	tpui->ia.digits[2] = exten > 100   ? exten / 100   % 10 : 0xb;
	tpui->ia.digits[3] = exten > 10    ? exten / 10    % 10 : 0xb;
	tpui->ia.digits[4] = exten > 1     ? exten / 1     % 10 : 0xb;
}

static struct dect_pt *dect_init_portable(const char *name,
					  const struct ast_variable *v)
{
	struct dect_pt *pt;

	pt = ast_calloc(1, sizeof(*pt));
	if (pt == NULL)
		return NULL;
	ast_copy_string(pt->name, name, sizeof(pt->name));
	snprintf(pt->fullname, sizeof(pt->fullname), "DECT/%s", pt->name);

	ast_string_field_init(pt, 512);
	ast_string_field_set(pt, context, dect_cfg.context);
	ast_string_field_set(pt, regexten, "");
	ast_string_field_set(pt, language, dect_cfg.language);
	ast_string_field_set(pt, cid_num, "");
	ast_string_field_set(pt, cid_name, "");
	ast_string_field_set(pt, ring_pattern, "0");
	pt->ipui.put = DECT_IPUI_N;

	for (; v != NULL; v = v->next) {
		if (!strcasecmp(v->name, "emc")) {
			pt->ipui.pun.n.ipei.emc = strtoul(v->value, NULL, 16);
		} else if (!strcasecmp(v->name, "psn")) {
			pt->ipui.pun.n.ipei.psn = strtoul(v->value, NULL, 16);
		} else if (!strcasecmp(v->name, "context")) {
			ast_string_field_set(pt, context, v->value);
		} else if (!strcasecmp(v->name, "regexten")) {
			ast_string_field_set(pt, regexten, v->value);
		} else if (!strcasecmp(v->name, "language")) {
			ast_string_field_set(pt, language, v->value);
		} else if (!strcasecmp(v->name, "cid_number")) {
			ast_string_field_set(pt, cid_num, v->value);
		} else if (!strcasecmp(v->name, "cid_name")) {
			ast_string_field_set(pt, cid_name, v->value);
		} else if (!strcasecmp(v->name, "ring_pattern")) {
			ast_string_field_set(pt, ring_pattern, v->value);
		}
	}

	AST_LIST_INSERT_TAIL(&dect_pt_list, pt, list);
	return pt;
}

static int dect_alloc_extension(unsigned int *exten)
{
	const struct dect_pt *pt;
	uint32_t bitmap[1024];
	unsigned int pext;

	memset(bitmap, 0, sizeof(bitmap));
	AST_LIST_TRAVERSE(&dect_pt_list, pt, list) {
		pext = strtoul(pt->regexten, NULL, 0);
		if (pext < dect_cfg.regexten_base ||
		    pext >= 8 * sizeof(bitmap))
			continue;
		pext -= dect_cfg.regexten_base;

		bitmap[pext / 32] |= 1 << (pext % 32);
	}

	for (pext = 0; pext < 8 * sizeof(bitmap); pext++) {
		if (!(bitmap[pext / 32] & (1 << (pext % 32)))) {
			*exten = dect_cfg.regexten_base + pext;
			return 1;
		}
	}

	return 0;
}

static void dect_register_extension(const struct dect_pt *pt, bool onoff)
{
	struct pbx_find_info q = { .stacklen = 0 };
	char *ext, *extenp, *context;
	char exten[256];

	if (ast_strlen_zero(dect_cfg.regcontext))
		return;

	ast_copy_string(exten, S_OR(pt->regexten, pt->name), sizeof(exten));
	extenp = exten;
	while ((ext = strsep(&extenp, "&")) != NULL) {
		context = strchr(ext, '@');
		if (context != NULL) {
			*context++ = '\0';
			if (!ast_context_find(context)) {
				ast_log(LOG_WARNING, "Context %s for PT %s does not exist",
					context, pt->name);
				continue;
			}
		} else
			context = dect_cfg.regcontext;

		if (onoff) {
			if (!ast_exists_extension(NULL, context, ext, 1, NULL)) {
				ast_add_extension(context, 1, ext, 1, NULL, NULL, "Dial",
						  (char *)pt->fullname, NULL, "DECT");
			}
		} else if (pbx_find_extension(NULL, NULL, &q, context, ext, 1,
					      NULL, "", E_MATCH)) {
			ast_context_remove_extension(context, ext, 1, NULL);
		}
	}
}

static int dect_init_call(struct dect_pvt *pvt, enum ast_channel_state state,
			  const char *exten)
{
	struct dect_pt *pt = pvt->pt;
	struct ast_channel *chan;

	ast_string_field_init(pvt, 512);

	chan = ast_channel_alloc(1, state, pt->cid_num, pt->cid_name, "",
				 exten, pt->context, 0, 0,
				 "DECT/%s-%08lx", pt->name, (long)pvt);
	if (chan == NULL)
		return -1;

	chan->tech	     = &dect_tech;
	chan->nativeformats  = AST_FORMAT_G726_AAL2;
	chan->readformat     = AST_FORMAT_G726_AAL2;
	chan->rawreadformat  = AST_FORMAT_G726_AAL2;
	chan->writeformat    = AST_FORMAT_G726_AAL2;
	chan->rawwriteformat = AST_FORMAT_G726_AAL2;
	chan->tech_pvt	     = pvt;

	if (exten != NULL)
		ast_copy_string(chan->exten, exten, sizeof(chan->exten));
	if (!ast_strlen_zero(pt->language))
		ast_string_field_set(chan, language, pt->language);

	ast_jb_configure(chan, &dect_cfg.jbconf);

	ast_module_ref(ast_module_info->self);
	pvt->chan = chan;

	if (state != AST_STATE_RESERVED && state != AST_STATE_DIALING) {
		if (ast_pbx_start(chan)) {
			ast_log(LOG_WARNING, "Unable to start PBX\n");
			ast_hangup(chan);
		}
	}
	return 0;
}

static int dect_try_to_connect_call(struct dect_pvt *pvt)
{
	struct ast_channel *chan = pvt->chan;
	struct dect_pt *pt = pvt->pt;

	if (!ast_exists_extension(NULL, pt->context, chan->exten, 1, NULL))
		return -1;
	ast_log(LOG_NOTICE, "connecting call\n");
	if (ast_pbx_start(chan)) {
		ast_log(LOG_WARNING, "Unable to start PBX\n");
		ast_hangup(chan);
	} else
		ast_setstate(chan, AST_STATE_RING);
	return 0;
}

static int dect_answer(struct ast_channel *chan)
{
	struct dect_pvt *pvt = chan->tech_pvt;
	struct dect_mncc_connect_param connect = {};

	ast_log(LOG_NOTICE, "answer call state %u\n", chan->_state);
	if (chan->_state == AST_STATE_UP || chan->_state == AST_STATE_RINGING)
		return 0;

	dect_mncc_connect_req(dh, pvt->call, &connect);
	ast_setstate(chan, AST_STATE_UP);
	return 0;
}

static int dect_call(struct ast_channel *chan, char *dest, int timeout)
{
	struct dect_pvt *pvt = chan->tech_pvt;
	struct dect_ie_basic_service basic_service;
	struct dect_ie_calling_party_number calling_party_number;
	struct dect_ie_calling_party_name calling_party_name;
	struct dect_mncc_setup_param param;
	int presentation;

	/* Store CallerID for ALERTING state */
	ast_string_field_set(pvt, cid_num,  chan->caller.id.number.str);
	ast_string_field_set(pvt, cid_name, chan->caller.id.name.str);

	basic_service.class		  = DECT_CALL_CLASS_NORMAL;
	basic_service.service		  = DECT_SERVICE_BASIC_SPEECH_DEFAULT;

	presentation = ast_party_id_presentation(&chan->caller.id);
	calling_party_number.type	  = DECT_NUMBER_TYPE_UNKNOWN;
	calling_party_number.npi	  = DECT_NPI_UNKNOWN;
	calling_party_number.presentation = dect_ast_presentation_to_dect(presentation);
	calling_party_number.screening    = dect_ast_screening_to_dect(presentation);
	calling_party_number.len	  = strlen(chan->caller.id.number.str);
	memcpy(calling_party_number.address, chan->caller.id.number.str, calling_party_number.len);

	calling_party_name.presentation   = dect_ast_presentation_to_dect(presentation);
	calling_party_name.screening	  = dect_ast_screening_to_dect(presentation);
	calling_party_name.alphabet	  = DECT_ALPHABET_STANDARD;
	calling_party_name.len		  = strlen(chan->caller.id.name.str);
	memcpy(calling_party_name.name, chan->caller.id.name.str, calling_party_name.len);

	memset(&param, 0, sizeof(param));
	param.basic_service		   = &basic_service;
	if (calling_party_number.len)
		param.calling_party_number = &calling_party_number;
	if (calling_party_name.len)
		param.calling_party_name   = &calling_party_name;

	dect_mncc_setup_req(dh, pvt->call, &pvt->pt->ipui, &param);

	ast_setstate(pvt->chan, AST_STATE_DIALING);
	chan->hangupcause = AST_CAUSE_NORMAL_CLEARING;
	return 0;
}

static struct ast_channel *dect_request_call(const char *type, format_t format,
					     const struct ast_channel *requestor,
					     void *data, int *cause)
{
	struct dect_pvt *pvt;
	struct dect_call *call;
	struct dect_pt *pt;
	const char *name = data;

	pt = dect_pt_get_by_name(name);
	if (pt == NULL) {
		ast_log(LOG_NOTICE, "Call to unknown PT '%s' requested\n", name);
		*cause = AST_CAUSE_UNALLOCATED;
		return NULL;
	}

	call = dect_call_alloc(dh);
	if (call == NULL) {
		*cause = AST_CAUSE_SWITCH_CONGESTION;
		return NULL;
	}
	pvt = dect_call_priv(call);

	ast_log(LOG_NOTICE, "Outgoing call to %s\n", pt->name);
	pvt->pt   = pt;
	pvt->call = call;
	if (dect_init_call(pvt, AST_STATE_RESERVED, NULL) < 0) {
		*cause = AST_CAUSE_SWITCH_CONGESTION;
		return NULL;
	}

	return pvt->chan;
}

static int dect_hangup(struct ast_channel *chan)
{
	struct dect_pvt *pvt = chan->tech_pvt;
	struct dect_ie_release_reason release_reason;
	struct dect_mncc_release_param param;

	ast_log(LOG_NOTICE, "Hangup\n");

	if (chan->_state != AST_STATE_DOWN) {
		dect_ie_init(&release_reason);
		release_reason.reason = DECT_RELEASE_NORMAL;

		memset(&param, 0, sizeof(param));
		param.release_reason = &release_reason;
		dect_mncc_release_req(dh, pvt->call, &param);
	}

	chan->tech_pvt = NULL;
	ast_setstate(chan, AST_STATE_DOWN);
	return 0;
}

static int dect_indicate(struct ast_channel *chan, int condition,
			 const void *data, size_t datalen)
{
	struct dect_pvt *pvt = chan->tech_pvt;
	struct dect_mncc_alert_param alert;
	struct dect_ie_progress_indicator progress;
	struct dect_ie_signal signal;
	int res = 0;

	switch (condition) {
	case AST_CONTROL_RINGING:
		ast_log(LOG_NOTICE, "Ringing\n");
		memset(&alert, 0, sizeof(alert));
		if (0) {
			alert.signal = dect_signal_init(&signal, DECT_SIGNAL_RING_BACK_TONE_ON);
		} else {
			dect_ie_init(&progress);
			progress.location = DECT_LOCATION_PRIVATE_NETWORK_SERVING_LOCAL_USER;
			progress.progress = DECT_PROGRESS_INBAND_INFORMATION_NOW_AVAILABLE;
			dect_ie_list_add(&progress, &alert.progress_indicator);
		}
		dect_mncc_alert_req(dh, pvt->call, &alert);
		ast_setstate(chan, AST_STATE_RINGING);
		res = -1;
		break;
	case AST_CONTROL_BUSY:
	case AST_CONTROL_CONGESTION:
	case AST_CONTROL_PROCEEDING:
	case AST_CONTROL_PROGRESS:
	case AST_CONTROL_HOLD:
	case AST_CONTROL_UNHOLD:
	case AST_CONTROL_VIDUPDATE:
	case AST_CONTROL_T38_PARAMETERS:
	case AST_CONTROL_SRCUPDATE:
	case -1:
		res = -1;
		ast_log(LOG_NOTICE, "Indicate %d\n", condition);
		break;
	default:
		ast_log(LOG_NOTICE, "Indicate unknown condition %d\n", condition);
		res = -1;
		break;
	}
	return res;
}

static int dect_write(struct ast_channel *chan, struct ast_frame *f)
{
	struct dect_pvt *pvt = chan->tech_pvt;
	struct dect_msg_buf mb;
	unsigned int len = f->datalen;

	mb.data = f->data.ptr;
	mb.len  = 40;
	while (len >= 40) {
		dect_dl_u_data_req(dh, pvt->call, &mb);
		mb.data += 40;
		len	-= 40;
	}
	return 0;
}

static struct ast_frame *dect_read(struct ast_channel *chan)
{
	ast_log(LOG_NOTICE, "read\n");
	return NULL;
}

static int dect_fixup(struct ast_channel *old, struct ast_channel *new)
{
	ast_log(LOG_NOTICE, "fixup\n");
	return 0;
}

static int dect_send_text(struct ast_channel *chan, const char *text)
{
	struct dect_pvt *pvt = chan->tech_pvt;
	struct dect_ie_display display;
	struct dect_mncc_info_param info = { .display = &display };

	dect_display_init(&display);
	dect_display_append_char(&display, DECT_C_CLEAR_DISPLAY);
	dect_display_append(&display, text, strlen(text));

	dect_mncc_info_req(dh, pvt->call, &info);
	return 0;
}

static const struct ast_channel_tech dect_tech = {
	.type		= "DECT",
	.description	= "Digital Enhanced Cordless Telecommunications (DECT)",
	.capabilities	= AST_FORMAT_G726_AAL2,
	.answer		= dect_answer,
	.requester	= dect_request_call,
	.call		= dect_call,
	.hangup		= dect_hangup,
	.indicate	= dect_indicate,
	.write		= dect_write,
	.read		= dect_read,
	.fixup		= dect_fixup,
	.send_text	= dect_send_text,
};

static void dect_mncc_reject(struct dect_call *call, enum dect_release_reasons reason)
{
	struct dect_ie_release_reason release_reason = { .reason = reason };
	struct dect_mncc_release_param release = { .release_reason = &release_reason };

	dect_mncc_reject_req(dh, call, &release);
}

static const struct {
	const char	*name;
	unsigned int	priority;
} dect_codecs[] = {
	[DECT_CODEC_USER_SPECIFIC_32KBIT]	= { "user specific 32kbit", 0 },
	[DECT_CODEC_G726_32KBIT]		= { "G.726", 1 },
	[DECT_CODEC_G722_64KBIT]		= { "G.722", 2 },
	[DECT_CODEC_G711_ALAW_64KBIT]		= { "G.711 alaw", 0 },
	[DECT_CODEC_G711_ULAW_64KBIT]		= { "G.711 ulaw", 0 },
	[DECT_CODEC_G729_1_32KBIT]		= { "G.729.1", 0 },
	[DECT_CODEC_MPEG4_ER_AAC_LD_32KBIT]	= { "MPEG-4 ER AAC-LD 32kbit", 0 },
	[DECT_CODEC_MPEG4_ER_AAC_LD_64KBIT]	= { "MPEG-4 ER AAC-LD 64kbit", 0 },
	[DECT_CODEC_USER_SPECIFIC_64KBIT]	= { "user specific 64kbit", 0 },
};

static char *dect_codecs_merge(char *buf, size_t size, const struct dect_pt *pt)
{
	struct dect_ie_codec_list *codec_list = pt->codec_list;
	const char *sep = "";
	unsigned int i;

	buf[0] = '\0';
	if (codec_list == NULL) {
		strcat(buf, dect_codecs[DECT_CODEC_G726_32KBIT].name);
		return buf;
	}

	for (i = 0; i < codec_list->num; i++) {
		strcat(buf, sep);
		strcat(buf, dect_codecs[codec_list->entry[i].codec].name);
		sep = ", ";
	}

	return buf;
}

static struct dect_ie_codec_list *dect_select_codec(const struct dect_pt *pt,
						    struct dect_ie_codec_list *codec_list)
{
	unsigned int i, prio, best = 0, n = 0;

	if (pt->codec_list == NULL)
		return NULL;

	for (i = 0; i < pt->codec_list->num; i++) {
		prio = dect_codecs[pt->codec_list->entry[i].codec].priority;
		if (prio > best) {
			best = prio;
			n    = i;
		}
	}

	codec_list->negotiation = DECT_NEGOTIATION_CODEC;
	codec_list->num         = 1;
	codec_list->entry[0]    = pt->codec_list->entry[n];

	return codec_list;
}

static void dect_mncc_setup_auth_cfm(struct dect_pvt *pvt, bool success,
				     struct dect_ie_collection *iec)
{
	struct dect_mncc_setup_param *param = (void *)iec;
	struct dect_mncc_setup_ack_param setup_ack;
	struct dect_mncc_call_proc_param call_proc;
	struct dect_ie_delimiter_request delimiter_request;
	struct dect_ie_codec_list codec_list;
	struct dect_ie_signal signal;
	struct dect_call *call = pvt->call;
	struct dect_pt *pt = pvt->pt;
	enum ast_channel_state state;
	const char *exten;

	if (!success)
		return dect_mncc_reject(call, DECT_RELEASE_AUTHENTICATION_FAILED);

	/* If the phone supplies the entire number en-bloc, enter call
	 * proceeding state. A number is considered complete when contained
	 * in a called party number IE, or a multi-keypad IE and the extension
	 * exists. When no number is supplied and an 's' extension exists in
	 * the context, the call is also moved to call proceeding state and
	 * further decisions are left to the PBX.
	 *
	 * Otherwise enter overlap sending and wait for further information.
	 */
	state = AST_STATE_RING;
	exten = NULL;

	if (param->called_party_number != NULL)
		; //ast_copy_string(exten, param->called_party_number.info, sizeof(exten));
	else if (param->keypad != NULL && param->keypad->info[0] < 0x80)
		exten = (char *)param->keypad->info;
	else {
		exten = "s";
		if (!ast_exists_extension(NULL, pt->context, exten, 1, NULL)) {
			state = AST_STATE_DIALING;
			exten = "";
		}
	}

	if (state == AST_STATE_RING) {
		memset(&call_proc, 0, sizeof(call_proc));
		call_proc.codec_list = dect_select_codec(pt, &codec_list);
		dect_mncc_call_proc_req(dh, call, &call_proc);
	} else {
		dect_ie_init(&delimiter_request);
		dect_signal_init(&signal, DECT_SIGNAL_DIAL_TONE_ON);

		memset(&setup_ack, 0, sizeof(setup_ack));
		setup_ack.delimiter_request = &delimiter_request;
		setup_ack.signal	    = &signal;
		dect_mncc_setup_ack_req(dh, call, &setup_ack);
	}

	dect_init_call(pvt, state, exten);

	/* WTF? Asterisk eats (actually leaks) the first queued frame when
	 * answering a channel. Give it something to eat :| */
	if (state == AST_STATE_DIALING)
		ast_queue_control(pvt->chan, -1);

}

static void dect_mncc_setup_ind(struct dect_handle *dh, struct dect_call *call,
				struct dect_mncc_setup_param *param)
{
	struct dect_pvt *pvt = dect_call_priv(call);
	struct dect_pt *pt;

	pt = dect_pt_get_by_ipui(dect_call_portable_identity(call));
	if (pt == NULL) {
		ast_log(LOG_NOTICE, "Incoming call from unknown PT\n");
		return dect_mncc_reject(call, DECT_RELEASE_UNKNOWN_IDENTITY);
	}

	ast_log(LOG_NOTICE, "Incoming call from %s\n", pt->name);

	pvt->pt   = pt;
	pvt->call = call;

	dect_mncc_setup_auth_cfm(pvt, true, &param->common);
	//dect_cipher(pvt, dect_mncc_setup_auth_cfm, &param->common);
}

static void dect_mncc_setup_ack_ind(struct dect_handle *dh, struct dect_call *call,
				    struct dect_mncc_setup_ack_param *param)
{
}

static void dect_mncc_reject_ind(struct dect_handle *dh, struct dect_call *call,
				 struct dect_mncc_release_param *param)
{
	struct dect_pvt *pvt = dect_call_priv(call);
	int cause;

	ast_setstate(pvt->chan, AST_STATE_DOWN);
	if (param->release_reason != NULL)
		cause =	dect_release_reason_to_ast(param->release_reason->reason);
	else
		cause = AST_CAUSE_FAILURE;

	pvt->chan->hangupcause = cause;
	ast_queue_hangup(pvt->chan);
}

#if 0
static int dect_display_timer(const void *data)
{
	struct dect_pvt *pvt = (struct dect_pvt *)data;
	struct dect_ie_display display;
	struct dect_mncc_info_param info = { .display = &display};

	dect_display_init(&display);
	dect_display_append_char(&display, DECT_C_RETURN);
	dect_display_append_char(&display, DECT_C_RETURN);

	dect_mncc_info_req(dh, pvt->call, &info);
	return 1;
}
#endif

static void dect_mncc_alert_ind(struct dect_handle *dh, struct dect_call *call,
				struct dect_mncc_alert_param *param)
{
	struct dect_pvt *pvt = dect_call_priv(call);
	struct dect_ie_display display;
	struct dect_ie_signal signal;
	struct dect_mncc_info_param info = { .signal = &signal, .display = &display};
	unsigned int name_len, num_len;
	char pattern[16];
	const char *c;

	ast_copy_string(pattern, pvt->pt->ring_pattern, sizeof(pattern));
	c = pbx_builtin_getvar_helper(pvt->chan, "RING_PATTERN");
	if (c != NULL)
		ast_copy_string(pattern, c, sizeof(pattern));

	if (strcasecmp(pattern, "silent")) {
		dect_ie_init(&signal);
		signal.code = DECT_SIGNAL_ALERTING_BASE | (atoi(pattern) & 0xf);
	}

	dect_display_init(&display);
	name_len = strlen(pvt->cid_name);
	num_len  = strlen(pvt->cid_num);
	if (name_len > 0 || num_len > 0) {
		dect_display_append_char(&display, DECT_C_CLEAR_DISPLAY);
		if (name_len > 0) {
			dect_display_append(&display, pvt->cid_name, name_len);
			dect_display_append(&display, " <", 2);
		}

		if (num_len > 0)
			dect_display_append(&display, pvt->cid_num, num_len);

		if (name_len > 0)
			dect_display_append(&display, ">", 1);
		//pvt->pt->timer_id = ast_sched_add(sched, 500, dect_display_timer, pvt);
	}

	dect_mncc_info_req(dh, call, &info);

	ast_queue_control(pvt->chan, AST_CONTROL_RINGING);
	ast_setstate(pvt->chan, AST_STATE_RINGING);
}

static void dect_mncc_connect_ind(struct dect_handle *dh, struct dect_call *call,
				  struct dect_mncc_connect_param *param)
{
	struct dect_pvt *pvt = dect_call_priv(call);

	ast_queue_control(pvt->chan, AST_CONTROL_ANSWER);
	dect_mncc_connect_res(dh, call, param);
}

static void dect_mncc_release_ind(struct dect_handle *dh, struct dect_call *call,
				  struct dect_mncc_release_param *param)
{
	struct dect_pvt *pvt = dect_call_priv(call);

	ast_setstate(pvt->chan, AST_STATE_DOWN);
	pvt->chan->hangupcause =
		dect_release_reason_to_ast(param->release_reason->reason);
	ast_queue_hangup(pvt->chan);

	dect_mncc_release_res(dh, call, param);
}

static void dect_mncc_release_cfm(struct dect_handle *dh, struct dect_call *call,
				  struct dect_mncc_release_param *param)
{
}

static void dect_dl_u_data_ind(struct dect_handle *dh, struct dect_call *call,
			       struct dect_msg_buf *mb)
{
	struct dect_pvt *pvt = dect_call_priv(call);
	struct ast_frame f;

	if (pvt->chan->_state == AST_STATE_DOWN)
		return;

	memset(&f, 0, sizeof(f));
	f.frametype	   = AST_FRAME_VOICE;
	f.subclass.integer = AST_FORMAT_G726_AAL2;
	f.samples	   = mb->len * 2;
	f.datalen	   = mb->len;
	f.data.ptr	   = mb->data;
	f.offset	   = AST_FRIENDLY_OFFSET;

	ast_queue_frame(pvt->chan, &f);
}

static void dect_keypad_info(struct dect_pvt *pvt,
			     const struct dect_ie_keypad *keypad)
{
	struct ast_frame f = { .frametype = AST_FRAME_DTMF, };
	struct ast_channel *chan = pvt->chan;
	unsigned int i;

	if (chan->_state == AST_STATE_DIALING) {
		strncat(chan->exten, (char *)keypad->info, keypad->len);
		dect_try_to_connect_call(pvt);
	} else {
		for (i = 0; i < keypad->len; i++) {
			ast_verbose("keypad: '%c' (%x)\n", keypad->info[i], keypad->info[i]);
			f.subclass.integer = keypad->info[i];
			ast_queue_frame(chan, &f);
		}
	}
}

static void dect_mncc_info_ind(struct dect_handle *dh, struct dect_call *call,
			       struct dect_mncc_info_param *param)
{
	struct dect_pvt *pvt = dect_call_priv(call);

	if (param->keypad != NULL)
		dect_keypad_info(pvt, param->keypad);
}

static const struct dect_cc_ops dect_cc_ops = {
	.priv_size		= sizeof(struct dect_pvt),
	.mncc_setup_ind		= dect_mncc_setup_ind,
	.mncc_setup_ack_ind	= dect_mncc_setup_ack_ind,
	.mncc_reject_ind	= dect_mncc_reject_ind,
	.mncc_call_proc_ind	= NULL,
	.mncc_alert_ind		= dect_mncc_alert_ind,
	.mncc_connect_ind	= dect_mncc_connect_ind,
	.mncc_connect_cfm	= NULL,
	.mncc_release_ind	= dect_mncc_release_ind,
	.mncc_release_cfm	= dect_mncc_release_cfm,
	.mncc_facility_ind	= NULL,
	.mncc_info_ind		= dect_mncc_info_ind,
	.mncc_modify_ind	= NULL,
	.mncc_modify_cfm	= NULL,
	.mncc_hold_ind		= NULL,
	.mncc_hold_cfm		= NULL,
	.mncc_retrieve_ind	= NULL,
	.mncc_retrieve_cfm	= NULL,
	.mncc_iwu_info_ind	= NULL,
	.dl_u_data_ind		= dect_dl_u_data_ind,
};

/*
 * Authentication / Key Allocation / Ciphering
 */

static void dect_mm_authenticate_reject(struct dect_mm_endpoint *mme,
					enum dect_reject_reasons reason)
{
	struct dect_ie_reject_reason reject_reason = { .reason = reason };
	struct dect_mm_authenticate_param reply = { .reject_reason = &reject_reason };

	dect_mm_authenticate_res(dh, mme, false, &reply);
}

static void dect_mm_authenticate_ind(struct dect_handle *dh,
				     struct dect_mm_endpoint *mme,
				     struct dect_mm_authenticate_param *param)
{
	struct dect_pvt *pvt = dect_mm_priv(mme);
	typeof(pvt->auth_cfm) auth_cfm = pvt->auth_cfm;
	struct dect_ie_collection *iec = pvt->iec;
	struct dect_ie_auth_value rs;
	struct dect_ie_auth_res res;
	struct dect_mm_authenticate_param reply = {
		.res		= &res,
		.rs		= &rs,
	};
	uint8_t k[DECT_AUTH_KEY_LEN], ks[DECT_AUTH_KEY_LEN];
	uint8_t dck[DECT_CIPHER_KEY_LEN];
	uint8_t ac[4];
	uint32_t res1;

	if (param->auth_type->auth_id != DECT_AUTH_DSAA) {
		dect_mm_authenticate_reject(mme, DECT_REJECT_AUTHENTICATION_ALGORITHM_NOT_SUPPORTED);
		return;
	}

	dect_pin_to_ac(dect_cfg.pin, ac, sizeof(ac));
	dect_auth_b1(ac, sizeof(ac), k);

	if (pvt->auth_state == DECT_AUTH_KEY_ALLOCATION) {
		/* Reset state before invoking completion handler since it may invoke
		 * a new authentication procedure.
		 */
		pvt->auth_state	= DECT_AUTH_NONE;
		pvt->auth_cfm	= NULL;

		dect_auth_a11(k, pvt->rs, ks);
		dect_auth_a12(ks, pvt->rand, dck, &res1);

		if (res1 == param->res->value) {
			ast_log(LOG_NOTICE, "PT authentication succeeded\n");

			rs.value = pvt->rs;
			dect_auth_a21(k, rs.value, ks);
			dect_auth_a22(ks, param->rand->value, &res.value);

			dect_mm_authenticate_res(dh, mme, true, &reply);

			/* Store KS' as UAK */
			memcpy(pvt->uak, ks, sizeof(pvt->uak));
			auth_cfm(pvt, true, iec);
		} else {
			ast_log(LOG_NOTICE, "PT authentication failed\n");
			dect_mm_authenticate_reject(mme, DECT_REJECT_AUTHENTICATION_FAILED);
			auth_cfm(pvt, false, iec);
		}
		__dect_ie_collection_put(dh, iec);
	} else {
		ast_log(LOG_NOTICE, "FT authentication\n");

		rs.value = dect_random();
		dect_auth_a21(k, rs.value, ks);
		dect_auth_a22(ks, param->rand->value, &res.value);

		dect_mm_authenticate_res(dh, mme, true, &reply);
	}
}

static void dect_mm_authenticate_cfm(struct dect_handle *dh,
				     struct dect_mm_endpoint *mme, bool accept,
				     struct dect_mm_authenticate_param *param)
{
	struct dect_pvt *pvt = dect_mm_priv(mme);
	struct dect_pt *pt = pvt->pt;
	typeof(pvt->auth_cfm) auth_cfm = pvt->auth_cfm;
	struct dect_ie_collection *iec = pvt->iec;
	uint8_t k[DECT_AUTH_KEY_LEN], ks[DECT_AUTH_KEY_LEN];
	uint8_t dck[DECT_CIPHER_KEY_LEN];
	uint32_t res1;

	/* Reset state before invoking completion handler since it may invoke
	 * a new authentication procedure.
	 */
	pvt->auth_state	= DECT_AUTH_NONE;
	pvt->auth_cfm	= NULL;

	if (!accept)
		goto reject;

	dect_auth_b1(pt->uak, sizeof(pt->uak), k);

	dect_auth_a11(k, pvt->rs, ks);
	dect_auth_a12(ks, pvt->rand, dck, &res1);

	if (res1 == param->res->value) {
		ast_log(LOG_NOTICE, "PT authentication succeeded\n");

		/* Store DCK */
		memcpy(pt->dck, dck, sizeof(pt->dck));
		auth_cfm(pvt, true, iec);
	} else {
reject:
		ast_log(LOG_NOTICE, "PT authentication failed\n");
		auth_cfm(pvt, false, iec);
	}

	__dect_ie_collection_put(dh, iec);
}

static void dect_authenticate(struct dect_pvt *pvt,
			      void (*auth_cfm)(struct dect_pvt *, bool,
					       struct dect_ie_collection *),
			      struct dect_ie_collection *iec)
{
	struct dect_ie_auth_type auth_type;
	struct dect_ie_auth_value rand, rs;
	struct dect_mm_authenticate_param req = {
		.auth_type		= &auth_type,
		.rand			= &rand,
		.rs			= &rs,
	};

	pvt->auth_state			= DECT_AUTH_PT;
	pvt->auth_cfm			= auth_cfm;
	pvt->iec			= __dect_ie_collection_hold(iec);

	pvt->rand			= dect_random();
	pvt->rs				= dect_random();

	auth_type.auth_id		= DECT_AUTH_DSAA;
	auth_type.auth_key_type		= DECT_KEY_USER_AUTHENTICATION_KEY;
	auth_type.auth_key_num  	= 0 | DECT_AUTH_KEY_IPUI_PARK;
	auth_type.cipher_key_num	= 0;
	auth_type.flags			= DECT_AUTH_FLAG_UPC;
	rand.value			= pvt->rand;
	rs.value			= pvt->rs;

	dect_mm_authenticate_req(dh, pvt->mme, &req);
}

static void dect_mm_key_allocate(struct dect_pvt *pvt,
				 void (*auth_cfm)(struct dect_pvt *, bool,
						  struct dect_ie_collection *iec),
				 struct dect_ie_collection *iec)
{
	struct dect_ie_allocation_type allocation_type;
	struct dect_ie_auth_value rand, rs;
	struct dect_mm_key_allocate_param req = {
		.allocation_type	= &allocation_type,
		.rand			= &rand,
		.rs			= &rs,
	};

	pvt->auth_state			= DECT_AUTH_KEY_ALLOCATION;
	pvt->auth_cfm			= auth_cfm;
	pvt->iec			= __dect_ie_collection_hold(iec);

	pvt->rand		 	= dect_random();
	pvt->rs			 	= dect_random();

	allocation_type.auth_id		= DECT_AUTH_DSAA;
	allocation_type.auth_key_num	= 0 | DECT_AUTH_KEY_IPUI_PARK;
	allocation_type.auth_code_num	= 0 | DECT_AUTH_KEY_IPUI_PARK;
	rand.value			= pvt->rand;
	rs.value			= pvt->rs;

	dect_mm_key_allocate_req(dh, pvt->mme, &req);
}

static void dect_mm_cipher_ind(struct dect_handle *dh,
			       struct dect_mm_endpoint *mme,
			       struct dect_mm_cipher_param *param)
{

}

static void dect_mm_cipher_cfm(struct dect_handle *dh,
			       struct dect_mm_endpoint *mme, bool accept,
			       struct dect_mm_cipher_param *param)
{
	struct dect_pvt *pvt = dect_mm_priv(mme);
	typeof(pvt->cipher_cfm) cipher_cfm = pvt->cipher_cfm;
	struct dect_ie_collection *iec = pvt->iec;

	pvt->ciphered   = accept;
	pvt->cipher_cfm = NULL;
	cipher_cfm(pvt, accept, iec);
	__dect_ie_collection_put(dh, iec);
}

static void dect_cipher_auth_cfm(struct dect_pvt *pvt, bool success,
				 struct dect_ie_collection *iec)
{
	struct dect_ie_cipher_info cipher_info;
	struct dect_mm_cipher_param req = {
		.cipher_info	= &cipher_info,
	};

	if (!success)
		return dect_mm_cipher_cfm(dh, pvt->mme, success, NULL);

	cipher_info.enable		= true;
	cipher_info.cipher_alg_id	= DECT_CIPHER_STANDARD_1;
	cipher_info.cipher_key_type	= DECT_CIPHER_DERIVED_KEY;
	cipher_info.cipher_key_num	= 0;

	dect_mm_cipher_req(dh, pvt->mme, &req, pvt->pt->dck);
}

/* Authenticate the PT, thereby establishing a new DCK, then switch to ciphering. */
static void dect_cipher(struct dect_pvt *pvt,
			void (*cipher_cfm)(struct dect_pvt *, bool,
					   struct dect_ie_collection *),
			struct dect_ie_collection *iec)
{
	if (pvt->ciphered)
		return cipher_cfm(pvt, true, iec);

	pvt->cipher_cfm			= cipher_cfm;
	pvt->iec			= __dect_ie_collection_hold(iec);

	dect_authenticate(pvt, dect_cipher_auth_cfm, pvt->iec);
}

/*
 * Access rights procedures
 */

static int dect_access_rights_timer(const void *data)
{
	ast_log(LOG_NOTICE, "disabling access rights requests\n");
	dect_fpc.hlc   &= ~DECT_HLC_ACCESS_RIGHTS_REQUESTS;
	dect_fpc.ehlc2 &= ~DECT_EHLC2_EASY_PAIRING;
	dect_llme_rfp_preload_req(dh, &dect_fpc);
	return 0;
}

static int dect_access_rights_requests_enable(void)
{
	int id;

	if (dect_fpc.hlc & DECT_HLC_ACCESS_RIGHTS_REQUESTS)
		return 0;

	id = ast_sched_add(sched, 120 * 1000, dect_access_rights_timer, NULL);

	dect_fpc.hlc   |= DECT_HLC_ACCESS_RIGHTS_REQUESTS;
	dect_fpc.ehlc2 |= DECT_EHLC2_EASY_PAIRING;
	if (dect_llme_rfp_preload_req(dh, &dect_fpc) < 0)
		goto err1;

	access_rights_timer = id;
	return 0;

err1:
	AST_SCHED_DEL(sched, id);
	return -1;
}

static int dect_access_rights_requests_disable(void)
{
	if (!(dect_fpc.hlc & DECT_HLC_ACCESS_RIGHTS_REQUESTS))
		return 0;

	dect_fpc.hlc   &= ~DECT_HLC_ACCESS_RIGHTS_REQUESTS;
	dect_fpc.ehlc2 &= ~DECT_EHLC2_EASY_PAIRING;
	if (dect_llme_rfp_preload_req(dh, &dect_fpc) < 0)
		return -1;

	AST_SCHED_DEL(sched, access_rights_timer);
	return 0;
}

static void dect_mm_access_rights_reject(struct dect_mm_endpoint *mme,
					 enum dect_reject_reasons reason)
{
	struct dect_ie_reject_reason reject_reason = { .reason = reason };
	struct dect_mm_access_rights_param reply = { .reject_reason = &reject_reason };

	dect_mm_access_rights_res(dh, mme, false, &reply);
}

static void dect_mm_access_rights_auth_cfm(struct dect_pvt *pvt, bool success,
					   struct dect_ie_collection *iec)
{
	struct dect_pt *pt;
	struct dect_mm_endpoint *mme = pvt->mme;
	struct dect_mm_access_rights_param *param = (void *)iec, reply = {
		.portable_identity	= param->portable_identity,
		.auth_type		= param->auth_type,
		.cipher_info		= param->cipher_info,
		.codec_list		= param->codec_list,
	};

	if (!success) {
		dect_mm_access_rights_reject(mme, DECT_REJECT_AUTHENTICATION_FAILED);
		return;
	}

	pt = dect_pt_get_by_ipui(&param->portable_identity->ipui);
	if (pt == NULL) {
		unsigned int exten;
		char name[64];

		if (!dect_alloc_extension(&exten)) {
			dect_mm_access_rights_reject(mme, DECT_REJECT_INSUFFICIENT_MEMORY);
			return;
		}

		snprintf(name, sizeof(name), "DECT-PT-%u", exten);
		pt = dect_init_portable(name, NULL);
		if (pt == NULL) {
			dect_mm_access_rights_reject(mme, DECT_REJECT_INSUFFICIENT_MEMORY);
			return;
		}

		ast_string_field_build(pt, cid_num, "%u", exten);
		ast_string_field_build(pt, regexten, "%u", exten);

		memcpy(&pt->ipui, &param->portable_identity->ipui, sizeof(pt->ipui));
		dect_init_tpui(&pt->tpui, exten);
	}

	if (dect_mm_access_rights_res(dh, mme, true, &reply) < 0)
		return;
	dect_access_rights_requests_disable();

	memcpy(pt->uak, pvt->uak, sizeof(pt->uak));
	dect_ie_update(pt->terminal_capability, param->terminal_capability);
	dect_ie_update(pt->codec_list, param->codec_list);
}

static void dect_mm_access_rights_ind(struct dect_handle *dh,
				      struct dect_mm_endpoint *mme,
				      struct dect_mm_access_rights_param *param)
{
	struct dect_ie_auth_type *auth_type = param->auth_type;
	struct dect_ie_cipher_info *cipher_info = param->cipher_info;
	struct dect_pvt *pvt = dect_mm_priv(mme);

	if (!(dect_fpc.hlc & DECT_HLC_ACCESS_RIGHTS_REQUESTS))
		return dect_mm_access_rights_reject(mme, DECT_REJECT_INCOMPATIBLE_SERVICE);

	if (auth_type) {
		if (auth_type->auth_id != DECT_AUTH_DSAA)
			return dect_mm_access_rights_reject(mme, DECT_REJECT_AUTHENTICATION_ALGORITHM_NOT_SUPPORTED);
		if (auth_type->auth_key_type != DECT_KEY_AUTHENTICATION_CODE)
			return dect_mm_access_rights_reject(mme, DECT_REJECT_AUTHENTICATION_KEY_NOT_SUPPORTED);
	}

	if (cipher_info) {
		if (cipher_info->cipher_alg_id != DECT_CIPHER_STANDARD_1)
			return dect_mm_access_rights_reject(mme, DECT_REJECT_CIPHER_ALGORITHM_NOT_SUPPORTED);
	}

	pvt->mme = mme;

	dect_mm_key_allocate(pvt, dect_mm_access_rights_auth_cfm, &param->common);
}

/*
 * Access rights termination
 */

static void dect_destroy_portable(struct dect_pt *pt)
{
	dect_register_extension(pt, false);

	AST_LIST_REMOVE(&dect_pt_list, pt, list);
	ast_free(pt);
}

static void dect_mm_access_rights_terminate_reject(struct dect_mm_endpoint *mme,
						   enum dect_reject_reasons reason)
{
	struct dect_ie_reject_reason reject_reason = { .reason = reason };
	struct dect_mm_access_rights_terminate_param reply = { .reject_reason = &reject_reason };

	dect_mm_access_rights_terminate_res(dh, mme, false, &reply);
}

static void dect_mm_access_rights_terminate_auth_cfm(struct dect_pvt *pvt, bool success,
						     struct dect_ie_collection *iec)
{
	struct dect_pt *pt = pvt->pt;
	struct dect_mm_endpoint *mme = pvt->mme;

	if (!success) {
		dect_mm_access_rights_terminate_reject(mme, DECT_REJECT_AUTHENTICATION_FAILED);
		return;
	}

	dect_destroy_portable(pt);
}

static void dect_mm_access_rights_terminate_ind(struct dect_handle *dh,
						struct dect_mm_endpoint *mme,
						struct dect_mm_access_rights_terminate_param *param)
{
	struct dect_pvt *pvt = dect_mm_priv(mme);
	struct dect_pt *pt;

	pt = dect_pt_get_by_ipui(&param->portable_identity->ipui);
	if (pt == NULL)
		return dect_mm_access_rights_terminate_reject(mme, DECT_REJECT_IPUI_UNKNOWN);

	pvt->pt  = pt;
	pvt->mme = mme;

	dect_cipher(pvt, dect_mm_access_rights_terminate_auth_cfm, &param->common);
}

static void dect_mm_access_rights_terminate_cfm(struct dect_handle *dh,
						struct dect_mm_endpoint *mme, bool accept,
						struct dect_mm_access_rights_terminate_param *param)
{
	struct dect_pvt *pvt = dect_mm_priv(mme);
	struct dect_pt *pt = pvt->pt;

	dect_destroy_portable(pt);
}

static void dect_access_rights_terminate(struct dect_pt *pt)
{
	struct dect_ie_portable_identity portable_identity;
	struct dect_mm_access_rights_terminate_param param = {
		.portable_identity	= &portable_identity,
	};
	struct dect_mm_endpoint *mme;
	struct dect_pvt *pvt;

	mme = dect_mm_endpoint_alloc(dh, &pt->ipui);
	if (mme == NULL)
		return;
	pvt = dect_mm_priv(mme);
	pvt->mme = mme;
	pvt->pt  = pt;

	portable_identity.type	= DECT_PORTABLE_ID_TYPE_IPUI;
	portable_identity.ipui	= pt->ipui;

	dect_mm_access_rights_terminate_req(dh, mme, &param);
}

/*
 * Location procedures
 */

static void dect_mm_locate_reject(struct dect_mm_endpoint *mme,
				  enum dect_reject_reasons reason)
{
	struct dect_ie_reject_reason reject_reason = { .reason = reason };
	struct dect_mm_locate_param reply = { .reject_reason = &reject_reason };

	dect_mm_locate_res(dh, mme, false, &reply);
}

static void dect_mm_locate_auth_cfm(struct dect_pvt *pvt, bool success,
				    struct dect_ie_collection *iec)
{
	struct dect_pt *pt = pvt->pt;
	struct dect_mm_endpoint *mme = pvt->mme;
	struct dect_ie_portable_identity portable_identity;
	struct dect_ie_duration duration;
	struct dect_mm_locate_param *param = (void *)iec, reply = {
		.portable_identity	= &portable_identity,
		.location_area		= param->location_area,
		.codec_list		= param->codec_list,
		.duration		= &duration,
	};

	if (!success) {
		dect_mm_locate_reject(mme, DECT_REJECT_AUTHENTICATION_FAILED);
		return;
	}

	portable_identity.type	= DECT_PORTABLE_ID_TYPE_TPUI;
	portable_identity.tpui	= pt->tpui;

	duration.lock	  	= DECT_LOCK_TEMPORARY_USER_LIMIT_1;
	duration.time	  	= DECT_TIME_LIMIT_DEFINED_TIME_LIMIT_1;
	duration.duration 	= 1;

	if (dect_mm_locate_res(dh, mme, true, &reply) < 0)
		return;

	dect_ie_update(pt->terminal_capability, param->terminal_capability);
	dect_ie_update(pt->codec_list, param->codec_list);

	dect_register_extension(pt, true);
}

static void dect_mm_locate_ind(struct dect_handle *dh,
			       struct dect_mm_endpoint *mme,
			       struct dect_mm_locate_param *param)
{
	struct dect_pvt *pvt = dect_mm_priv(mme);
	struct dect_pt *pt;

	pt = dect_pt_get_by_ipui(&param->portable_identity->ipui);
	if (pt == NULL)
		return dect_mm_locate_reject(mme, DECT_REJECT_IPUI_UNKNOWN);

	pvt->pt  = pt;
	pvt->mme = mme;

	dect_cipher(pvt, dect_mm_locate_auth_cfm, &param->common);
}

/*
 * Identity assignment procedures
 */

static void dect_mm_identity_assign_cfm(struct dect_handle *dh,
					struct dect_mm_endpoint *mme, bool accept,
					struct dect_mm_identity_assign_param *param)
{
}

static const struct dect_mm_ops dect_mm_ops = {
	.priv_size			= sizeof(struct dect_pvt),
	.mm_authenticate_ind		= dect_mm_authenticate_ind,
	.mm_authenticate_cfm		= dect_mm_authenticate_cfm,
	.mm_cipher_ind			= dect_mm_cipher_ind,
	.mm_cipher_cfm			= dect_mm_cipher_cfm,
	.mm_access_rights_ind		= dect_mm_access_rights_ind,
	.mm_access_rights_terminate_ind	= dect_mm_access_rights_terminate_ind,
	.mm_access_rights_terminate_cfm	= dect_mm_access_rights_terminate_cfm,
	.mm_locate_ind			= dect_mm_locate_ind,
	.mm_identity_assign_cfm		= dect_mm_identity_assign_cfm,
};

static void dect_show_debug(enum dect_debug_subsys subsys,
			    const char *fmt, va_list ap)
{
	ast_verbose_ap(fmt, ap);
}

static int dect_load_config(void)
{
	struct ast_flags cfg_flags = {};
	struct ast_config *cfg;
	struct ast_variable *v;
	struct dect_pt *pt;
	char *cat;

	memcpy(&dect_cfg.jbconf, &dect_default_jbconf, sizeof(struct ast_jb_conf));

	cfg = ast_config_load(CONFIG_FILE, cfg_flags);
	if (cfg == CONFIG_STATUS_FILEINVALID) {
		ast_log(LOG_ERROR, "Config file %s is in an invalid format.\n",
			CONFIG_FILE);
		return AST_MODULE_LOAD_DECLINE;
	}

	if (cfg == NULL) {
		ast_log(LOG_ERROR, "Unable to load config %s\n", CONFIG_FILE);
		return AST_MODULE_LOAD_DECLINE;
	}

	for (v = ast_variable_browse(cfg, "general"); v != NULL; v = v->next) {
		/* jitter buffer configuration */
		if (!ast_jb_read_conf(&dect_cfg.jbconf, v->name, v->value))
			continue;

		if (!strcasecmp(v->name, "cluster")) {
			ast_copy_string(dect_cfg.cluster, v->value,
					sizeof(dect_cfg.cluster));
		} else if (!strcasecmp(v->name, "context")) {
			ast_copy_string(dect_cfg.context, v->value,
					sizeof(dect_cfg.context));
		} else if (!strcasecmp(v->name, "language")) {
			ast_copy_string(dect_cfg.language, v->value,
					sizeof(dect_cfg.language));
		} else if (!strcasecmp(v->name, "regcontext")) {
			ast_copy_string(dect_cfg.regcontext, v->value,
					sizeof(dect_cfg.regcontext));
			/* Create context if it doesn't exist already */
			ast_context_find_or_create(NULL, NULL, dect_cfg.regcontext, "DECT");
		} else if (!strcasecmp(v->name, "regexten_base")) {
			dect_cfg.regexten_base = strtoul(v->value, NULL, 0);
		} else if (!strcasecmp(v->name, "pin")) {
			ast_copy_string(dect_cfg.pin, v->value,
					sizeof(dect_cfg.pin));
		}
	}

	/* Phone configuration */
	cat = NULL;
	while ((cat = ast_category_browse(cfg, cat)) != NULL) {
		if (!strcasecmp(cat, "general"))
			continue;
		pt = dect_init_portable(cat, ast_variable_browse(cfg, cat));
		if (pt == NULL)
			return AST_MODULE_LOAD_DECLINE;
		dect_register_extension(pt, true);
	}
	return 0;
}

/*
 * Asterisk CLI commands
 */

static char *dect_complete_pt(const char *word, int state)
{
	size_t wordlen = strlen(word);
	struct dect_pt *pt;
	int which = 0;
	char *res;

	AST_LIST_TRAVERSE(&dect_pt_list, pt, list) {
		if (!strncasecmp(word, pt->name, wordlen) && ++which > state) {
			res = ast_strdup(pt->name);
			if (res)
				return res;
		}
	}
	return NULL;
}

static char *dect_cli_debug(struct ast_cli_entry *e, int cmd,
			    struct ast_cli_args *a)
{
	const char *arg;

	switch (cmd) {
	case CLI_INIT:
		e->command = "dect set debug {on|off}";
		e->usage   = "Usage: dect set debug {on|off}\n";
		return NULL;
	case CLI_GENERATE:
		return NULL;
	}

	arg = a->argv[e->args - 1];
	if (!strcasecmp(arg, "on")) {
		dect_set_debug_hook(dect_show_debug);
		ast_cli(a->fd, "DECT debugging enabled\n");
	} else if (!strcasecmp(arg, "off")) {
		dect_set_debug_hook(NULL);
		ast_cli(a->fd, "DECT debugging disabled\n");
	} else
		return CLI_SHOWUSAGE;

	return CLI_SUCCESS;
}

static char *dect_cli_show_portables(struct ast_cli_entry *e, int cmd,
				     struct ast_cli_args *a)
{
	struct dect_pt *pt;

	switch (cmd) {
	case CLI_INIT:
		e->command = "dect show portables";
		e->usage   = "Usage: dect show portables\n";
		return NULL;
	case CLI_GENERATE:
		return NULL;
	}

	ast_cli(a->fd, "Name		Extension\n");
	AST_LIST_TRAVERSE(&dect_pt_list, pt, list)
		ast_cli(a->fd, "%-16s%s\n", pt->name, pt->regexten);

	return CLI_SUCCESS;
}

static char *dect_cli_show_portable(struct ast_cli_entry *e, int cmd,
				    struct ast_cli_args *a)
{
	struct dect_pt *pt;
	char cidbuf[256], codbuf[256];

	switch (cmd) {
	case CLI_INIT:
		e->command = "dect show portable";
		e->usage   = "Usage: dect show portable <name>\n";
		return NULL;
	case CLI_GENERATE:
		if (a->pos == 3)
			return dect_complete_pt(a->word, a->n);
		return NULL;
	}

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

	pt = dect_pt_get_by_name(a->argv[3]);
	if (pt == NULL) {
		ast_cli(a->fd, "PT '%s' not found\n", a->argv[3]);
		return CLI_FAILURE;
	}

	ast_callerid_merge(cidbuf, sizeof(cidbuf), pt->cid_name, pt->cid_num,
			   "<unspecified>");
	dect_codecs_merge(codbuf, sizeof(codbuf), pt);

	ast_cli(a->fd, "Extension:	%s\n", pt->regexten);
	ast_cli(a->fd, "Context:	%s\n", pt->context);
	ast_cli(a->fd, "Language:	%s\n", pt->language);
	ast_cli(a->fd, "CallerId:	%s\n", cidbuf);
	ast_cli(a->fd, "Codecs:		%s\n", codbuf);

	return CLI_SUCCESS;
}

static char *dect_cli_ari(struct ast_cli_entry *e, int cmd,
			  struct ast_cli_args *a)
{
	struct dect_pt *pt;
	const char *arg;

	switch (cmd) {
	case CLI_INIT:
		e->command = "dect access-rights {enable|disable|terminate}";
		e->usage   = "Usage: dect access-rights {enable|disable|terminate}\n";
		return NULL;
	case CLI_GENERATE:
		if (a->pos == 3 && !strcasecmp(a->argv[2], "terminate"))
			return dect_complete_pt(a->word, a->n);
		return NULL;
	}

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

	arg = a->argv[2];
	if (!strcasecmp(arg, "enable")) {
		if (dect_access_rights_requests_enable() == 0)
			ast_cli(a->fd, "ARI enabled\n");
	} else if (!strcasecmp(arg, "disable")) {
		if (dect_access_rights_requests_disable() == 0)
			ast_cli(a->fd, "ARI disabled\n");
	} else if (!strcasecmp(arg, "terminate")) {
		if (a->argc < 4)
			return CLI_SHOWUSAGE;
		ast_cli(a->fd, "ARI terminate\n");
		pt = dect_pt_get_by_name(a->argv[3]);
		if (pt == NULL) {
			ast_cli(a->fd, "PT '%s' not found\n", a->argv[3]);
			return CLI_FAILURE;
		}
		dect_access_rights_terminate(pt);
	} else
		return CLI_SHOWUSAGE;

	return CLI_SUCCESS;
}

static struct ast_cli_entry dect_cli_cmds[] = {
	AST_CLI_DEFINE(dect_cli_debug,		"Enable/Disable DECT debugging"),
	AST_CLI_DEFINE(dect_cli_ari,		"Access rights modification"),
	AST_CLI_DEFINE(dect_cli_show_portables,	"Show list of portables"),
	AST_CLI_DEFINE(dect_cli_show_portable,	"Show portable information"),
};

/*
 * libdect event ops
 */

struct dect_fd_priv {
	int	*id;
};

static int dect_io_callback(int *id, int fd, short io_events, void *data)
{
	struct dect_fd *dfd = data;
	uint32_t events = 0;

	if (io_events & (AST_IO_IN | AST_IO_ERR | AST_IO_HUP))
		events |= DECT_FD_READ;
	if (io_events & AST_IO_OUT)
		events |= DECT_FD_WRITE;
	dect_fd_process(dh, dfd, events);
	return 1;
}

static int dect_register_fd(const struct dect_handle *dh, struct dect_fd *dfd,
			    uint32_t events)
{
	struct dect_fd_priv *priv = dect_fd_priv(dfd);
	short io_events = 0;

	if (events & DECT_FD_READ)
		io_events |= AST_IO_IN;
	if (events & DECT_FD_WRITE)
		io_events |= AST_IO_OUT;

	priv->id = ast_io_add(io, dect_fd_num(dfd), dect_io_callback,
			      io_events, dfd);;
	return priv->id ? 0 : -1;
}

static void dect_unregister_fd(const struct dect_handle *dh, struct dect_fd *dfd)
{
	struct dect_fd_priv *priv = dect_fd_priv(dfd);

	ast_io_remove(io, priv->id);
}

struct dect_timer_priv {
	int	id;
};

static int dect_timer_callback(const void *data)
{
	struct dect_timer *timer = (struct dect_timer *)data;;

	dect_timer_run(dh, timer);
	return 0;
}

static void dect_start_timer(const struct dect_handle *dh,
			     struct dect_timer *timer,
			     const struct timeval *tv)
{
	struct dect_timer_priv *priv = dect_timer_priv(timer);

	priv->id = ast_sched_add(sched, tv->tv_sec * 1000 + tv->tv_usec / 1000,
				 dect_timer_callback, timer);
}

static void dect_stop_timer(const struct dect_handle *dh,
			    struct dect_timer *timer)
{
	struct dect_timer_priv *priv = dect_timer_priv(timer);

	AST_SCHED_DEL(sched, priv->id);
}

static const struct dect_event_ops dect_event_ops = {
	.fd_priv_size		= sizeof(struct dect_fd_priv),
	.register_fd		= dect_register_fd,
	.unregister_fd		= dect_unregister_fd,
	.timer_priv_size	= sizeof(struct dect_timer_priv),
	.start_timer		= dect_start_timer,
	.stop_timer		= dect_stop_timer,
};

static struct dect_ops dect_ops = {
	.event_ops		= &dect_event_ops,
	.cc_ops			= &dect_cc_ops,
	.mm_ops			= &dect_mm_ops,
};

static pthread_t io_thread = AST_PTHREADT_NULL;

static void *dect_io_thread(void *ignore)
{
	int timeout;

	while (1) {
		pthread_testcancel();
		timeout = ast_sched_wait(sched);
		if (timeout < 0)
			timeout = 1000;
		ast_io_wait(io, timeout);
		ast_sched_runq(sched);
	}
	return NULL;
}

static int dect_io_thread_start(void)
{
	int err;

	err = ast_pthread_create_background(&io_thread, NULL, dect_io_thread, NULL);
	if (err < 0) {
		ast_log(LOG_ERROR, "Unable to start IO thread\n");
		return err;
	}
	return 0;
}

static void dect_io_thread_stop(void)
{
	pthread_cancel(io_thread);
	pthread_kill(io_thread, SIGURG);
	pthread_join(io_thread, NULL);
}

static int dect_load_module(void)
{
	const char *cluster;

	sched = sched_context_create();
	if (sched == NULL) {
		ast_log(LOG_ERROR, "Unable to create scheduler context\n");
		goto err1;
	}

	io = io_context_create();
	if (io == NULL) {
		ast_log(LOG_ERROR, "Unable to create IO context\n");
		goto err2;
	}

	if (ast_channel_register(&dect_tech)) {
		ast_log(LOG_ERROR, "Unable to register 'DECT' channel\n");
		goto err3;
	}

	ast_cli_register_multiple(dect_cli_cmds, ARRAY_LEN(dect_cli_cmds));

	dect_load_config();

	if (dect_io_thread_start() < 0)
		goto err4;

	cluster = strlen(dect_cfg.cluster) ? dect_cfg.cluster : NULL;
	dh = dect_open_handle(&dect_ops, cluster);
	if (dh == NULL) {
		ast_log(LOG_ERROR, "Unable to initialize DECT handle\n");
		goto err5;
	}
	if (dect_llme_rfp_preload_req(dh, &dect_fpc) < 0) {
		ast_log(LOG_ERROR, "Unable to set FP capabilities\n");
		goto err6;
	}

	return AST_MODULE_LOAD_SUCCESS;

err6:
	dect_close_handle(dh);
err5:
	dect_io_thread_stop();
err4:
	ast_cli_unregister_multiple(dect_cli_cmds, ARRAY_LEN(dect_cli_cmds));
	ast_channel_unregister(&dect_tech);
err3:
	io_context_destroy(io);
err2:
	sched_context_destroy(sched);
err1:
	return AST_MODULE_LOAD_FAILURE;
}

static int dect_unload_module(void)
{
	dect_close_handle(dh);
	dect_io_thread_stop();
	ast_cli_unregister_multiple(dect_cli_cmds, ARRAY_LEN(dect_cli_cmds));
	ast_channel_unregister(&dect_tech);
	io_context_destroy(io);
	sched_context_destroy(sched);
	return 0;
}

AST_MODULE_INFO(ASTERISK_GPL_KEY, AST_MODFLAG_DEFAULT, "DECT",
		.load	= dect_load_module,
		.unload	= dect_unload_module,
);