grub/net/ieee1275/interface.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;
  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 not yet implemented.\n"); 
    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; 
}