listen.c

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