packet.c 10.3 KB
Newer Older
1 2 3
/*
 *	BIRD -- OSPF
 *
4
 *	(c) 1999--2004 Ondrej Filip <feela@network.cz>
5 6 7 8 9
 *
 *	Can be freely distributed and used under the terms of the GNU GPL.
 */

#include "ospf.h"
10 11
#include "nest/password.h"
#include "lib/md5.h"
12 13

void
14
ospf_pkt_fill_hdr(struct ospf_iface *ifa, void *buf, u8 h_type)
15 16 17 18
{
  struct ospf_packet *pkt;
  struct proto *p;

19
  p = (struct proto *) (ifa->proto);
20

21
  pkt = (struct ospf_packet *) buf;
22

23
  pkt->version = OSPF_VERSION;
24

25 26
  pkt->type = h_type;

Ondřej Filip's avatar
Ondřej Filip committed
27
  pkt->routerid = htonl(p->cf->global->router_id);
28
  pkt->areaid = htonl(ifa->oa->areaid);
Ondřej Filip's avatar
Ondřej Filip committed
29
  pkt->autype = htons(ifa->autype);
30
  pkt->checksum = 0;
31 32
}

33 34 35 36 37 38 39
unsigned
ospf_pkt_maxsize(struct ospf_iface *ifa)
{
  return ifa->iface->mtu - SIZE_OF_IP_HEADER -
    ((ifa->autype == OSPF_AUTH_CRYPT) ? OSPF_AUTH_CRYPT_SIZE : 0);
}

40
void
41
ospf_pkt_finalize(struct ospf_iface *ifa, struct ospf_packet *pkt)
42
{
43 44 45 46 47 48 49
  struct proto_ospf *po = ifa->proto;
  struct proto *p = &po->proto;
  struct password_item *passwd = password_find (ifa->passwords);
  void *tail;
  struct MD5Context ctxt;
  char password[OSPF_AUTH_CRYPT_SIZE];

Ondřej Filip's avatar
Ondřej Filip committed
50
  pkt->autype = htons(ifa->autype);
51 52 53 54

  switch(ifa->autype)
  {
    case OSPF_AUTH_SIMPLE:
55 56 57 58 59 60 61
      bzero(&pkt->u, sizeof(union ospf_auth));
      if (!passwd)
      {
        log( L_ERR "No suitable password found for authentication" );
        return;
      }
      password_cpy(pkt->u.password, passwd->password, sizeof(union ospf_auth));
62
    case OSPF_AUTH_NONE:
63 64
      pkt->checksum = ipsum_calculate(pkt, sizeof(struct ospf_packet) -
                                  sizeof(union ospf_auth), (pkt + 1),
65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93
				  ntohs(pkt->length) -
				  sizeof(struct ospf_packet), NULL);
      break;
    case OSPF_AUTH_CRYPT:
      if (!passwd)
      {
        log( L_ERR "No suitable password found for authentication" );
        return;
      }

      pkt->checksum = 0;

      if (!ifa->csn)
        ifa->csn = (u32) time(NULL);

      pkt->u.md5.keyid = passwd->id;
      pkt->u.md5.len = OSPF_AUTH_CRYPT_SIZE;
      pkt->u.md5.zero = 0;
      pkt->u.md5.csn = htonl(ifa->csn++);
      tail = ((void *)pkt) + ntohs(pkt->length);
      MD5Init(&ctxt);
      MD5Update(&ctxt, (char *) pkt, ntohs(pkt->length));
      password_cpy(password, passwd->password, OSPF_AUTH_CRYPT_SIZE);
      MD5Update(&ctxt, password, OSPF_AUTH_CRYPT_SIZE);
      MD5Final(tail, &ctxt);
      break;
    default:
      bug("Unknown authentication type");
  }
94 95
}

