Annotation of embedaddon/libnet/src/libnet_build_802.2.c, revision 1.1
1.1 ! misho 1: /*
! 2: * $Id: libnet_build_802.2.c,v 1.10 2004/01/28 19:45:00 mike Exp $
! 3: *
! 4: * libnet
! 5: * libnet_build_802.2.c - 802.2 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_802_2(u_int8_t dsap, u_int8_t ssap, u_int8_t control,
! 44: u_int8_t *payload, u_int32_t payload_s, libnet_t *l, libnet_ptag_t ptag)
! 45: {
! 46: u_int32_t n, h;
! 47: libnet_pblock_t *p;
! 48: struct libnet_802_2_hdr _802_2_hdr;
! 49:
! 50: if (l == NULL)
! 51: {
! 52: return (-1);
! 53: }
! 54:
! 55: n = LIBNET_802_2_H + payload_s;
! 56: h = 0;
! 57:
! 58: /*
! 59: * Find the existing protocol block if a ptag is specified, or create
! 60: * a new one.
! 61: */
! 62: p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_802_2_H);
! 63: if (p == NULL)
! 64: {
! 65: return (-1);
! 66: }
! 67:
! 68: memset(&_802_2_hdr, 0, sizeof(_802_2_hdr));
! 69: _802_2_hdr.llc_dsap = dsap;
! 70: _802_2_hdr.llc_ssap = ssap;
! 71: _802_2_hdr.llc_control = control;
! 72:
! 73: n = libnet_pblock_append(l, p, (u_int8_t *)&_802_2_hdr, LIBNET_802_2_H);
! 74: if (n == -1)
! 75: {
! 76: goto bad;
! 77: }
! 78:
! 79: if ((payload && !payload_s) || (!payload && payload_s))
! 80: {
! 81: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
! 82: "%s(): payload inconsistency\n", __func__);
! 83: goto bad;
! 84: }
! 85:
! 86: if (payload && payload_s)
! 87: {
! 88: n = libnet_pblock_append(l, p, payload, payload_s);
! 89: if (n == -1)
! 90: {
! 91: goto bad;
! 92: }
! 93: }
! 94:
! 95: return (ptag ? ptag : libnet_pblock_update(l, p, h,
! 96: LIBNET_PBLOCK_802_2_H));
! 97: bad:
! 98: libnet_pblock_delete(l, p);
! 99: return (-1);
! 100: }
! 101:
! 102:
! 103: libnet_ptag_t
! 104: libnet_build_802_2snap(u_int8_t dsap, u_int8_t ssap, u_int8_t control, u_int8_t *oui,
! 105: u_int16_t type, u_int8_t *payload, u_int32_t payload_s, libnet_t *l,
! 106: libnet_ptag_t ptag)
! 107: {
! 108: u_int32_t n, h;
! 109: libnet_pblock_t *p;
! 110: struct libnet_802_2snap_hdr _802_2_hdr;
! 111:
! 112: if (l == NULL)
! 113: {
! 114: return (-1);
! 115: }
! 116:
! 117: n = LIBNET_802_2SNAP_H + payload_s;
! 118: h = 0;
! 119:
! 120: /*
! 121: * Find the existing protocol block if a ptag is specified, or create
! 122: * a new one.
! 123: */
! 124: p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_802_2SNAP_H);
! 125: if (p == NULL)
! 126: {
! 127: return (-1);
! 128: }
! 129:
! 130: memset(&_802_2_hdr, 0, sizeof(_802_2_hdr));
! 131: _802_2_hdr.snap_dsap = dsap;
! 132: _802_2_hdr.snap_ssap = ssap;
! 133: _802_2_hdr.snap_control = control;
! 134: memcpy(_802_2_hdr.snap_oui, oui, 3);
! 135: _802_2_hdr.snap_type = htons(type);
! 136:
! 137: n = libnet_pblock_append(l, p, (u_int8_t *)&_802_2_hdr, LIBNET_802_2SNAP_H);
! 138: if (n == -1)
! 139: {
! 140: goto bad;
! 141: }
! 142:
! 143: if ((payload && !payload_s) || (!payload && payload_s))
! 144: {
! 145: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
! 146: "%s(): payload inconsistency\n", __func__);
! 147: goto bad;
! 148: }
! 149:
! 150: if (payload && payload_s)
! 151: {
! 152: n = libnet_pblock_append(l, p, payload, payload_s);
! 153: if (n == -1)
! 154: {
! 155: goto bad;
! 156: }
! 157: }
! 158:
! 159: return (ptag ? ptag : libnet_pblock_update(l, p, h,
! 160: LIBNET_PBLOCK_802_2SNAP_H));
! 161: bad:
! 162: libnet_pblock_delete(l, p);
! 163: return (-1);
! 164: }
! 165:
! 166:
! 167: /* EOF */
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/icons/cvsweb/back.gif){kind=icon}
Return to libnet_build_802.2.c CVS log ![[TXT]](/icons/cvsweb/text.gif){kind=icon}
![[DIR]](/icons/cvsweb/dir.gif){kind=icon}
Up to [ELWIX - Embedded LightWeight unIX -] / embedaddon / libnet / src