static void stdin_process(char c){ switch (c){ case 'p': printf("Connecting to PTS at %s...\n", bd_addr_to_str(pts_addr)); bnep_connect(&packet_handler, pts_addr, bnep_l2cap_psm, bnep_src_uuid, bnep_dest_uuid); break; case 'e': printf("Sending general ethernet packet\n"); send_ethernet_packet(0,0); break; case 'c': printf("Sending compressed ethernet packet\n"); send_ethernet_packet(1,1); break; case 's': printf("Sending src only compressed ethernet packet\n"); send_ethernet_packet(0,1); break; case 'd': printf("Sending dst only ethernet packet\n"); send_ethernet_packet(1,0); break; case 'f': printf("Setting network protocol filter\n"); set_network_protocol_filter(); break; case 'm': printf("Setting multicast filter\n"); set_multicast_filter(); break; case '1': printf("Sending ICMP Ping via IPv4\n"); send_ping_request_ipv4(); break; case '2': printf("Sending ICMP Ping via IPv6\n"); send_ping_request_ipv6(); break; case '4': printf("Sending IPv4 ARP Probe\n"); send_arp_probe_ipv4(); break; case '6': printf("Sending IPv6 ARP Probe\n"); send_ndp_probe_ipv6(); break; case '7': printf("Sending IPv4 LLMNR Request\n"); send_llmnr_request_ipv4(); break; case '8': printf("Sending IPv6 LLMNR Request\n"); send_llmnr_request_ipv6(); break; default: show_usage(); break; } }
grub_err_t grub_net_arp_send_request (struct grub_net_network_level_interface *inf, const grub_net_network_level_address_t *proto_addr) { struct grub_net_buff nb; struct arphdr *arp_header; grub_net_link_level_address_t target_hw_addr; grub_uint8_t *aux, arp_data[128]; grub_err_t err; int i; grub_size_t addrlen; grub_uint16_t etherpro; grub_uint8_t *nbd; if (proto_addr->type == GRUB_NET_NETWORK_LEVEL_PROTOCOL_IPV4) { addrlen = 4; etherpro = GRUB_NET_ETHERTYPE_IP; } else return grub_error (GRUB_ERR_BUG, "unsupported address family"); /* Build a request packet. */ nb.head = arp_data; nb.end = arp_data + sizeof (arp_data); grub_netbuff_clear (&nb); grub_netbuff_reserve (&nb, 128); err = grub_netbuff_push (&nb, sizeof (*arp_header) + 2 * (6 + addrlen)); if (err) return err; arp_header = (struct arphdr *) nb.data; arp_header->hrd = grub_cpu_to_be16 (GRUB_NET_ARPHRD_ETHERNET); arp_header->hln = 6; arp_header->pro = grub_cpu_to_be16 (etherpro); arp_header->pln = addrlen; arp_header->op = grub_cpu_to_be16 (ARP_REQUEST); aux = (grub_uint8_t *) arp_header + sizeof (*arp_header); /* Sender hardware address. */ grub_memcpy (aux, &inf->hwaddress.mac, 6); aux += 6; /* Sender protocol address */ grub_memcpy (aux, &inf->address.ipv4, 4); aux += addrlen; /* Target hardware address */ for (i = 0; i < 6; i++) aux[i] = 0x00; aux += 6; /* Target protocol address */ grub_memcpy (aux, &proto_addr->ipv4, 4); grub_memset (&target_hw_addr.mac, 0xff, 6); nbd = nb.data; send_ethernet_packet (inf, &nb, target_hw_addr, GRUB_NET_ETHERTYPE_ARP); for (i = 0; i < GRUB_NET_TRIES; i++) { if (grub_net_link_layer_resolve_check (inf, proto_addr)) return GRUB_ERR_NONE; pending_req = proto_addr->ipv4; have_pending = 0; grub_net_poll_cards (GRUB_NET_INTERVAL, &have_pending); if (grub_net_link_layer_resolve_check (inf, proto_addr)) return GRUB_ERR_NONE; nb.data = nbd; send_ethernet_packet (inf, &nb, target_hw_addr, GRUB_NET_ETHERTYPE_ARP); } return GRUB_ERR_NONE; }
grub_err_t grub_net_arp_receive (struct grub_net_buff *nb, struct grub_net_card *card) { struct arphdr *arp_header = (struct arphdr *) nb->data; grub_uint8_t *sender_hardware_address; grub_uint8_t *target_hardware_address; grub_net_network_level_address_t sender_addr, target_addr; grub_net_link_level_address_t sender_hw_addr; struct grub_net_network_level_interface *inf; grub_uint8_t *sender_protocol_address, *target_protocol_address; sender_hardware_address = (grub_uint8_t *) arp_header + sizeof (*arp_header); sender_protocol_address = sender_hardware_address + arp_header->hln; target_hardware_address = sender_protocol_address + arp_header->pln; target_protocol_address = target_hardware_address + arp_header->hln; if (grub_be_to_cpu16 (arp_header->pro) == GRUB_NET_ETHERTYPE_IP && arp_header->pln == 4) { sender_addr.type = GRUB_NET_NETWORK_LEVEL_PROTOCOL_IPV4; target_addr.type = GRUB_NET_NETWORK_LEVEL_PROTOCOL_IPV4; grub_memcpy (&sender_addr.ipv4, sender_protocol_address, 4); grub_memcpy (&target_addr.ipv4, target_protocol_address, 4); if (grub_memcmp (sender_protocol_address, &pending_req, 4) == 0) have_pending = 1; } else return GRUB_ERR_NONE; sender_hw_addr.type = GRUB_NET_LINK_LEVEL_PROTOCOL_ETHERNET; grub_memcpy (sender_hw_addr.mac, sender_hardware_address, sizeof (sender_hw_addr.mac)); grub_net_link_layer_add_address (card, &sender_addr, &sender_hw_addr, 1); FOR_NET_NETWORK_LEVEL_INTERFACES (inf) { /* Am I the protocol address target? */ if (grub_net_addr_cmp (&inf->address, &target_addr) == 0 && grub_be_to_cpu16 (arp_header->op) == ARP_REQUEST) { grub_net_link_level_address_t target; /* We've already checked that pln is either 4 or 16. */ char tmp[arp_header->pln]; target.type = GRUB_NET_LINK_LEVEL_PROTOCOL_ETHERNET; grub_memcpy (target.mac, sender_hardware_address, 6); grub_memcpy (target_hardware_address, target.mac, 6); grub_memcpy (sender_hardware_address, inf->hwaddress.mac, 6); grub_memcpy (tmp, sender_protocol_address, arp_header->pln); grub_memcpy (sender_protocol_address, target_protocol_address, arp_header->pln); grub_memcpy (target_protocol_address, tmp, arp_header->pln); /* Change operation to REPLY and send packet */ arp_header->op = grub_be_to_cpu16 (ARP_REPLY); send_ethernet_packet (inf, nb, target, GRUB_NET_ETHERTYPE_ARP); } } return GRUB_ERR_NONE; }