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