sems/core/sip/udp_trsp.cpp

/*
 * $Id: udp_trsp.cpp 1713 2010-03-30 14:11:14Z rco $
 *
 * Copyright (C) 2007 Raphael Coeffic
 *
 * This file is part of SEMS, a free SIP media server.
 *
 * SEMS is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version. This program is released under
 * the GPL with the additional exemption that compiling, linking,
 * and/or using OpenSSL is allowed.
 *
 * For a license to use the SEMS software under conditions
 * other than those described here, or to purchase support for this
 * software, please contact iptel.org by e-mail at the following addresses:
 *    info@iptel.org
 *
 * SEMS is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License 
 * along with this program; if not, write to the Free Software 
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 */

#define __APPLE_USE_RFC_3542
#include <netinet/in.h>

#include "udp_trsp.h"
#include "ip_util.h"
#include "raw_sender.h"
#include "sip_parser.h"
#include "trans_layer.h"
#include "log.h"
#include "AmUtils.h"

#include <sys/param.h>
#include <arpa/inet.h>
#include <sys/socket.h>
#include <net/if.h>
#include <netdb.h>

#include <errno.h>
#include <string.h>


/** @see trsp_socket */
int udp_trsp_socket::bind(const string& bind_ip, unsigned short bind_port)
{
    if(sd != -1){
	WARN("re-binding socket\n");
	close(sd);
	sd = -1;
    }

    if(am_inet_pton(bind_ip.c_str(),&addr) == 0){

	ERROR("am_inet_pton(%s): %s\n",bind_ip.c_str(),strerror(errno));
	return -1;
    }

    if( ((addr.ss_family == AF_INET) &&
     	 (SAv4(&addr)->sin_addr.s_addr == INADDR_ANY)) ||
     	((addr.ss_family == AF_INET6) &&
     	 IN6_IS_ADDR_UNSPECIFIED(&SAv6(&addr)->sin6_addr)) ){

     	ERROR("Sorry, we cannot bind to 'ANY' address\n");
     	return -1;
    }

    am_set_port(&addr,bind_port);

    if((sd = socket(addr.ss_family,SOCK_DGRAM,0)) == -1){
	ERROR("socket: %s\n",strerror(errno));
	return -1;
    }

    if(::bind(sd,(const struct sockaddr*)&addr,SA_len(&addr))) {

	ERROR("bind: %s\n",strerror(errno));
	return -1;
    }

    int true_opt = 1;

    if(addr.ss_family == AF_INET) {
	if(setsockopt(sd, IPPROTO_IP, DSTADDR_SOCKOPT,
		      (void*)&true_opt, sizeof (true_opt)) == -1) {

	    ERROR("%s\n",strerror(errno));
	    return -1;
	}
    } else {
	if(setsockopt(sd, IPPROTO_IPV6, DSTADDR6_SOCKOPT,
		      (void*)&true_opt, sizeof (true_opt)) == -1) {

	    ERROR("%s\n",strerror(errno));
	    return -1;
	}
    }

    port = bind_port;
    ip   = bind_ip;

    DBG("UDP transport bound to %s/%i\n",ip.c_str(),port);

    return 0;
}


int udp_trsp_socket::set_recvbuf_size(int rcvbuf_size)
{
    if (rcvbuf_size > 0) {
	DBG("trying to set SIP UDP socket buffer to %d\n", rcvbuf_size);
	if(setsockopt(sd, SOL_SOCKET, SO_RCVBUF,
		      (void*)&rcvbuf_size, sizeof (int)) == -1) {
	    WARN("could not set SIP UDP socket buffer: '%s'\n",
		 strerror(errno));
	} else {
	    int set_rcvbuf_size=0;
	    socklen_t optlen = sizeof(int);
	    if (getsockopt(sd, SOL_SOCKET, SO_RCVBUF,
			   &set_rcvbuf_size, &optlen) == -1) {
		WARN("could not read back SIP UDP socket buffer length: '%s'\n",
		     strerror(errno));
	    } else {
		if (set_rcvbuf_size != rcvbuf_size) {
		    WARN("failed to set SIP UDP RCVBUF size"
			 " (wanted %d, got %d)\n",
			 rcvbuf_size, set_rcvbuf_size);
		}
	    }
	}
    }

    return 0;
}