96
static int
97
ospf_pkt_checkauth(struct ospf_neighbor *n, struct ospf_iface *ifa, struct ospf_packet *pkt, int size)
98 99
{
  int i;
100 101 102 103 104 105 106 107 108
  struct proto_ospf *po = ifa->proto;
  struct proto *p = &po->proto;
  struct password_item *pass = NULL, *ptmp;
  void *tail;
  char md5sum[OSPF_AUTH_CRYPT_SIZE];
  char password[OSPF_AUTH_CRYPT_SIZE];
  struct MD5Context ctxt;


Ondřej Filip's avatar
Ondřej Filip committed
109 110
  if (pkt->autype != htons(ifa->autype))
  {
111 112
    OSPF_TRACE(D_PACKETS, "OSPF_auth: Method differs (%d)", ntohs(pkt->autype));
    return 0;
Ondřej Filip's avatar
Ondřej Filip committed
113
  }
114

115 116 117 118 119 120 121
  if (n && (ifa != n->ifa))
  {
    OSPF_TRACE(D_PACKETS, "OSPF_auth: received packet from strange interface (%s/%s)",
      ifa->iface->name, n->ifa->iface->name);
    return 0;
  }

122 123 124 125 126 127 128 129 130 131 132 133
  switch(ifa->autype)
  {
    case OSPF_AUTH_NONE:
      return 1;
      break;
    case OSPF_AUTH_SIMPLE:
      pass = password_find (ifa->passwords);
      if(!pass)
      {
        OSPF_TRACE(D_PACKETS, "OSPF_auth: no password found");
	return 0;
      }
134
      password_cpy(password, pass->password, sizeof(union ospf_auth));
135

136
      if (memcmp(pkt->u.password, password, sizeof(union ospf_auth)))
137
      {
138 139 140 141
        char ppass[sizeof(union ospf_auth) + 1];
        bzero(ppass, (sizeof(union ospf_auth) + 1));
        memcpy(ppass, pkt->u.password, sizeof(union ospf_auth));
        OSPF_TRACE(D_PACKETS, "OSPF_auth: different passwords (%s)", ppass);
142 143
	return 0;
      }
144
      return 1;
145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167
      break;
    case OSPF_AUTH_CRYPT:
      if (pkt->u.md5.len != OSPF_AUTH_CRYPT_SIZE)
      {
        OSPF_TRACE(D_PACKETS, "OSPF_auth: wrong size of md5 digest");
        return 0;
      }
      if (ntohs(pkt->length) + OSPF_AUTH_CRYPT_SIZE != size)
      {
        OSPF_TRACE(D_PACKETS, "OSPF_auth: size mismatch");
        return 0;
      }

      if (pkt->u.md5.zero)
      {
        OSPF_TRACE(D_PACKETS, "OSPF_auth: \"zero\" area is non-zero");
        return 0;
      }

      tail = ((void *)pkt) + ntohs(pkt->length);

      WALK_LIST(ptmp, *(ifa->passwords))
      {
168 169
        if (pkt->u.md5.keyid != ptmp->id) continue;
        if ((ptmp->genfrom > now) || (ptmp->gento < now)) continue;
170 171 172 173 174 175 176 177 178 179 180 181
        pass = ptmp;
        break;
      }

      if(!pass)
      {
        OSPF_TRACE(D_PACKETS, "OSPF_auth: no suitable md5 password found");
        return 0;
      }

      if(n)
      {
182
        if(ntohs(pkt->u.md5.csn) < n->csn)
183 184 185 186 187 188 189 190 191 192 193 194
        {
          OSPF_TRACE(D_PACKETS, "OSPF_auth: lower sequence number");
          return 0;
        }
        n->csn = ntohs(pkt->u.md5.csn);
      }

      MD5Init(&ctxt);
      MD5Update(&ctxt, (char *) pkt, ntohs(pkt->length));
      password_cpy(password, pass->password, OSPF_AUTH_CRYPT_SIZE);
      MD5Update(&ctxt, password, OSPF_AUTH_CRYPT_SIZE);
      MD5Final(md5sum, &ctxt);
195
      if (memcmp(md5sum, tail, OSPF_AUTH_CRYPT_SIZE))
196 197 198 199 200 201 202 203 204 205
      {
        OSPF_TRACE(D_PACKETS, "OSPF_auth: wrong md5 digest");
        return 0;
      }
      return 1;
      break;
    default:
      OSPF_TRACE(D_PACKETS, "OSPF_auth: unknown auth type");
      return 0;
  }
206 207
}

Ondřej Filip's avatar
Ondřej Filip committed
208 209
/**
 * ospf_rx_hook
210
 * @sk: socket we received the packet. Its ignored.
Ondřej Filip's avatar
Ondřej Filip committed
211 212
 * @size: size of the packet
 *
213 214
 * This is the entry point for messages from neighbors. Many checks (like
 * authentication, checksums, size) are done before the packet is passed to
Ondřej Filip's avatar
Ondřej Filip committed
215 216
 * non generic functions.
 */
