#ifndef EV_EPOLL_HPP #define EV_EPOLL_HPP #include #include #include #include #include #include #include #include #include #include "buffer.hpp" #include "ev.hpp" #include "llarp/net.hpp" #include "logger.hpp" #include "mem.hpp" #include namespace llarp { struct udp_listener : public ev_io { llarp_udp_io* udp; udp_listener(int fd, llarp_udp_io* u) : ev_io(fd), udp(u){}; ~udp_listener() { } bool tick() { if(udp->tick) udp->tick(udp); return true; } int read(void* buf, size_t sz) { sockaddr_in6 src; socklen_t slen = sizeof(sockaddr_in6); sockaddr* addr = (sockaddr*)&src; ssize_t ret = ::recvfrom(fd, buf, sz, 0, addr, &slen); if(ret == -1) return -1; if(ret > sz) return -1; udp->recvfrom(udp, addr, buf, ret); return 0; } int sendto(const sockaddr* to, const void* data, size_t sz) { socklen_t slen; switch(to->sa_family) { case AF_INET: slen = sizeof(struct sockaddr_in); break; case AF_INET6: slen = sizeof(struct sockaddr_in6); break; default: return -1; } ssize_t sent = ::sendto(fd, data, sz, SOCK_NONBLOCK, to, slen); if(sent == -1) { llarp::LogWarn(strerror(errno)); } return sent; } }; struct tun : public ev_io { llarp_tun_io* t; device* tunif; tun(llarp_tun_io* tio, llarp_ev_loop* l) : ev_io(-1, new LossyWriteQueue_t("tun_write_queue", l)) , t(tio) , tunif(tuntap_init()) { }; int sendto(const sockaddr* to, const void* data, size_t sz) { return -1; } bool tick() { if(t->tick) t->tick(t); flush_write(); return true; } void flush_write() { if(t->before_write) { t->before_write(t); } ev_io::flush_write(); } int read(void* buf, size_t sz) { ssize_t ret = tuntap_read(tunif, buf, sz); if(ret > 0 && t->recvpkt) { // does not have pktinfo t->recvpkt(t, buf, ret); } return ret; } bool setup() { llarp::LogDebug("set ifname to ", t->ifname); strncpy(tunif->if_name, t->ifname, sizeof(tunif->if_name)); if(tuntap_start(tunif, TUNTAP_MODE_TUNNEL, 0) == -1) { llarp::LogWarn("failed to start interface"); return false; } if(tuntap_up(tunif) == -1) { llarp::LogWarn("failed to put interface up: ", strerror(errno)); return false; } if(tuntap_set_ip(tunif, t->ifaddr, t->ifaddr, t->netmask) == -1) { llarp::LogWarn("failed to set ip"); return false; } fd = tunif->tun_fd; if(fd == -1) return false; // set non blocking int flags = fcntl(fd, F_GETFL, 0); if(flags == -1) return false; return fcntl(fd, F_SETFL, flags | O_NONBLOCK) != -1; } ~tun() { } }; }; // namespace llarp struct llarp_epoll_loop : public llarp_ev_loop { int epollfd; llarp_epoll_loop() : epollfd(-1) { } ~llarp_epoll_loop() { if(epollfd != -1) close(epollfd); } bool running() const { return epollfd != -1; } bool init() { if(epollfd == -1) epollfd = epoll_create(1); return false; } int tick(int ms) { epoll_event events[1024]; int result; result = epoll_wait(epollfd, events, 1024, ms); if(result > 0) { int idx = 0; while(idx < result) { llarp::ev_io* ev = static_cast< llarp::ev_io* >(events[idx].data.ptr); if(ev) { if(events[idx].events & EPOLLIN) { ev->read(readbuf, sizeof(readbuf)); } if(events[idx].events & EPOLLOUT) { ev->flush_write(); } } ++idx; } } if(result != -1) tick_listeners(); return result; } int run() { epoll_event events[1024]; int result; do { result = epoll_wait(epollfd, events, 1024, EV_TICK_INTERVAL); if(result > 0) { int idx = 0; while(idx < result) { llarp::ev_io* ev = static_cast< llarp::ev_io* >(events[idx].data.ptr); if(ev) { if(events[idx].events & EPOLLIN) { ev->read(readbuf, sizeof(readbuf)); } if(events[idx].events & EPOLLOUT) { ev->flush_write(); } } ++idx; } } if(result != -1) tick_listeners(); } while(epollfd != -1); return result; } int udp_bind(const sockaddr* addr) { socklen_t slen; switch(addr->sa_family) { case AF_INET: slen = sizeof(struct sockaddr_in); break; case AF_INET6: slen = sizeof(struct sockaddr_in6); break; default: return -1; } int fd = socket(addr->sa_family, SOCK_DGRAM, 0); if(fd == -1) { perror("socket()"); return -1; } if(addr->sa_family == AF_INET6) { // enable dual stack explicitly int dual = 1; if(setsockopt(fd, IPPROTO_IPV6, IPV6_V6ONLY, &dual, sizeof(dual)) == -1) { // failed perror("setsockopt()"); close(fd); return -1; } } llarp::Addr a(*addr); llarp::LogDebug("bind to ", a); if(bind(fd, addr, slen) == -1) { perror("bind()"); close(fd); return -1; } return fd; } bool close_ev(llarp::ev_io* ev) { return epoll_ctl(epollfd, EPOLL_CTL_DEL, ev->fd, nullptr) != -1; } llarp::ev_io* create_tun(llarp_tun_io* tun) { llarp::tun* t = new llarp::tun(tun, this); if(t->setup()) { return t; } delete t; return nullptr; } llarp::ev_io* create_udp(llarp_udp_io* l, const sockaddr* src) { int fd = udp_bind(src); if(fd == -1) return nullptr; llarp::ev_io* listener = new llarp::udp_listener(fd, l); l->impl = listener; return listener; } bool add_ev(llarp::ev_io* e, bool write) { epoll_event ev; ev.data.ptr = e; ev.events = EPOLLIN; if(write) ev.events |= EPOLLOUT; if(epoll_ctl(epollfd, EPOLL_CTL_ADD, e->fd, &ev) == -1) { delete e; return false; } handlers.emplace_back(e); return true; } bool udp_close(llarp_udp_io* l) { bool ret = false; llarp::udp_listener* listener = static_cast< llarp::udp_listener* >(l->impl); if(listener) { close_ev(listener); // remove handler auto itr = handlers.begin(); while(itr != handlers.end()) { if(itr->get() == listener) itr = handlers.erase(itr); else ++itr; } l->impl = nullptr; ret = true; } return ret; } void stop() { if(epollfd != -1) close(epollfd); epollfd = -1; } }; #endif