707 lines
24 KiB
C
707 lines
24 KiB
C
/*
|
|
* 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>
|
|
*
|
|
*/
|
|
|
|
/*
|
|
* Copyright (c) 2013-2016, Freescale Semiconductor, Inc.
|
|
* Copyright 2016-2020 NXP
|
|
* All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include "lwip/opt.h"
|
|
#include "lwip/def.h"
|
|
#include "lwip/ethip6.h"
|
|
#include "lwip/igmp.h"
|
|
#include "lwip/mem.h"
|
|
#include "lwip/mld6.h"
|
|
#include "lwip/pbuf.h"
|
|
#include "lwip/snmp.h"
|
|
#include "lwip/stats.h"
|
|
#include "lwip/sys.h"
|
|
#include "netif/etharp.h"
|
|
#include "netif/ppp/pppoe.h"
|
|
|
|
#if USE_RTOS && defined(FSL_RTOS_FREE_RTOS)
|
|
#include "FreeRTOS.h"
|
|
#include "event_groups.h"
|
|
#endif
|
|
|
|
#include "enet_ethernetif.h"
|
|
#include "enet_ethernetif_priv.h"
|
|
|
|
#include "fsl_enet.h"
|
|
#include "fsl_phy.h"
|
|
|
|
/*
|
|
* Padding of ethernet frames has to be disabled for zero-copy functionality
|
|
* since ENET driver requires the starting buffer addresses to be aligned.
|
|
*/
|
|
#if ETH_PAD_SIZE != 0
|
|
#error "ETH_PAD_SIZE != 0"
|
|
#endif /* ETH_PAD_SIZE != 0 */
|
|
|
|
/*******************************************************************************
|
|
* Definitions
|
|
******************************************************************************/
|
|
|
|
#ifndef ENET_RXBD_NUM
|
|
#define ENET_RXBD_NUM (5)
|
|
#endif
|
|
|
|
#ifndef ENET_TXBD_NUM
|
|
#define ENET_TXBD_NUM (3)
|
|
#endif
|
|
|
|
#ifndef ENET_RXBUFF_SIZE
|
|
#define ENET_RXBUFF_SIZE ENET_FRAME_MAX_FRAMELEN
|
|
#endif
|
|
|
|
#ifndef ENET_TXBUFF_SIZE
|
|
#define ENET_TXBUFF_SIZE (ENET_FRAME_MAX_FRAMELEN)
|
|
#endif
|
|
|
|
#if defined(FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL) && FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL
|
|
#if defined(FSL_FEATURE_L2CACHE_LINESIZE_BYTE) \
|
|
&& ((!defined(FSL_SDK_DISBLE_L2CACHE_PRESENT)) || (FSL_SDK_DISBLE_L2CACHE_PRESENT == 0))
|
|
#if defined(FSL_FEATURE_L1DCACHE_LINESIZE_BYTE)
|
|
#define FSL_CACHE_LINESIZE_MAX MAX(FSL_FEATURE_L1DCACHE_LINESIZE_BYTE, FSL_FEATURE_L2CACHE_LINESIZE_BYTE)
|
|
#define FSL_ENET_BUFF_ALIGNMENT MAX(ENET_BUFF_ALIGNMENT, FSL_CACHE_LINESIZE_MAX)
|
|
#else
|
|
#define FSL_ENET_BUFF_ALIGNMENT MAX(ENET_BUFF_ALIGNMENT, FSL_FEATURE_L2CACHE_LINESIZE_BYTE)
|
|
#endif
|
|
#elif defined(FSL_FEATURE_L1DCACHE_LINESIZE_BYTE)
|
|
#define FSL_ENET_BUFF_ALIGNMENT MAX(ENET_BUFF_ALIGNMENT, FSL_FEATURE_L1DCACHE_LINESIZE_BYTE)
|
|
#else
|
|
#define FSL_ENET_BUFF_ALIGNMENT ENET_BUFF_ALIGNMENT
|
|
#endif
|
|
#else
|
|
#define FSL_ENET_BUFF_ALIGNMENT ENET_BUFF_ALIGNMENT
|
|
#endif
|
|
|
|
typedef uint8_t rx_buffer_t[SDK_SIZEALIGN(ENET_RXBUFF_SIZE, FSL_ENET_BUFF_ALIGNMENT)];
|
|
typedef uint8_t tx_buffer_t[SDK_SIZEALIGN(ENET_TXBUFF_SIZE, FSL_ENET_BUFF_ALIGNMENT)];
|
|
|
|
/*!
|
|
* @brief Used to wrap received data in a pbuf to be passed into lwIP
|
|
* without copying.
|
|
* Once last reference is released, RX descriptor will be returned to DMA.
|
|
*/
|
|
typedef struct rx_pbuf_wrapper
|
|
{
|
|
struct pbuf_custom p; /*!< Pbuf wrapper. Has to be first. */
|
|
void *buffer; /*!< Original buffer wrapped by p. */
|
|
struct ethernetif *ethernetif; /*!< Ethernet interface context data. */
|
|
} rx_pbuf_wrapper_t;
|
|
|
|
/**
|
|
* Helper struct to hold private data used to operate your ethernet interface.
|
|
*/
|
|
struct ethernetif
|
|
{
|
|
ENET_Type *base;
|
|
#if (defined(FSL_FEATURE_SOC_ENET_COUNT) && (FSL_FEATURE_SOC_ENET_COUNT > 0)) || \
|
|
(USE_RTOS && defined(FSL_RTOS_FREE_RTOS))
|
|
enet_handle_t handle;
|
|
#endif
|
|
#if USE_RTOS && defined(FSL_RTOS_FREE_RTOS)
|
|
EventGroupHandle_t enetTransmitAccessEvent;
|
|
EventBits_t txFlag;
|
|
#endif
|
|
enet_rx_bd_struct_t *RxBuffDescrip;
|
|
enet_tx_bd_struct_t *TxBuffDescrip;
|
|
rx_buffer_t *RxDataBuff;
|
|
tx_buffer_t *TxDataBuff;
|
|
rx_pbuf_wrapper_t RxPbufs[ENET_RXBD_NUM];
|
|
};
|
|
|
|
/*******************************************************************************
|
|
* Prototypes
|
|
******************************************************************************/
|
|
|
|
static void ethernetif_rx_release(struct pbuf *p);
|
|
|
|
/*******************************************************************************
|
|
* Code
|
|
******************************************************************************/
|
|
#if USE_RTOS && defined(FSL_RTOS_FREE_RTOS)
|
|
static void ethernet_callback(ENET_Type *base,
|
|
enet_handle_t *handle,
|
|
#if FSL_FEATURE_ENET_QUEUE > 1
|
|
uint32_t ringId,
|
|
#endif /* FSL_FEATURE_ENET_QUEUE */
|
|
enet_event_t event,
|
|
enet_frame_info_t *frameInfo,
|
|
void *userData)
|
|
{
|
|
struct netif *netif = (struct netif *)userData;
|
|
struct ethernetif *ethernetif = netif->state;
|
|
BaseType_t xResult;
|
|
|
|
|
|
switch (event)
|
|
{
|
|
case kENET_RxEvent:
|
|
ethernetif_input(netif);
|
|
break;
|
|
case kENET_TxEvent:
|
|
{
|
|
portBASE_TYPE taskToWake = pdFALSE;
|
|
|
|
#ifdef __CA7_REV
|
|
if (SystemGetIRQNestingLevel())
|
|
#else
|
|
if (__get_IPSR())
|
|
#endif
|
|
{
|
|
xResult = xEventGroupSetBitsFromISR(ethernetif->enetTransmitAccessEvent, ethernetif->txFlag, &taskToWake);
|
|
if ((pdPASS == xResult) && (pdTRUE == taskToWake))
|
|
{
|
|
portYIELD_FROM_ISR(taskToWake);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
xEventGroupSetBits(ethernetif->enetTransmitAccessEvent, ethernetif->txFlag);
|
|
}
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
#if LWIP_IPV4 && LWIP_IGMP
|
|
err_t ethernetif_igmp_mac_filter(struct netif *netif, const ip4_addr_t *group,
|
|
enum netif_mac_filter_action action)
|
|
{
|
|
struct ethernetif *ethernetif = netif->state;
|
|
uint8_t multicastMacAddr[6];
|
|
err_t result;
|
|
|
|
multicastMacAddr[0] = 0x01U;
|
|
multicastMacAddr[1] = 0x00U;
|
|
multicastMacAddr[2] = 0x5EU;
|
|
multicastMacAddr[3] = (group->addr >> 8) & 0x7FU;
|
|
multicastMacAddr[4] = (group->addr >> 16) & 0xFFU;
|
|
multicastMacAddr[5] = (group->addr >> 24) & 0xFFU;
|
|
|
|
switch (action)
|
|
{
|
|
case IGMP_ADD_MAC_FILTER:
|
|
/* Adds the ENET device to a multicast group.*/
|
|
ENET_AddMulticastGroup(ethernetif->base, multicastMacAddr);
|
|
result = ERR_OK;
|
|
break;
|
|
case IGMP_DEL_MAC_FILTER:
|
|
/*
|
|
* Moves the ENET device from a multicast group.
|
|
* Since the ENET_LeaveMulticastGroup() could filter out also other
|
|
* group addresses having the same hash, the call is commented out.
|
|
*/
|
|
/* ENET_LeaveMulticastGroup(ethernetif->base, multicastMacAddr); */
|
|
result = ERR_OK;
|
|
break;
|
|
default:
|
|
result = ERR_IF;
|
|
break;
|
|
}
|
|
|
|
return result;
|
|
}
|
|
#endif
|
|
|
|
#if LWIP_IPV6 && LWIP_IPV6_MLD
|
|
err_t ethernetif_mld_mac_filter(struct netif *netif, const ip6_addr_t *group,
|
|
enum netif_mac_filter_action action)
|
|
{
|
|
struct ethernetif *ethernetif = netif->state;
|
|
uint8_t multicastMacAddr[6];
|
|
err_t result;
|
|
|
|
multicastMacAddr[0] = 0x33U;
|
|
multicastMacAddr[1] = 0x33U;
|
|
multicastMacAddr[2] = (group->addr[3]) & 0xFFU;
|
|
multicastMacAddr[3] = (group->addr[3] >> 8) & 0xFFU;
|
|
multicastMacAddr[4] = (group->addr[3] >> 16) & 0xFFU;
|
|
multicastMacAddr[5] = (group->addr[3] >> 24) & 0xFFU;
|
|
|
|
switch (action)
|
|
{
|
|
case NETIF_ADD_MAC_FILTER:
|
|
/* Adds the ENET device to a multicast group.*/
|
|
ENET_AddMulticastGroup(ethernetif->base, multicastMacAddr);
|
|
result = ERR_OK;
|
|
break;
|
|
case NETIF_DEL_MAC_FILTER:
|
|
/*
|
|
* Moves the ENET device from a multicast group.
|
|
* Since the ENET_LeaveMulticastGroup() could filter out also other
|
|
* group addresses having the same hash, the call is commented out.
|
|
*/
|
|
/* ENET_LeaveMulticastGroup(ethernetif->base, multicastMacAddr); */
|
|
result = ERR_OK;
|
|
break;
|
|
default:
|
|
result = ERR_IF;
|
|
break;
|
|
}
|
|
|
|
return result;
|
|
}
|
|
#endif
|
|
|
|
/**
|
|
* Initializes ENET driver.
|
|
*/
|
|
void ethernetif_enet_init(struct netif *netif, struct ethernetif *ethernetif,
|
|
const ethernetif_config_t *ethernetifConfig)
|
|
{
|
|
enet_config_t config;
|
|
uint32_t sysClock;
|
|
enet_buffer_config_t buffCfg[ENET_RING_NUM];
|
|
phy_speed_t speed;
|
|
phy_duplex_t duplex;
|
|
int i;
|
|
|
|
/* prepare the buffer configuration. */
|
|
buffCfg[0].rxBdNumber = ENET_RXBD_NUM; /* Receive buffer descriptor number. */
|
|
buffCfg[0].txBdNumber = ENET_TXBD_NUM; /* Transmit buffer descriptor number. */
|
|
buffCfg[0].rxBuffSizeAlign = sizeof(rx_buffer_t); /* Aligned receive data buffer size. */
|
|
buffCfg[0].txBuffSizeAlign = sizeof(tx_buffer_t); /* Aligned transmit data buffer size. */
|
|
buffCfg[0].rxBdStartAddrAlign = &(ethernetif->RxBuffDescrip[0]); /* Aligned receive buffer descriptor start address. */
|
|
buffCfg[0].txBdStartAddrAlign = &(ethernetif->TxBuffDescrip[0]); /* Aligned transmit buffer descriptor start address. */
|
|
buffCfg[0].rxBufferAlign = &(ethernetif->RxDataBuff[0][0]); /* Receive data buffer start address. */
|
|
buffCfg[0].txBufferAlign = &(ethernetif->TxDataBuff[0][0]); /* Transmit data buffer start address. */
|
|
buffCfg[0].txFrameInfo = NULL; /* Transmit frame information start address. Set only if using zero-copy transmit. */
|
|
buffCfg[0].rxMaintainEnable = true; /* Receive buffer cache maintain. */
|
|
buffCfg[0].txMaintainEnable = true; /* Transmit buffer cache maintain. */
|
|
|
|
sysClock = ethernetifConfig->phyHandle->mdioHandle->resource.csrClock_Hz;
|
|
|
|
ENET_GetDefaultConfig(&config);
|
|
config.ringNum = ENET_RING_NUM;
|
|
#ifdef LWIP_ENET_FLEXIBLE_CONFIGURATION
|
|
extern void BOARD_ENETFlexibleConfigure(enet_config_t *config);
|
|
BOARD_ENETFlexibleConfigure(&config);
|
|
#endif
|
|
|
|
ethernetif_phy_init(ethernetif, ethernetifConfig, &speed, &duplex);
|
|
config.miiSpeed = (enet_mii_speed_t)speed;
|
|
config.miiDuplex = (enet_mii_duplex_t)duplex;
|
|
|
|
#if USE_RTOS && defined(FSL_RTOS_FREE_RTOS)
|
|
uint32_t instance;
|
|
static ENET_Type *const enetBases[] = ENET_BASE_PTRS;
|
|
static const IRQn_Type enetTxIrqId[] = ENET_Transmit_IRQS;
|
|
/*! @brief Pointers to enet receive IRQ number for each instance. */
|
|
static const IRQn_Type enetRxIrqId[] = ENET_Receive_IRQS;
|
|
#if defined(ENET_ENHANCEDBUFFERDESCRIPTOR_MODE) && ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
|
|
/*! @brief Pointers to enet timestamp IRQ number for each instance. */
|
|
static const IRQn_Type enetTsIrqId[] = ENET_1588_Timer_IRQS;
|
|
#endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
|
|
|
|
/* Create the Event for transmit busy release trigger. */
|
|
ethernetif->enetTransmitAccessEvent = xEventGroupCreate();
|
|
ethernetif->txFlag = 0x1;
|
|
|
|
config.interrupt |= kENET_RxFrameInterrupt | kENET_TxFrameInterrupt | kENET_TxBufferInterrupt | kENET_LateCollisionInterrupt;
|
|
|
|
for (instance = 0; instance < ARRAY_SIZE(enetBases); instance++)
|
|
{
|
|
if (enetBases[instance] == ethernetif->base)
|
|
{
|
|
#ifdef __CA7_REV
|
|
GIC_SetPriority(enetRxIrqId[instance], ENET_PRIORITY);
|
|
GIC_SetPriority(enetTxIrqId[instance], ENET_PRIORITY);
|
|
#if defined(ENET_ENHANCEDBUFFERDESCRIPTOR_MODE) && ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
|
|
GIC_SetPriority(enetTsIrqId[instance], ENET_1588_PRIORITY);
|
|
#endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
|
|
#else
|
|
NVIC_SetPriority(enetRxIrqId[instance], ENET_PRIORITY);
|
|
NVIC_SetPriority(enetTxIrqId[instance], ENET_PRIORITY);
|
|
#if defined(ENET_ENHANCEDBUFFERDESCRIPTOR_MODE) && ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
|
|
NVIC_SetPriority(enetTsIrqId[instance], ENET_1588_PRIORITY);
|
|
#endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
|
|
#endif /* __CA7_REV */
|
|
break;
|
|
}
|
|
}
|
|
|
|
LWIP_ASSERT("Input Ethernet base error!", (instance != ARRAY_SIZE(enetBases)));
|
|
#endif /* USE_RTOS */
|
|
|
|
for (i = 0; i < ENET_RXBD_NUM; i++)
|
|
{
|
|
ethernetif->RxPbufs[i].p.custom_free_function = ethernetif_rx_release;
|
|
ethernetif->RxPbufs[i].buffer = &(ethernetif->RxDataBuff[i][0]);
|
|
ethernetif->RxPbufs[i].ethernetif = ethernetif;
|
|
}
|
|
|
|
/* Initialize the ENET module. */
|
|
ENET_Init(ethernetif->base, ðernetif->handle, &config, &buffCfg[0], netif->hwaddr, sysClock);
|
|
|
|
#if USE_RTOS && defined(FSL_RTOS_FREE_RTOS)
|
|
ENET_SetCallback(ðernetif->handle, ethernet_callback, netif);
|
|
#endif
|
|
|
|
ENET_ActiveRead(ethernetif->base);
|
|
}
|
|
|
|
void **ethernetif_enet_ptr(struct ethernetif *ethernetif)
|
|
{
|
|
return (void **)&(ethernetif->base);
|
|
}
|
|
|
|
/**
|
|
* Returns next buffer for TX.
|
|
* Can wait if no buffer available.
|
|
*/
|
|
static unsigned char *enet_get_tx_buffer(struct ethernetif *ethernetif)
|
|
{
|
|
static unsigned char ucBuffer[ENET_FRAME_MAX_FRAMELEN];
|
|
return ucBuffer;
|
|
}
|
|
|
|
/**
|
|
* Sends frame via ENET.
|
|
*/
|
|
static err_t enet_send_frame(struct ethernetif *ethernetif, unsigned char *data, const uint32_t length)
|
|
{
|
|
#if USE_RTOS && defined(FSL_RTOS_FREE_RTOS)
|
|
{
|
|
status_t result;
|
|
|
|
do
|
|
{
|
|
result = ENET_SendFrame(ethernetif->base, ðernetif->handle, data, length, 0, false, NULL);
|
|
|
|
if (result == kStatus_ENET_TxFrameBusy)
|
|
{
|
|
xEventGroupWaitBits(ethernetif->enetTransmitAccessEvent, ethernetif->txFlag, pdTRUE, (BaseType_t) false,
|
|
portMAX_DELAY);
|
|
}
|
|
|
|
} while (result == kStatus_ENET_TxFrameBusy);
|
|
return ERR_OK;
|
|
}
|
|
#else
|
|
{
|
|
uint32_t counter;
|
|
|
|
for (counter = ENET_TIMEOUT; counter != 0U; counter--)
|
|
{
|
|
if (ENET_SendFrame(ethernetif->base, ðernetif->handle, data, length, 0, false, NULL) != kStatus_ENET_TxFrameBusy)
|
|
{
|
|
return ERR_OK;
|
|
}
|
|
}
|
|
|
|
return ERR_TIMEOUT;
|
|
}
|
|
#endif
|
|
}
|
|
|
|
/**
|
|
* Reclaims RX buffer held by the p after p is no longer used
|
|
* by the application / lwIP.
|
|
*/
|
|
static void ethernetif_rx_release(struct pbuf *p)
|
|
{
|
|
rx_pbuf_wrapper_t *wrapper = (rx_pbuf_wrapper_t *)p;
|
|
SYS_ARCH_DECL_PROTECT(old_level);
|
|
|
|
SYS_ARCH_PROTECT(old_level);
|
|
ENET_ReleaseRxBuffer(wrapper->ethernetif->base, &wrapper->ethernetif->handle, wrapper->buffer, 0);
|
|
SYS_ARCH_UNPROTECT(old_level);
|
|
}
|
|
|
|
/**
|
|
* Reads a received frame - wraps its descriptor buffer(s) into a pbuf or a pbuf chain and returns it.
|
|
* The descriptors are returned to DMA only once the returned pbuf is released.
|
|
* Function can be called only after ENET_GetRxFrameSize() indicates
|
|
* that there actually is a received frame.
|
|
*/
|
|
static struct pbuf *ethernetif_read_frame(struct ethernetif *ethernetif, uint32_t length)
|
|
{
|
|
rx_pbuf_wrapper_t *wrapper;
|
|
uint32_t len = 0;
|
|
uint32_t ts;
|
|
struct pbuf *p = NULL;
|
|
struct pbuf *q = NULL;
|
|
void *buffer;
|
|
bool isLastBuff;
|
|
status_t status;
|
|
int i;
|
|
|
|
do
|
|
{
|
|
status = ENET_GetRxBuffer(ethernetif->base, ðernetif->handle, &buffer, &len, 0, &isLastBuff, &ts);
|
|
LWIP_UNUSED_ARG(status); /* for LWIP_NOASSERT */
|
|
LWIP_ASSERT("ENET_GetRxBuffer() status != kStatus_Success", status == kStatus_Success);
|
|
|
|
/* Find pbuf wrapper for the actually read byte buffer */
|
|
wrapper = NULL;
|
|
for (i = 0; i < ENET_RXBD_NUM; i++)
|
|
{
|
|
if (buffer == ethernetif->RxPbufs[i].buffer)
|
|
{
|
|
wrapper = ðernetif->RxPbufs[i];
|
|
break;
|
|
}
|
|
}
|
|
LWIP_ASSERT("Buffer returned by ENET_GetRxBuffer() doesn't match any RX buffer descriptor", wrapper != NULL);
|
|
|
|
/* Wrap the receive buffer in pbuf. */
|
|
if (p == NULL)
|
|
{
|
|
p = pbuf_alloced_custom(PBUF_RAW, len, PBUF_REF, &wrapper->p, buffer, len);
|
|
LWIP_ASSERT("pbuf_alloced_custom() failed", p);
|
|
}
|
|
else
|
|
{
|
|
q = pbuf_alloced_custom(PBUF_RAW, len, PBUF_REF, &wrapper->p, buffer, len);
|
|
LWIP_ASSERT("pbuf_alloced_custom() failed", q);
|
|
|
|
pbuf_cat(p, q);
|
|
}
|
|
} while (!isLastBuff);
|
|
|
|
LWIP_ASSERT("p->tot_len != length", p->tot_len == length);
|
|
|
|
MIB2_STATS_NETIF_ADD(netif, ifinoctets, p->tot_len);
|
|
if (((u8_t *)p->payload)[0] & 1)
|
|
{
|
|
/* broadcast or multicast packet */
|
|
MIB2_STATS_NETIF_INC(netif, ifinnucastpkts);
|
|
}
|
|
else
|
|
{
|
|
/* unicast packet */
|
|
MIB2_STATS_NETIF_INC(netif, ifinucastpkts);
|
|
}
|
|
|
|
LINK_STATS_INC(link.recv);
|
|
|
|
return p;
|
|
}
|
|
|
|
/**
|
|
* Drops (releases) receive descriptors until the last one of a frame is reached.
|
|
* Function can be called only after ENET_GetRxFrameSize() indicates
|
|
* that there actually is a frame error or a received frame.
|
|
*/
|
|
static void ethernetif_drop_frame(struct ethernetif *ethernetif)
|
|
{
|
|
status_t status;
|
|
void *buffer;
|
|
uint32_t len;
|
|
uint32_t ts;
|
|
bool isLastBuff;
|
|
|
|
do
|
|
{
|
|
#if 0 /* Error statisctics */
|
|
enet_data_error_stats_t eErrStatic;
|
|
/* Get the error information of the received g_frame. */
|
|
ENET_GetRxErrBeforeReadFrame(ðernetif->handle, &eErrStatic);
|
|
#endif
|
|
status = ENET_GetRxBuffer(ethernetif->base, ðernetif->handle, &buffer, &len, 0, &isLastBuff, &ts);
|
|
LWIP_UNUSED_ARG(status); /* for LWIP_NOASSERT */
|
|
LWIP_ASSERT("ENET_GetRxBuffer() status != kStatus_Success", status == kStatus_Success);
|
|
ENET_ReleaseRxBuffer(ethernetif->base, ðernetif->handle, buffer, 0);
|
|
} while (!isLastBuff);
|
|
|
|
LWIP_DEBUGF(NETIF_DEBUG, ("ethernetif_linkinput: RxFrameError\n"));
|
|
|
|
LINK_STATS_INC(link.drop);
|
|
MIB2_STATS_NETIF_INC(netif, ifindiscards);
|
|
}
|
|
|
|
struct pbuf *ethernetif_linkinput(struct netif *netif)
|
|
{
|
|
struct ethernetif *ethernetif = netif->state;
|
|
struct pbuf *p = NULL;
|
|
status_t status;
|
|
uint32_t len;
|
|
|
|
/* Obtain the size of the packet and put it into the "len" variable. */
|
|
status = ENET_GetRxFrameSize(ðernetif->handle, &len, 0);
|
|
|
|
if (status == kStatus_Success)
|
|
{
|
|
/* Read frame. */
|
|
p = ethernetif_read_frame(ethernetif, len);
|
|
}
|
|
else if (status != kStatus_ENET_RxFrameEmpty)
|
|
{
|
|
/* Drop the frame when error happened. */
|
|
ethernetif_drop_frame(ethernetif);
|
|
}
|
|
|
|
return p;
|
|
}
|
|
|
|
err_t ethernetif_linkoutput(struct netif *netif, struct pbuf *p)
|
|
{
|
|
err_t result;
|
|
struct ethernetif *ethernetif = netif->state;
|
|
struct pbuf *q;
|
|
unsigned char *pucBuffer;
|
|
unsigned char *pucChar;
|
|
|
|
LWIP_ASSERT("Output packet buffer empty", p);
|
|
|
|
pucBuffer = enet_get_tx_buffer(ethernetif);
|
|
if (pucBuffer == NULL)
|
|
{
|
|
return ERR_BUF;
|
|
}
|
|
|
|
/* Initiate transfer. */
|
|
|
|
#if ETH_PAD_SIZE
|
|
pbuf_header(p, -ETH_PAD_SIZE); /* drop the padding word */
|
|
#endif
|
|
|
|
if (p->len == p->tot_len)
|
|
{
|
|
/* No pbuf chain, don't have to copy -> faster. */
|
|
pucBuffer = (unsigned char *)p->payload;
|
|
}
|
|
else
|
|
{
|
|
/* pbuf chain, copy into contiguous ucBuffer. */
|
|
if (p->tot_len > ENET_FRAME_MAX_FRAMELEN)
|
|
{
|
|
return ERR_BUF;
|
|
}
|
|
else
|
|
{
|
|
pucChar = pucBuffer;
|
|
|
|
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. */
|
|
/* send data from(q->payload, q->len); */
|
|
memcpy(pucChar, q->payload, q->len);
|
|
pucChar += q->len;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Send frame. */
|
|
result = enet_send_frame(ethernetif, pucBuffer, p->tot_len);
|
|
|
|
MIB2_STATS_NETIF_ADD(netif, ifoutoctets, p->tot_len);
|
|
if (((u8_t *)p->payload)[0] & 1)
|
|
{
|
|
/* broadcast or multicast packet*/
|
|
MIB2_STATS_NETIF_INC(netif, ifoutnucastpkts);
|
|
}
|
|
else
|
|
{
|
|
/* unicast packet */
|
|
MIB2_STATS_NETIF_INC(netif, ifoutucastpkts);
|
|
}
|
|
/* increase ifoutdiscards or ifouterrors on error */
|
|
|
|
#if ETH_PAD_SIZE
|
|
pbuf_header(p, ETH_PAD_SIZE); /* reclaim the padding word */
|
|
#endif
|
|
|
|
LINK_STATS_INC(link.xmit);
|
|
|
|
return result;
|
|
}
|
|
|
|
/**
|
|
* Should be called at the beginning of the program to set up the
|
|
* first network interface. It calls the function ethernetif_init() to do the
|
|
* actual setup of the hardware.
|
|
*
|
|
* This function should be passed as a parameter to netif_add().
|
|
*
|
|
* @param netif the lwip network interface structure for this ethernetif
|
|
* @return ERR_OK if the loopif is initialized
|
|
* ERR_MEM if private data couldn't be allocated
|
|
* any other err_t on error
|
|
*/
|
|
err_t ethernetif0_init(struct netif *netif)
|
|
{
|
|
static struct ethernetif ethernetif_0;
|
|
AT_NONCACHEABLE_SECTION_ALIGN(static enet_rx_bd_struct_t rxBuffDescrip_0[ENET_RXBD_NUM], FSL_ENET_BUFF_ALIGNMENT);
|
|
AT_NONCACHEABLE_SECTION_ALIGN(static enet_tx_bd_struct_t txBuffDescrip_0[ENET_TXBD_NUM], FSL_ENET_BUFF_ALIGNMENT);
|
|
SDK_ALIGN(static rx_buffer_t rxDataBuff_0[ENET_RXBD_NUM], FSL_ENET_BUFF_ALIGNMENT);
|
|
SDK_ALIGN(static tx_buffer_t txDataBuff_0[ENET_TXBD_NUM], FSL_ENET_BUFF_ALIGNMENT);
|
|
|
|
ethernetif_0.RxBuffDescrip = &(rxBuffDescrip_0[0]);
|
|
ethernetif_0.TxBuffDescrip = &(txBuffDescrip_0[0]);
|
|
ethernetif_0.RxDataBuff = &(rxDataBuff_0[0]);
|
|
ethernetif_0.TxDataBuff = &(txDataBuff_0[0]);
|
|
|
|
return ethernetif_init(netif, ðernetif_0, ethernetif_get_enet_base(0U), (ethernetif_config_t *)netif->state);
|
|
}
|
|
|
|
#if defined(FSL_FEATURE_SOC_ENET_COUNT) && (FSL_FEATURE_SOC_ENET_COUNT > 1)
|
|
/**
|
|
* Should be called at the beginning of the program to set up the
|
|
* second network interface. It calls the function ethernetif_init() to do the
|
|
* actual setup of the hardware.
|
|
*
|
|
* This function should be passed as a parameter to netif_add().
|
|
*
|
|
* @param netif the lwip network interface structure for this ethernetif
|
|
* @return ERR_OK if the loopif is initialized
|
|
* ERR_MEM if private data couldn't be allocated
|
|
* any other err_t on error
|
|
*/
|
|
err_t ethernetif1_init(struct netif *netif)
|
|
{
|
|
static struct ethernetif ethernetif_1;
|
|
AT_NONCACHEABLE_SECTION_ALIGN(static enet_rx_bd_struct_t rxBuffDescrip_1[ENET_RXBD_NUM], FSL_ENET_BUFF_ALIGNMENT);
|
|
AT_NONCACHEABLE_SECTION_ALIGN(static enet_tx_bd_struct_t txBuffDescrip_1[ENET_TXBD_NUM], FSL_ENET_BUFF_ALIGNMENT);
|
|
SDK_ALIGN(static rx_buffer_t rxDataBuff_1[ENET_RXBD_NUM], FSL_ENET_BUFF_ALIGNMENT);
|
|
SDK_ALIGN(static tx_buffer_t txDataBuff_1[ENET_TXBD_NUM], FSL_ENET_BUFF_ALIGNMENT);
|
|
|
|
ethernetif_1.RxBuffDescrip = &(rxBuffDescrip_1[0]);
|
|
ethernetif_1.TxBuffDescrip = &(txBuffDescrip_1[0]);
|
|
ethernetif_1.RxDataBuff = &(rxDataBuff_1[0]);
|
|
ethernetif_1.TxDataBuff = &(txDataBuff_1[0]);
|
|
|
|
return ethernetif_init(netif, ðernetif_1, ethernetif_get_enet_base(1U), (ethernetif_config_t *)netif->state);
|
|
}
|
|
#endif /* FSL_FEATURE_SOC_*_ENET_COUNT */
|