217
int
Ondřej Filip's avatar
Ondřej Filip committed
218
ospf_rx_hook(sock * sk, int size)
219 220
{
  struct ospf_packet *ps;
221
  struct ospf_iface *ifa = (struct ospf_iface *) (sk->data);
222
  struct proto_ospf *po = ifa->proto;
223
  struct proto *p = (struct proto *) (ifa->proto);
224
  struct ospf_neighbor *n;
225
  int osize;
226
  char *mesg = "Bad OSPF packet from ";
227
  struct ospf_iface *iff;
228

229 230 231
  if (ifa->stub)
    return (1);

232 233 234 235 236 237 238 239 240 241 242 243 244 245
  ps = (struct ospf_packet *) ipv4_skip_header(sk->rbuf, &size);

  if ((ifa->oa->areaid != 0) && (ntohl(ps->areaid) == 0))
  {
    WALK_LIST(iff, po->iface_list)
    {
      if ((iff->type == OSPF_IT_VLINK) && (iff->iface == ifa->iface) &&
          (iff->voa = ifa->oa) && ipa_equal(sk->faddr, iff->vip))
      {
        return 1;       /* Packet is for VLINK */
      }
    }
  }

Ondřej Filip's avatar
Ondřej Filip committed
246
  DBG("%s: RX_Hook called on interface %s.\n", p->name, sk->iface->name);
247

248
  osize = ntohs(ps->length);
249
  if (ps == NULL)
Ondřej Filip's avatar
Ondřej Filip committed
250
  {
251 252
    log(L_ERR "%s%I - bad IP header", mesg, sk->faddr);
    return 1;
Ondřej Filip's avatar
Ondřej Filip committed
253
  }
254

Ondřej Filip's avatar
Ondřej Filip committed
255 256
  if ((unsigned) size < sizeof(struct ospf_packet))
  {
257 258
    log(L_ERR "%s%I - too short (%u bytes)", mesg, sk->faddr, size);
    return 1;
Ondřej Filip's avatar
Ondřej Filip committed
259
  }
260

261
  if ((osize > size) || (osize != (4 * (osize / 4))))
Ondřej Filip's avatar
Ondřej Filip committed
262
  {
263
    log(L_ERR "%s%I - size field does not match (%d/%d)", mesg, sk->faddr, ntohs(ps->length), size );
264
    return 1;
Ondřej Filip's avatar
Ondřej Filip committed
265
  }
266 267

  if (ps->version != OSPF_VERSION)
Ondřej Filip's avatar
Ondřej Filip committed
268
  {
269 270
    log(L_ERR "%s%I - version %u", mesg, sk->faddr, ps->version);
    return 1;
Ondřej Filip's avatar
Ondřej Filip committed
271
  }
272

273 274
  if ((ps->autype != htons(OSPF_AUTH_CRYPT)) &&
      (!ipsum_verify(ps, 16, (void *) ps + sizeof(struct ospf_packet),
275
		    ntohs(ps->length) - sizeof(struct ospf_packet), NULL)))
Ondřej Filip's avatar
Ondřej Filip committed
276
  {
277 278
    log(L_ERR "%s%I - bad checksum", mesg, sk->faddr);
    return 1;
Ondřej Filip's avatar
Ondřej Filip committed
279
  }
280

281
  if (ntohl(ps->areaid) != ifa->oa->areaid)
Ondřej Filip's avatar
Ondřej Filip committed
282
  {
283 284
    log(L_ERR "%s%I - other area %ld", mesg, sk->faddr, ps->areaid);
    return 1;
Ondřej Filip's avatar
Ondřej Filip committed
285
  }
286

Ondřej Filip's avatar
Ondřej Filip committed
287 288
  if (ntohl(ps->routerid) == p->cf->global->router_id)
  {
289 290
    log(L_ERR "%s%I - received my own router ID!", mesg, sk->faddr);
    return 1;
Ondřej Filip's avatar
Ondřej Filip committed
291
  }
292

Ondřej Filip's avatar
Ondřej Filip committed
293 294
  if (ntohl(ps->routerid) == 0)
  {
295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310
    log(L_ERR "%s%I - router id = 0.0.0.0", mesg, sk->faddr);
    return 1;
  }

  if ((unsigned) size > ifa->iface->mtu)
  {
    log(L_ERR "%s%I - received larger packet than MTU", mesg, sk->faddr);
    return 1;
  }

  n = find_neigh(ifa, ntohl(((struct ospf_packet *) ps)->routerid));

  if(!n && (ps->type != HELLO_P))
  {
    OSPF_TRACE(D_PACKETS, "Received non-hello packet from uknown neighbor (%I)", sk->faddr);
    return 1;
Ondřej Filip's avatar
Ondřej Filip committed
311
  }
312

313
  if (!ospf_pkt_checkauth(n, ifa, ps, size))
314 315 316 317 318
  {
    log(L_ERR "%s%I - authentification failed", mesg, sk->faddr);
    return 1;
  }

Ondřej Filip's avatar
Ondřej Filip committed
319
  /* Dump packet 
320 321 322 323 324 325 326 327
     pu8=(u8 *)(sk->rbuf+5*4);
     for(i=0;i<ntohs(ps->length);i+=4)
     DBG("%s: received %u,%u,%u,%u\n",p->name, pu8[i+0], pu8[i+1], pu8[i+2],
     pu8[i+3]);
     DBG("%s: received size: %u\n",p->name,size);
   */

  switch (ps->type)
Ondřej Filip's avatar
Ondřej Filip committed
328 329 330
  {
  case HELLO_P:
    DBG("%s: Hello received.\n", p->name);
331
    ospf_hello_receive((struct ospf_hello_packet *) ps, ifa, n, sk->faddr);
Ondřej Filip's avatar
Ondřej Filip committed
332 333 334
    break;
  case DBDES_P:
    DBG("%s: Database description received.\n", p->name);
335
    ospf_dbdes_receive((struct ospf_dbdes_packet *) ps, ifa, n);
Ondřej Filip's avatar
Ondřej Filip committed
336 337 338
    break;
  case LSREQ_P:
    DBG("%s: Link state request received.\n", p->name);
339
    ospf_lsreq_receive((struct ospf_lsreq_packet *) ps, ifa, n);
Ondřej Filip's avatar
Ondřej Filip committed
340 341 342
    break;
  case LSUPD_P:
    DBG("%s: Link state update received.\n", p->name);
343
    ospf_lsupd_receive((struct ospf_lsupd_packet *) ps, ifa, n);
Ondřej Filip's avatar
Ondřej Filip committed
344 345 346
    break;
  case LSACK_P:
    DBG("%s: Link state ack received.\n", p->name);
347
    ospf_lsack_receive((struct ospf_lsack_packet *) ps, ifa, n);
Ondřej Filip's avatar
Ondřej Filip committed
348 349
    break;
  default:
350 351
    log(L_ERR "%s%I - wrong type %u", mesg, sk->faddr, ps->type);
    return 1;
Ondřej Filip's avatar
Ondřej Filip committed
352
  };
353
  return 1;
354 355 356
}

