90 lines
2.2 KiB
C
90 lines
2.2 KiB
C
#include <grub/misc.h>
|
|
#include <grub/mm.h>
|
|
#include <grub/net/ethernet.h>
|
|
#include <grub/net/ip.h>
|
|
#include <grub/net/arp.h>
|
|
#include <grub/net/netbuff.h>
|
|
#include <grub/net.h>
|
|
#include <grub/time.h>
|
|
#include <grub/net/arp.h>
|
|
|
|
grub_err_t
|
|
send_ethernet_packet (struct grub_net_network_level_interface *inf,
|
|
struct grub_net_buff *nb,
|
|
grub_net_link_level_address_t target_addr,
|
|
grub_uint16_t ethertype)
|
|
{
|
|
struct etherhdr *eth;
|
|
grub_err_t err;
|
|
|
|
err = grub_netbuff_push (nb, sizeof (*eth));
|
|
if (err)
|
|
return err;
|
|
eth = (struct etherhdr *) nb->data;
|
|
grub_memcpy (eth->dst, target_addr.mac, 6);
|
|
grub_memcpy (eth->src, inf->hwaddress.mac, 6);
|
|
|
|
eth->type = grub_cpu_to_be16 (ethertype);
|
|
if (!inf->card->opened)
|
|
{
|
|
err = GRUB_ERR_NONE;
|
|
if (inf->card->driver->open)
|
|
err = inf->card->driver->open (inf->card);
|
|
if (err)
|
|
return err;
|
|
inf->card->opened = 1;
|
|
}
|
|
return inf->card->driver->send (inf->card, nb);
|
|
}
|
|
|
|
grub_err_t
|
|
grub_net_recv_ethernet_packet (struct grub_net_buff * nb,
|
|
const struct grub_net_card * card)
|
|
{
|
|
struct etherhdr *eth;
|
|
struct llchdr *llch;
|
|
struct snaphdr *snaph;
|
|
grub_uint16_t type;
|
|
grub_net_link_level_address_t hwaddress;
|
|
grub_err_t err;
|
|
|
|
eth = (struct etherhdr *) nb->data;
|
|
type = grub_be_to_cpu16 (eth->type);
|
|
err = grub_netbuff_pull (nb, sizeof (*eth));
|
|
if (err)
|
|
return err;
|
|
|
|
if (type <= 1500)
|
|
{
|
|
llch = (struct llchdr *) nb->data;
|
|
type = llch->dsap & LLCADDRMASK;
|
|
|
|
if (llch->dsap == 0xaa && llch->ssap == 0xaa && llch->ctrl == 0x3)
|
|
{
|
|
err = grub_netbuff_pull (nb, sizeof (*llch));
|
|
if (err)
|
|
return err;
|
|
snaph = (struct snaphdr *) nb->data;
|
|
type = snaph->type;
|
|
}
|
|
}
|
|
|
|
hwaddress.type = GRUB_NET_LINK_LEVEL_PROTOCOL_ETHERNET;
|
|
grub_memcpy (hwaddress.mac, eth->dst, sizeof (hwaddress.mac));
|
|
|
|
/* ARP packet. */
|
|
if (type == GRUB_NET_ETHERTYPE_ARP)
|
|
{
|
|
grub_net_arp_receive (nb);
|
|
grub_netbuff_free (nb);
|
|
return GRUB_ERR_NONE;
|
|
}
|
|
/* IP packet. */
|
|
if (type == GRUB_NET_ETHERTYPE_IP)
|
|
{
|
|
grub_net_recv_ip_packets (nb, card, &hwaddress);
|
|
return GRUB_ERR_NONE;
|
|
}
|
|
grub_netbuff_free (nb);
|
|
return GRUB_ERR_NONE;
|
|
}
|