mirror of
https://github.com/danog/libtgvoip.git
synced 2024-11-27 04:34:42 +01:00
291 lines
8.5 KiB
C++
291 lines
8.5 KiB
C++
//
|
|
// Created by Grishka on 10.04.17.
|
|
//
|
|
|
|
#include "NetworkSocketPosix.h"
|
|
#include <sys/socket.h>
|
|
#include <errno.h>
|
|
#include <assert.h>
|
|
#include <netdb.h>
|
|
#include <net/if.h>
|
|
#include <sys/ioctl.h>
|
|
#include <unistd.h>
|
|
#include "../../logging.h"
|
|
#include "../../VoIPController.h"
|
|
|
|
using namespace tgvoip;
|
|
|
|
NetworkSocketPosix::NetworkSocketPosix() : lastRecvdV4(0), lastRecvdV6("::0"){
|
|
needUpdateNat64Prefix=true;
|
|
nat64Present=false;
|
|
switchToV6at=0;
|
|
isV4Available=false;
|
|
}
|
|
|
|
NetworkSocketPosix::~NetworkSocketPosix(){
|
|
|
|
}
|
|
|
|
void NetworkSocketPosix::SetMaxPriority(){
|
|
#ifdef __APPLE__
|
|
int prio=NET_SERVICE_TYPE_VO;
|
|
int res=setsockopt(fd, SOL_SOCKET, SO_NET_SERVICE_TYPE, &prio, sizeof(prio));
|
|
if(res<0){
|
|
LOGE("error setting darwin-specific net priority: %d / %s", errno, strerror(errno));
|
|
}
|
|
#else
|
|
int prio=5;
|
|
int res=setsockopt(fd, SOL_SOCKET, SO_PRIORITY, &prio, sizeof(prio));
|
|
if(res<0){
|
|
LOGE("error setting priority: %d / %s", errno, strerror(errno));
|
|
}
|
|
prio=6 << 5;
|
|
res=setsockopt(fd, SOL_IP, IP_TOS, &prio, sizeof(prio));
|
|
if(res<0){
|
|
LOGE("error setting ip tos: %d / %s", errno, strerror(errno));
|
|
}
|
|
#endif
|
|
}
|
|
|
|
void NetworkSocketPosix::Send(NetworkPacket *packet){
|
|
if(!packet || !packet->address){
|
|
LOGW("tried to send null packet");
|
|
return;
|
|
}
|
|
sockaddr_in6 addr;
|
|
IPv4Address* v4addr=dynamic_cast<IPv4Address*>(packet->address);
|
|
if(v4addr){
|
|
if(needUpdateNat64Prefix && !isV4Available && VoIPController::GetCurrentTime()>switchToV6at && switchToV6at!=0){
|
|
LOGV("Updating NAT64 prefix");
|
|
nat64Present=false;
|
|
addrinfo* addr0;
|
|
int res=getaddrinfo("ipv4only.arpa", NULL, NULL, &addr0);
|
|
if(res!=0){
|
|
LOGW("Error updating NAT64 prefix: %d / %s", res, gai_strerror(res));
|
|
}else{
|
|
addrinfo* addrPtr;
|
|
unsigned char* addr170=NULL;
|
|
unsigned char* addr171=NULL;
|
|
for(addrPtr=addr0;addrPtr;addrPtr=addrPtr->ai_next){
|
|
if(addrPtr->ai_family==AF_INET6){
|
|
sockaddr_in6* translatedAddr=(sockaddr_in6*)addrPtr->ai_addr;
|
|
uint32_t v4part=*((uint32_t*)&translatedAddr->sin6_addr.s6_addr[12]);
|
|
if(v4part==0xAA0000C0 && !addr170){
|
|
addr170=translatedAddr->sin6_addr.s6_addr;
|
|
}
|
|
if(v4part==0xAB0000C0 && !addr171){
|
|
addr171=translatedAddr->sin6_addr.s6_addr;
|
|
}
|
|
char buf[INET6_ADDRSTRLEN];
|
|
LOGV("Got translated address: %s", inet_ntop(AF_INET6, &translatedAddr->sin6_addr, buf, sizeof(buf)));
|
|
}
|
|
}
|
|
if(addr170 && addr171 && memcmp(addr170, addr171, 12)==0){
|
|
nat64Present=true;
|
|
memcpy(nat64Prefix, addr170, 12);
|
|
char buf[INET6_ADDRSTRLEN];
|
|
LOGV("Found nat64 prefix from %s", inet_ntop(AF_INET6, addr170, buf, sizeof(buf)));
|
|
}else{
|
|
LOGV("Didn't find nat64");
|
|
}
|
|
freeaddrinfo(addr0);
|
|
}
|
|
needUpdateNat64Prefix=false;
|
|
}
|
|
memset(&addr, 0, sizeof(sockaddr_in6));
|
|
addr.sin6_family=AF_INET6;
|
|
*((uint32_t*)&addr.sin6_addr.s6_addr[12])=v4addr->GetAddress();
|
|
if(nat64Present)
|
|
memcpy(addr.sin6_addr.s6_addr, nat64Prefix, 12);
|
|
else
|
|
addr.sin6_addr.s6_addr[11]=addr.sin6_addr.s6_addr[10]=0xFF;
|
|
|
|
}else{
|
|
IPv6Address* v6addr=dynamic_cast<IPv6Address*>(packet->address);
|
|
assert(v6addr!=NULL);
|
|
}
|
|
addr.sin6_port=htons(packet->port);
|
|
char buf[INET6_ADDRSTRLEN];
|
|
inet_ntop(AF_INET6, &addr.sin6_addr, buf, sizeof(buf));
|
|
int res=sendto(fd, packet->data, packet->length, 0, (const sockaddr *) &addr, sizeof(addr));
|
|
if(res<0){
|
|
LOGE("error sending: %d / %s", errno, strerror(errno));
|
|
if(errno==ENETUNREACH && !isV4Available && VoIPController::GetCurrentTime()<switchToV6at){
|
|
switchToV6at=VoIPController::GetCurrentTime();
|
|
LOGI("Network unreachable, trying NAT64");
|
|
}
|
|
}
|
|
}
|
|
|
|
void NetworkSocketPosix::Receive(NetworkPacket *packet){
|
|
int addrLen=sizeof(sockaddr_in6);
|
|
sockaddr_in6 srcAddr;
|
|
ssize_t len=recvfrom(fd, packet->data, packet->length, 0, (sockaddr *) &srcAddr, (socklen_t *) &addrLen);
|
|
if(len>0)
|
|
packet->length=(size_t) len;
|
|
else{
|
|
LOGE("error receiving %d / %s", errno, strerror(errno));
|
|
packet->length=0;
|
|
return;
|
|
}
|
|
//LOGV("Received %d bytes from %s:%d at %.5lf", len, inet_ntoa(srcAddr.sin_addr), ntohs(srcAddr.sin_port), GetCurrentTime());
|
|
if(!isV4Available && IN6_IS_ADDR_V4MAPPED(&srcAddr.sin6_addr)){
|
|
isV4Available=true;
|
|
LOGI("Detected IPv4 connectivity, will not try IPv6");
|
|
}
|
|
if(IN6_IS_ADDR_V4MAPPED(&srcAddr.sin6_addr) || (nat64Present && memcmp(nat64Prefix, srcAddr.sin6_addr.s6_addr, 12)==0)){
|
|
in_addr v4addr=*((in_addr *) &srcAddr.sin6_addr.s6_addr[12]);
|
|
lastRecvdV4=IPv4Address(v4addr.s_addr);
|
|
packet->address=&lastRecvdV4;
|
|
}else{
|
|
lastRecvdV6=IPv6Address(srcAddr.sin6_addr.s6_addr);
|
|
packet->address=&lastRecvdV6;
|
|
}
|
|
}
|
|
|
|
void NetworkSocketPosix::Open(){
|
|
fd=socket(PF_INET6, SOCK_DGRAM, IPPROTO_UDP);
|
|
if(fd<0){
|
|
LOGE("error creating socket: %d / %s", errno, strerror(errno));
|
|
}
|
|
int flag=0;
|
|
int res=setsockopt(fd, IPPROTO_IPV6, IPV6_V6ONLY, &flag, sizeof(flag));
|
|
if(res<0){
|
|
LOGE("error enabling dual stack socket: %d / %s", errno, strerror(errno));
|
|
}
|
|
|
|
SetMaxPriority();
|
|
|
|
int tries=0;
|
|
sockaddr_in6 addr;
|
|
//addr.sin6_addr.s_addr=0;
|
|
memset(&addr, 0, sizeof(sockaddr_in6));
|
|
//addr.sin6_len=sizeof(sa_family_t);
|
|
addr.sin6_family=AF_INET6;
|
|
for(tries=0;tries<10;tries++){
|
|
addr.sin6_port=htons(GenerateLocalPort());
|
|
res=::bind(fd, (sockaddr *) &addr, sizeof(sockaddr_in6));
|
|
LOGV("trying bind to port %u", ntohs(addr.sin6_port));
|
|
if(res<0){
|
|
LOGE("error binding to port %u: %d / %s", ntohs(addr.sin6_port), errno, strerror(errno));
|
|
}else{
|
|
break;
|
|
}
|
|
}
|
|
if(tries==10){
|
|
addr.sin6_port=0;
|
|
res=::bind(fd, (sockaddr *) &addr, sizeof(sockaddr_in6));
|
|
if(res<0){
|
|
LOGE("error binding to port %u: %d / %s", ntohs(addr.sin6_port), errno, strerror(errno));
|
|
//SetState(STATE_FAILED);
|
|
return;
|
|
}
|
|
}
|
|
size_t addrLen=sizeof(sockaddr_in6);
|
|
getsockname(fd, (sockaddr*)&addr, (socklen_t*) &addrLen);
|
|
uint16_t localUdpPort=ntohs(addr.sin6_port);
|
|
LOGD("Bound to local UDP port %u", ntohs(addr.sin6_port));
|
|
|
|
needUpdateNat64Prefix=true;
|
|
isV4Available=false;
|
|
switchToV6at=VoIPController::GetCurrentTime()+ipv6Timeout;
|
|
}
|
|
|
|
void NetworkSocketPosix::Close(){
|
|
shutdown(fd, SHUT_RDWR);
|
|
close(fd);
|
|
}
|
|
|
|
void NetworkSocketPosix::OnActiveInterfaceChanged(){
|
|
needUpdateNat64Prefix=true;
|
|
isV4Available=false;
|
|
switchToV6at=VoIPController::GetCurrentTime()+ipv6Timeout;
|
|
}
|
|
|
|
std::string NetworkSocketPosix::GetLocalInterfaceInfo(IPv4Address *v4addr, IPv6Address *v6addr){
|
|
struct ifconf ifc;
|
|
struct ifreq* ifr;
|
|
char buf[16384];
|
|
int sd;
|
|
std::string name="";
|
|
sd=socket(PF_INET, SOCK_DGRAM, 0);
|
|
if(sd>0){
|
|
ifc.ifc_len=sizeof(buf);
|
|
ifc.ifc_ifcu.ifcu_buf=buf;
|
|
if(ioctl(sd, SIOCGIFCONF, &ifc)==0){
|
|
ifr=ifc.ifc_req;
|
|
int len;
|
|
int i;
|
|
for(i=0;i<ifc.ifc_len;){
|
|
#ifndef __linux__
|
|
len=IFNAMSIZ + ifr->ifr_addr.sa_len;
|
|
#else
|
|
len=sizeof(*ifr);
|
|
#endif
|
|
if(ifr->ifr_addr.sa_family==AF_INET){
|
|
if(ioctl(sd, SIOCGIFADDR, ifr)==0){
|
|
struct sockaddr_in* addr=(struct sockaddr_in *)(&ifr->ifr_addr);
|
|
LOGI("Interface %s, address %s\n", ifr->ifr_name, inet_ntoa(addr->sin_addr));
|
|
if(ioctl(sd, SIOCGIFFLAGS, ifr)==0){
|
|
if(!(ifr->ifr_flags & IFF_LOOPBACK) && (ifr->ifr_flags & IFF_UP) && (ifr->ifr_flags & IFF_RUNNING)){
|
|
//LOGV("flags = %08X", ifr->ifr_flags);
|
|
if((ntohl(addr->sin_addr.s_addr) & 0xFFFF0000)==0xA9FE0000){
|
|
LOGV("skipping link-local");
|
|
continue;
|
|
}
|
|
if(v4addr){
|
|
*v4addr=IPv4Address(addr->sin_addr.s_addr);
|
|
}
|
|
name=ifr->ifr_name;
|
|
}
|
|
}
|
|
}else{
|
|
LOGE("Error getting address for %s: %d\n", ifr->ifr_name, errno);
|
|
}
|
|
}
|
|
ifr=(struct ifreq*)((char*)ifr+len);
|
|
i+=len;
|
|
}
|
|
}else{
|
|
LOGE("Error getting LAN address: %d", errno);
|
|
}
|
|
}
|
|
close(sd);
|
|
return name;
|
|
}
|
|
|
|
uint16_t NetworkSocketPosix::GetLocalPort(){
|
|
sockaddr_in6 addr;
|
|
size_t addrLen=sizeof(sockaddr_in6);
|
|
getsockname(fd, (sockaddr*)&addr, (socklen_t*) &addrLen);
|
|
return ntohs(addr.sin6_port);
|
|
}
|
|
|
|
std::string NetworkSocketPosix::V4AddressToString(uint32_t address){
|
|
char buf[INET_ADDRSTRLEN];
|
|
in_addr addr;
|
|
addr.s_addr=address;
|
|
inet_ntop(AF_INET, &addr, buf, sizeof(buf));
|
|
return std::string(buf);
|
|
}
|
|
|
|
std::string NetworkSocketPosix::V6AddressToString(unsigned char *address){
|
|
char buf[INET6_ADDRSTRLEN];
|
|
in6_addr addr;
|
|
memcpy(addr.s6_addr, address, 16);
|
|
inet_ntop(AF_INET6, &addr, buf, sizeof(buf));
|
|
return std::string(buf);
|
|
}
|
|
|
|
uint32_t NetworkSocketPosix::StringToV4Address(std::string address){
|
|
in_addr addr;
|
|
inet_pton(AF_INET, address.c_str(), &addr);
|
|
return addr.s_addr;
|
|
}
|
|
|
|
void NetworkSocketPosix::StringToV6Address(std::string address, unsigned char *out){
|
|
in6_addr addr;
|
|
inet_pton(AF_INET6, address.c_str(), &addr);
|
|
memcpy(out, addr.s6_addr, 16);
|
|
}
|