Annotation of embedaddon/libnet/src/libnet_build_cdp.c, revision 1.1
1.1 ! misho 1: /*
! 2: * $Id: libnet_build_cdp.c,v 1.9 2004/01/21 19:01:29 mike Exp $
! 3: *
! 4: * libnet
! 5: * libnet_build_cdp.c - CDP packet assembler
! 6: *
! 7: * Copyright (c) 1998 - 2004 Mike D. Schiffman <mike@infonexus.com>
! 8: * All rights reserved.
! 9: *
! 10: * Redistribution and use in source and binary forms, with or without
! 11: * modification, are permitted provided that the following conditions
! 12: * are met:
! 13: * 1. Redistributions of source code must retain the above copyright
! 14: * notice, this list of conditions and the following disclaimer.
! 15: * 2. Redistributions in binary form must reproduce the above copyright
! 16: * notice, this list of conditions and the following disclaimer in the
! 17: * documentation and/or other materials provided with the distribution.
! 18: *
! 19: * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
! 20: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
! 21: * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
! 22: * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
! 23: * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
! 24: * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
! 25: * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
! 26: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
! 27: * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
! 28: * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
! 29: * SUCH DAMAGE.
! 30: *
! 31: */
! 32:
! 33: #if (HAVE_CONFIG_H)
! 34: #include "../include/config.h"
! 35: #endif
! 36: #if (!(_WIN32) || (__CYGWIN__))
! 37: #include "../include/libnet.h"
! 38: #else
! 39: #include "../include/win32/libnet.h"
! 40: #endif
! 41:
! 42: libnet_ptag_t
! 43: libnet_build_cdp(u_int8_t version, u_int8_t ttl, u_int16_t sum, u_int16_t type,
! 44: u_int16_t len, u_int8_t *value, u_int8_t *payload, u_int32_t payload_s,
! 45: libnet_t *l, libnet_ptag_t ptag)
! 46: {
! 47: u_int32_t n,h;
! 48: libnet_pblock_t *p;
! 49: struct libnet_cdp_hdr cdp_hdr;
! 50:
! 51: if (l == NULL)
! 52: {
! 53: return (-1);
! 54: }
! 55:
! 56: n = LIBNET_CDP_H + len + payload_s;
! 57: h = LIBNET_CDP_H + len + payload_s;
! 58:
! 59: /*
! 60: * Find the existing protocol block if a ptag is specified, or create
! 61: * a new one.
! 62: */
! 63: p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_CDP_H);
! 64: if (p == NULL)
! 65: {
! 66: return (-1);
! 67: }
! 68:
! 69: memset(&cdp_hdr, 0, sizeof(cdp_hdr));
! 70: cdp_hdr.cdp_version = version;
! 71: cdp_hdr.cdp_ttl = ttl;
! 72: cdp_hdr.cdp_sum = (sum ? htons(sum) : 0);
! 73: cdp_hdr.cdp_type = htons(type);
! 74: cdp_hdr.cdp_len = htons(len + 4); /* 4 bytes for len and type */
! 75:
! 76: n = libnet_pblock_append(l, p, (u_int8_t *)&cdp_hdr, LIBNET_CDP_H);
! 77: if (n == -1)
! 78: {
! 79: goto bad;
! 80: }
! 81:
! 82: n = libnet_pblock_append(l, p, value, len);
! 83: if (n == -1)
! 84: {
! 85: /* err msg set in libnet_pblock_append() */
! 86: goto bad;
! 87: }
! 88:
! 89: if ((payload && !payload_s) || (!payload && payload_s))
! 90: {
! 91: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
! 92: "%s(): payload inconsistency\n", __func__);
! 93: goto bad;
! 94: }
! 95:
! 96: if (payload && payload_s)
! 97: {
! 98: n = libnet_pblock_append(l, p, payload, payload_s);
! 99: if (n == -1)
! 100: {
! 101: goto bad;
! 102: }
! 103: }
! 104:
! 105: if (sum == 0)
! 106: {
! 107: /*
! 108: * If checksum is zero, by default libnet will compute a checksum
! 109: * for the user. The programmer can override this by calling
! 110: * libnet_toggle_checksum(l, ptag, 1);
! 111: */
! 112: libnet_pblock_setflags(p, LIBNET_PBLOCK_DO_CHECKSUM);
! 113: }
! 114: return (ptag ? ptag : libnet_pblock_update(l, p, h, LIBNET_PBLOCK_CDP_H));
! 115: bad:
! 116: libnet_pblock_delete(l, p);
! 117: return (-1);
! 118: }
! 119:
! 120:
! 121: int
! 122: /* Not Yet Implemented */
! 123: libnet_build_cdp_value(u_int16_t type, u_int16_t len, u_int8_t *value, libnet_t *l,
! 124: libnet_ptag_t ptag)
! 125: {
! 126: u_int32_t n;
! 127: libnet_pblock_t *p;
! 128: struct libnet_cdp_value_hdr cdp_value_hdr;
! 129:
! 130: if (l == NULL)
! 131: {
! 132: return (-1);
! 133: }
! 134:
! 135: /*
! 136: * Find the existing protocol block.
! 137: */
! 138: p = libnet_pblock_find(l, ptag);
! 139: if (p == NULL)
! 140: {
! 141: /* err msg set in libnet_pblock_find */
! 142: return (-1);
! 143: }
! 144: if (p->type != LIBNET_PBLOCK_CDP_H)
! 145: {
! 146: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
! 147: "libnet_build_cdp_value: ptag references different type than expected");
! 148: return (-1);
! 149: }
! 150:
! 151: memset(&cdp_value_hdr, 0, sizeof(cdp_value_hdr));
! 152: cdp_value_hdr.cdp_type = htons(type);
! 153: cdp_value_hdr.cdp_len = htons(len + 4); /* 4 bytes for len and type */
! 154:
! 155: switch (type)
! 156: {
! 157: case LIBNET_CDP_DEVID:
! 158: break;
! 159: case LIBNET_CDP_ADDRESS:
! 160: break;
! 161: case LIBNET_CDP_PORTID:
! 162: break;
! 163: case LIBNET_CDP_CAPABIL:
! 164: break;
! 165: case LIBNET_CDP_VERSION:
! 166: break;
! 167: case LIBNET_CDP_PLATFORM:
! 168: break;
! 169: case LIBNET_CDP_IPPREFIX:
! 170: break;
! 171: default:
! 172: break;
! 173: }
! 174:
! 175: n = libnet_pblock_append(l, p, (u_int8_t *)&cdp_value_hdr, LIBNET_CDP_H);
! 176: if (n == -1)
! 177: {
! 178: return (-1);
! 179: }
! 180:
! 181: n = libnet_pblock_append(l, p, value, len);
! 182: if (n == -1)
! 183: {
! 184: /* err msg set in libnet_pblock_append() */
! 185: return (-1);
! 186: }
! 187:
! 188: return (1);
! 189: }
! 190:
! 191: /* EOF */
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>