* $Id: libnet_build_stp.c,v 1.19 2005/11/29 22:49:48 carlosc Exp $
* libnet_build_stp.c - STP packet assembler
* Copyright (c) 1998 - 2004 Mike D. Schiffman <mike@infonexus.com>
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* 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
#include "../include/config.h"
#if (!(_WIN32) || (__CYGWIN__))
#include "../include/libnet.h"
#include "../include/win32/libnet.h"
libnet_build_stp_conf(u_int16_t id
, u_int8_t version
, u_int8_t bpdu_type
,
u_int8_t flags
, u_int8_t
*root_id
, u_int32_t root_pc
, u_int8_t
*bridge_id
,
u_int16_t port_id
, u_int16_t message_age
, u_int16_t max_age
,
u_int16_t hello_time
, u_int16_t f_delay
, u_int8_t
*payload
,
u_int32_t payload_s
, libnet_t
*l
, libnet_ptag_t ptag
)
/* until we get some data marshalling in place we can't use this */
/* struct libnet_stp_conf_hdr stp_hdr; */
n
= LIBNET_STP_CONF_H
+ payload_s
; /* size of memory block */
* Find the existing protocol block if a ptag is specified, or create
p
= libnet_pblock_probe(l
, ptag
, n
, LIBNET_PBLOCK_STP_CONF_H
);
/* until we get some data marshalling in place we can't use this */
stp_hdr.stp_id = htons(id);
stp_hdr.stp_version = version;
stp_hdr.stp_bpdu_type = bpdu_type;
stp_hdr.stp_flags = flags;
memcpy(&stp_hdr.stp_rootid, root_id, 8);
stp_hdr.stp_rootpc = htonl(root_pc);
memcpy(&stp_hdr.stp_bridgeid, bridge_id, 8);
stp_hdr.stp_portid = htons(port_id);
stp_hdr.stp_mage = htons(message_age);
stp_hdr.stp_maxage = htons(max_age);
stp_hdr.stp_hellot = htons(hello_time);
stp_hdr.stp_fdelay = htons(f_delay);
memcpy(stp_hdr
, &value_s
, 2);
memcpy(&stp_hdr
[5], root_id
, 8);
value_l
= htonl(root_pc
);
memcpy(&stp_hdr
[13], &value_l
, 4);
memcpy(&stp_hdr
[17], bridge_id
, 8);
value_s
= htons(port_id
);
memcpy(&stp_hdr
[25], &value_s
, 2);
#if (LIBNET_BIG_ENDIAN == 1)
value_s
= htons(message_age
);
memcpy(&stp_hdr
[27], &value_s
, 2);
#if (LIBNET_BIG_ENDIAN == 1)
value_s
= htons(max_age
);
memcpy(&stp_hdr
[29], &value_s
, 2);
#if (LIBNET_BIG_ENDIAN == 1)
value_s
= htons(hello_time
);
memcpy(&stp_hdr
[31], &value_s
, 2);
#if (LIBNET_BIG_ENDIAN == 1)
value_s
= htons(f_delay
);
memcpy(&stp_hdr
[33], &value_s
, 2);
/* until we get some data marshalling in place we can't use this */
/*n = libnet_pblock_append(l, p, (u_int8_t *)&stp_hdr, LIBNET_STP_CONF_H); */
n
= libnet_pblock_append(l
, p
, stp_hdr
, LIBNET_STP_CONF_H
);
if ((payload
&& !payload_s
) || (!payload
&& payload_s
))
snprintf(l
->err_buf
, LIBNET_ERRBUF_SIZE
,
"%s(): payload inconsistency\n", __func__
);
if (payload
&& payload_s
)
n
= libnet_pblock_append(l
, p
, payload
, payload_s
);
return (ptag
? ptag
: libnet_pblock_update(l
, p
, h
,
LIBNET_PBLOCK_STP_CONF_H
));
libnet_pblock_delete(l
, p
);
libnet_build_stp_tcn(u_int16_t id
, u_int8_t version
, u_int8_t bpdu_type
,
u_int8_t
*payload
, u_int32_t payload_s
, libnet_t
*l
, libnet_ptag_t ptag
)
struct libnet_stp_tcn_hdr stp_hdr
;
n
= LIBNET_STP_TCN_H
+ payload_s
; /* size of memory block */
* Find the existing protocol block if a ptag is specified, or create
p
= libnet_pblock_probe(l
, ptag
, n
, LIBNET_PBLOCK_STP_TCN_H
);
memset(&stp_hdr
, 0, sizeof(stp_hdr
));
stp_hdr
.stp_id
= htons(id
);
stp_hdr
.stp_version
= version
;
stp_hdr
.stp_bpdu_type
= bpdu_type
;
n
= libnet_pblock_append(l
, p
, (u_int8_t
*)&stp_hdr
, LIBNET_STP_TCN_H
);
if ((payload
&& !payload_s
) || (!payload
&& payload_s
))
snprintf(l
->err_buf
, LIBNET_ERRBUF_SIZE
,
"%s(): payload inconsistency\n", __func__
);
if (payload
&& payload_s
)
n
= libnet_pblock_append(l
, p
, payload
, payload_s
);
return (ptag
? ptag
: libnet_pblock_update(l
, p
, h
,
LIBNET_PBLOCK_STP_TCN_H
));
libnet_pblock_delete(l
, p
);