int udp_trsp_socket::sendto(const sockaddr_storage* sa,
			    const char* msg,
			    const int msg_len)
{
  int err = ::sendto(sd, msg, msg_len, 0,
		     (const struct sockaddr*)sa,
		     SA_len(sa));

  if (err < 0) {
    char host[NI_MAXHOST] = "";
    ERROR("sendto(%i;%s:%i): %s\n", sd,
	  am_inet_ntop_sip(sa,host,NI_MAXHOST),
	  am_get_port(sa),strerror(errno));
    return err;
  }
  else if (err != msg_len) {
    ERROR("sendto: sent %i instead of %i bytes\n", err, msg_len);
    return -1;
  }

  return 0;
}

int udp_trsp_socket::sendmsg(const sockaddr_storage* sa,
			     const char* msg,
			     const int msg_len)
{
    struct msghdr hdr;
    struct cmsghdr* cmsg;

  union {
    char cmsg4_buf[CMSG_SPACE(sizeof(struct in_pktinfo))];
    char cmsg6_buf[CMSG_SPACE(sizeof(struct in6_pktinfo))];
  } cmsg_buf;

  struct iovec msg_iov[1];
  msg_iov[0].iov_base = (void*)msg;
  msg_iov[0].iov_len  = msg_len;

  bzero(&hdr,sizeof(hdr));
  hdr.msg_name = (void*)sa;
  hdr.msg_namelen = SA_len(sa);
  hdr.msg_iov = msg_iov;
  hdr.msg_iovlen = 1;

  bzero(&cmsg_buf,sizeof(cmsg_buf));
  hdr.msg_control = &cmsg_buf;
  hdr.msg_controllen = sizeof(cmsg_buf);

  cmsg = CMSG_FIRSTHDR(&hdr);
  if(sa->ss_family == AF_INET) {

    cmsg->cmsg_level = IPPROTO_IP;
    cmsg->cmsg_type = IP_PKTINFO;
    cmsg->cmsg_len = CMSG_LEN(sizeof(struct in_pktinfo));

    struct in_pktinfo* pktinfo = (struct in_pktinfo*) CMSG_DATA(cmsg);
    pktinfo->ipi_ifindex = sys_if_idx;
  }
  else if(sa->ss_family == AF_INET6) {
    cmsg->cmsg_level = IPPROTO_IPV6;
    cmsg->cmsg_type = IPV6_PKTINFO;
    cmsg->cmsg_len = CMSG_LEN(sizeof(struct in6_pktinfo));

    struct in6_pktinfo* pktinfo = (struct in6_pktinfo*) CMSG_DATA(cmsg);
    pktinfo->ipi6_ifindex = sys_if_idx;
  }

  hdr.msg_controllen = cmsg->cmsg_len;

  // bytes_sent = ;
  if(::sendmsg(sd, &hdr, 0) < 0) {
      char host[NI_MAXHOST] = "";
      ERROR("sendmsg(%i;%s:%i): %s\n", sd,
	    am_inet_ntop_sip(sa,host,NI_MAXHOST),
	    am_get_port(sa),strerror(errno));
      return -1;
  }

  return 0;
}

int udp_trsp_socket::send(const sockaddr_storage* sa,
			  const char* msg,
			  const int msg_len,
			  unsigned int flags)
{
    if (log_level_raw_msgs >= 0) {
	_LOG(log_level_raw_msgs,
	     "send msg to %s:%i\n%.*s\n",
	     get_addr_str(sa).c_str(),
	     ntohs(((sockaddr_in*)sa)->sin_port),
	     msg_len, msg);
    }

    if(socket_options & use_raw_sockets)
	return raw_sender::send(msg,msg_len,sys_if_idx,&addr,sa);

    if(socket_options & force_outbound_if)
	return sendmsg(sa,msg,msg_len);

    return sendto(sa,msg,msg_len);
}


/** @see trsp_socket */

