Subversion Repositories openrisc

/*

 * Copyright (c) 2001-2004 Swedish Institute of Computer Science.

 * All rights reserved.

 *

 * Redistribution and use in source and binary forms, with or without modification,

 * are permitted provided that the following conditions are met:

 *

 * 1. Redistributions of source code must retain the above copyright notice,

 *    this list of conditions and the following disclaimer.

 * 2. Redistributions in binary form must reproduce the above copyright notice,

 *    this list of conditions and the following disclaimer in the documentation

 *    and/or other materials provided with the distribution.

 * 3. The name of the author may not be used to endorse or promote products

 *    derived from this software without specific prior written permission.

 *

 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED

 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF

 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT

 * SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,

 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT

 * OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS

 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN

 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING

 * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY

 * OF SUCH DAMAGE.

 *

 * This file is part of the lwIP TCP/IP stack.

 *

 * Author: Adam Dunkels <adam@sics.se>

 *

 */

/* lwIP includes. */

#include <string.h>

#include "lwip/opt.h"

#include "lwip/def.h"

#include "lwip/mem.h"

#include "lwip/pbuf.h"

#include "lwip/sys.h"

#include <lwip/stats.h>

#include "netif/etharp.h"

/* FreeRTOS includes. */

#include "FreeRTOS.h"

#include "SAM7_EMAC.h"

#include "Emac.h"

#define netifMTU                                                        ( 1500 )

#define netifINTERFACE_TASK_STACK_SIZE          ( 350 )

#define netifINTERFACE_TASK_PRIORITY            ( configMAX_PRIORITIES - 1 )

#define netifGUARD_BLOCK_TIME                           ( 250 )

#define IFNAME0 'e'

#define IFNAME1 'm'

/* lwIP definitions. */

struct ethernetif

{

        struct eth_addr *ethaddr;

};

static const struct eth_addr    ethbroadcast = { { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff } };

static struct netif *xNetIf = NULL;

/* Forward declarations. */

static void ethernetif_input( void * );

static err_t ethernetif_output( struct netif *netif, struct pbuf *p, struct ip_addr *ipaddr );

err_t ethernetif_init( struct netif *netif );

/*-----------------------------------------------------------*/

static void low_level_init( struct netif *netif )

{

unsigned portBASE_TYPE uxPriority;

        /* set MAC hardware address length */

        netif->hwaddr_len = 6;

        /* set MAC hardware address */

        netif->hwaddr[0] = emacETHADDR0;

        netif->hwaddr[1] = emacETHADDR1;

        netif->hwaddr[2] = emacETHADDR2;

        netif->hwaddr[3] = emacETHADDR3;

        netif->hwaddr[4] = emacETHADDR4;

        netif->hwaddr[5] = emacETHADDR5;

        /* maximum transfer unit */

        netif->mtu = netifMTU;

        /* broadcast capability */

        netif->flags = NETIF_FLAG_BROADCAST;

        xNetIf = netif;

        /* Initialise the EMAC.  This routine contains code that polls status bits.

        If the Ethernet cable is not plugged in then this can take a considerable

        time.  To prevent this starving lower priority tasks of processing time we

        lower our priority prior to the call, then raise it back again once the

        initialisation is complete. */

        uxPriority = uxTaskPriorityGet( NULL );

        vTaskPrioritySet( NULL, tskIDLE_PRIORITY );

        while( xEMACInit() == NULL )

        {

                __asm( "NOP" );

        }

        vTaskPrioritySet( NULL, uxPriority );

        /* Create the task that handles the EMAC. */

        xTaskCreate( ethernetif_input, ( signed char * ) "ETH_INT", netifINTERFACE_TASK_STACK_SIZE, NULL, netifINTERFACE_TASK_PRIORITY, NULL );

}

/*-----------------------------------------------------------*/

/*

 * low_level_output(): Should do the actual transmission of the packet. The

 * packet is contained in the pbuf that is passed to the function. This pbuf

 * might be chained.

 */

static err_t low_level_output( struct netif *netif, struct pbuf *p )

{

struct pbuf *q;

static xSemaphoreHandle xTxSemaphore = NULL;

err_t xReturn = ERR_OK;

        /* Parameter not used. */

        ( void ) netif;

        if( xTxSemaphore == NULL )

        {

                vSemaphoreCreateBinary( xTxSemaphore );

        }

        #if ETH_PAD_SIZE

                pbuf_header( p, -ETH_PAD_SIZE );    /* drop the padding word */

        #endif

        /* Access to the EMAC is guarded using a semaphore. */

        if( xSemaphoreTake( xTxSemaphore, netifGUARD_BLOCK_TIME ) )

        {

                for( q = p; q != NULL; q = q->next )

                {

                        /* Send the data from the pbuf to the interface, one pbuf at a

                        time. The size of the data in each pbuf is kept in the ->len

                        variable.  if q->next == NULL then this is the last pbuf in the

                        chain. */

                        if( !lEMACSend( q->payload, q->len, ( q->next == NULL ) ) )

                        {

                                xReturn = ~ERR_OK;

                        }

                }

        xSemaphoreGive( xTxSemaphore );

        }

        #if ETH_PAD_SIZE

                pbuf_header( p, ETH_PAD_SIZE );     /* reclaim the padding word */

        #endif

        #if LINK_STATS

                lwip_stats.link.xmit++;

        #endif /* LINK_STATS */

    return xReturn;

}

/*-----------------------------------------------------------*/

