listen.c

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