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 DragonnetPeer *dragonnet_peer_accept(int sock, struct sockaddr_in6 addr,
  15                 DragonnetListener *l)
  16 {
  17         DragonnetPeer *p = malloc(sizeof *p);
  18         p->mu = malloc(sizeof *p->mu);
  19         pthread_rwlock_init(p->mu, NULL);
  20         pthread_rwlock_wrlock(p->mu);
  21
  22         p->sock = sock;
  23         p->laddr = l->laddr;
  24         p->raddr = dragonnet_addr_parse_sock(addr);
  25
  26         if (setsockopt(p->sock, SOL_SOCKET, SO_RCVTIMEO, &dragonnet_timeout,
  27                         sizeof dragonnet_timeout) < 0) {
  28                 perror("setsockopt");
  29                 dragonnet_peer_delete(p);
  30                 return NULL;
  31         }
  32
  33         if (setsockopt(p->sock, SOL_SOCKET, SO_SNDTIMEO, &dragonnet_timeout,
  34                         sizeof dragonnet_timeout) < 0) {
  35                 perror("setsockopt");
  36                 dragonnet_peer_delete(p);
  37                 return NULL;
  38         }
  39
  40         pthread_rwlock_unlock(p->mu);
  41         return p;
  42 }
  43
  44 // --------
  45 // Listener
  46 // --------
  47
  48 DragonnetListener *dragonnet_listener_new(char *addr,
  49                 void (*on_connect)(DragonnetPeer *p))
  50 {
  51         DragonnetListener *l = malloc(sizeof *l);
  52         l->mu = malloc(sizeof *l->mu);
  53         pthread_rwlock_init(l->mu, NULL);
  54         pthread_rwlock_wrlock(l->mu);
  55
  56         l->sock = socket(AF_INET6, SOCK_STREAM, 0);
  57         l->on_connect = on_connect;
  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         pthread_rwlock_unlock(l->mu);
  83         return l;
  84 }
  85
  86 void dragonnet_listener_run(DragonnetListener *l)
  87 {
  88         pthread_rwlock_wrlock(l->mu);
  89
  90         assert(l->state == DRAGONNET_LISTENER_CREATED);
  91         l->state++;
  92
  93         pthread_rwlock_unlock(l->mu);
  94
  95         while (l->state == DRAGONNET_LISTENER_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                         perror("accept");
 102                         continue;
 103                 }
 104
 105                 DragonnetPeer *p = dragonnet_peer_accept(clt_sock, clt_addr, l);
 106                 if (p == NULL)
 107                         continue;
 108
 109                 if (l->on_connect != NULL)
 110                         l->on_connect(p);
 111         }
 112 }
 113
 114 void dragonnet_listener_close(DragonnetListener *l)
 115 {
 116         pthread_rwlock_wrlock(l->mu);
 117
 118         assert(l->state == DRAGONNET_LISTENER_ACTIVE);
 119         close(l->sock);
 120         l->sock = 0;
 121         l->state++;
 122
 123         pthread_rwlock_unlock(l->mu);
 124 }
 125
 126 void dragonnet_listener_delete(DragonnetListener *l)
 127 {
 128         pthread_rwlock_destroy(l->mu);
 129         free(l);
 130 }