108 lines
2.9 KiB
C
108 lines
2.9 KiB
C
#include <grub/net/ieee1275/interface.h>
|
|
#include <grub/time.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/ieee1275/ofnet.h>
|
|
|
|
static grub_ieee1275_ihandle_t handle;
|
|
int card_open (void)
|
|
{
|
|
|
|
grub_ieee1275_open (grub_net->dev , &handle);
|
|
return 0;
|
|
|
|
}
|
|
|
|
int card_close (void)
|
|
{
|
|
|
|
if (handle)
|
|
grub_ieee1275_close (handle);
|
|
return 0;
|
|
}
|
|
|
|
|
|
int send_card_buffer (struct grub_net_buff *pack)
|
|
{
|
|
|
|
int actual;
|
|
//grub_printf("packet size transmited: %d\n",pack->tail - pack->data);
|
|
grub_ieee1275_write (handle,pack->data,pack->tail - pack->data,&actual);
|
|
// grub_printf("actual transmited %d\n",actual);
|
|
|
|
return actual;
|
|
}
|
|
|
|
int get_card_packet (struct grub_net_buff *pack __attribute__ ((unused)))
|
|
{
|
|
|
|
int actual;
|
|
char *datap;
|
|
struct iphdr *iph;
|
|
struct etherhdr *eth;
|
|
struct arphdr *arph;
|
|
struct ip6hdr *ip6h;
|
|
pack->data = pack->tail = pack->head;
|
|
datap = pack->data;
|
|
do
|
|
{
|
|
grub_ieee1275_read (handle,datap,sizeof (*eth),&actual);
|
|
// if (actual <= 0)
|
|
// grub_millisleep(10);
|
|
|
|
}while (actual <= 0);
|
|
eth = (struct etherhdr *) datap;
|
|
datap += sizeof(*eth);
|
|
|
|
// grub_printf("ethernet eth->dst %x:%x:%x:%x:%x:%x\n",eth->dst[0],
|
|
// eth->dst[1],eth->dst[2],eth->dst[3],eth->dst[4],eth->dst[5]);
|
|
// grub_printf("ethernet eth->src %x:%x:%x:%x:%x:%x\n",eth->src[0],eth->src[1],
|
|
// eth->src[2],eth->src[3],eth->src[4],eth->src[5]);
|
|
// grub_printf ("eth.type 0x%x\n",eth->type);
|
|
|
|
switch (eth->type)
|
|
{
|
|
case 0x806:
|
|
|
|
grub_ieee1275_read (handle,datap,sizeof (*arph),&actual);
|
|
arph = (struct arphdr *) datap;
|
|
|
|
grub_netbuff_put (pack,sizeof (*eth) + sizeof (*arph));
|
|
break;
|
|
case 0x800:
|
|
grub_ieee1275_read (handle,datap,sizeof (*iph),&actual);
|
|
iph = (struct iphdr *) datap;
|
|
datap += sizeof(*iph);
|
|
|
|
// grub_printf("ip.src 0x%x\n",iph->src);
|
|
// grub_printf("ip.dst 0x%x\n",iph->dest);
|
|
// grub_printf("ip.len 0x%x\n",iph->len);
|
|
// grub_printf("ip.protocol 0x%x\n",iph->protocol);
|
|
|
|
grub_ieee1275_read (handle,datap,iph->len - sizeof (*iph),&actual);
|
|
|
|
|
|
grub_netbuff_put (pack,sizeof (*eth) + iph->len);
|
|
break;
|
|
|
|
case 0x86DD:
|
|
grub_printf("!!!!!!!!!!!!!!!!!IPV6 packet received!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!\n");
|
|
grub_ieee1275_read (handle,datap,sizeof (*ip6h),&actual);
|
|
ip6h = (struct ip6hdr *) datap;
|
|
grub_printf("ip6hdr->payload_len = %x\n",ip6h->payload_len);
|
|
grub_printf("ip6hdr->nexthdr = %x\n",ip6h->nexthdr);
|
|
|
|
datap += sizeof(*ip6h);
|
|
grub_ieee1275_read (handle,datap,ip6h->payload_len - sizeof (*ip6h),&actual);
|
|
break;
|
|
|
|
default:
|
|
grub_printf("Unknow packet %x\n",eth->type);
|
|
break;
|
|
}
|
|
// grub_printf("packsize %d\n",pack->tail - pack->data);
|
|
return 0;// sizeof (eth) + iph.len;
|
|
}
|