net.c

国外牛人公开的ＡＶＲ代码

/*! \file net.c \brief Network support library. */
//*****************************************************************************
//
// File Name	: 'net.c'
// Title		: Network support library
// Author		: Pascal Stang
// Created		: 8/30/2004
// Revised		: 7/3/2005
// Version		: 0.1
// Target MCU	: Atmel AVR series
// Editor Tabs	: 4
//
//*****************************************************************************

#include <inttypes.h>
#include "global.h"
#include "rprintf.h"

#include "net.h"

uint16_t htons(uint16_t val)
{
	return (val<<8) | (val>>8);
}

uint32_t htonl(uint32_t val)
{
	return (htons(val>>16) | (uint32_t)htons(val&0x0000FFFF)<<16);
}


uint16_t netChecksum(void *data, uint16_t len)
{
    register uint32_t sum = 0;

    for (;;) {
        if (len < 2)
            break;
		//sum += *((uint16_t *)data)++;
		sum += *((uint16_t *)data);
		data+=2;
        len -= 2;
    }
    if (len)
        sum += *(uint8_t *) data;

    while ((len = (uint16_t) (sum >> 16)) != 0)
        sum = (uint16_t) sum + len;

    return (uint16_t) sum ^ 0xFFFF;
}

void netPrintEthAddr(struct netEthAddr* ethaddr)
{
	rprintfu08(ethaddr->addr[0]);
	rprintfChar(':');
	rprintfu08(ethaddr->addr[1]);
	rprintfChar(':');
	rprintfu08(ethaddr->addr[2]);
	rprintfChar(':');
	rprintfu08(ethaddr->addr[3]);
	rprintfChar(':');
	rprintfu08(ethaddr->addr[4]);
	rprintfChar(':');
	rprintfu08(ethaddr->addr[5]);
}

void netPrintIPAddr(uint32_t ipaddr)
{
	rprintf("%d.%d.%d.%d",
		((unsigned char*)&ipaddr)[3],
		((unsigned char*)&ipaddr)[2],
		((unsigned char*)&ipaddr)[1],
		((unsigned char*)&ipaddr)[0]);
}

/*
void netPrintEthHeader(struct netEthHeader* eth_hdr)
{
	rprintfProgStrM("Eth Packet Type: 0x");
	rprintfu16(eth_hdr->type);

	rprintfProgStrM(" SRC:");
	netPrintEthAddr(&eth_hdr->src);
	rprintfProgStrM("->DST:");
	netPrintEthAddr(&eth_hdr->dest);
	rprintfCRLF();
}

void netPrintIpHeader(struct netIpHeader* ipheader)
{
	rprintfProgStrM("IP Header\r\n");
	rprintf("Ver     : %d\r\n", (ipheader->vhl)>>4);
	rprintf("Length  : %d\r\n", htons(ipheader->len));
	if(ipheader->proto == IP_PROTO_ICMP)
		rprintfProgStrM("Protocol: ICMP\r\n");
	else if(ipheader->proto == IP_PROTO_TCP)
		rprintfProgStrM("Protocol: TCP\r\n");
	else if(ipheader->proto == IP_PROTO_UDP)
		rprintfProgStrM("Protocol: UDP\r\n");
	else
		rprintf("Protocol: %d\r\n", ipheader->proto);
	
	rprintfProgStrM("SourceIP: "); netPrintIPAddr(htonl(ipheader->srcipaddr));	rprintfCRLF();
	rprintfProgStrM("Dest  IP: "); netPrintIPAddr(htonl(ipheader->destipaddr));	rprintfCRLF();
}

void netPrintTcpHeader(struct netTcpHeader* tcpheader)
{
	rprintfProgStrM("TCP Header\r\n");
	rprintf("Src Port: %d\r\n", htons(tcpheader->srcport));
	rprintf("Dst Port: %d\r\n", htons(tcpheader->destport));
	rprintfProgStrM("Seq Num : 0x"); rprintfu32(htonl(tcpheader->seqno));	rprintfCRLF();
	rprintfProgStrM("Ack Num : 0x"); rprintfu32(htonl(tcpheader->ackno));	rprintfCRLF();
	rprintfProgStrM("Flags   : ");
	if(tcpheader->flags & TCP_FLAGS_FIN)
		rprintfProgStrM("FIN ");
	if(tcpheader->flags & TCP_FLAGS_SYN)
		rprintfProgStrM("SYN ");
	if(tcpheader->flags & TCP_FLAGS_RST)
		rprintfProgStrM("RST ");
	if(tcpheader->flags & TCP_FLAGS_PSH)
		rprintfProgStrM("PSH ");
	if(tcpheader->flags & TCP_FLAGS_ACK)
		rprintfProgStrM("ACK ");
	if(tcpheader->flags & TCP_FLAGS_URG)
		rprintfProgStrM("URG ");
	rprintfCRLF();
}
*/