listen.c

   1 #define _GNU_SOURCE
   2 #include <assert.h>
   3 #include <dragonnet/listen.h>
   4 #include <dragonnet/recv.h>
   5 #include <errno.h>
   6 #include <features.h>
   7 #include <netdb.h>
   8 #include <signal.h>
   9 #include <stdio.h>
  10 #include <stdlib.h>
  11 #include <sys/socket.h>
  12 #include <unistd.h>
  13
  14 // ----
  15 // Peer
  16 // ----
  17
  18 static bool dragonnet_peer_init_accepted(DragonnetPeer *p, int sock,
  19                 struct sockaddr_in6 addr, DragonnetListener *l)
  20 {
  21         pthread_mutex_init(&p->mtx, NULL);
  22
  23         p->sock = sock;
  24         p->laddr = l->laddr;
  25         p->raddr = dragonnet_addr_parse_sock(addr);
  26         p->on_disconnect = l->on_disconnect;
  27         p->on_recv = l->on_recv;
  28         p->on_recv_type = l->on_recv_type;
  29
  30         return true;
  31 }
  32
  33 static DragonnetPeer *dragonnet_peer_accept(int sock, struct sockaddr_in6 addr,
  34                 DragonnetListener *l)
  35 {
  36         DragonnetPeer *p = malloc(sizeof *p);
  37         if (!dragonnet_peer_init_accepted(p, sock, addr, l)) {
  38                 pthread_mutex_destroy(&p->mtx);
  39                 free(p);
  40                 return NULL;
  41         }
  42
  43         return p;
  44 }
  45
  46 // --------
  47 // Listener
  48 // --------
  49
  50 DragonnetListener *dragonnet_listener_new(char *addr)
  51 {
  52         DragonnetListener *l = malloc(sizeof *l);
  53
  54         l->active = true;
  55         l->sock = socket(AF_INET6, SOCK_STREAM, 0);
  56         l->on_connect = NULL;
  57         l->on_disconnect = NULL;
  58         l->on_recv = NULL;
  59         l->on_recv_type = calloc(sizeof *l->on_recv_type, dragonnet_num_types);
  60
  61         int so_reuseaddr = 1;
  62         if (setsockopt(l->sock, SOL_SOCKET, SO_REUSEADDR, &so_reuseaddr,
  63                         sizeof so_reuseaddr) < 0) {
  64                 perror("setsockopt");
  65                 dragonnet_listener_delete(l);
  66                 return NULL;
  67         }
  68
  69         l->laddr = dragonnet_addr_parse_str(addr);
  70         struct sockaddr_in6 ai_addr = dragonnet_addr_sock(l->laddr);
  71
  72         if (bind(l->sock, (const struct sockaddr *) &ai_addr, sizeof ai_addr) < 0) {
  73                 perror("bind");
  74                 dragonnet_listener_delete(l);
  75                 return NULL;
  76         }
  77
  78         if (listen(l->sock, 10) < 0) {
  79                 perror("listen");
  80                 dragonnet_listener_delete(l);
  81                 return NULL;
  82         }
  83
  84         return l;
  85 }
  86
  87 static void *listener_main(void *g_listener)
  88 {
  89 #ifdef __GLIBC__
  90         pthread_setname_np(pthread_self(), "listen");
  91 #endif
  92
  93         DragonnetListener *l = (DragonnetListener *) g_listener;
  94
  95         while (l->active) {
  96                 struct sockaddr_in6 clt_addr;
  97                 socklen_t clt_addrlen = sizeof clt_addr;
  98
  99                 int clt_sock = accept(l->sock, (struct sockaddr *) &clt_addr, &clt_addrlen);
 100                 if (clt_sock < 0) {
 101                         if (errno != EINTR)
 102                                 perror("accept");
 103                         continue;
 104                 }
 105
 106                 DragonnetPeer *p = dragonnet_peer_accept(clt_sock, clt_addr, l);
 107                 if (p == NULL)
 108                         continue;
 109
 110                 void (*on_connect)(DragonnetPeer *) = l->on_connect;
 111
 112                 if (on_connect != NULL)
 113                         on_connect(p);
 114
 115                 dragonnet_peer_run(p);
 116         }
 117
 118         return NULL;
 119 }
 120
 121 void dragonnet_listener_run(DragonnetListener *l)
 122 {
 123         pthread_create(&l->accept_thread, NULL, &listener_main, l);
 124 }
 125
 126 void dragonnet_listener_close(DragonnetListener *l)
 127 {
 128         l->active = false;
 129
 130         pthread_kill(l->accept_thread, SIGINT);
 131         pthread_join(l->accept_thread, NULL);
 132 }
 133
 134 void dragonnet_listener_delete(DragonnetListener *l)
 135 {
 136         free(l->on_recv_type);
 137         free(l);
 138 }