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); }