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