net.c

Go to the documentation of this file.

/*! \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 <stdint.h>
#include "global.h"
#include "rprintf.h"

#include "net.h"

uint16_t htons(uint16_t val)
{
    return ((val<<8) | ((val>>8)&0xFF))&0x0000FFFF;
/*
    int tmp;
 
    __asm __volatile(
        "and    %1, %2, #0xff\n"
        "mov    %0, %2, lsr #8\n"
        "orr    %0, %0, %1, lsl #8"
    : "=r" (v), "=r" (tmp)
    : "r" (v));
 
    return (v);
*/
}

uint32_t htonl(uint32_t val)
{
//  return (htons(val>>16) | (uint32_t)htons(val&0x0000FFFF)<<16);
/*  return (((val&0xFF000000)>>24) |
            ((val&0x00FF0000)>>8)  |
            ((val&0x0000FF00)<<8)  |
            ((val&0x000000FF)<<24) );
*/
    int tmp;
 
    __asm __volatile(
        "eor    %1, %2, %2, ror #16\n"
        "bic    %1, %1, #0x00ff0000\n"
        "mov    %0, %2, ror #8\n"
        "eor    %0, %0, %1, lsr #8"
    : "=r" (val), "=r" (tmp)
    : "r" (val));
 
    return (val);
}


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(htons(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();
}
*/

---