void
Ondřej Filip's avatar
Ondřej Filip committed
357
ospf_tx_hook(sock * sk)
358 359 360 361
{
  struct ospf_iface *ifa;
  struct proto *p;

362
  ifa = (struct ospf_iface *) (sk->data);
363

364
  p = (struct proto *) (ifa->proto);
Ondřej Filip's avatar
Ondřej Filip committed
365
  DBG("%s: TX_Hook called on interface %s\n", p->name, sk->iface->name);
366 367 368
}

void
Ondřej Filip's avatar
Ondřej Filip committed
369
ospf_err_hook(sock * sk, int err UNUSED)
370 371 372 373
{
  struct ospf_iface *ifa;
  struct proto *p;

374
  ifa = (struct ospf_iface *) (sk->data);
375

376
  p = (struct proto *) (ifa->proto);
Ondřej Filip's avatar
Ondřej Filip committed
377
  DBG("%s: Err_Hook called on interface %s\n", p->name, sk->iface->name);
378 379
}

380
void
381
ospf_send_to_agt(sock * sk, struct ospf_iface *ifa, u8 state)
382 383 384
{
  struct ospf_neighbor *n;

Ondřej Filip's avatar
Ondřej Filip committed
385
  WALK_LIST(NODE n, ifa->neigh_list) if (n->state >= state)
386
    ospf_send_to(sk, n->ip, ifa);
387
}
388 389

void
390
ospf_send_to_bdr(sock * sk, struct ospf_iface *ifa)
391
{
392
  if (!ipa_equal(ifa->drip, IPA_NONE))
393
    ospf_send_to(sk, ifa->drip, ifa);
394
  if (!ipa_equal(ifa->bdrip, IPA_NONE))
395
    ospf_send_to(sk, ifa->bdrip, ifa);
396
}
Ondřej Filip's avatar
Ondřej Filip committed
397 398

void
399
ospf_send_to(sock *sk, ip_addr ip, struct ospf_iface *ifa)
Ondřej Filip's avatar
Ondřej Filip committed
400
{
401
  struct ospf_packet *pkt = (struct ospf_packet *) sk->tbuf;
402
  int len = ntohs(pkt->length) + ((ifa->autype == OSPF_AUTH_CRYPT) ? OSPF_AUTH_CRYPT_SIZE : 0);
403 404 405 406 407 408
  ospf_pkt_finalize(ifa, pkt);

  if (ipa_equal(ip, IPA_NONE))
    sk_send(sk, len);
  else
    sk_send_to(sk, len, ip, OSPF_PROTO);
Ondřej Filip's avatar
Ondřej Filip committed
409 410
}