mirror of https://github.com/asterisk/asterisk
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
1728 lines
46 KiB
1728 lines
46 KiB
/*
|
|
* Asterisk -- A telephony toolkit for Linux.
|
|
*
|
|
* Implementation of Media Gateway Control Protocol
|
|
*
|
|
* Copyright (C) 1999, Mark Spencer
|
|
*
|
|
* Mark Spencer <markster@linux-support.net>
|
|
*
|
|
* This program is free software, distributed under the terms of
|
|
* the GNU General Public License
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <pthread.h>
|
|
#include <string.h>
|
|
#include <asterisk/lock.h>
|
|
#include <asterisk/channel.h>
|
|
#include <asterisk/channel_pvt.h>
|
|
#include <asterisk/config.h>
|
|
#include <asterisk/logger.h>
|
|
#include <asterisk/module.h>
|
|
#include <asterisk/pbx.h>
|
|
#include <asterisk/options.h>
|
|
#include <asterisk/lock.h>
|
|
#include <asterisk/sched.h>
|
|
#include <asterisk/io.h>
|
|
#include <asterisk/rtp.h>
|
|
#include <asterisk/acl.h>
|
|
#include <asterisk/callerid.h>
|
|
#include <asterisk/cli.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/ioctl.h>
|
|
#include <net/if.h>
|
|
#include <errno.h>
|
|
#include <unistd.h>
|
|
#include <stdlib.h>
|
|
#include <fcntl.h>
|
|
#include <netdb.h>
|
|
#include <arpa/inet.h>
|
|
#include <sys/signal.h>
|
|
|
|
#define MGCPDUMPER
|
|
#define DEFAULT_EXPIREY 120
|
|
#define MAX_EXPIREY 3600
|
|
|
|
static char *desc = "Media Gateway Control Protocol (MGCP)";
|
|
static char *type = "MGCP";
|
|
static char *tdesc = "Media Gateway Control Protocol (MGCP)";
|
|
static char *config = "mgcp.conf";
|
|
|
|
#define DEFAULT_MGCP_PORT 2427/* From RFC 2705 */
|
|
#define MGCP_MAX_PACKET 1500 /* Also from RFC 2543, should sub headers tho */
|
|
|
|
static int usecnt =0;
|
|
static pthread_mutex_t usecnt_lock = AST_MUTEX_INITIALIZER;
|
|
static int oseq;
|
|
|
|
/* Protect the monitoring thread, so only one process can kill or start it, and not
|
|
when it's doing something critical. */
|
|
static pthread_mutex_t netlock = AST_MUTEX_INITIALIZER;
|
|
|
|
static pthread_mutex_t monlock = AST_MUTEX_INITIALIZER;
|
|
|
|
/* 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 = 0;
|
|
|
|
static int restart_monitor(void);
|
|
|
|
/* Just about everybody seems to support ulaw, so make it a nice default */
|
|
static int capability = AST_FORMAT_ULAW;
|
|
|
|
static char ourhost[256];
|
|
static struct in_addr __ourip;
|
|
static int ourport;
|
|
|
|
static struct sched_context *sched;
|
|
static struct io_context *io;
|
|
/* The private structures of the mgcp channels are linked for
|
|
selecting outgoing channels */
|
|
|
|
#define MGCP_MAX_HEADERS 64
|
|
#define MGCP_MAX_LINES 64
|
|
|
|
struct mgcp_request {
|
|
int len;
|
|
char *verb;
|
|
char *identifier;
|
|
char *endpoint;
|
|
char *version;
|
|
int headers; /* MGCP Headers */
|
|
char *header[MGCP_MAX_HEADERS];
|
|
int lines; /* SDP Content */
|
|
char *line[MGCP_MAX_LINES];
|
|
char data[MGCP_MAX_PACKET];
|
|
};
|
|
|
|
static struct mgcp_pkt {
|
|
int retrans;
|
|
struct mgcp_endpoint *owner;
|
|
int packetlen;
|
|
char data[MGCP_MAX_PACKET];
|
|
struct mgcp_pkt *next;
|
|
} *packets = NULL;
|
|
|
|
#define TYPE_TRUNK 1
|
|
#define TYPE_LINE 2
|
|
|
|
struct mgcp_endpoint {
|
|
pthread_mutex_t lock;
|
|
char name[80];
|
|
char accountcode[80];
|
|
char exten[AST_MAX_EXTENSION]; /* Extention where to start */
|
|
char context[AST_MAX_EXTENSION];
|
|
char language[MAX_LANGUAGE];
|
|
char callerid[256]; /* Caller*ID */
|
|
char curtone[80]; /* Current tone */
|
|
char txident[80];
|
|
char cxident[80];
|
|
char callid[80];
|
|
int hascallerid;
|
|
int amaflags;
|
|
int type;
|
|
int group;
|
|
int iseq;
|
|
int nat;
|
|
int lastout;
|
|
int alreadygone;
|
|
int needdestroy;
|
|
int capability;
|
|
int outgoing;
|
|
struct ast_channel *owner;
|
|
struct ast_rtp *rtp;
|
|
struct sockaddr_in tmpdest;
|
|
struct mgcp_endpoint *next;
|
|
struct mgcp_gateway *parent;
|
|
};
|
|
|
|
struct mgcp_gateway {
|
|
/* A gateway containing one or more endpoints */
|
|
char name[80];
|
|
struct sockaddr_in addr;
|
|
struct in_addr ourip;
|
|
struct mgcp_endpoint *endpoints;
|
|
struct ast_ha *ha;
|
|
struct mgcp_gateway *next;
|
|
} *gateways;
|
|
|
|
static pthread_mutex_t gatelock = AST_MUTEX_INITIALIZER;
|
|
|
|
static int mgcpsock = -1;
|
|
|
|
static struct sockaddr_in bindaddr;
|
|
|
|
static struct ast_frame *mgcp_read(struct ast_channel *ast);
|
|
static int transmit_response(struct mgcp_endpoint *p, char *msg, struct mgcp_request *req, char *msgrest);
|
|
static int transmit_notify_request(struct mgcp_endpoint *p, char *tone, int offhook);
|
|
static int transmit_connection_del(struct mgcp_endpoint *p);
|
|
static int transmit_notify_request_with_callerid(struct mgcp_endpoint *p, char *tone, int offhook, char *callerid);
|
|
|
|
static int __mgcp_xmit(struct mgcp_endpoint *p, char *data, int len)
|
|
{
|
|
int res;
|
|
res=sendto(mgcpsock, data, len, 0, (struct sockaddr *)&p->parent->addr, sizeof(struct sockaddr_in));
|
|
if (res != len) {
|
|
ast_log(LOG_WARNING, "mgcp_xmit returned %d: %s\n", res, strerror(errno));
|
|
}
|
|
return res;
|
|
}
|
|
|
|
static int send_response(struct mgcp_endpoint *p, struct mgcp_request *req)
|
|
{
|
|
int res;
|
|
printf("Transmitting:\n%s\n to %s:%d\n", req->data, inet_ntoa(p->parent->addr.sin_addr), ntohs(p->parent->addr.sin_port));
|
|
res = __mgcp_xmit(p, req->data, req->len);
|
|
if (res > 0)
|
|
res = 0;
|
|
return res;
|
|
}
|
|
|
|
static int send_request(struct mgcp_endpoint *p, struct mgcp_request *req)
|
|
{
|
|
int res;
|
|
printf("XXX Need to handle Retransmitting XXX:\n%s to %s:%d\n", req->data, inet_ntoa(p->parent->addr.sin_addr), ntohs(p->parent->addr.sin_port));
|
|
res = __mgcp_xmit(p, req->data, req->len);
|
|
return res;
|
|
}
|
|
|
|
static int mgcp_call(struct ast_channel *ast, char *dest, int timeout)
|
|
{
|
|
int res;
|
|
struct mgcp_endpoint *p;
|
|
|
|
p = ast->pvt->pvt;
|
|
if ((ast->_state != AST_STATE_DOWN) && (ast->_state != AST_STATE_RESERVED)) {
|
|
ast_log(LOG_WARNING, "mgcp_call called on %s, neither down nor reserved\n", ast->name);
|
|
return -1;
|
|
}
|
|
|
|
res = 0;
|
|
p->outgoing = 1;
|
|
if (p->type == TYPE_LINE) {
|
|
transmit_notify_request_with_callerid(p, "rg", 0, ast->callerid);
|
|
ast_setstate(ast, AST_STATE_RINGING);
|
|
ast_queue_control(ast, AST_CONTROL_RINGING, 0);
|
|
} else {
|
|
ast_log(LOG_NOTICE, "Don't know how to dial on trunks yet\n");
|
|
res = -1;
|
|
}
|
|
return res;
|
|
}
|
|
|
|
/* Interface lookup code courtesy Tilghman of DrunkCoder.com. Thanks! */
|
|
|
|
struct my_ifreq {
|
|
union
|
|
{
|
|
char ifrn_name[IFNAMSIZ]; /* Interface name, e.g. "en0". */
|
|
} ifr_ifrn;
|
|
|
|
union
|
|
{
|
|
struct sockaddr_in ifru_addr;
|
|
char ifru_data[512];
|
|
} ifr_ifru;
|
|
};
|
|
|
|
struct in_addr *lookup_iface(char *iface) {
|
|
int mysock;
|
|
int res;
|
|
static struct my_ifreq ifreq;
|
|
strncpy(ifreq.ifr_ifrn.ifrn_name,iface,sizeof(ifreq.ifr_ifrn.ifrn_name));
|
|
|
|
mysock = socket(PF_INET,SOCK_DGRAM,IPPROTO_IP);
|
|
res = ioctl(mysock,SIOCGIFADDR,&ifreq);
|
|
|
|
close(mysock);
|
|
if (res < 0) {
|
|
ast_log(LOG_WARNING, "Unable to get IP of %s: %s\n", iface, strerror(errno));
|
|
return &__ourip;
|
|
}
|
|
return( (struct in_addr *) &ifreq.ifr_ifru.ifru_addr.sin_addr );
|
|
}
|
|
|
|
static struct in_addr *myaddrfor(struct in_addr *them)
|
|
{
|
|
FILE *PROC;
|
|
struct in_addr *temp = NULL;
|
|
unsigned int remote_ip;
|
|
char line[256];
|
|
remote_ip = them->s_addr;
|
|
|
|
PROC = fopen("/proc/net/route","r");
|
|
if (!PROC) {
|
|
/* If /proc/net/route doesn't exist, fall back to the old method */
|
|
return &__ourip;
|
|
}
|
|
/* First line contains headers */
|
|
fgets(line,sizeof(line),PROC);
|
|
|
|
while (!feof(PROC)) {
|
|
char iface[8];
|
|
unsigned int dest, gateway, mask;
|
|
int i,aoffset;
|
|
char *fields[40];
|
|
|
|
fgets(line,sizeof(line),PROC);
|
|
|
|
aoffset = 0;
|
|
for (i=0;i<sizeof(line);i++) {
|
|
char *boffset;
|
|
|
|
fields[aoffset++] = line + i;
|
|
boffset = strchr(line + i,'\t');
|
|
if (boffset == NULL) {
|
|
/* Exit loop */
|
|
break;
|
|
} else {
|
|
*boffset = '\0';
|
|
i = boffset - line;
|
|
}
|
|
}
|
|
|
|
sscanf(fields[0],"%s",iface);
|
|
sscanf(fields[1],"%x",&dest);
|
|
sscanf(fields[2],"%x",&gateway);
|
|
sscanf(fields[7],"%x",&mask);
|
|
#if 0
|
|
printf("Addr: %s %08x Dest: %08x Mask: %08x\n", inet_ntoa(*them), remote_ip, dest, mask);
|
|
#endif
|
|
if (((remote_ip & mask) ^ dest) == 0) {
|
|
|
|
printf("Interface is %s\n",iface);
|
|
temp = lookup_iface(iface);
|
|
printf("IP Address is %s\n",inet_ntoa(*temp));
|
|
break;
|
|
}
|
|
}
|
|
fclose(PROC);
|
|
if (!temp) {
|
|
ast_log(LOG_WARNING, "Couldn't figure out how to get to %s. Using default\n", inet_ntoa(*them));
|
|
temp = &__ourip;
|
|
}
|
|
return temp;
|
|
}
|
|
|
|
|
|
static int mgcp_hangup(struct ast_channel *ast)
|
|
{
|
|
struct mgcp_endpoint *p = ast->pvt->pvt;
|
|
if (option_debug)
|
|
ast_log(LOG_DEBUG, "mgcp_hangup(%s)\n", ast->name);
|
|
if (!ast->pvt->pvt) {
|
|
ast_log(LOG_DEBUG, "Asked to hangup channel not connected\n");
|
|
return 0;
|
|
}
|
|
ast_pthread_mutex_lock(&p->lock);
|
|
p->owner = NULL;
|
|
if (strlen(p->cxident))
|
|
transmit_connection_del(p);
|
|
strcpy(p->cxident, "");
|
|
if (!p->alreadygone && (!p->outgoing || (ast->_state == AST_STATE_UP)))
|
|
transmit_notify_request(p, "ro", 1);
|
|
else
|
|
transmit_notify_request(p, "", 0);
|
|
ast->pvt->pvt = NULL;
|
|
p->alreadygone = 0;
|
|
p->outgoing = 0;
|
|
strcpy(p->callid, "");
|
|
/* Reset temporary destination */
|
|
memset(&p->tmpdest, 0, sizeof(p->tmpdest));
|
|
if (p->rtp) {
|
|
ast_rtp_destroy(p->rtp);
|
|
p->rtp = NULL;
|
|
}
|
|
ast_pthread_mutex_unlock(&p->lock);
|
|
return 0;
|
|
}
|
|
|
|
static int mgcp_show_endpoints(int fd, int argc, char *argv[])
|
|
{
|
|
struct mgcp_gateway *g;
|
|
struct mgcp_endpoint *e;
|
|
int hasendpoints = 0;
|
|
if (argc != 3)
|
|
return RESULT_SHOWUSAGE;
|
|
ast_pthread_mutex_lock(&gatelock);
|
|
g = gateways;
|
|
while(g) {
|
|
e = g->endpoints;
|
|
ast_cli(fd, "Gateway '%s' at %s\n", g->name, inet_ntoa(g->addr.sin_addr));
|
|
while(e) {
|
|
ast_cli(fd, " -- '%s@%s in '%s' is %s\n", e->name, g->name, e->context, e->owner ? "active" : "idle");
|
|
hasendpoints = 1;
|
|
e = e->next;
|
|
}
|
|
if (!hasendpoints) {
|
|
ast_cli(fd, " << No Endpoints Defined >> ");
|
|
}
|
|
g = g->next;
|
|
}
|
|
ast_pthread_mutex_unlock(&gatelock);
|
|
return RESULT_SUCCESS;
|
|
}
|
|
|
|
static char show_endpoints_usage[] =
|
|
"Usage: mgcp show endpoints\n"
|
|
" Lists all endpoints known to the MGCP (Media Gateawy Control Protocol) subsystem.\n";
|
|
|
|
static struct ast_cli_entry cli_show_endpoints =
|
|
{ { "mgcp", "show", "endpoints", NULL }, mgcp_show_endpoints, "Show defined MGCP endpoints", show_endpoints_usage };
|
|
|
|
static int mgcp_answer(struct ast_channel *ast)
|
|
{
|
|
int res = 0;
|
|
struct mgcp_endpoint *p = ast->pvt->pvt;
|
|
if (ast->_state != AST_STATE_UP) {
|
|
ast_setstate(ast, AST_STATE_UP);
|
|
if (option_debug)
|
|
ast_log(LOG_DEBUG, "mgcp_answer(%s)\n", ast->name);
|
|
transmit_notify_request(p, "", 1);
|
|
}
|
|
return res;
|
|
}
|
|
|
|
static struct ast_frame *mgcp_rtp_read(struct mgcp_endpoint *p)
|
|
{
|
|
/* Retrieve audio/etc from channel. Assumes p->lock is already held. */
|
|
struct ast_frame *f;
|
|
f = ast_rtp_read(p->rtp);
|
|
if (p->owner) {
|
|
/* We already hold the channel lock */
|
|
if (f->frametype == AST_FRAME_VOICE) {
|
|
if (f->subclass != p->owner->nativeformats) {
|
|
ast_log(LOG_DEBUG, "Oooh, format changed to %d\n", f->subclass);
|
|
p->owner->nativeformats = f->subclass;
|
|
ast_set_read_format(p->owner, p->owner->readformat);
|
|
ast_set_write_format(p->owner, p->owner->writeformat);
|
|
}
|
|
}
|
|
}
|
|
return f;
|
|
}
|
|
|
|
|
|
static struct ast_frame *mgcp_read(struct ast_channel *ast)
|
|
{
|
|
struct ast_frame *fr;
|
|
struct mgcp_endpoint *p = ast->pvt->pvt;
|
|
ast_pthread_mutex_lock(&p->lock);
|
|
fr = mgcp_rtp_read(p);
|
|
ast_pthread_mutex_unlock(&p->lock);
|
|
return fr;
|
|
}
|
|
|
|
static int mgcp_write(struct ast_channel *ast, struct ast_frame *frame)
|
|
{
|
|
struct mgcp_endpoint *p = ast->pvt->pvt;
|
|
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 %d type frames with MGCP write\n", frame->frametype);
|
|
return 0;
|
|
}
|
|
} else {
|
|
if (!(frame->subclass & ast->nativeformats)) {
|
|
ast_log(LOG_WARNING, "Asked to transmit frame type %d, while native formats is %d (read/write = %d/%d)\n",
|
|
frame->subclass, ast->nativeformats, ast->readformat, ast->writeformat);
|
|
return -1;
|
|
}
|
|
}
|
|
if (p) {
|
|
ast_pthread_mutex_lock(&p->lock);
|
|
if (p->rtp) {
|
|
res = ast_rtp_write(p->rtp, frame);
|
|
}
|
|
ast_pthread_mutex_unlock(&p->lock);
|
|
}
|
|
return res;
|
|
}
|
|
|
|
static int mgcp_fixup(struct ast_channel *oldchan, struct ast_channel *newchan)
|
|
{
|
|
struct mgcp_endpoint *p = newchan->pvt->pvt;
|
|
ast_pthread_mutex_lock(&p->lock);
|
|
if (p->owner != oldchan) {
|
|
ast_log(LOG_WARNING, "old channel wasn't %p but was %p\n", oldchan, p->owner);
|
|
return -1;
|
|
}
|
|
p->owner = newchan;
|
|
ast_pthread_mutex_unlock(&p->lock);
|
|
return 0;
|
|
}
|
|
|
|
static int mgcp_senddigit(struct ast_channel *ast, char digit)
|
|
{
|
|
struct mgcp_endpoint *p = ast->pvt->pvt;
|
|
char tmp[2];
|
|
tmp[0] = digit;
|
|
tmp[1] = '\0';
|
|
transmit_notify_request(p, tmp, 1);
|
|
return -1;
|
|
}
|
|
|
|
|
|
static int mgcp_indicate(struct ast_channel *ast, int ind)
|
|
{
|
|
struct mgcp_endpoint *p = ast->pvt->pvt;
|
|
switch(ind) {
|
|
case AST_CONTROL_RINGING:
|
|
transmit_notify_request(p, "rt", 1);
|
|
break;
|
|
case AST_CONTROL_BUSY:
|
|
transmit_notify_request(p, "bz", 1);
|
|
break;
|
|
case AST_CONTROL_CONGESTION:
|
|
transmit_notify_request(p, "nbz", 1);
|
|
break;
|
|
case -1:
|
|
transmit_notify_request(p, "", 1);
|
|
break;
|
|
default:
|
|
ast_log(LOG_WARNING, "Don't know how to indicate condition %d\n", ind);
|
|
return -1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static struct ast_channel *mgcp_new(struct mgcp_endpoint *i, int state)
|
|
{
|
|
struct ast_channel *tmp;
|
|
int fmt;
|
|
tmp = ast_channel_alloc(1);
|
|
if (tmp) {
|
|
tmp->nativeformats = i->capability;
|
|
if (!tmp->nativeformats)
|
|
tmp->nativeformats = capability;
|
|
fmt = ast_best_codec(tmp->nativeformats);
|
|
snprintf(tmp->name, sizeof(tmp->name), "MGCP/%s@%s", i->name, i->parent->name);
|
|
if (i->rtp)
|
|
tmp->fds[0] = ast_rtp_fd(i->rtp);
|
|
tmp->type = type;
|
|
ast_setstate(tmp, state);
|
|
if (state == AST_STATE_RING)
|
|
tmp->rings = 1;
|
|
tmp->writeformat = fmt;
|
|
tmp->pvt->rawwriteformat = fmt;
|
|
tmp->readformat = fmt;
|
|
tmp->pvt->rawreadformat = fmt;
|
|
tmp->pvt->pvt = i;
|
|
tmp->pvt->call = mgcp_call;
|
|
tmp->pvt->hangup = mgcp_hangup;
|
|
tmp->pvt->answer = mgcp_answer;
|
|
tmp->pvt->read = mgcp_read;
|
|
tmp->pvt->write = mgcp_write;
|
|
tmp->pvt->indicate = mgcp_indicate;
|
|
tmp->pvt->fixup = mgcp_fixup;
|
|
tmp->pvt->send_digit = mgcp_senddigit;
|
|
tmp->pvt->bridge = ast_rtp_bridge;
|
|
if (strlen(i->language))
|
|
strncpy(tmp->language, i->language, sizeof(tmp->language)-1);
|
|
i->owner = tmp;
|
|
ast_pthread_mutex_lock(&usecnt_lock);
|
|
usecnt++;
|
|
ast_pthread_mutex_unlock(&usecnt_lock);
|
|
ast_update_use_count();
|
|
strncpy(tmp->context, i->context, sizeof(tmp->context)-1);
|
|
strncpy(tmp->exten, i->exten, sizeof(tmp->exten)-1);
|
|
if (strlen(i->callerid))
|
|
tmp->callerid = strdup(i->callerid);
|
|
tmp->priority = 1;
|
|
if (state != AST_STATE_DOWN) {
|
|
if (ast_pbx_start(tmp)) {
|
|
ast_log(LOG_WARNING, "Unable to start PBX on %s\n", tmp->name);
|
|
ast_hangup(tmp);
|
|
tmp = NULL;
|
|
}
|
|
}
|
|
} else
|
|
ast_log(LOG_WARNING, "Unable to allocate channel structure\n");
|
|
return tmp;
|
|
}
|
|
|
|
static char *get_sdp(struct mgcp_request *req, char *name)
|
|
{
|
|
int x;
|
|
int len = strlen(name);
|
|
char *r;
|
|
for (x=0;x<req->lines;x++) {
|
|
if (!strncasecmp(req->line[x], name, len) &&
|
|
(req->line[x][len] == '=')) {
|
|
r = req->line[x] + len + 1;
|
|
while(*r && (*r < 33))
|
|
r++;
|
|
return r;
|
|
}
|
|
}
|
|
return "";
|
|
}
|
|
|
|
static char *__get_header(struct mgcp_request *req, char *name, int *start)
|
|
{
|
|
int x;
|
|
int len = strlen(name);
|
|
char *r;
|
|
for (x=*start;x<req->headers;x++) {
|
|
if (!strncasecmp(req->header[x], name, len) &&
|
|
(req->header[x][len] == ':')) {
|
|
r = req->header[x] + len + 1;
|
|
while(*r && (*r < 33))
|
|
r++;
|
|
*start = x+1;
|
|
return r;
|
|
}
|
|
}
|
|
/* Don't return NULL, so get_header is always a valid pointer */
|
|
return "";
|
|
}
|
|
|
|
static char *get_header(struct mgcp_request *req, char *name)
|
|
{
|
|
int start = 0;
|
|
return __get_header(req, name, &start);
|
|
}
|
|
|
|
#if 0
|
|
static int rtpready(struct ast_rtp *rtp, struct ast_frame *f, void *data)
|
|
{
|
|
/* Just deliver the audio directly */
|
|
struct mgcp_endpoint *p = data;
|
|
ast_pthread_mutex_lock(&p->lock);
|
|
if (p->owner) {
|
|
/* Generally, you lock in the order channel lock, followed by private
|
|
lock. Since here we are doing the reverse, there is the possibility
|
|
of deadlock. As a result, in the case of a deadlock, we simply fail out
|
|
here. */
|
|
if (!pthread_mutex_trylock(&p->owner->lock)) {
|
|
if (f->frametype == AST_FRAME_VOICE) {
|
|
if (f->subclass != p->owner->nativeformats) {
|
|
ast_log(LOG_DEBUG, "Oooh, format changed to %d\n", f->subclass);
|
|
p->owner->nativeformats = f->subclass;
|
|
ast_set_read_format(p->owner, p->owner->readformat);
|
|
ast_set_write_format(p->owner, p->owner->writeformat);
|
|
}
|
|
}
|
|
ast_queue_frame(p->owner, f, 0);
|
|
pthread_mutex_unlock(&p->owner->lock);
|
|
}
|
|
}
|
|
ast_pthread_mutex_unlock(&p->lock);
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
static struct mgcp_endpoint *find_endpoint(char *name, int msgid, struct sockaddr_in *sin)
|
|
{
|
|
struct mgcp_endpoint *p = NULL;
|
|
struct mgcp_gateway *g;
|
|
char tmp[256] = "";
|
|
char *at = NULL;
|
|
if (name) {
|
|
strncpy(tmp, name, sizeof(tmp) - 1);
|
|
at = strchr(tmp, '@');
|
|
if (!at) {
|
|
ast_log(LOG_NOTICE, "Endpoint '%s' has no at sign!\n", name);
|
|
return NULL;
|
|
}
|
|
*at = '\0';
|
|
at++;
|
|
}
|
|
ast_pthread_mutex_lock(&gatelock);
|
|
g = gateways;
|
|
while(g) {
|
|
if (!name || !strcasecmp(g->name, at)) {
|
|
/* Found the gateway -- now for the endpoint */
|
|
p = g->endpoints;
|
|
while(p) {
|
|
if ((name && !strcasecmp(p->name, tmp)) ||
|
|
(msgid && (p->lastout == msgid)))
|
|
break;
|
|
p = p->next;
|
|
}
|
|
if (name || p)
|
|
break;
|
|
}
|
|
g = g->next;
|
|
}
|
|
ast_pthread_mutex_unlock(&gatelock);
|
|
if (!p) {
|
|
if (name) {
|
|
if (g)
|
|
ast_log(LOG_NOTICE, "Endpoint '%s' not found on gateway '%s'\n", tmp,at);
|
|
else
|
|
ast_log(LOG_NOTICE, "Gateway '%s' (and thus its endpoint '%s') does not exist\n", at, tmp);
|
|
}
|
|
}
|
|
return p;
|
|
}
|
|
|
|
static void parse(struct mgcp_request *req)
|
|
{
|
|
/* Divide fields by NULL's */
|
|
char *c;
|
|
int f = 0;
|
|
c = req->data;
|
|
|
|
/* First header starts immediately */
|
|
req->header[f] = c;
|
|
while(*c) {
|
|
if (*c == '\n') {
|
|
/* We've got a new header */
|
|
*c = 0;
|
|
|
|
#if 0
|
|
printf("Header: %s (%d)\n", req->header[f], strlen(req->header[f]));
|
|
#endif
|
|
if (!strlen(req->header[f])) {
|
|
/* Line by itself means we're now in content */
|
|
c++;
|
|
break;
|
|
}
|
|
if (f >= MGCP_MAX_HEADERS - 1) {
|
|
ast_log(LOG_WARNING, "Too many MGCP headers...\n");
|
|
} else
|
|
f++;
|
|
req->header[f] = c + 1;
|
|
} else if (*c == '\r') {
|
|
/* Ignore but eliminate \r's */
|
|
*c = 0;
|
|
}
|
|
c++;
|
|
}
|
|
/* Check for last header */
|
|
if (strlen(req->header[f]))
|
|
f++;
|
|
req->headers = f;
|
|
/* Now we process any mime content */
|
|
f = 0;
|
|
req->line[f] = c;
|
|
while(*c) {
|
|
if (*c == '\n') {
|
|
/* We've got a new line */
|
|
*c = 0;
|
|
#if 0
|
|
printf("Line: %s (%d)\n", req->line[f], strlen(req->line[f]));
|
|
#endif
|
|
if (f >= MGCP_MAX_LINES - 1) {
|
|
ast_log(LOG_WARNING, "Too many SDP lines...\n");
|
|
} else
|
|
f++;
|
|
req->line[f] = c + 1;
|
|
} else if (*c == '\r') {
|
|
/* Ignore and eliminate \r's */
|
|
*c = 0;
|
|
}
|
|
c++;
|
|
}
|
|
/* Check for last line */
|
|
if (strlen(req->line[f]))
|
|
f++;
|
|
req->lines = f;
|
|
/* Parse up the initial header */
|
|
c = req->header[0];
|
|
while(*c && *c < 33) c++;
|
|
/* First the verb */
|
|
req->verb = c;
|
|
while(*c && (*c > 32)) c++;
|
|
if (*c) {
|
|
*c = '\0';
|
|
c++;
|
|
while(*c && (*c < 33)) c++;
|
|
req->identifier = c;
|
|
while(*c && (*c > 32)) c++;
|
|
if (*c) {
|
|
*c = '\0';
|
|
c++;
|
|
while(*c && (*c < 33)) c++;
|
|
req->endpoint = c;
|
|
while(*c && (*c > 32)) c++;
|
|
if (*c) {
|
|
*c = '\0';
|
|
c++;
|
|
while(*c && (*c < 33)) c++;
|
|
req->version = c;
|
|
while(*c && (*c > 32)) c++;
|
|
while(*c && (*c < 33)) c++;
|
|
while(*c && (*c > 32)) c++;
|
|
*c = '\0';
|
|
}
|
|
}
|
|
}
|
|
|
|
printf("Verb: '%s', Identifier: '%s', Endpoint: '%s', Version: '%s'\n",
|
|
req->verb, req->identifier, req->endpoint, req->version);
|
|
printf("%d headers, %d lines\n", req->headers, req->lines);
|
|
if (*c)
|
|
ast_log(LOG_WARNING, "Odd content, extra stuff left over ('%s')\n", c);
|
|
}
|
|
|
|
static int process_sdp(struct mgcp_endpoint *p, struct mgcp_request *req)
|
|
{
|
|
char *m;
|
|
char *c;
|
|
char host[258];
|
|
int len;
|
|
int portno;
|
|
int peercapability;
|
|
struct sockaddr_in sin;
|
|
char *codecs;
|
|
struct hostent *hp;
|
|
int codec;
|
|
/* Get codec and RTP info from SDP */
|
|
m = get_sdp(req, "m");
|
|
c = get_sdp(req, "c");
|
|
if (!strlen(m) || !strlen(c)) {
|
|
ast_log(LOG_WARNING, "Insufficient information for SDP (m = '%s', c = '%s')\n", m, c);
|
|
return -1;
|
|
}
|
|
if (sscanf(c, "IN IP4 %256s", host) != 1) {
|
|
ast_log(LOG_WARNING, "Invalid host in c= line, '%s'\n", c);
|
|
return -1;
|
|
}
|
|
/* XXX This could block for a long time, and block the main thread! XXX */
|
|
hp = gethostbyname(host);
|
|
if (!hp) {
|
|
ast_log(LOG_WARNING, "Unable to lookup host in c= line, '%s'\n", c);
|
|
return -1;
|
|
}
|
|
if (sscanf(m, "audio %d RTP/AVP %n", &portno, &len) != 1) {
|
|
ast_log(LOG_WARNING, "Unable to determine port number for RTP in '%s'\n", m);
|
|
return -1;
|
|
}
|
|
sin.sin_family = AF_INET;
|
|
memcpy(&sin.sin_addr, hp->h_addr, sizeof(sin.sin_addr));
|
|
sin.sin_port = htons(portno);
|
|
if (p->rtp)
|
|
ast_rtp_set_peer(p->rtp, &sin);
|
|
#if 0
|
|
printf("Peer RTP is at port %s:%d\n", inet_ntoa(sin.sin_addr), ntohs(sin.sin_port));
|
|
#endif
|
|
peercapability = 0;
|
|
codecs = m + len;
|
|
while(strlen(codecs)) {
|
|
if (sscanf(codecs, "%d %n", &codec, &len) != 1) {
|
|
ast_log(LOG_WARNING, "Error in codec string '%s'\n", codecs);
|
|
return -1;
|
|
}
|
|
#if 0
|
|
printf("Codec: %d\n", codec);
|
|
#endif
|
|
codec = rtp2ast(codec);
|
|
if (codec > -1)
|
|
peercapability |= codec;
|
|
codecs += len;
|
|
}
|
|
p->capability = capability & peercapability;
|
|
printf("Capabilities: us - %d, them - %d, combined - %d\n",
|
|
capability, peercapability, p->capability);
|
|
if (!p->capability) {
|
|
ast_log(LOG_WARNING, "No compatible codecs!\n");
|
|
return -1;
|
|
}
|
|
return 0;
|
|
|
|
}
|
|
|
|
static int add_header(struct mgcp_request *req, char *var, char *value)
|
|
{
|
|
if (req->len >= sizeof(req->data) - 4) {
|
|
ast_log(LOG_WARNING, "Out of space, can't add anymore\n");
|
|
return -1;
|
|
}
|
|
if (req->lines) {
|
|
ast_log(LOG_WARNING, "Can't add more headers when lines have been added\n");
|
|
return -1;
|
|
}
|
|
req->header[req->headers] = req->data + req->len;
|
|
snprintf(req->header[req->headers], sizeof(req->data) - req->len, "%s: %s\r\n", var, value);
|
|
req->len += strlen(req->header[req->headers]);
|
|
if (req->headers < MGCP_MAX_HEADERS)
|
|
req->headers++;
|
|
else {
|
|
ast_log(LOG_WARNING, "Out of header space\n");
|
|
return -1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int add_line(struct mgcp_request *req, char *line)
|
|
{
|
|
if (req->len >= sizeof(req->data) - 4) {
|
|
ast_log(LOG_WARNING, "Out of space, can't add anymore\n");
|
|
return -1;
|
|
}
|
|
if (!req->lines) {
|
|
/* Add extra empty return */
|
|
snprintf(req->data + req->len, sizeof(req->data) - req->len, "\r\n");
|
|
req->len += strlen(req->data + req->len);
|
|
}
|
|
req->line[req->lines] = req->data + req->len;
|
|
snprintf(req->line[req->lines], sizeof(req->data) - req->len, "%s", line);
|
|
req->len += strlen(req->line[req->lines]);
|
|
if (req->lines < MGCP_MAX_LINES)
|
|
req->lines++;
|
|
else {
|
|
ast_log(LOG_WARNING, "Out of line space\n");
|
|
return -1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int init_resp(struct mgcp_request *req, char *resp, struct mgcp_request *orig, char *resprest)
|
|
{
|
|
/* Initialize a response */
|
|
if (req->headers || req->len) {
|
|
ast_log(LOG_WARNING, "Request already initialized?!?\n");
|
|
return -1;
|
|
}
|
|
req->header[req->headers] = req->data + req->len;
|
|
snprintf(req->header[req->headers], sizeof(req->data) - req->len, "%s %s %s\r\n", resp, orig->identifier, resprest);
|
|
req->len += strlen(req->header[req->headers]);
|
|
if (req->headers < MGCP_MAX_HEADERS)
|
|
req->headers++;
|
|
else
|
|
ast_log(LOG_WARNING, "Out of header space\n");
|
|
return 0;
|
|
}
|
|
|
|
static int init_req(struct mgcp_endpoint *p, struct mgcp_request *req, char *verb)
|
|
{
|
|
/* Initialize a response */
|
|
if (req->headers || req->len) {
|
|
ast_log(LOG_WARNING, "Request already initialized?!?\n");
|
|
return -1;
|
|
}
|
|
req->header[req->headers] = req->data + req->len;
|
|
snprintf(req->header[req->headers], sizeof(req->data) - req->len, "%s %d %s@%s MGCP 1.0\r\n", verb, oseq, p->name, p->parent->name);
|
|
req->len += strlen(req->header[req->headers]);
|
|
if (req->headers < MGCP_MAX_HEADERS)
|
|
req->headers++;
|
|
else
|
|
ast_log(LOG_WARNING, "Out of header space\n");
|
|
return 0;
|
|
}
|
|
|
|
|
|
static int respprep(struct mgcp_request *resp, struct mgcp_endpoint *p, char *msg, struct mgcp_request *req, char *msgrest)
|
|
{
|
|
memset(resp, 0, sizeof(*resp));
|
|
init_resp(resp, msg, req, msgrest);
|
|
return 0;
|
|
}
|
|
|
|
static int reqprep(struct mgcp_request *req, struct mgcp_endpoint *p, char *verb)
|
|
{
|
|
memset(req, 0, sizeof(struct mgcp_request));
|
|
oseq++;
|
|
init_req(p, req, verb);
|
|
return 0;
|
|
}
|
|
|
|
static int transmit_response(struct mgcp_endpoint *p, char *msg, struct mgcp_request *req, char *msgrest)
|
|
{
|
|
struct mgcp_request resp;
|
|
respprep(&resp, p, msg, req, msgrest);
|
|
return send_response(p, &resp);
|
|
}
|
|
|
|
|
|
static int add_sdp(struct mgcp_request *resp, struct mgcp_endpoint *p, struct ast_rtp *rtp)
|
|
{
|
|
int len;
|
|
int codec;
|
|
char costr[80];
|
|
struct sockaddr_in sin;
|
|
char v[256];
|
|
char s[256];
|
|
char o[256];
|
|
char c[256];
|
|
char t[256];
|
|
char m[256];
|
|
char a[1024] = "";
|
|
int x;
|
|
struct sockaddr_in dest;
|
|
/* XXX We break with the "recommendation" and send our IP, in order that our
|
|
peer doesn't have to gethostbyname() us XXX */
|
|
len = 0;
|
|
if (!p->rtp) {
|
|
ast_log(LOG_WARNING, "No way to add SDP without an RTP structure\n");
|
|
return -1;
|
|
}
|
|
ast_rtp_get_us(p->rtp, &sin);
|
|
if (rtp) {
|
|
ast_rtp_get_peer(rtp, &dest);
|
|
} else {
|
|
if (p->tmpdest.sin_addr.s_addr) {
|
|
dest.sin_addr = p->tmpdest.sin_addr;
|
|
dest.sin_port = p->tmpdest.sin_port;
|
|
/* Reset temporary destination */
|
|
memset(&p->tmpdest, 0, sizeof(p->tmpdest));
|
|
} else {
|
|
dest.sin_addr = p->parent->ourip;
|
|
dest.sin_port = sin.sin_port;
|
|
}
|
|
}
|
|
printf("We're at %s port %d\n", inet_ntoa(p->parent->ourip), ntohs(sin.sin_port));
|
|
snprintf(v, sizeof(v), "v=0\r\n");
|
|
snprintf(o, sizeof(o), "o=root %d %d IN IP4 %s\r\n", getpid(), getpid(), inet_ntoa(dest.sin_addr));
|
|
snprintf(s, sizeof(s), "s=session\r\n");
|
|
snprintf(c, sizeof(c), "c=IN IP4 %s\r\n", inet_ntoa(dest.sin_addr));
|
|
snprintf(t, sizeof(t), "t=0 0\r\n");
|
|
snprintf(m, sizeof(m), "m=audio %d RTP/AVP", ntohs(dest.sin_port));
|
|
for (x=1;x<= AST_FORMAT_MAX_AUDIO; x <<= 1) {
|
|
if (p->capability & x) {
|
|
printf("Answering with capability %d\n", x);
|
|
if ((codec = ast2rtp(x)) > -1) {
|
|
snprintf(costr, sizeof(costr), " %d", codec);
|
|
strcat(m, costr);
|
|
snprintf(costr, sizeof(costr), "a=rtpmap:%d %s/8000\r\n", codec, ast2rtpn(x));
|
|
strcat(a, costr);
|
|
}
|
|
}
|
|
}
|
|
strcat(m, "\r\n");
|
|
len = strlen(v) + strlen(s) + strlen(o) + strlen(c) + strlen(t) + strlen(m) + strlen(a);
|
|
snprintf(costr, sizeof(costr), "%d", len);
|
|
add_line(resp, v);
|
|
add_line(resp, o);
|
|
add_line(resp, s);
|
|
add_line(resp, c);
|
|
add_line(resp, t);
|
|
add_line(resp, m);
|
|
add_line(resp, a);
|
|
return 0;
|
|
}
|
|
|
|
static int transmit_modify_with_sdp(struct mgcp_endpoint *p, struct ast_rtp *rtp)
|
|
{
|
|
struct mgcp_request resp;
|
|
char local[256];
|
|
char tmp[80];
|
|
int x;
|
|
if (!strlen(p->cxident) && rtp) {
|
|
/* We don't have a CXident yet, store the destination and
|
|
wait a bit */
|
|
ast_rtp_get_peer(rtp, &p->tmpdest);
|
|
return 0;
|
|
}
|
|
snprintf(local, sizeof(local), "p:20");
|
|
for (x=1;x<= AST_FORMAT_MAX_AUDIO; x <<= 1) {
|
|
if (p->capability & x) {
|
|
snprintf(tmp, sizeof(tmp), ", a:%s", ast2rtpn(x));
|
|
strcat(local, tmp);
|
|
}
|
|
}
|
|
reqprep(&resp, p, "MDCX");
|
|
add_header(&resp, "C", p->callid);
|
|
add_header(&resp, "L", local);
|
|
add_header(&resp, "M", "sendrecv");
|
|
add_header(&resp, "X", p->txident);
|
|
add_header(&resp, "I", p->cxident);
|
|
add_header(&resp, "S", "");
|
|
add_sdp(&resp, p, rtp);
|
|
p->lastout = oseq;
|
|
return send_request(p, &resp);
|
|
}
|
|
|
|
static int transmit_connect_with_sdp(struct mgcp_endpoint *p, struct ast_rtp *rtp)
|
|
{
|
|
struct mgcp_request resp;
|
|
char local[256];
|
|
char tmp[80];
|
|
int x;
|
|
snprintf(local, sizeof(local), "p:20");
|
|
for (x=1;x<= AST_FORMAT_MAX_AUDIO; x <<= 1) {
|
|
if (p->capability & x) {
|
|
snprintf(tmp, sizeof(tmp), ", a:%s", ast2rtpn(x));
|
|
strcat(local, tmp);
|
|
}
|
|
}
|
|
reqprep(&resp, p, "CRCX");
|
|
add_header(&resp, "C", p->callid);
|
|
add_header(&resp, "L", local);
|
|
add_header(&resp, "M", "sendrecv");
|
|
add_header(&resp, "X", p->txident);
|
|
add_header(&resp, "S", "");
|
|
add_sdp(&resp, p, rtp);
|
|
p->lastout = oseq;
|
|
return send_request(p, &resp);
|
|
}
|
|
|
|
static int transmit_notify_request(struct mgcp_endpoint *p, char *tone, int offhook)
|
|
{
|
|
struct mgcp_request resp;
|
|
strncpy(p->curtone, tone, sizeof(p->curtone) - 1);
|
|
reqprep(&resp, p, "RQNT");
|
|
add_header(&resp, "X", p->txident);
|
|
if (offhook)
|
|
add_header(&resp, "R", "hu(N), hf(N), D/[0-9#*](N)");
|
|
else
|
|
add_header(&resp, "R", "hd(N)");
|
|
add_header(&resp, "S", tone);
|
|
return send_request(p, &resp);
|
|
}
|
|
|
|
static int transmit_notify_request_with_callerid(struct mgcp_endpoint *p, char *tone, int offhook, char *callerid)
|
|
{
|
|
struct mgcp_request resp;
|
|
char cid[256];
|
|
char tone2[256];
|
|
char *l, *n;
|
|
time_t t;
|
|
struct tm *tm;
|
|
|
|
time(&t);
|
|
tm = localtime(&t);
|
|
if (callerid)
|
|
strncpy(cid, callerid, sizeof(cid) - 1);
|
|
else
|
|
strcpy(cid, "");
|
|
ast_callerid_parse(cid, &n, &l);
|
|
if (l) {
|
|
ast_shrink_phone_number(l);
|
|
if (!ast_isphonenumber(l)) {
|
|
n = l;
|
|
l = "";
|
|
}
|
|
}
|
|
if (!n)
|
|
n = "O";
|
|
if (!l)
|
|
l = "";
|
|
snprintf(tone2, sizeof(tone2), "%s, ci(%02d/%02d/%02d/%02d,%s,%s)", tone,
|
|
tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, l, n);
|
|
strncpy(p->curtone, tone, sizeof(p->curtone) - 1);
|
|
reqprep(&resp, p, "RQNT");
|
|
add_header(&resp, "X", p->txident);
|
|
if (offhook)
|
|
add_header(&resp, "R", "hu(N), hf(N), D/[0-9#*](N)");
|
|
else
|
|
add_header(&resp, "R", "hd(N)");
|
|
add_header(&resp, "S", tone2);
|
|
return send_request(p, &resp);
|
|
}
|
|
static int transmit_connection_del(struct mgcp_endpoint *p)
|
|
{
|
|
struct mgcp_request resp;
|
|
reqprep(&resp, p, "DLCX");
|
|
add_header(&resp, "C", p->callid);
|
|
add_header(&resp, "I", p->cxident);
|
|
return send_request(p, &resp);
|
|
}
|
|
|
|
static void handle_response(struct mgcp_endpoint *p, int result, int ident)
|
|
{
|
|
if ((result >= 400) && (result <= 499)) {
|
|
ast_log(LOG_NOTICE, "Terminating on result %d from %s@%s\n", result, p->name, p->parent->name);
|
|
if (p->owner)
|
|
ast_softhangup(p->owner, AST_SOFTHANGUP_DEV);
|
|
}
|
|
}
|
|
|
|
static void start_rtp(struct mgcp_endpoint *p)
|
|
{
|
|
ast_pthread_mutex_lock(&p->lock);
|
|
/* Allocate the RTP now */
|
|
p->rtp = ast_rtp_new(NULL, NULL);
|
|
if (p->rtp && p->owner)
|
|
p->owner->fds[0] = ast_rtp_fd(p->rtp);
|
|
if (p->rtp)
|
|
ast_rtp_setnat(p->rtp, p->nat);
|
|
#if 0
|
|
ast_rtp_set_callback(p->rtp, rtpready);
|
|
ast_rtp_set_data(p->rtp, p);
|
|
#endif
|
|
/* Make a call*ID */
|
|
snprintf(p->callid, sizeof(p->callid), "%08x%s", rand(), p->txident);
|
|
/* Transmit the connection create */
|
|
transmit_connect_with_sdp(p, NULL);
|
|
ast_pthread_mutex_unlock(&p->lock);
|
|
}
|
|
|
|
static void *mgcp_ss(void *data)
|
|
{
|
|
struct ast_channel *chan = data;
|
|
struct mgcp_endpoint *p = chan->pvt->pvt;
|
|
char exten[AST_MAX_EXTENSION] = "";
|
|
int pos = 0;
|
|
int to = 16000;
|
|
int res;
|
|
for (;;) {
|
|
res = ast_waitfordigit(chan, to);
|
|
if (!res) {
|
|
ast_log(LOG_DEBUG, "Timeout...\n");
|
|
break;
|
|
}
|
|
if (res < 0) {
|
|
ast_log(LOG_DEBUG, "Got hangup...\n");
|
|
break;
|
|
}
|
|
exten[pos++] = res;
|
|
if (!ast_ignore_pattern(chan->context, exten))
|
|
ast_indicate(chan, -1);
|
|
if (ast_matchmore_extension(chan, chan->context, exten, 1, chan->callerid)) {
|
|
if (ast_exists_extension(chan, chan->context, exten, 1, chan->callerid))
|
|
to = 3000;
|
|
else
|
|
to = 8000;
|
|
} else
|
|
break;
|
|
}
|
|
if (ast_exists_extension(chan, chan->context, exten, 1, chan->callerid)) {
|
|
strncpy(chan->exten, exten, sizeof(chan->exten) - 1);
|
|
start_rtp(p);
|
|
ast_setstate(chan, AST_STATE_RING);
|
|
chan->rings = 1;
|
|
if (ast_pbx_run(chan)) {
|
|
ast_log(LOG_WARNING, "Unable to launch PBX on %s\n", chan->name);
|
|
} else
|
|
return NULL;
|
|
}
|
|
ast_hangup(chan);
|
|
return NULL;
|
|
}
|
|
|
|
static int handle_request(struct mgcp_endpoint *p, struct mgcp_request *req, struct sockaddr_in *sin)
|
|
{
|
|
char *ev, *s;
|
|
struct ast_channel *c;
|
|
pthread_t t;
|
|
struct ast_frame f = { 0, };
|
|
printf("Handling request '%s' on %s@%s\n", req->verb, p->name, p->parent->name);
|
|
/* Clear out potential response */
|
|
if (!strcasecmp(req->verb, "RSIP")) {
|
|
if (option_verbose > 2)
|
|
ast_verbose(VERBOSE_PREFIX_3 "Resetting interface %s@%s\n", p->name, p->parent->name);
|
|
if (p->owner)
|
|
ast_softhangup(p->owner, AST_SOFTHANGUP_DEV);
|
|
transmit_response(p, "200", req, "OK");
|
|
} else if (!strcasecmp(req->verb, "NTFY")) {
|
|
/* Acknowledge and be sure we keep looking for the same things */
|
|
transmit_response(p, "200", req, "OK");
|
|
/* Notified of an event */
|
|
ev = get_header(req, "O");
|
|
s = strchr(ev, '/');
|
|
if (s) ev = s + 1;
|
|
ast_log(LOG_DEBUG, "Endpoint '%s@%s' observed '%s'\n", p->name, p->parent->name, ev);
|
|
/* Keep looking for events unless this was a hangup */
|
|
if (strcasecmp(ev, "hu") && strcasecmp(ev, "hd"))
|
|
transmit_notify_request(p, p->curtone, 1);
|
|
if (!strcasecmp(ev, "hd")) {
|
|
/* Off hook / answer */
|
|
if (p->outgoing) {
|
|
/* Answered */
|
|
if (p->owner) {
|
|
start_rtp(p);
|
|
ast_queue_control(p->owner, AST_CONTROL_ANSWER, 1);
|
|
}
|
|
} else {
|
|
/* Start switch */
|
|
if (!p->owner) {
|
|
transmit_notify_request(p, "dl", 1);
|
|
c = mgcp_new(p, AST_STATE_DOWN);
|
|
if (c) {
|
|
if (pthread_create(&t, NULL, mgcp_ss, c)) {
|
|
ast_log(LOG_WARNING, "Unable to create switch thread: %s\n", strerror(errno));
|
|
ast_hangup(c);
|
|
}
|
|
} else
|
|
ast_log(LOG_WARNING, "Unable to create channel for %s@%s\n", p->name, p->parent->name);
|
|
} else {
|
|
ast_log(LOG_WARNING, "Off hook, but alreaedy have owner on %s@%s\n", p->name, p->parent->name);
|
|
}
|
|
}
|
|
} else if (!strcasecmp(ev, "hu")) {
|
|
ast_log(LOG_DEBUG, "Went on hook\n");
|
|
if (p->owner) {
|
|
p->alreadygone = 1;
|
|
ast_queue_hangup(p->owner, 1);
|
|
}
|
|
} else if ((strlen(ev) == 1) &&
|
|
(((ev[0] >= '0') && (ev[0] <= '9')) ||
|
|
((ev[0] >= 'A') && (ev[0] <= 'D')) ||
|
|
(ev[0] == '*') || (ev[0] == '#'))) {
|
|
f.frametype = AST_FRAME_DTMF;
|
|
f.subclass = ev[0];
|
|
f.src = "mgcp";
|
|
if (p->owner)
|
|
ast_queue_frame(p->owner, &f, 1);
|
|
} else if (!strcasecmp(ev, "T")) {
|
|
/* Digit timeout -- unimportant */
|
|
} else {
|
|
ast_log(LOG_NOTICE, "Received unknown event '%s' from %s@%s\n", ev, p->name, p->parent->name);
|
|
}
|
|
} else {
|
|
ast_log(LOG_WARNING, "Unknown verb '%s' received from %s\n", req->verb, inet_ntoa(sin->sin_addr));
|
|
transmit_response(p, "510", req, "Unknown verb");
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int mgcpsock_read(int *id, int fd, short events, void *ignore)
|
|
{
|
|
struct mgcp_request req;
|
|
struct sockaddr_in sin;
|
|
struct mgcp_endpoint *p;
|
|
char *c;
|
|
int res;
|
|
int len;
|
|
int result;
|
|
int ident;
|
|
len = sizeof(sin);
|
|
memset(&req, 0, sizeof(req));
|
|
res = recvfrom(mgcpsock, req.data, sizeof(req.data) - 1, 0, (struct sockaddr *)&sin, &len);
|
|
if (res < 0) {
|
|
if (errno != ECONNREFUSED)
|
|
ast_log(LOG_WARNING, "Recv error: %s\n", strerror(errno));
|
|
return 1;
|
|
}
|
|
req.data[res] = '\0';
|
|
req.len = res;
|
|
printf("MGCP read: \n%s\n", req.data);
|
|
parse(&req);
|
|
if (req.headers < 1) {
|
|
/* Must have at least one header */
|
|
return 1;
|
|
}
|
|
if (!req.identifier || !strlen(req.identifier)) {
|
|
ast_log(LOG_NOTICE, "Message from %s missing identifier\n", inet_ntoa(sin.sin_addr));
|
|
return 1;
|
|
}
|
|
|
|
if (sscanf(req.verb, "%d", &result) &&
|
|
sscanf(req.identifier, "%d", &ident)) {
|
|
/* Try to find who this message is for, if it's important */
|
|
p = find_endpoint(NULL, ident, &sin);
|
|
if (p) {
|
|
handle_response(p, result, ident);
|
|
if ((c = get_header(&req, "I"))) {
|
|
if (strlen(c)) {
|
|
strncpy(p->cxident, c, sizeof(p->cxident) - 1);
|
|
if (p->tmpdest.sin_addr.s_addr) {
|
|
transmit_modify_with_sdp(p, NULL);
|
|
}
|
|
}
|
|
}
|
|
if (req.lines)
|
|
process_sdp(p, &req);
|
|
}
|
|
} else {
|
|
if (!req.endpoint || !strlen(req.endpoint) ||
|
|
!req.version || !strlen(req.version) ||
|
|
!req.verb || !strlen(req.verb)) {
|
|
ast_log(LOG_NOTICE, "Message must have a verb, an idenitifier, version, and endpoint\n");
|
|
return 1;
|
|
}
|
|
/* Process request, with iflock held */
|
|
p = find_endpoint(req.endpoint, 0, &sin);
|
|
if (p) {
|
|
handle_request(p, &req, &sin);
|
|
}
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
static void *do_monitor(void *data)
|
|
{
|
|
int res;
|
|
struct mgcp_pkt *p;
|
|
sched = sched_context_create();
|
|
if (!sched) {
|
|
ast_log(LOG_WARNING, "Unable to create schedule context\n");
|
|
return NULL;
|
|
}
|
|
io = io_context_create();
|
|
if (!io) {
|
|
ast_log(LOG_WARNING, "Unable to create I/O context\n");
|
|
return NULL;
|
|
}
|
|
|
|
/* Add an I/O event to our UDP socket */
|
|
if (mgcpsock > -1)
|
|
ast_io_add(io, mgcpsock, mgcpsock_read, AST_IO_IN, NULL);
|
|
|
|
/* This thread monitors all the frame relay interfaces which are not yet in use
|
|
(and thus do not have a separate thread) indefinitely */
|
|
/* From here on out, we die whenever asked */
|
|
for(;;) {
|
|
/* Check for interfaces needing to be killed */
|
|
/* Don't let anybody kill us right away. Nobody should lock the interface list
|
|
and wait for the monitor list, but the other way around is okay. */
|
|
ast_pthread_mutex_lock(&monlock);
|
|
/* Lock the network interface */
|
|
ast_pthread_mutex_lock(&netlock);
|
|
p = packets;
|
|
while(p) {
|
|
/* Handle any retransmissions */
|
|
p = p->next;
|
|
}
|
|
/* Okay, now that we know what to do, release the network lock */
|
|
ast_pthread_mutex_unlock(&netlock);
|
|
/* And from now on, we're okay to be killed, so release the monitor lock as well */
|
|
ast_pthread_mutex_unlock(&monlock);
|
|
pthread_testcancel();
|
|
/* Wait for sched or io */
|
|
res = ast_sched_wait(sched);
|
|
res = ast_io_wait(io, res);
|
|
ast_pthread_mutex_lock(&monlock);
|
|
if (res >= 0)
|
|
ast_sched_runq(sched);
|
|
ast_pthread_mutex_unlock(&monlock);
|
|
}
|
|
/* Never reached */
|
|
return NULL;
|
|
|
|
}
|
|
|
|
static int restart_monitor(void)
|
|
{
|
|
/* If we're supposed to be stopped -- stay stopped */
|
|
if (monitor_thread == -2)
|
|
return 0;
|
|
if (ast_pthread_mutex_lock(&monlock)) {
|
|
ast_log(LOG_WARNING, "Unable to lock monitor\n");
|
|
return -1;
|
|
}
|
|
if (monitor_thread == pthread_self()) {
|
|
ast_pthread_mutex_unlock(&monlock);
|
|
ast_log(LOG_WARNING, "Cannot kill myself\n");
|
|
return -1;
|
|
}
|
|
if (monitor_thread) {
|
|
/* Wake up the thread */
|
|
pthread_kill(monitor_thread, SIGURG);
|
|
} else {
|
|
/* Start a new monitor */
|
|
if (pthread_create(&monitor_thread, NULL, do_monitor, NULL) < 0) {
|
|
ast_pthread_mutex_unlock(&monlock);
|
|
ast_log(LOG_ERROR, "Unable to start monitor thread.\n");
|
|
return -1;
|
|
}
|
|
}
|
|
ast_pthread_mutex_unlock(&monlock);
|
|
return 0;
|
|
}
|
|
|
|
static struct ast_channel *mgcp_request(char *type, int format, void *data)
|
|
{
|
|
int oldformat;
|
|
struct mgcp_endpoint *p;
|
|
struct ast_channel *tmpc = NULL;
|
|
char tmp[256];
|
|
char *dest = data;
|
|
|
|
oldformat = format;
|
|
format &= capability;
|
|
if (!format) {
|
|
ast_log(LOG_NOTICE, "Asked to get a channel of unsupported format '%d'\n", format);
|
|
return NULL;
|
|
}
|
|
strncpy(tmp, dest, sizeof(tmp) - 1);
|
|
if (!strlen(tmp)) {
|
|
ast_log(LOG_NOTICE, "MGCP Channels require an endpoint\n");
|
|
return NULL;
|
|
}
|
|
p = find_endpoint(tmp, 0, NULL);
|
|
if (!p) {
|
|
ast_log(LOG_WARNING, "Unable to find MGCP endpoint '%s'\n", tmp);
|
|
return NULL;
|
|
}
|
|
/* Must be busy */
|
|
if (p->owner)
|
|
return NULL;
|
|
tmpc = mgcp_new(p, AST_STATE_DOWN);
|
|
if (!tmpc)
|
|
ast_log(LOG_WARNING, "Unable to make channel for '%s'\n", tmp);
|
|
restart_monitor();
|
|
return tmpc;
|
|
}
|
|
|
|
struct mgcp_gateway *build_gateway(char *cat, struct ast_variable *v)
|
|
{
|
|
struct mgcp_gateway *gw;
|
|
struct mgcp_endpoint *e;
|
|
char context[AST_MAX_EXTENSION] = "default";
|
|
char language[80] = "";
|
|
char callerid[AST_MAX_EXTENSION] = "";
|
|
int nat = 0;
|
|
|
|
gw = malloc(sizeof(struct mgcp_gateway));
|
|
if (gw) {
|
|
memset(gw, 0, sizeof(struct mgcp_gateway));
|
|
strncpy(gw->name, cat, sizeof(gw->name) - 1);
|
|
while(v) {
|
|
if (!strcasecmp(v->name, "host")) {
|
|
if (ast_get_ip(&gw->addr, v->value)) {
|
|
free(gw);
|
|
return NULL;
|
|
}
|
|
} else if (!strcasecmp(v->name, "permit") ||
|
|
!strcasecmp(v->name, "deny")) {
|
|
gw->ha = ast_append_ha(v->name, v->value, gw->ha);
|
|
} else if (!strcasecmp(v->name, "port")) {
|
|
gw->addr.sin_port = htons(atoi(v->value));
|
|
} else if (!strcasecmp(v->name, "context")) {
|
|
strncpy(context, v->value, sizeof(context) - 1);
|
|
} else if (!strcasecmp(v->name, "nat")) {
|
|
nat = ast_true(v->value);
|
|
} else if (!strcasecmp(v->name, "callerid")) {
|
|
if (!strcasecmp(v->value, "asreceived"))
|
|
strcpy(callerid, "");
|
|
else
|
|
strncpy(callerid, v->value, sizeof(callerid) - 1);
|
|
} else if (!strcasecmp(v->name, "language")) {
|
|
strncpy(language, v->value, sizeof(language)-1);
|
|
} else if (!strcasecmp(v->name, "trunk") ||
|
|
!strcasecmp(v->name, "line")) {
|
|
e = malloc(sizeof(struct mgcp_endpoint));
|
|
if (e) {
|
|
memset(e, 0, sizeof(struct mgcp_endpoint));
|
|
/* XXX Should we really check for uniqueness?? XXX */
|
|
snprintf(e->txident, sizeof(e->txident), "%08x", rand());
|
|
strncpy(e->context, context, sizeof(e->context) - 1);
|
|
strncpy(e->callerid, callerid, sizeof(e->callerid) - 1);
|
|
strncpy(e->language, language, sizeof(e->language) - 1);
|
|
e->capability = capability;
|
|
e->parent = gw;
|
|
e->nat = nat;
|
|
strncpy(e->name, v->value, sizeof(e->name) - 1);
|
|
if (!strcasecmp(v->name, "trunk"))
|
|
e->type = TYPE_TRUNK;
|
|
else
|
|
e->type = TYPE_LINE;
|
|
e->next = gw->endpoints;
|
|
gw->endpoints = e;
|
|
}
|
|
} else
|
|
ast_log(LOG_WARNING, "Don't know keyword '%s' at line %d\n", v->name, v->lineno);
|
|
v = v->next;
|
|
}
|
|
|
|
}
|
|
if (!ntohl(gw->addr.sin_addr.s_addr)) {
|
|
ast_log(LOG_WARNING, "Gateway '%s' lacks IP address\n", gw->name);
|
|
free(gw);
|
|
gw = NULL;
|
|
} else if (!ntohs(gw->addr.sin_port)) {
|
|
gw->addr.sin_port = htons(DEFAULT_MGCP_PORT);
|
|
memcpy(&gw->ourip, myaddrfor(&gw->addr.sin_addr), sizeof(gw->ourip));
|
|
}
|
|
return gw;
|
|
}
|
|
|
|
static struct ast_rtp *mgcp_get_rtp_peer(struct ast_channel *chan)
|
|
{
|
|
struct mgcp_endpoint *p;
|
|
p = chan->pvt->pvt;
|
|
if (p && p->rtp)
|
|
return p->rtp;
|
|
return NULL;
|
|
}
|
|
|
|
static int mgcp_set_rtp_peer(struct ast_channel *chan, struct ast_rtp *rtp)
|
|
{
|
|
struct mgcp_endpoint *p;
|
|
p = chan->pvt->pvt;
|
|
if (p) {
|
|
transmit_modify_with_sdp(p, rtp);
|
|
return 0;
|
|
}
|
|
return -1;
|
|
}
|
|
|
|
static struct ast_rtp_protocol mgcp_rtp = {
|
|
get_rtp_info: mgcp_get_rtp_peer,
|
|
set_rtp_peer: mgcp_set_rtp_peer,
|
|
};
|
|
|
|
int load_module()
|
|
{
|
|
struct ast_config *cfg;
|
|
struct ast_variable *v;
|
|
struct mgcp_gateway *g;
|
|
char *cat;
|
|
struct hostent *hp;
|
|
int format;
|
|
|
|
if (gethostname(ourhost, sizeof(ourhost))) {
|
|
ast_log(LOG_WARNING, "Unable to get hostname, MGCP disabled\n");
|
|
return 0;
|
|
}
|
|
cfg = ast_load(config);
|
|
|
|
/* We *must* have a config file otherwise stop immediately */
|
|
if (!cfg) {
|
|
ast_log(LOG_NOTICE, "Unable to load config %s, MGCP disabled\n", config);
|
|
return 0;
|
|
}
|
|
memset(&bindaddr, 0, sizeof(bindaddr));
|
|
v = ast_variable_browse(cfg, "general");
|
|
while(v) {
|
|
/* Create the interface list */
|
|
if (!strcasecmp(v->name, "bindaddr")) {
|
|
if (!(hp = gethostbyname(v->value))) {
|
|
ast_log(LOG_WARNING, "Invalid address: %s\n", v->value);
|
|
} else {
|
|
memcpy(&bindaddr.sin_addr, hp->h_addr, sizeof(bindaddr.sin_addr));
|
|
}
|
|
} else if (!strcasecmp(v->name, "allow")) {
|
|
format = ast_getformatbyname(v->value);
|
|
if (format < 1)
|
|
ast_log(LOG_WARNING, "Cannot allow unknown format '%s'\n", v->value);
|
|
else
|
|
capability |= format;
|
|
} else if (!strcasecmp(v->name, "disallow")) {
|
|
format = ast_getformatbyname(v->value);
|
|
if (format < 1)
|
|
ast_log(LOG_WARNING, "Cannot disallow unknown format '%s'\n", v->value);
|
|
else
|
|
capability &= ~format;
|
|
} else if (!strcasecmp(v->name, "port")) {
|
|
if (sscanf(v->value, "%i", &ourport) == 1) {
|
|
bindaddr.sin_port = htons(ourport);
|
|
} else {
|
|
ast_log(LOG_WARNING, "Invalid port number '%s' at line %d of %s\n", v->value, v->lineno, config);
|
|
}
|
|
}
|
|
v = v->next;
|
|
}
|
|
|
|
cat = ast_category_browse(cfg, NULL);
|
|
while(cat) {
|
|
if (strcasecmp(cat, "general")) {
|
|
g = build_gateway(cat, ast_variable_browse(cfg, cat));
|
|
if (g) {
|
|
if (option_verbose > 2)
|
|
ast_verbose(VERBOSE_PREFIX_3 "Added gateway '%s'\n", g->name);
|
|
ast_pthread_mutex_lock(&gatelock);
|
|
g->next = gateways;
|
|
gateways = g;
|
|
ast_pthread_mutex_unlock(&gatelock);
|
|
}
|
|
}
|
|
cat = ast_category_browse(cfg, cat);
|
|
}
|
|
|
|
if (ntohl(bindaddr.sin_addr.s_addr)) {
|
|
memcpy(&__ourip, &bindaddr, sizeof(__ourip));
|
|
} else {
|
|
hp = gethostbyname(ourhost);
|
|
if (!hp) {
|
|
ast_log(LOG_WARNING, "Unable to get our IP address, MGCP disabled\n");
|
|
return 0;
|
|
}
|
|
memcpy(&__ourip, hp->h_addr, sizeof(__ourip));
|
|
}
|
|
if (!ntohs(bindaddr.sin_port))
|
|
bindaddr.sin_port = ntohs(DEFAULT_MGCP_PORT);
|
|
bindaddr.sin_family = AF_INET;
|
|
pthread_mutex_lock(&netlock);
|
|
if (mgcpsock > -1)
|
|
close(mgcpsock);
|
|
mgcpsock = socket(AF_INET, SOCK_DGRAM, 0);
|
|
if (mgcpsock < 0) {
|
|
ast_log(LOG_WARNING, "Unable to create MGCP socket: %s\n", strerror(errno));
|
|
} else {
|
|
if (bind(mgcpsock, (struct sockaddr *)&bindaddr, sizeof(bindaddr)) < 0) {
|
|
ast_log(LOG_WARNING, "Failed to bind to %s:%d: %s\n",
|
|
inet_ntoa(bindaddr.sin_addr), ntohs(bindaddr.sin_port),
|
|
strerror(errno));
|
|
close(mgcpsock);
|
|
mgcpsock = -1;
|
|
} else if (option_verbose > 1)
|
|
ast_verbose(VERBOSE_PREFIX_2 "MGCP Listening on %s:%d\n",
|
|
inet_ntoa(bindaddr.sin_addr), ntohs(bindaddr.sin_port));
|
|
}
|
|
pthread_mutex_unlock(&netlock);
|
|
ast_destroy(cfg);
|
|
|
|
/* Make sure we can register our mgcp channel type */
|
|
if (ast_channel_register(type, tdesc, capability, mgcp_request)) {
|
|
ast_log(LOG_ERROR, "Unable to register channel class %s\n", type);
|
|
ast_destroy(cfg);
|
|
return -1;
|
|
}
|
|
mgcp_rtp.type = type;
|
|
ast_rtp_proto_register(&mgcp_rtp);
|
|
ast_cli_register(&cli_show_endpoints);
|
|
/* And start the monitor for the first time */
|
|
restart_monitor();
|
|
return 0;
|
|
}
|
|
|
|
int unload_module()
|
|
{
|
|
struct mgcp_endpoint *p, *pl;
|
|
#if 0
|
|
/* First, take us out of the channel loop */
|
|
ast_channel_unregister(type);
|
|
if (!ast_pthread_mutex_lock(&gatelock)) {
|
|
/* Hangup all interfaces if they have an owner */
|
|
p = iflist;
|
|
while(p) {
|
|
if (p->owner)
|
|
ast_softhangup(p->owner, AST_SOFTHANGUP_APPUNLOAD);
|
|
p = p->next;
|
|
}
|
|
iflist = NULL;
|
|
ast_pthread_mutex_unlock(&iflock);
|
|
} else {
|
|
ast_log(LOG_WARNING, "Unable to lock the monitor\n");
|
|
return -1;
|
|
}
|
|
if (!ast_pthread_mutex_lock(&monlock)) {
|
|
if (monitor_thread) {
|
|
pthread_cancel(monitor_thread);
|
|
pthread_kill(monitor_thread, SIGURG);
|
|
pthread_join(monitor_thread, NULL);
|
|
}
|
|
monitor_thread = -2;
|
|
ast_pthread_mutex_unlock(&monlock);
|
|
} else {
|
|
ast_log(LOG_WARNING, "Unable to lock the monitor\n");
|
|
return -1;
|
|
}
|
|
|
|
if (!ast_pthread_mutex_lock(&iflock)) {
|
|
/* Destroy all the interfaces and free their memory */
|
|
p = iflist;
|
|
while(p) {
|
|
pl = p;
|
|
p = p->next;
|
|
/* Free associated memory */
|
|
free(pl);
|
|
}
|
|
iflist = NULL;
|
|
ast_pthread_mutex_unlock(&iflock);
|
|
} else {
|
|
ast_log(LOG_WARNING, "Unable to lock the monitor\n");
|
|
return -1;
|
|
}
|
|
#endif
|
|
return -1;
|
|
}
|
|
|
|
int usecount()
|
|
{
|
|
int res;
|
|
ast_pthread_mutex_lock(&usecnt_lock);
|
|
res = usecnt;
|
|
ast_pthread_mutex_unlock(&usecnt_lock);
|
|
return res;
|
|
}
|
|
|
|
char *key()
|
|
{
|
|
return ASTERISK_GPL_KEY;
|
|
}
|
|
|
|
char *description()
|
|
{
|
|
return desc;
|
|
}
|
|
|