|
|
|
|
@ -58,33 +58,108 @@
|
|
|
|
|
// u_char data[DSTADDR_DATASIZE];
|
|
|
|
|
// };
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
udp_trsp::udp_trsp(trans_layer* tl)
|
|
|
|
|
: transport(tl), sd(0)
|
|
|
|
|
/** @see trsp_socket */
|
|
|
|
|
int udp_trsp_socket::bind(const string& bind_ip, unsigned short bind_port)
|
|
|
|
|
{
|
|
|
|
|
tl->register_transport(this);
|
|
|
|
|
}
|
|
|
|
|
if(sd){
|
|
|
|
|
WARN("re-binding socket\n");
|
|
|
|
|
close(sd);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
memset(&addr,0,sizeof(addr));
|
|
|
|
|
|
|
|
|
|
udp_trsp::~udp_trsp()
|
|
|
|
|
{
|
|
|
|
|
}
|
|
|
|
|
addr.ss_family = AF_INET;
|
|
|
|
|
#if defined(BSD44SOCKETS)
|
|
|
|
|
addr.ss_len = sizeof(struct sockaddr_in);
|
|
|
|
|
#endif
|
|
|
|
|
SAv4(&addr)->sin_port = htons(bind_port);
|
|
|
|
|
|
|
|
|
|
if(inet_aton(bind_ip.c_str(),&SAv4(&addr)->sin_addr)<0){
|
|
|
|
|
|
|
|
|
|
ERROR("inet_aton: %s\n",strerror(errno));
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if(SAv4(&addr)->sin_addr.s_addr == INADDR_ANY){
|
|
|
|
|
ERROR("Sorry, we cannot bind 'ANY' address\n");
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
const char* udp_trsp::get_local_ip()
|
|
|
|
|
{
|
|
|
|
|
return local_ip.c_str();
|
|
|
|
|
if((sd = socket(PF_INET,SOCK_DGRAM,0)) == -1){
|
|
|
|
|
ERROR("socket: %s\n",strerror(errno));
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if(::bind(sd,(const struct sockaddr*)&addr,
|
|
|
|
|
sizeof(struct sockaddr_in))) {
|
|
|
|
|
|
|
|
|
|
ERROR("bind: %s\n",strerror(errno));
|
|
|
|
|
close(sd);
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int true_opt = 1;
|
|
|
|
|
if(setsockopt(sd, SOL_SOCKET, SO_REUSEADDR,
|
|
|
|
|
(void*)&true_opt, sizeof (true_opt)) == -1) {
|
|
|
|
|
|
|
|
|
|
ERROR("%s\n",strerror(errno));
|
|
|
|
|
close(sd);
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if(setsockopt(sd, IPPROTO_IP, DSTADDR_SOCKOPT,
|
|
|
|
|
(void*)&true_opt, sizeof (true_opt)) == -1) {
|
|
|
|
|
|
|
|
|
|
ERROR("%s\n",strerror(errno));
|
|
|
|
|
close(sd);
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (SipCtrlInterface::udp_rcvbuf > 0) {
|
|
|
|
|
DBG("trying to set SIP UDP socket buffer to %d\n",
|
|
|
|
|
SipCtrlInterface::udp_rcvbuf);
|
|
|
|
|
if(setsockopt(sd, SOL_SOCKET, SO_RCVBUF,
|
|
|
|
|
(void*)&SipCtrlInterface::udp_rcvbuf,
|
|
|
|
|
sizeof (SipCtrlInterface::udp_rcvbuf)) == -1) {
|
|
|
|
|
WARN("could not set SIP UDP socket buffer: '%s'\n",
|
|
|
|
|
strerror(errno));
|
|
|
|
|
} else {
|
|
|
|
|
socklen_t optlen;
|
|
|
|
|
int set_rcvbuf_size=0;
|
|
|
|
|
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 != SipCtrlInterface::udp_rcvbuf) {
|
|
|
|
|
WARN("failed to set SIP UDP RCVBUF size (wanted %d, got %d)\n",
|
|
|
|
|
SipCtrlInterface::udp_rcvbuf, set_rcvbuf_size);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
port = bind_port;
|
|
|
|
|
ip = bind_ip;
|
|
|
|
|
|
|
|
|
|
DBG("UDP transport bound to %s:%i\n",ip.c_str(),port);
|
|
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
unsigned short udp_trsp::get_local_port()
|
|
|
|
|
/** @see trsp_socket */
|
|
|
|
|
|
|
|
|
|
udp_trsp::udp_trsp(udp_trsp_socket* sock)
|
|
|
|
|
: transport(sock)
|
|
|
|
|
{
|
|
|
|
|
return local_port;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void udp_trsp::copy_local_addr(sockaddr_storage* sa)
|
|
|
|
|
udp_trsp::~udp_trsp()
|
|
|
|
|
{
|
|
|
|
|
memcpy(sa,&local_addr,sizeof(sockaddr_storage));
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/** @see AmThread */
|
|
|
|
|
void udp_trsp::run()
|
|
|
|
|
{
|
|
|
|
|
@ -107,16 +182,18 @@ void udp_trsp::run()
|
|
|
|
|
msg.msg_control = new u_char[DSTADDR_DATASIZE];
|
|
|
|
|
msg.msg_controllen = DSTADDR_DATASIZE;
|
|
|
|
|
|
|
|
|
|
if(sd<=0){
|
|
|
|
|
if(sock->get_sd()<=0){
|
|
|
|
|
ERROR("Transport instance not bound\n");
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
DBG("Started UDP server listening to %s:%i\n",sock->get_ip(),sock->get_port());
|
|
|
|
|
|
|
|
|
|
while(true){
|
|
|
|
|
|
|
|
|
|
DBG("before recvmsg (%s:%i)\n",local_ip.c_str(),local_port);
|
|
|
|
|
//DBG("before recvmsg (%s:%i)\n",sock->get_ip(),sock->get_port());
|
|
|
|
|
|
|
|
|
|
buf_len = recvmsg(sd,&msg,0);
|
|
|
|
|
buf_len = recvmsg(sock->get_sd(),&msg,0);
|
|
|
|
|
if(buf_len <= 0){
|
|
|
|
|
ERROR("recvfrom returned %d: %s\n",buf_len,strerror(errno));
|
|
|
|
|
switch(errno){
|
|
|
|
|
@ -148,13 +225,13 @@ void udp_trsp::run()
|
|
|
|
|
cmsgptr->cmsg_type == DSTADDR_SOCKOPT) {
|
|
|
|
|
|
|
|
|
|
s_msg->local_ip.ss_family = AF_INET;
|
|
|
|
|
((sockaddr_in*)(&s_msg->local_ip))->sin_port = htons(local_port);
|
|
|
|
|
((sockaddr_in*)(&s_msg->local_ip))->sin_port = htons(sock->get_port());
|
|
|
|
|
memcpy(&((sockaddr_in*)(&s_msg->local_ip))->sin_addr,dstaddr(cmsgptr),sizeof(in_addr));
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// pass message to the parser / transaction layer
|
|
|
|
|
tl->received_msg(s_msg);
|
|
|
|
|
trans_layer::instance()->received_msg(s_msg);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
@ -165,127 +242,6 @@ void udp_trsp::on_stop()
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/** @see transport */
|
|
|
|
|
int udp_trsp::bind(const string& address, unsigned short port)
|
|
|
|
|
{
|
|
|
|
|
if(sd){
|
|
|
|
|
WARN("re-binding socket\n");
|
|
|
|
|
close(sd);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
memset(&local_addr,0,sizeof(local_addr));
|
|
|
|
|
local_addr.ss_family = AF_INET;
|
|
|
|
|
#if defined(BSD44SOCKETS)
|
|
|
|
|
local_addr.ss_len = sizeof(struct sockaddr_in);
|
|
|
|
|
#endif
|
|
|
|
|
SAv4(&local_addr)->sin_port = htons(port);
|
|
|
|
|
|
|
|
|
|
if(inet_aton(address.c_str(),&SAv4(&local_addr)->sin_addr)<0){
|
|
|
|
|
|
|
|
|
|
ERROR("inet_aton: %s\n",strerror(errno));
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if(SAv4(&local_addr)->sin_addr.s_addr == INADDR_ANY){
|
|
|
|
|
ERROR("Sorry, we cannot bind 'ANY' address\n");
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if((sd = socket(PF_INET,SOCK_DGRAM,0)) == -1){
|
|
|
|
|
ERROR("socket: %s\n",strerror(errno));
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if(::bind(sd,(const struct sockaddr*)&local_addr,
|
|
|
|
|
sizeof(struct sockaddr_in))) {
|
|
|
|
|
|
|
|
|
|
ERROR("bind: %s\n",strerror(errno));
|
|
|
|
|
close(sd);
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int true_opt = 1;
|
|
|
|
|
if(setsockopt(sd, SOL_SOCKET, SO_REUSEADDR,
|
|
|
|
|
(void*)&true_opt, sizeof (true_opt)) == -1) {
|
|
|
|
|
|
|
|
|
|
ERROR("%s\n",strerror(errno));
|
|
|
|
|
close(sd);
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if(setsockopt(sd, IPPROTO_IP, DSTADDR_SOCKOPT,
|
|
|
|
|
(void*)&true_opt, sizeof (true_opt)) == -1) {
|
|
|
|
|
|
|
|
|
|
ERROR("%s\n",strerror(errno));
|
|
|
|
|
close(sd);
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (SipCtrlInterface::udp_rcvbuf > 0) {
|
|
|
|
|
DBG("trying to set SIP UDP socket buffer to %d\n",
|
|
|
|
|
SipCtrlInterface::udp_rcvbuf);
|
|
|
|
|
if(setsockopt(sd, SOL_SOCKET, SO_RCVBUF,
|
|
|
|
|
(void*)&SipCtrlInterface::udp_rcvbuf,
|
|
|
|
|
sizeof (SipCtrlInterface::udp_rcvbuf)) == -1) {
|
|
|
|
|
WARN("could not set SIP UDP socket buffer: '%s'\n",
|
|
|
|
|
strerror(errno));
|
|
|
|
|
} else {
|
|
|
|
|
socklen_t optlen;
|
|
|
|
|
int set_rcvbuf_size=0;
|
|
|
|
|
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 != SipCtrlInterface::udp_rcvbuf) {
|
|
|
|
|
WARN("failed to set SIP UDP RCVBUF size (wanted %d, got %d)\n",
|
|
|
|
|
SipCtrlInterface::udp_rcvbuf, set_rcvbuf_size);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
local_port = port;
|
|
|
|
|
local_ip = address;
|
|
|
|
|
|
|
|
|
|
DBG("UDP transport bound to %s:%i\n",address.c_str(),port);
|
|
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/** @see transport */
|
|
|
|
|
int udp_trsp::send(const sockaddr_storage* sa, const char* msg, const int msg_len)
|
|
|
|
|
{
|
|
|
|
|
if ((SipCtrlInterface::log_raw_messages >= 0)
|
|
|
|
|
&& (SipCtrlInterface::log_raw_messages <=log_level)) {
|
|
|
|
|
_LOG(SipCtrlInterface::log_raw_messages,
|
|
|
|
|
"send msg\n--++--\n%.*s--++--\n", msg_len, msg);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int err;
|
|
|
|
|
#ifdef SUPPORT_IPV6
|
|
|
|
|
if (sa->ss_family == AF_INET6) {
|
|
|
|
|
err = sendto(sd, msg, msg_len, 0, (const struct sockaddr*)sa, sizeof(sockaddr_in6));
|
|
|
|
|
}
|
|
|
|
|
else {
|
|
|
|
|
#endif
|
|
|
|
|
err = sendto(sd, msg, msg_len, 0, (const struct sockaddr*)sa, sizeof(sockaddr_in));
|
|
|
|
|
#ifdef SUPPORT_IPV6
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
if (err < 0) {
|
|
|
|
|
ERROR("sendto: %s\n",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;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/** EMACS **
|
|
|
|
|
* Local variables:
|
|
|
|
|
|