text: /*
   *  $Id: libnet_build_802.2.c,v 1.11 2004/04/13 17:32:28 mike Exp $
   *
   *  libnet
   *  libnet_build_802.2.c - 802.2 packet assembler
   *
   *  Copyright (c) 1998 - 2004 Mike D. Schiffman <mike@infonexus.com>
   *  All rights reserved.
   *
   * Redistribution and use in source and binary forms, with or without
   * modification, are permitted provided that the following conditions
   * are met:
   * 1. Redistributions of source code must retain the above copyright
   *    notice, this list of conditions and the following disclaimer.
   * 2. Redistributions in binary form must reproduce the above copyright
   *    notice, this list of conditions and the following disclaimer in the
   *    documentation and/or other materials provided with the distribution.
   *
   * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
   * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
   * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
   * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
   * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
   * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
   * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
   * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
   * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
   * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
   * SUCH DAMAGE.
   *
   */
  
  #include "common.h"
  
  libnet_ptag_t
  libnet_build_802_2(uint8_t dsap, uint8_t ssap, uint8_t control, 
  const uint8_t *payload, uint32_t payload_s, libnet_t *l, libnet_ptag_t ptag)
  {
      uint32_t n, h;
      libnet_pblock_t *p;
      struct libnet_802_2_hdr _802_2_hdr;
  
      if (l == NULL)
      { 
          return (-1);
      } 
  
      n = LIBNET_802_2_H + payload_s;
      h = 0;
   
      /*
       *  Find the existing protocol block if a ptag is specified, or create
       *  a new one.
       */
      p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_802_2_H);
      if (p == NULL)
      {
          return (-1);
      }
  
      memset(&_802_2_hdr, 0, sizeof(_802_2_hdr));
      _802_2_hdr.llc_dsap = dsap;
      _802_2_hdr.llc_ssap = ssap;
      _802_2_hdr.llc_control = control;
  
      n = libnet_pblock_append(l, p, (uint8_t *)&_802_2_hdr, LIBNET_802_2_H);
      if (n == (uint32_t)-1)
      {
          goto bad;
      }
  
      /* boilerplate payload sanity check / append macro */
      LIBNET_DO_PAYLOAD(l, p);
  
      return (ptag ? ptag : libnet_pblock_update(l, p, h,
              LIBNET_PBLOCK_802_2_H));
  bad:
      libnet_pblock_delete(l, p);
      return (-1);
  }
  
  libnet_ptag_t
  libnet_build_802_2snap(uint8_t dsap, uint8_t ssap, uint8_t control,
  uint8_t *oui, uint16_t type, const uint8_t *payload, uint32_t payload_s,
  libnet_t *l, libnet_ptag_t ptag)
  {
      uint32_t n, h;
      libnet_pblock_t *p;
      struct libnet_802_2snap_hdr _802_2_hdr;
  
      if (l == NULL)
      { 
          return (-1);
      } 
  
      n = LIBNET_802_2SNAP_H + payload_s;
      h = 0;
   
      /*
       *  Find the existing protocol block if a ptag is specified, or create
       *  a new one.
       */
      p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_802_2SNAP_H);
      if (p == NULL)
      {
          return (-1);
      }
  
      memset(&_802_2_hdr, 0, sizeof(_802_2_hdr));
      _802_2_hdr.snap_dsap = dsap;
      _802_2_hdr.snap_ssap = ssap;
      _802_2_hdr.snap_control = control;
      memcpy(_802_2_hdr.snap_oui, oui, 3);
      _802_2_hdr.snap_type = htons(type);
  
      n = libnet_pblock_append(l, p, (uint8_t *)&_802_2_hdr, LIBNET_802_2SNAP_H);
      if (n == -1)
      {
          goto bad;
      }
  
      /* boilerplate payload sanity check / append macro */
      LIBNET_DO_PAYLOAD(l, p);
   
      return (ptag ? ptag : libnet_pblock_update(l, p, h,
              LIBNET_PBLOCK_802_2SNAP_H));
  bad:
      libnet_pblock_delete(l, p);
      return (-1);
  }
  
  
  /* EOF */
  