listen.c

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