tlv.c revision 1.1 1 1.1 kefren /* $NetBSD: tlv.c,v 1.1 2010/12/08 07:20:15 kefren Exp $ */
2 1.1 kefren
3 1.1 kefren /*-
4 1.1 kefren * Copyright (c) 2010 The NetBSD Foundation, Inc.
5 1.1 kefren * All rights reserved.
6 1.1 kefren *
7 1.1 kefren * This code is derived from software contributed to The NetBSD Foundation
8 1.1 kefren * by Mihai Chelaru <kefren (at) NetBSD.org>
9 1.1 kefren *
10 1.1 kefren * Redistribution and use in source and binary forms, with or without
11 1.1 kefren * modification, are permitted provided that the following conditions
12 1.1 kefren * are met:
13 1.1 kefren * 1. Redistributions of source code must retain the above copyright
14 1.1 kefren * notice, this list of conditions and the following disclaimer.
15 1.1 kefren * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 kefren * notice, this list of conditions and the following disclaimer in the
17 1.1 kefren * documentation and/or other materials provided with the distribution.
18 1.1 kefren *
19 1.1 kefren * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.1 kefren * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 kefren * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 kefren * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.1 kefren * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.1 kefren * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.1 kefren * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.1 kefren * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 kefren * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 kefren * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 kefren * POSSIBILITY OF SUCH DAMAGE.
30 1.1 kefren */
31 1.1 kefren
32 1.1 kefren #include <sys/stat.h>
33 1.1 kefren
34 1.1 kefren #include <stdlib.h>
35 1.1 kefren #include <strings.h>
36 1.1 kefren #include <stdio.h>
37 1.1 kefren
38 1.1 kefren #include "ldp.h"
39 1.1 kefren #include "fsm.h"
40 1.1 kefren #include "ldp_errors.h"
41 1.1 kefren #include "tlv.h"
42 1.1 kefren
43 1.1 kefren /* Reads and checks a tlv struct from a buffer */
44 1.1 kefren struct hello_tlv *
45 1.1 kefren get_hello_tlv(unsigned char *s, uint max)
46 1.1 kefren {
47 1.1 kefren struct hello_tlv *t;
48 1.1 kefren
49 1.1 kefren /* Do we have at least Type + Length + MSG_ID ? */
50 1.1 kefren if (max <= TLV_TYPE_LENGTH + MSGID_SIZE)
51 1.1 kefren return NULL;
52 1.1 kefren
53 1.1 kefren t = (struct hello_tlv *) s;
54 1.1 kefren
55 1.1 kefren if (ntohs(t->type) != LDP_HELLO)
56 1.1 kefren return NULL;
57 1.1 kefren
58 1.1 kefren /* Does its size fit into max ? */
59 1.1 kefren if (ntohs(t->length) + TLV_TYPE_LENGTH > max)
60 1.1 kefren return NULL;
61 1.1 kefren
62 1.1 kefren t->type = ntohs(t->type);
63 1.1 kefren t->length = ntohs(t->length);
64 1.1 kefren t->messageid = ntohl(t->messageid);
65 1.1 kefren return t;
66 1.1 kefren /* We don't check for Common Hello Params here */
67 1.1 kefren }
68 1.1 kefren
69 1.1 kefren /* Prints out some information about TLV */
70 1.1 kefren void
71 1.1 kefren debug_tlv(struct tlv * t)
72 1.1 kefren {
73 1.1 kefren warnp("TLV type %.4X, Length %d, Message ID %.8X\n", ntohs(t->type),
74 1.1 kefren ntohs(t->length), ntohs(t->messageid));
75 1.1 kefren }
76