/*

 * low_level_input(): Should allocate a pbuf and transfer the bytes of the

 * incoming packet from the interface into the pbuf.

 */

static struct pbuf *low_level_input( struct netif *netif )

{

struct pbuf         *p = NULL, *q;

u16_t               len = 0;

static xSemaphoreHandle xRxSemaphore = NULL;

        /* Parameter not used. */

        ( void ) netif;

        if( xRxSemaphore == NULL )

        {

                vSemaphoreCreateBinary( xRxSemaphore );

        }

        /* Access to the emac is guarded using a semaphore. */

        if( xSemaphoreTake( xRxSemaphore, netifGUARD_BLOCK_TIME ) )

        {

                /* Obtain the size of the packet. */

                len = ulEMACInputLength();

                if( len )

                {

                        #if ETH_PAD_SIZE

                                len += ETH_PAD_SIZE;    /* allow room for Ethernet padding */

                        #endif

                        /* We allocate a pbuf chain of pbufs from the pool. */

                        p = pbuf_alloc( PBUF_RAW, len, PBUF_POOL );

                        if( p != NULL )

                        {

                                #if ETH_PAD_SIZE

                                        pbuf_header( p, -ETH_PAD_SIZE );    /* drop the padding word */

                                #endif

                                /* Let the driver know we are going to read a new packet. */

                                vEMACRead( NULL, 0, len );

                                /* We iterate over the pbuf chain until we have read the entire

                                packet into the pbuf. */

                                for( q = p; q != NULL; q = q->next )

                                {

                                        /* Read enough bytes to fill this pbuf in the chain. The

                                        available data in the pbuf is given by the q->len variable. */

                                        vEMACRead( q->payload, q->len, len );

                                }

                                #if ETH_PAD_SIZE

                                        pbuf_header( p, ETH_PAD_SIZE );     /* reclaim the padding word */

                                #endif

                                #if LINK_STATS

                                        lwip_stats.link.recv++;

                                #endif /* LINK_STATS */

                        }

                        else

                        {

                                #if LINK_STATS

                                        lwip_stats.link.memerr++;

                                        lwip_stats.link.drop++;

                                #endif /* LINK_STATS */

                        }

                }

                xSemaphoreGive( xRxSemaphore );

        }

        return p;

}

/*-----------------------------------------------------------*/

/*

 * ethernetif_output(): This function is called by the TCP/IP stack when an

 * IP packet should be sent. It calls the function called low_level_output()

 * to do the actual transmission of the packet.

 */

static err_t ethernetif_output( struct netif *netif, struct pbuf *p, struct ip_addr *ipaddr )

{

    /* resolve hardware address, then send (or queue) packet */

    return etharp_output( netif, ipaddr, p );

}

/*-----------------------------------------------------------*/

/*

 * ethernetif_input(): This function should be called when a packet is ready to

 * be read from the interface. It uses the function low_level_input() that

 * should handle the actual reception of bytes from the network interface.

 */

static void ethernetif_input( void * pvParameters )

{

struct ethernetif   *ethernetif;

struct eth_hdr      *ethhdr;

struct pbuf         *p;

        ( void ) pvParameters;

        for( ;; )

        {

                do

                {

                        ethernetif = xNetIf->state;

                        /* move received packet into a new pbuf */

                        p = low_level_input( xNetIf );

                        if( p == NULL )

                        {

                                /* No packet could be read.  Wait a for an interrupt to tell us

                                there is more data available. */

                                vEMACWaitForInput();

                        }

                } while( p == NULL );

                /* points to packet payload, which starts with an Ethernet header */

                ethhdr = p->payload;

                #if LINK_STATS

                        lwip_stats.link.recv++;

                #endif /* LINK_STATS */

                ethhdr = p->payload;

                switch( htons( ethhdr->type ) )

                {

                        /* IP packet? */

                        case ETHTYPE_IP:

                                /* update ARP table */

                                etharp_ip_input( xNetIf, p );

                                /* skip Ethernet header */

                                pbuf_header( p, (s16_t)-sizeof(struct eth_hdr) );

                                /* pass to network layer */

                                xNetIf->input( p, xNetIf );

                                break;

                        case ETHTYPE_ARP:

                                /* pass p to ARP module */

                                etharp_arp_input( xNetIf, ethernetif->ethaddr, p );

                                break;

                        default:

                                pbuf_free( p );

                                p = NULL;

                                break;

                }

        }

}

/*-----------------------------------------------------------*/

static void arp_timer( void *arg )

{

        ( void ) arg;

    etharp_tmr();

    sys_timeout( ARP_TMR_INTERVAL, arp_timer, NULL );

}

/*-----------------------------------------------------------*/

err_t ethernetif_init( struct netif *netif )

{

struct ethernetif   *ethernetif;

        ethernetif = mem_malloc( sizeof(struct ethernetif) );

        if( ethernetif == NULL )

        {

                LWIP_DEBUGF( NETIF_DEBUG, ("ethernetif_init: out of memory\n") );

                return ERR_MEM;

        }

        netif->state = ethernetif;

        netif->name[0] = IFNAME0;

        netif->name[1] = IFNAME1;

        netif->output = ethernetif_output;

        netif->linkoutput = low_level_output;

        ethernetif->ethaddr = ( struct eth_addr * ) &( netif->hwaddr[0] );

        low_level_init( netif );

        etharp_init();

        sys_timeout( ARP_TMR_INTERVAL, arp_timer, NULL );

        return ERR_OK;

}