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 (p != NULL)
  27                 pthread_rwlock_unlock(p->mu);
  28
  29         return p;
  30 }
  31
  32 // --------
  33 // Listener
  34 // --------
  35
  36 DragonnetListener *dragonnet_listener_new(char *addr, void (*on_connect)(DragonnetPeer *p))
  37 {
  38         DragonnetListener *l = malloc(sizeof *l);
  39         l->mu = malloc(sizeof *l->mu);
  40         pthread_rwlock_init(l->mu, NULL);
  41         pthread_rwlock_wrlock(l->mu);
  42
  43         l->sock = socket(AF_INET6, SOCK_STREAM, 0);
  44         l->on_connect = on_connect;
  45
  46         int flag = 1;
  47         if (setsockopt(l->sock, SOL_SOCKET, SO_REUSEADDR, &flag, sizeof flag) < 0) {
  48                 perror("setsockopt");
  49                 dragonnet_listener_delete(l);
  50                 return NULL;
  51         }
  52
  53         l->laddr = dragonnet_addr_parse_str(addr);
  54         struct sockaddr_in6 ai_addr = dragonnet_addr_sock(l->laddr);
  55
  56         if (bind(l->sock, (const struct sockaddr *) &ai_addr, sizeof ai_addr) < 0) {
  57                 perror("bind");
  58                 dragonnet_listener_delete(l);
  59                 return NULL;
  60         }
  61
  62         if (listen(l->sock, 10) < 0) {
  63                 perror("listen");
  64                 dragonnet_listener_delete(l);
  65                 return NULL;
  66         }
  67
  68         pthread_rwlock_unlock(l->mu);
  69         return l;
  70 }
  71
  72 void dragonnet_listener_run(DragonnetListener *l)
  73 {
  74         pthread_rwlock_wrlock(l->mu);
  75
  76         assert(l->state == DRAGONNET_LISTENER_CREATED);
  77         l->state++;
  78
  79         pthread_rwlock_unlock(l->mu);
  80
  81         while (l->state == DRAGONNET_LISTENER_ACTIVE) {
  82                 struct sockaddr_in6 clt_addr;
  83                 socklen_t clt_addrlen = sizeof clt_addr;
  84
  85                 int clt_sock = accept(l->sock, (struct sockaddr *) &clt_addr, &clt_addrlen);
  86                 if (clt_sock < 0) {
  87                         perror("accept");
  88                         continue;
  89                 }
  90
  91                 DragonnetPeer *p = dragonnet_peer_accept(clt_sock, clt_addr, l);
  92                 if (p == NULL)
  93                         continue;
  94
  95                 if (l->on_connect != NULL)
  96                         l->on_connect(p);
  97         }
  98 }
  99
 100 void dragonnet_listener_close(DragonnetListener *l)
 101 {
 102         pthread_rwlock_wrlock(l->mu);
 103
 104         assert(l->state == DRAGONNET_LISTENER_ACTIVE);
 105         close(l->sock);
 106         l->state++;
 107
 108         pthread_rwlock_unlock(l->mu);
 109 }
 110
 111 void dragonnet_listener_delete(DragonnetListener *l)
 112 {
 113         pthread_rwlock_destroy(l->mu);
 114         free(l);
 115 }