udp_trsp::udp_trsp(udp_trsp_socket* sock)
    : transport(sock)
{
  iov[0].iov_base = buf;
  iov[0].iov_len  = MAX_UDP_MSGLEN;

  memset(&from_addr,0,sizeof(from_addr));
  memset(&msg,0,sizeof(msg));

  msg.msg_name       = &from_addr;
  msg.msg_namelen    = sizeof(sockaddr_storage);
  msg.msg_iov        = iov;
  msg.msg_iovlen     = 1;
  msg.msg_control    = dst_addr_buf;
  msg.msg_controllen = DSTADDR_DATASIZE;
}

udp_trsp::~udp_trsp()
{
}


/** @see AmThread */
void udp_trsp::run()
{
    int buf_len;

    if(sock->get_sd() == -1){
	ERROR("Transport instance not bound\n");
	return;
    }

    INFO("Started SIP server UDP transport on %s:%i\n",
	 sock->get_ip(),sock->get_port());

    while (!stop_requested()){
	buf_len = recvmsg(sock->get_sd(),&msg,0);
	if(buf_len <= 0){
	    if(!buf_len) continue;
	    ERROR("recvfrom returned %d: %s\n",buf_len,strerror(errno));
	    switch(errno){
	    case EBADF:
	    case ENOTSOCK:
	    case EOPNOTSUPP:
		return;
	    }
	    continue;
	}

	if(buf_len > MAX_UDP_MSGLEN){
	    ERROR("Message was too big (>%d)\n",MAX_UDP_MSGLEN);
	    continue;
	}

	sockaddr_storage* sa = (sockaddr_storage*)msg.msg_name;
	if(!am_get_port(sa)) {
	    DBG("Source port is 0: dropping");
	    continue;
	}

	char *buf = (char *)msg.msg_iov[0].iov_base;
	sip_msg* s_msg = new sip_msg(buf,buf_len);
	memcpy(&s_msg->remote_ip,msg.msg_name,msg.msg_namelen);

	if (trsp_socket::log_level_raw_msgs >= 0) {
	    char host[NI_MAXHOST] = "";
	    _LOG(trsp_socket::log_level_raw_msgs,
		 "received msg via UDP from %s:%i:\n"
		 "%.*s\n",
		 am_inet_ntop_sip(&s_msg->remote_ip,host,NI_MAXHOST),
		 am_get_port(&s_msg->remote_ip),
		 s_msg->len, s_msg->buf);
	}

	s_msg->local_socket = sock;
	inc_ref(sock);

	for (cmsghdr* cmsgptr = CMSG_FIRSTHDR(&msg);
             cmsgptr != NULL;
             cmsgptr = CMSG_NXTHDR(&msg, cmsgptr)) {

            if (cmsgptr->cmsg_level == IPPROTO_IP &&
                cmsgptr->cmsg_type == DSTADDR_SOCKOPT) {

		s_msg->local_ip.ss_family = AF_INET;
	        am_set_port(&s_msg->local_ip,sock->get_port());
                memcpy(&((sockaddr_in*)(&s_msg->local_ip))->sin_addr,
		       dstaddr(cmsgptr),sizeof(in_addr));
            }
	    else if(cmsgptr->cmsg_level == IPPROTO_IPV6 &&
		    cmsgptr->cmsg_type == IPV6_PKTINFO) {

		s_msg->local_ip.ss_family = AF_INET6;
	        am_set_port(&s_msg->local_ip,sock->get_port());
                memcpy(&((sockaddr_in6*)(&s_msg->local_ip))->sin6_addr,
		       dstaddr6(cmsgptr),sizeof(in6_addr));
	    }
        }

	// pass message to the parser / transaction layer
	trans_layer::instance()->received_msg(s_msg);
    }

    INFO("Stopped SIP server UDP transport on %s:%i\n",
	 sock->get_ip(),sock->get_port());
}

/** @see AmThread */
void udp_trsp::on_stop()
{
    // wake up thread blocked in recv()
    if (sock->get_sd() != -1)
	shutdown(sock->get_sd(), SHUT_RD);
}


/** EMACS **
 * Local variables:
 * mode: c++
 * c-basic-offset: 4
 * End:
 */