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>

 *

 */

/*

 * This file is a skeleton for developing Ethernet network interface

 * drivers for lwIP. Add code to the low_level functions and do a

 * search-and-replace for the word "ethernetif" to replace it with

 * something that better describes your network interface.

 */

#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 "conf_eth.h"

#include "netif/etharp.h"

/* FreeRTOS includes. */

#include "FreeRTOS.h"

#include "macb.h"

#define netifMTU              ( 1500 )

#define netifGUARD_BLOCK_TIME       ( 250 )

#define IFNAME0 'e'

#define IFNAME1 'm'

struct ethernetif {

  struct eth_addr *ethaddr;

  /* Add whatever per-interface state that is needed here. */

};

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

/* Forward declarations. */

void  ethernetif_input(void * );

static err_t ethernetif_output(struct netif *netif, struct pbuf *p,

             struct ip_addr *ipaddr);

static struct netif *xNetIf = NULL;

static void

low_level_init(struct netif *netif)

{

//  struct ethernetif *ethernetif = netif->state;

  unsigned portBASE_TYPE uxPriority;

  /* maximum transfer unit */

  netif->mtu = netifMTU;

  /* broadcast capability */

  netif->flags = NETIF_FLAG_BROADCAST;

  /* Do whatever else is needed to initialize interface. */

  xNetIf = netif;

  /* Initialise the MACB.  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( xMACBInit(&AVR32_MACB) == FALSE )

  {

    __asm__ __volatile__ ( "nop" );

  }

  vTaskPrioritySet( NULL, uxPriority );

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

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

  sys_thread_new( ethernetif_input, NULL, netifINTERFACE_TASK_PRIORITY );

}

/*

 * 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 MACB 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( !lMACBSend(&AVR32_MACB, 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;

struct pbuf         *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 = ulMACBInputLength();

    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. */

        vMACBRead( 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. */

          vMACBRead( 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.

 *

 */

void ethernetif_input( void * pvParameters )

{

struct ethernetif   *ethernetif;

struct eth_hdr      *ethhdr;

struct pbuf         *p;

  ( void ) pvParameters;

  for( ;; )  {

    ethernetif = xNetIf->state;

    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. */

        vMACBWaitForInput(100);

      }

    } 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)

{

  etharp_tmr();

  sys_timeout(ARP_TMR_INTERVAL, arp_timer, NULL);

}

/*

 * ethernetif_init():

 *

 * Should be called at the beginning of the program to set up the

 * network interface. It calls the function low_level_init() to do the

 * actual setup of the hardware.

 *

 */

extern struct netif MACB_if;

err_t

ethernetif_init(struct netif *netif)

{

  struct ethernetif *ethernetif;

  int i;

  ethernetif = (struct 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;

  for(i = 0; i < 6; i++) netif->hwaddr[i] = MACB_if.hwaddr[i];

  low_level_init(netif);

  etharp_init();

  sys_timeout(ARP_TMR_INTERVAL, arp_timer, NULL);

  return ERR_OK;

}