void udp_get_FF(){
struct finsFrame ff;
UDP_InputQueue_Read_local(&ff);
udpStat.totalRecieved++;
if(ff.dataOrCtrl == CONTROL){
// send to something to deal with FCF
}
if(ff.dataOrCtrl == DATA && ff.dataFrame.directionFlag == UP){
udp_in(&ff);
}
if(ff.dataOrCtrl == DATA && ff.dataFrame.directionFlag == DOWN){
udp_out(&ff);
}
}
process netin(void) {
status retval; /* return value from function */
recv_packets = 0; /* initialize */
netbufpool = mkbufpool(PACKLEN, UDP_SLOTS * UDP_QSIZ +
ICMP_SLOTS * ICMP_QSIZ + ICMP_OQSIZ + 1);
if (netbufpool == SYSERR) {
kprintf("Cannot allocate network buffer pool");
kill(getpid());
}
/* Copy Ethernet address to global variable */
control(ETHER0, ETH_CTRL_GET_MAC, (int32)NetData.ethaddr, 0);
/* Indicate that IP address, mask, and router are not yet valid */
NetData.ipvalid = FALSE;
NetData.ipaddr = 0;
NetData.addrmask = 0;
NetData.routeraddr = 0;
/* Initialize ARP cache */
arp_init();
/* Initialize UDP table */
udp_init();
currpkt = (struct netpacket *)getbuf(netbufpool);
/* Do forever: read packets from the network and process */
//kprintf("[netin]: start to read packets\r\n");
while(1) {
retval = read(ETHER0, (char *)currpkt, PACKLEN);
if (retval == SYSERR) {
panic("Ethernet read error");
}
/* Convert Ethernet Type to host order */
eth_ntoh(currpkt);
/* Demultiplex on Ethernet type */
switch (currpkt->net_ethtype) {
case ETH_ARP:
arp_in(); /* Handle an ARP packet */
continue;
case ETH_IP:
/* Convert IP packet to host order */
if (ipcksum(currpkt) != 0) {
kprintf("checksum failed\n\r");
continue;
}
if (currpkt->net_ipvh != 0x45) {
kprintf("version failed\n\r");
continue;
}
/* Convert IP packet to host byte order */
ip_ntoh(currpkt);
if ( (currpkt->net_ipdst != IP_BCAST) &&
(NetData.ipvalid) &&
(currpkt->net_ipdst != NetData.ipaddr) ) {
continue;
}
/* Demultiplex UDP and ignore others */
if (currpkt->net_ipproto == IP_UDP) {
//kprintf("[netin]: UDP# %d\r\n", ++recv_packets);
udp_in();/* Handle a UDP packet */
}
continue;
default: /* Ignore all other Ethernet types */
kprintf("\n");
continue;
}
}
}
process netin(void) {
status retval; /* return value from function */
int i=0;
struct ipv4_packet* ippkt = NULL;
/*
* FIXME : This might now work
*/
netbufpool = mkbufpool(PACKLEN, UDP_SLOTS * UDP_QSIZ +
ICMP_SLOTS * ICMP_QSIZ + ICMP_OQSIZ + 1);
if (netbufpool == SYSERR) {
kprintf("Cannot allocate network buffer pool");
kill(getpid());
}
/* Copy Ethernet address to global variable */
control(ETHER0, ETH_CTRL_GET_MAC, (int32)NetData.ethaddr, 0);
/* Indicate that IP address, mask, and router are not yet valid */
NetData.ipvalid = FALSE;
NetData.ipaddr = 0;
NetData.addrmask = 0;
NetData.routeraddr = 0;
kprintf("My Mac is : %06x\r\n", *(NetData.ethaddr+4));
/* Initialize ARP cache */
arp_init();
/* Initialize UDP table */
udp_init();
currpkt = (struct eth_packet *)getbuf(netbufpool);
/* Do forever: read packets from the network and process */
while(1) {
retval = read(ETHER0, (char *)currpkt, PACKLEN);
if (retval == SYSERR) {
panic("Ethernet read error");
}
/* Convert Ethernet Type to host order */
eth_ntoh(currpkt);
/* Demultiplex on Ethernet type */
switch (currpkt->net_ethtype) {
case ETH_ARP:
arp_in(); /* Handle an ARP packet */
continue;
case ETH_IP:
//kprintf("Ip packet received \r\n");
ippkt = (struct ipv4_packet *)(currpkt->net_ethdata);
if (ipcksum(ippkt) != 0) {
kprintf("checksum failed\n\r");
continue;
}
if (ippkt->net_ipvh != 0x45) {
kprintf("version failed\n\r");
continue;
}
/* Convert IP packet to host order */
ip_ntoh(ippkt);
if ( (ippkt->net_ipdst != IP_BCAST) &&
(NetData.ipvalid) &&
(ippkt->net_ipdst != NetData.ipaddr) ) {
continue;
}
/* Demultiplex UDP and ignore others */
if (ippkt->net_ipproto == IP_UDP) {
udp_in();/* Handle a UDP packet */
}else if (ippkt->net_ipproto == IP_ICMP){
kprintf("ICMP Packet \r\n");
icmp_in();/* Handle ICMP packet */
}
continue;
case 0x1000:
#ifdef DEBUG
kprintf("Received a simulator packet\r\n");
#endif
wait(rpl_sim_write_sem);
memcpy((char *)&sim_queue[i], currpkt->net_ethdata, sizeof(struct rpl_sim_packet));
#ifdef DEBUG
kprintf("Netin working with iter [%d] message type : %d dest : %04x source : %04x\r\n",i, sim_queue[i].msg_type, *((uint32 *)(sim_queue[i].dest_node)), *((uint32 *)(sim_queue[i].src_node)));
#endif
signal(rpl_sim_read_sem);
i = (i+1)%RPL_SIM_RECV_QUEUE_LEN;
continue;
default: /* Ignore all other Ethernet types */
continue;
}
}
}
