118 lines
2.8 KiB
C
118 lines
2.8 KiB
C
#include <grub/net/ip.h>
|
|
#include <grub/misc.h>
|
|
#include <grub/net/arp.h>
|
|
#include <grub/net/udp.h>
|
|
#include <grub/net/ethernet.h>
|
|
#include <grub/net.h>
|
|
#include <grub/net/netbuff.h>
|
|
#include <grub/mm.h>
|
|
|
|
grub_uint16_t
|
|
ipchksum (void *ipv, int len)
|
|
{
|
|
grub_uint16_t *ip = (grub_uint16_t *) ipv;
|
|
grub_uint32_t sum = 0;
|
|
|
|
len >>= 1;
|
|
while (len--)
|
|
{
|
|
sum += grub_be_to_cpu16 (*(ip++));
|
|
if (sum > 0xFFFF)
|
|
sum -= 0xFFFF;
|
|
}
|
|
|
|
return grub_cpu_to_be16 ((~sum) & 0x0000FFFF);
|
|
}
|
|
|
|
grub_err_t
|
|
grub_net_send_ip_packet (struct grub_net_network_level_interface * inf,
|
|
const grub_net_network_level_address_t * target,
|
|
struct grub_net_buff * nb)
|
|
{
|
|
struct iphdr *iph;
|
|
static int id = 0x2400;
|
|
grub_net_link_level_address_t ll_target_addr;
|
|
grub_err_t err;
|
|
|
|
grub_netbuff_push (nb, sizeof (*iph));
|
|
iph = (struct iphdr *) nb->data;
|
|
|
|
iph->verhdrlen = ((4 << 4) | 5);
|
|
iph->service = 0;
|
|
iph->len = grub_cpu_to_be16 (nb->tail - nb->data);
|
|
iph->ident = grub_cpu_to_be16 (++id);
|
|
iph->frags = 0;
|
|
iph->ttl = 0xff;
|
|
iph->protocol = 0x11;
|
|
iph->src = inf->address.ipv4;
|
|
iph->dest = target->ipv4;
|
|
|
|
iph->chksum = 0;
|
|
iph->chksum = ipchksum ((void *) nb->data, sizeof (*iph));
|
|
|
|
/* Determine link layer target address via ARP. */
|
|
err = grub_net_arp_resolve (inf, target, &ll_target_addr);
|
|
if (err)
|
|
return err;
|
|
return send_ethernet_packet (inf, nb, ll_target_addr,
|
|
GRUB_NET_ETHERTYPE_IP);
|
|
}
|
|
|
|
grub_err_t
|
|
grub_net_recv_ip_packets (struct grub_net_buff * nb,
|
|
const struct grub_net_card * card,
|
|
const grub_net_link_level_address_t * hwaddress)
|
|
{
|
|
struct iphdr *iph = (struct iphdr *) nb->data;
|
|
grub_err_t err;
|
|
struct grub_net_network_level_interface *inf;
|
|
|
|
err = grub_netbuff_pull (nb, sizeof (*iph));
|
|
if (err)
|
|
return err;
|
|
|
|
FOR_NET_NETWORK_LEVEL_INTERFACES (inf)
|
|
{
|
|
if (inf->card == card
|
|
&& inf->address.type == GRUB_NET_NETWORK_LEVEL_PROTOCOL_IPV4
|
|
&& inf->address.ipv4 == iph->dest
|
|
&& grub_net_hwaddr_cmp (&inf->hwaddress, hwaddress) == 0)
|
|
break;
|
|
}
|
|
if (!inf)
|
|
{
|
|
FOR_NET_NETWORK_LEVEL_INTERFACES (inf)
|
|
if (inf->card == card
|
|
&& inf->address.type == GRUB_NET_NETWORK_LEVEL_PROTOCOL_PROMISC
|
|
&& grub_net_hwaddr_cmp (&inf->hwaddress, hwaddress) == 0)
|
|
break;
|
|
}
|
|
if (!inf)
|
|
{
|
|
if (iph->protocol == IP_UDP
|
|
&& grub_net_hwaddr_cmp (&card->default_address, hwaddress) == 0)
|
|
{
|
|
struct udphdr *udph;
|
|
udph = (struct udphdr *) nb->data;
|
|
err = grub_netbuff_pull (nb, sizeof (*udph));
|
|
if (err)
|
|
return err;
|
|
if (grub_be_to_cpu16 (udph->dst) == 68)
|
|
grub_net_process_dhcp (nb, card);
|
|
}
|
|
grub_netbuff_free (nb);
|
|
return GRUB_ERR_NONE;
|
|
}
|
|
|
|
switch (iph->protocol)
|
|
{
|
|
case IP_UDP:
|
|
return grub_net_recv_udp_packet (nb, inf);
|
|
break;
|
|
default:
|
|
grub_netbuff_free (nb);
|
|
break;
|
|
}
|
|
|
|
return GRUB_ERR_NONE;
|
|
}
|