int
main(int argc, char *argv[])
{
int c, len, index;
libnet_t *l;
libnet_ptag_t t;
u_char *value;
u_char values[100];
u_short tmp;
char errbuf[LIBNET_ERRBUF_SIZE];
u_int8_t oui[3] = { 0x00, 0x00, 0x0c };
u_int8_t cdp_mac[6] = {0x01, 0x0, 0xc, 0xcc, 0xcc, 0xcc};
if (argc != 3)
{
fprintf(stderr, "usage %s device device-id\n", argv[0]);
return (EXIT_FAILURE);
}
fprintf(stderr, "cdppoke...\n");
l = libnet_init(LIBNET_LINK, argv[1], errbuf);
if (l == NULL)
{
fprintf(stderr, "libnet_init() failed: %s", errbuf);
return (EXIT_FAILURE);
}
/* build the TLV's by hand until we get something better */
memset(values, 0, sizeof(values));
index = 0;
tmp = htons(LIBNET_CDP_VERSION);
memcpy(values, &tmp, 2);
index += 2;
tmp = htons(9); /* length of string below plus type and length fields */
memcpy(values + index, &tmp, 2);
index += 2;
memcpy(values + index, (u_char *)"1.1.1", 5);
index += 5;
/* this TLV is handled by the libnet builder */
value = argv[2];
len = strlen(argv[2]);
/* build CDP header */
t = libnet_build_cdp(
1, /* version */
30, /* time to live */
0x0, /* checksum */
0x1, /* type */
len, /* length */
value, /* value */
values, /* payload */
index, /* payload size */
l, /* libnet context */
0); /* libnet ptag */
if (t == -1)
{
fprintf(stderr, "Can't build CDP header: %s\n", libnet_geterror(l));
goto bad;
}
/* build 802.2 header */
t = libnet_build_802_2snap(
LIBNET_SAP_SNAP, /* SAP SNAP code */
LIBNET_SAP_SNAP, /* SAP SNAP code */
0x03, /* control */
oui, /* OUI */
0x2000, /* upper layer protocol type */
NULL, /* payload */
0, /* payload size */
l, /* libnet context */
0); /* libnet ptag */
if (t == -1)
{
fprintf(stderr, "Can't build SNAP header: %s\n", libnet_geterror(l));
goto bad;
}
/* build 802.3 header */
t = libnet_build_802_3(
cdp_mac, /* ethernet destination */
(u_int8_t *)libnet_get_hwaddr(l), /* ethernet source */
LIBNET_802_2_H + LIBNET_802_2SNAP_H + LIBNET_CDP_H, /* packet len */
NULL, /* payload */
0, /* payload size */
l, /* libnet context */
0); /* libnet ptag */
if (t == -1)
{
fprintf(stderr, "Can't build 802.3 header: %s\n", libnet_geterror(l));
goto bad;
}
/* write the packet out */
c = libnet_write(l);
if (c == -1)
{
fprintf(stderr, "Write error: %s\n", libnet_geterror(l));
goto bad;
}
else
{
fprintf(stderr, "Wrote %d byte CDP frame \"%s\"\n", c, argv[2]);
}
libnet_destroy(l);
return (EXIT_SUCCESS);
bad:
libnet_destroy(l);
return (EXIT_FAILURE);
}
int libnet_gen_l2_packet(struct packet_desc *packet_vars, libnet_t *l) {
libnet_ptag_t t;
char *payload;
u_short payload_s;
u_char *cp, oui[3];
u_short priority, cfi;
u_short frame_type;
int is_llc_snap, is_arp, is_802_3;
u_short len_proto;
/* TMP CODE ONLY TO TEST OTHER LAYERS */
if (packet_vars->l2_pkt_type == 0) {
printf("***TEST PROGRAM ERROR !! \n");
return(-1);
}
is_llc_snap = is_arp = is_802_3 = 0;
payload = NULL;
payload_s = 0;
if (packet_vars->l2_len) {
payload = genPayload(packet_vars->payload.data_type,
packet_vars->payload.data_seed,
packet_vars->l2_len);
payload_s = packet_vars->l2_len;
} else {
payload = NULL;
payload_s = 0;
}
frame_type = 0;
if (packet_vars->l3_pkt_type) {
if (packet_vars->l3_pkt_type & L3_PKT_TYPE_IPV4) {
frame_type = ETHERTYPE_IP;
} else if (packet_vars->l3_pkt_type & L3_PKT_TYPE_IPV6) {
frame_type = ETHERTYPE_IPV6;
} else {
frame_type = 0;
}
printf("L3 protocol chosen - %x\n", frame_type);
} else if (packet_vars->l2_pkt_type & L2_PKT_TYPE_ARP) {
frame_type = ETHERTYPE_ARP;
} else if (packet_vars->l2_pkt_type & L2_PKT_TYPE_RARP) {
frame_type = ETHERTYPE_REVARP;
#if 0 /* Needs to be implemented to support user defined frame types */
} else if (packet_vars->ether.proto) {
frame_type = packet_vars->ether.proto;
#endif
} else {
is_802_3 = 1;
}
if ((packet_vars->l2_pkt_type & L2_PKT_TYPE_ARP) ||
(packet_vars->l2_pkt_type & L2_PKT_TYPE_RARP)) {
printf("---Generating ARP/RARP header \n");
t = libnet_build_arp(packet_vars->arp.hw_type,
packet_vars->arp.proto_type,
packet_vars->arp.hw_len,
packet_vars->arp.proto_len,
packet_vars->arp.op_code,
packet_vars->arp.src_ha,
packet_vars->arp.src_ip,
packet_vars->arp.tgt_ha,
packet_vars->arp.tgt_ip,
payload, /* payload */
payload_s, /* payload size */
l, /* libnet handle */
0); /* libnet id */
if (t == -1) {
fprintf(stderr, "***Can't build ARP header: %s\n",
libnet_geterror(l));
return (NULL);
}
payload = NULL;
payload_s = 0;
is_arp = 1;
}
if (packet_vars->l2_pkt_type & L2_PKT_TYPE_LLCSNAP) {
memset(&oui, 0, 3);
printf("---Generating LLC header \n");
t = libnet_build_802_2snap (
0xaa, /* SNAP DSAP */
0xaa, /* SNAP SSAP */
0x3, /* control */
oui, /* oui */
frame_type, /* protocol */
payload, /* payload */
payload_s, /* payload size */
l, /* libnet handle */
0); /* libnet id */
if (t == -1) {
fprintf(stderr, "***Can't build LLC SNAP header: "
"%s\n", libnet_geterror(l));
return(NULL);
}
payload = NULL;
payload_s = 0;
is_llc_snap = 1;
}
if(packet_vars->payload.error_code & PG_TYPE_LEN_USER_MODE) {
len_proto = (packet_vars->payload.error_data & 0xffff0000)>>16;
}else if(packet_vars->payload.error_code & PG_TYPE_LEN_ERR) {
int
main(int argc, char *argv[])
{
int c, len, do_802_2;
u_long i;
libnet_t *l;
libnet_ptag_t t;
u_char *dst, *src, oui[3];
char *device = NULL;
char errbuf[LIBNET_ERRBUF_SIZE];
printf("libnet 1.1 packet shaping: ieee[802.1q / 802.2 / ARP]\n");
do_802_2 = 0;
device = NULL;
src = dst = NULL;
while ((c = getopt(argc, argv, "8d:i:s:")) != EOF)
{
switch (c)
{
case '8':
do_802_2 = 1;
break;
case 'd':
dst = libnet_hex_aton(optarg, &len);
break;
case 'i':
device = optarg;
break;
case 's':
src = libnet_hex_aton(optarg, &len);
break;
}
}
if (src == NULL || dst == NULL)
{
fprintf(stderr, "usage %s -d dst -s src [-8 ] [-i interface]\n",
argv[0]);
exit(EXIT_FAILURE);
}
/*
* Initialize the library. Root priviledges are required.
*/
l = libnet_init(
LIBNET_LINK, /* injection type */
device, /* network interface */
errbuf); /* errbuf */
if (l == NULL)
{
fprintf(stderr, "libnet_init() failed: %s", errbuf);
exit(EXIT_FAILURE);
}
i = libnet_get_ipaddr4(l);
t = libnet_build_arp(
ARPHRD_ETHER, /* hardware addr */
ETHERTYPE_IP, /* protocol addr */
6, /* hardware addr size */
4, /* protocol addr size */
ARPOP_REPLY, /* operation type */
src, /* sender hardware addr */
(u_char *)&i, /* sender protocol addr */
dst, /* target hardware addr */
(u_char *)&i, /* target protocol addr */
NULL, /* payload */
0, /* payload size */
l, /* libnet handle */
0); /* libnet id */
if (t == -1)
{
fprintf(stderr, "Can't build ARP header: %s\n", libnet_geterror(l));
goto bad;
}
if (do_802_2)
{
memset(&oui, 0, 3);
t = libnet_build_802_2snap(
0xaa, /* SNAP DSAP */
0xaa, /* SNAP SSAP */
0, /* control */
oui, /* oui */
ETHERTYPE_ARP, /* ARP header follows */
NULL, /* payload */
0, /* payload size */
l, /* libnet handle */
0); /* libnet id */
if (t == -1)
{
fprintf(stderr, "Can't build 802.2 header: %s\n", libnet_geterror(l));
goto bad;
}
}
t = libnet_build_802_1q(
dst, /* dest mac */
src, /* source mac */
ETHERTYPE_VLAN, /* TPI */
0x006, /* priority (0 - 7) */
0x001, /* CFI flag */
0x100, /* vid (0 - 4095) */
do_802_2 ? LIBNET_802_2SNAP_H + LIBNET_ARP_ETH_IP_H : 0x0806,
NULL, /* payload */
0, /* payload size */
l, /* libnet handle */
0); /* libnet id */
if (t == -1)
{
fprintf(stderr, "Can't build 802.1q header: %s\n", libnet_geterror(l));
goto bad;
}
/*
* Write it to the wire.
*/
c = libnet_write(l);
if (c == -1)
{
fprintf(stderr, "Write error: %s\n", libnet_geterror(l));
goto bad;
}
else
{
fprintf(stderr, "Wrote %d byte 802.1q packet; check the wire.\n", c);
}
free(dst);
free(src);
libnet_destroy(l);
return (EXIT_SUCCESS);
bad:
free(dst);
free(src);
libnet_destroy(l);
return (EXIT_FAILURE);
}
