lib/packet.c

   1 /* See the file COPYING for licensing information.  */
   2
   3 #include <string.h>
   4 #include <assert.h>
   5 #include <freeradius/libradius.h>
   6 #include <event2/event.h>
   7 #include <event2/bufferevent.h>
   8 #include <radsec/radsec.h>
   9 #include <radsec/radsec-impl.h>
  10 #if defined DEBUG
  11 #include <netdb.h>
  12 #include <sys/socket.h>
  13 #include "debug.h"
  14 #endif
  15
  16 static int
  17 _packet_create (struct rs_connection *conn, struct rs_packet **pkt_out)
  18 {
  19   struct rs_packet *p;
  20   RADIUS_PACKET *rpkt;
  21
  22   *pkt_out = NULL;
  23
  24   rpkt = rad_alloc (1);
  25   if (!rpkt)
  26     return rs_err_conn_push (conn, RSE_NOMEM, __func__);
  27   rpkt->id = conn->nextid++;
  28
  29   p = (struct rs_packet *) malloc (sizeof (struct rs_packet));
  30   if (!p)
  31     {
  32       rad_free (&rpkt);
  33       return rs_err_conn_push (conn, RSE_NOMEM, __func__);
  34     }
  35   memset (p, 0, sizeof (struct rs_packet));
  36   p->conn = conn;
  37   p->rpkt = rpkt;
  38
  39   *pkt_out = p;
  40   return RSE_OK;
  41 }
  42
  43 static int
  44 _do_send (struct rs_packet *pkt)
  45 {
  46   int err;
  47
  48   if (rad_encode (pkt->rpkt, NULL, pkt->conn->active_peer->secret))
  49     return rs_err_conn_push_fl (pkt->conn, RSE_FR, __FILE__, __LINE__,
  50                                 "rad_encode: %s", fr_strerror ());
  51   if (rad_sign (pkt->rpkt, NULL, pkt->conn->active_peer->secret))
  52     return rs_err_conn_push_fl (pkt->conn, RSE_FR, __FILE__, __LINE__,
  53                                 "rad_sign: %s", fr_strerror ());
  54   assert (pkt->rpkt);
  55 #if defined (DEBUG)
  56   {
  57     char host[80], serv[80];
  58
  59     getnameinfo (pkt->conn->active_peer->addr->ai_addr,
  60                  pkt->conn->active_peer->addr->ai_addrlen,
  61                  host, sizeof(host), serv, sizeof(serv),
  62                  0 /* NI_NUMERICHOST|NI_NUMERICSERV*/);
  63     fprintf (stderr, "%s: about to send this to %s:%s:\n", __func__, host,
  64              serv);
  65     rs_dump_packet (pkt);
  66   }
  67 #endif
  68   err = bufferevent_write (pkt->conn->bev, pkt->rpkt->data,
  69                            pkt->rpkt->data_len);
  70   if (err < 0)
  71     return rs_err_conn_push_fl (pkt->conn, RSE_EVENT, __FILE__, __LINE__,
  72                                 "bufferevent_write: %s",
  73                                 evutil_gai_strerror(err));
  74   return RSE_OK;
  75 }
  76
  77 static void
  78 _event_cb (struct bufferevent *bev, short events, void *ctx)
  79 {
  80   struct rs_packet *pkt = (struct rs_packet *)ctx;
  81   struct rs_connection *conn;
  82   struct rs_peer *p;
  83   int err;
  84
  85   assert (pkt);
  86   assert (pkt->conn);
  87   assert (pkt->conn->active_peer);
  88   conn = pkt->conn;
  89   p = conn->active_peer;
  90
  91   p->is_connecting = 0;
  92   if (events & BEV_EVENT_CONNECTED)
  93     {
  94       p->is_connected = 1;
  95       if (conn->callbacks.connected_cb)
  96         conn->callbacks.connected_cb (conn->user_data);
  97
  98 #if defined (DEBUG)
  99       fprintf (stderr, "%s: connected\n", __func__);
 100 #endif
 101       if (_do_send (pkt))
 102         return;
 103       if (conn->callbacks.sent_cb)
 104         conn->callbacks.sent_cb (conn->user_data);
 105       /* Packet will be freed in write callback.  */
 106     }
 107   else if (events & BEV_EVENT_ERROR)
 108     rs_err_conn_push_fl (pkt->conn, RSE_CONNERR, __FILE__, __LINE__, NULL);
 109 }
 110
 111 static void
 112 _write_cb (struct bufferevent *bev, void *ctx)
 113 {
 114   struct rs_packet *pkt = (struct rs_packet *) ctx;
 115
 116   assert (pkt);
 117   assert (pkt->conn);
 118 #if defined (DEBUG)
 119   fprintf (stderr, "%s: packet written, breaking event loop\n", __func__);
 120 #endif
 121   if (event_base_loopbreak (pkt->conn->evb) < 0)
 122     abort ();                   /* FIXME */
 123   rs_packet_destroy (pkt);
 124 }
 125
 126 static void
 127 _read_cb (struct bufferevent *bev, void *ctx)
 128 {
 129   struct rs_packet *pkt = (struct rs_packet *) ctx;
 130   size_t n;
 131
 132   assert (pkt);
 133   assert (pkt->conn);
 134   if (!pkt->hdr_read_flag)
 135     {
 136       n = bufferevent_read (pkt->conn->bev, pkt->hdr, RS_HEADER_LEN);
 137       if (n == RS_HEADER_LEN)
 138         {
 139           pkt->hdr_read_flag = 1;
 140           pkt->rpkt->data_len = (pkt->hdr[2] << 8) + pkt->hdr[3];
 141           if (pkt->rpkt->data_len < 20 /* || len > 4096 */)
 142             abort ();           /* FIXME: Read and discard packet.  */
 143           pkt->rpkt->data = rs_malloc (pkt->conn->ctx, pkt->rpkt->data_len);
 144           if (!pkt->rpkt->data)
 145             {
 146               rs_err_conn_push_fl (pkt->conn, RSE_NOMEM, __FILE__, __LINE__,
 147                                    NULL);
 148               abort ();         /* FIXME: Read and discard packet.  */
 149             }
 150           memcpy (pkt->rpkt->data, pkt->hdr, RS_HEADER_LEN);
 151           bufferevent_setwatermark (pkt->conn->bev, EV_READ,
 152                                     pkt->rpkt->data_len - RS_HEADER_LEN, 0);
 153 #if defined (DEBUG)
 154           fprintf (stderr, "%s: packet header read, total pkt len=%d\n",
 155                    __func__, pkt->rpkt->data_len);
 156 #endif
 157         }
 158       else if (n < 0)
 159         return;                 /* Buffer frozen.  */
 160       else
 161         assert (!"short header");
 162     }
 163
 164 #if defined (DEBUG)
 165   printf ("%s: trying to read %d octets of packet data\n", __func__, pkt->rpkt->data_len - RS_HEADER_LEN);
 166 #endif
 167   n = bufferevent_read (pkt->conn->bev, pkt->rpkt->data + RS_HEADER_LEN, pkt->rpkt->data_len - RS_HEADER_LEN);
 168 #if defined (DEBUG)
 169   printf ("%s: read %d octets of packet data\n", __func__, n);
 170 #endif
 171   if (n == pkt->rpkt->data_len - RS_HEADER_LEN)
 172     {
 173       bufferevent_disable (pkt->conn->bev, EV_READ);
 174       pkt->hdr_read_flag = 0;
 175       memset (pkt->hdr, 0, sizeof(*pkt->hdr));
 176 #if defined (DEBUG)
 177       fprintf (stderr, "%s: complete packet read\n", __func__);
 178 #endif
 179       if (!rad_packet_ok (pkt->rpkt, 0) != 0)
 180         return;
 181       if (rad_decode (pkt->rpkt, NULL, pkt->conn->active_peer->secret) != 0)
 182         return;
 183
 184       if (pkt->conn->callbacks.received_cb)
 185         pkt->conn->callbacks.received_cb(pkt, pkt->conn->user_data);
 186
 187       if (event_base_loopbreak (pkt->conn->evb) < 0)
 188         abort ();               /* FIXME */
 189     }
 190   else if (n < 0)
 191     return;                     /* Buffer frozen.  */
 192   else
 193     assert (!"short packet");
 194 }
 195
 196 static void
 197 _evlog_cb (int severity, const char *msg)
 198 {
 199   const char *sevstr;
 200   switch (severity)
 201     {
 202     case _EVENT_LOG_DEBUG:
 203 #if !defined (DEBUG_LEVENT)
 204       return;
 205 #endif
 206       sevstr = "debug";
 207       break;
 208     case _EVENT_LOG_MSG:
 209       sevstr = "msg";
 210       break;
 211     case _EVENT_LOG_WARN:
 212       sevstr = "warn";
 213       break;
 214     case _EVENT_LOG_ERR:
 215       sevstr = "err";
 216       break;
 217     default:
 218       sevstr = "???";
 219       break;
 220     }
 221   fprintf (stderr, "libevent: [%s] %s\n", sevstr, msg);
 222 }
 223
 224 static int
 225 _init_evb (struct rs_connection *conn)
 226 {
 227   if (!conn->evb)
 228     {
 229 #if defined (DEBUG)
 230       event_enable_debug_mode ();
 231 #endif
 232       event_set_log_callback (_evlog_cb);
 233       conn->evb = event_base_new ();
 234       if (!conn->evb)
 235         return rs_err_conn_push_fl (conn, RSE_EVENT, __FILE__, __LINE__,
 236                                     "event_base_new");
 237     }
 238   return RSE_OK;
 239 }
 240
 241 static int
 242 _init_socket (struct rs_connection *conn, struct rs_peer *p)
 243 {
 244   if (p->fd != -1)
 245     return RSE_OK;
 246
 247   assert (p->addr);
 248   p->fd = socket (p->addr->ai_family, p->addr->ai_socktype,
 249                   p->addr->ai_protocol);
 250   if (p->fd < 0)
 251     return rs_err_conn_push_fl (conn, RSE_SOME_ERROR, __FILE__, __LINE__,
 252                                 strerror (errno));
 253   if (evutil_make_socket_nonblocking (p->fd) < 0)
 254     {
 255       evutil_closesocket (p->fd);
 256       return rs_err_conn_push_fl (conn, RSE_SOME_ERROR, __FILE__, __LINE__,
 257                                   strerror (errno));
 258     }
 259   return RSE_OK;
 260 }
 261
 262 static struct rs_peer *
 263 _pick_peer (struct rs_connection *conn)
 264 {
 265   if (!conn->active_peer)
 266     conn->active_peer = conn->peers;
 267   return conn->active_peer;
 268 }
 269
 270 static int
 271 _init_bev (struct rs_connection *conn, struct rs_peer *peer)
 272 {
 273   if (!conn->bev)
 274     {
 275       conn->bev = bufferevent_socket_new (conn->evb, peer->fd, 0);
 276       if (!conn->bev)
 277         return rs_err_conn_push_fl (conn, RSE_EVENT, __FILE__, __LINE__,
 278                                     "bufferevent_socket_new");
 279     }
 280   return RSE_OK;
 281 }
 282
 283 static void
 284 _do_connect (struct rs_peer *p)
 285 {
 286   int err;
 287
 288   err = bufferevent_socket_connect (p->conn->bev, p->addr->ai_addr,
 289                                     p->addr->ai_addrlen);
 290   if (err < 0)
 291     rs_err_conn_push_fl (p->conn, RSE_EVENT, __FILE__, __LINE__,
 292                          "bufferevent_socket_connect: %s",
 293                          evutil_gai_strerror(err));
 294   else
 295     p->is_connecting = 1;
 296 }
 297
 298 static int
 299 _conn_open(struct rs_connection *conn, struct rs_packet *pkt)
 300 {
 301   struct rs_peer *p;
 302
 303   if (_init_evb (conn))
 304     return -1;
 305
 306   p = _pick_peer (conn);
 307   if (!p)
 308     return rs_err_conn_push_fl (conn, RSE_NOPEER, __FILE__, __LINE__, NULL);
 309
 310   if (_init_socket (conn, p))
 311     return -1;
 312
 313   if (_init_bev (conn, p))
 314     return -1;
 315
 316   if (!p->is_connected)
 317     if (!p->is_connecting)
 318       _do_connect (p);
 319
 320   return RSE_OK;
 321 }
 322
 323 static int
 324 _conn_is_open_p (struct rs_connection *conn)
 325 {
 326   return conn->active_peer && conn->active_peer->is_connected;
 327 }
 328
 329 /* Public functions.  */
 330 int
 331 rs_packet_create_acc_request (struct rs_connection *conn,
 332                               struct rs_packet **pkt_out,
 333                               const char *user_name, const char *user_pw)
 334 {
 335   struct rs_packet *pkt;
 336   struct rs_attr *attr;
 337
 338   if (_packet_create (conn, pkt_out))
 339     return -1;
 340   pkt = *pkt_out;
 341   pkt->rpkt->code = PW_AUTHENTICATION_REQUEST;
 342
 343   if (rs_attr_create (conn, &attr, "User-Name", user_name))
 344     return -1;
 345   rs_packet_add_attr (pkt, attr);
 346
 347   if (rs_attr_create (conn, &attr, "User-Password", user_pw))
 348     return -1;
 349   /* FIXME: need this too? rad_pwencode(user_pw, &pwlen, SECRET, reqauth) */
 350   rs_packet_add_attr (pkt, attr);
 351
 352   return RSE_OK;
 353 }
 354
 355 int
 356 rs_packet_send (struct rs_packet *pkt, void *user_data)
 357 {
 358   struct rs_connection *conn;
 359
 360   assert (pkt);
 361   conn = pkt->conn;
 362
 363   if (_conn_is_open_p (conn))
 364     _do_send (pkt);
 365   else
 366     if (_conn_open (conn, pkt))
 367       return -1;
 368
 369   assert (conn->evb);
 370   assert (conn->bev);
 371   assert (conn->active_peer);
 372   assert (conn->active_peer->fd >= 0);
 373
 374   if (conn->callbacks.connected_cb || conn->callbacks.disconnected_cb
 375       || conn->callbacks.received_cb || conn->callbacks.sent_cb)
 376     ;           /* FIXME: install event callbacks, other than below */
 377   else
 378     {
 379       bufferevent_setcb (conn->bev, _read_cb, _write_cb, _event_cb, pkt);
 380       event_base_dispatch (conn->evb);
 381     }
 382
 383 #if defined (DEBUG)
 384   fprintf (stderr, "%s: event loop done\n", __func__);
 385   assert (event_base_got_break(conn->evb));
 386 #endif
 387
 388   return RSE_OK;
 389 }
 390
 391 int
 392 rs_conn_receive_packet (struct rs_connection *conn, struct rs_packet **pkt_out)
 393 {
 394   struct rs_packet *pkt;
 395
 396   assert (conn);
 397
 398   if (_packet_create (conn, pkt_out))
 399     return -1;
 400   pkt = *pkt_out;
 401   pkt->conn = conn;
 402
 403   if (_conn_open (conn, pkt))
 404     return -1;
 405   assert (conn->evb);
 406   assert (conn->bev);
 407   assert (conn->active_peer);
 408   assert (conn->active_peer->fd >= 0);
 409
 410   bufferevent_setwatermark (conn->bev, EV_READ, RS_HEADER_LEN, 0);
 411   bufferevent_enable (conn->bev, EV_READ);
 412   event_base_dispatch (conn->evb);
 413 #if defined (DEBUG)
 414   fprintf (stderr, "%s: event loop done", __func__);
 415   if (event_base_got_break(conn->evb))
 416     {
 417       fprintf (stderr, ", got this:\n");
 418       rs_dump_packet (pkt);
 419     }
 420   else
 421     fprintf (stderr, ", no reply\n");
 422 #endif
 423
 424   return RSE_OK;
 425 }
 426
 427 void
 428 rs_packet_add_attr(struct rs_packet *pkt, struct rs_attr *attr)
 429 {
 430   pairadd (&pkt->rpkt->vps, attr->vp);
 431   attr->pkt = pkt;
 432 }
 433
 434 struct radius_packet *
 435 rs_packet_frpkt(struct rs_packet *pkt)
 436 {
 437   assert (pkt);
 438   return pkt->rpkt;
 439 }
 440
 441 void
 442 rs_packet_destroy(struct rs_packet *pkt)
 443 {
 444   if (pkt)
 445     {
 446       rad_free (&pkt->rpkt);
 447       rs_free (pkt->conn->ctx, pkt);
 448     }
 449 }