123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414 |
- #include "ethernetif_eth.h"
- #include "lwip/def.h"
- #include "lwip/err.h"
- #include "lwip/mem.h"
- #include "lwip/opt.h"
- #include "lwip/pbuf.h"
- #include "lwip/timeouts.h"
- #include "lwip_init.h"
- #include "main.h"
- #include "netif/etharp.h"
- #include "stm32f4x7_eth.h"
- #include <string.h>
- #define ENET_RX_TASK_PRIO (4)
- #define ENET_RX_TASK_STK_SIZE (2048)
- CPU_STK enet_rx_task_stk[ENET_RX_TASK_STK_SIZE];
- #define IFNAME0 's'
- #define IFNAME1 't'
- extern ETH_DMADESCTypeDef DMARxDscrTab[ETH_RXBUFNB], DMATxDscrTab[ETH_TXBUFNB];
- extern uint8_t Rx_Buff[ETH_RXBUFNB][ETH_RX_BUF_SIZE];
- extern uint8_t Tx_Buff[ETH_TXBUFNB][ETH_TX_BUF_SIZE];
- extern ETH_DMADESCTypeDef *DMATxDescToSet;
- extern ETH_DMADESCTypeDef *DMARxDescToGet;
- extern ETH_DMA_Rx_Frame_infos *DMA_RX_FRAME_infos;
- static struct netif *low_netif = NULL;
- OS_EVENT *g_enet_rx_sem = NULL;
- static void ethernetif_input(void *pvParameters);
- static void low_level_init(struct netif *netif)
- {
- #ifdef CHECKSUM_BY_HARDWARE
- int i;
- #endif
-
- netif->hwaddr_len = ETHARP_HWADDR_LEN;
-
- netif->hwaddr[0] = ethdev.mac[0];
- netif->hwaddr[1] = ethdev.mac[1];
- netif->hwaddr[2] = ethdev.mac[2];
- netif->hwaddr[3] = ethdev.mac[3];
- netif->hwaddr[4] = ethdev.mac[4];
- netif->hwaddr[5] = ethdev.mac[5];
-
- ETH_MACAddressConfig(ETH_MAC_Address0, netif->hwaddr);
-
- netif->mtu = 1500;
-
-
- netif->flags = NETIF_FLAG_BROADCAST | NETIF_FLAG_ETHARP | NETIF_FLAG_LINK_UP;
- low_netif = netif;
-
- if (NULL == g_enet_rx_sem)
- {
- g_enet_rx_sem = OSSemCreate(0);
- }
-
- ETH_DMATxDescChainInit(DMATxDscrTab, &Tx_Buff[0][0], ETH_TXBUFNB);
-
- ETH_DMARxDescChainInit(DMARxDscrTab, &Rx_Buff[0][0], ETH_RXBUFNB);
-
- for (i = 0; i < ETH_RXBUFNB; i++)
- {
- ETH_DMARxDescReceiveITConfig(&DMARxDscrTab[i], ENABLE);
- }
- #ifdef CHECKSUM_BY_HARDWARE
-
- for (i = 0; i < ETH_TXBUFNB; i++)
- {
- ETH_DMATxDescChecksumInsertionConfig(&DMATxDscrTab[i], ETH_DMATxDesc_ChecksumTCPUDPICMPFull);
- }
- #endif
-
-
- OSTaskCreateExt((void (*)(void *))ethernetif_input,
- (void *)0,
- (OS_STK *)&enet_rx_task_stk[ENET_RX_TASK_STK_SIZE - 1],
- (INT8U)ENET_RX_TASK_PRIO,
- (INT16U)ENET_RX_TASK_PRIO,
- (OS_STK *)&enet_rx_task_stk[0],
- (INT32U)ENET_RX_TASK_STK_SIZE,
- (void *)0,
- (INT16U)OS_TASK_OPT_STK_CHK | OS_TASK_OPT_STK_CLR | OS_TASK_OPT_SAVE_FP);
-
- ETH_Start();
- }
- static err_t low_level_output(struct netif *netif, struct pbuf *p)
- {
- static OS_EVENT *p_enet_tx_sem = NULL;
- INT8U err;
- struct pbuf *q;
- u8 *buffer;
- __IO ETH_DMADESCTypeDef *DmaTxDesc;
- uint16_t framelength = 0;
- uint32_t bufferoffset = 0;
- uint32_t byteslefttocopy = 0;
- uint32_t payloadoffset = 0;
- SYS_ARCH_DECL_PROTECT(sr);
- if (NULL == p_enet_tx_sem)
- {
- p_enet_tx_sem = OSSemCreate(1);
- }
- OSSemPend(p_enet_tx_sem, 0, &err);
- SYS_ARCH_PROTECT(sr);
- DmaTxDesc = DMATxDescToSet;
- buffer = (u8 *)(DmaTxDesc->Buffer1Addr);
- bufferoffset = 0;
- for (q = p; q != NULL; q = q->next)
- {
- if ((DmaTxDesc->Status & ETH_DMATxDesc_OWN) != (u32)RESET)
- {
- goto error;
- }
-
- byteslefttocopy = q->len;
- payloadoffset = 0;
-
- while ((byteslefttocopy + bufferoffset) > ETH_TX_BUF_SIZE)
- {
-
- memcpy((u8_t *)((u8_t *)buffer + bufferoffset), (u8_t *)((u8_t *)q->payload + payloadoffset), (ETH_TX_BUF_SIZE - bufferoffset));
-
- DmaTxDesc = (ETH_DMADESCTypeDef *)(DmaTxDesc->Buffer2NextDescAddr);
-
- if ((DmaTxDesc->Status & ETH_DMATxDesc_OWN) != (u32)RESET)
- {
- goto error;
- }
- buffer = (u8 *)(DmaTxDesc->Buffer1Addr);
- byteslefttocopy = byteslefttocopy - (ETH_TX_BUF_SIZE - bufferoffset);
- payloadoffset = payloadoffset + (ETH_TX_BUF_SIZE - bufferoffset);
- framelength = framelength + (ETH_TX_BUF_SIZE - bufferoffset);
- bufferoffset = 0;
- }
-
- memcpy((u8_t *)((u8_t *)buffer + bufferoffset), (u8_t *)((u8_t *)q->payload + payloadoffset), byteslefttocopy);
- bufferoffset = bufferoffset + byteslefttocopy;
- framelength = framelength + byteslefttocopy;
- }
-
- ETH_Prepare_Transmit_Descriptors(framelength);
- error:
-
- OSSemPost(p_enet_tx_sem);
- SYS_ARCH_UNPROTECT(sr);
- return ERR_OK;
- }
- static struct pbuf *low_level_input(struct netif *netif)
- {
- struct pbuf *p = NULL, *q;
- u32_t len;
- FrameTypeDef frame;
- u8 *buffer;
- __IO ETH_DMADESCTypeDef *DMARxDesc;
- uint32_t bufferoffset = 0;
- uint32_t payloadoffset = 0;
- uint32_t byteslefttocopy = 0;
- uint32_t i = 0;
-
- frame = ETH_Get_Received_Frame_interrupt();
-
- len = frame.length;
- buffer = (u8 *)frame.buffer;
- if (len > 0)
- {
-
- p = pbuf_alloc(PBUF_RAW, len, PBUF_POOL);
- }
- if (p != NULL)
- {
- DMARxDesc = frame.descriptor;
- bufferoffset = 0;
- for (q = p; q != NULL; q = q->next)
- {
- byteslefttocopy = q->len;
- payloadoffset = 0;
-
- while ((byteslefttocopy + bufferoffset) > ETH_RX_BUF_SIZE)
- {
-
- memcpy((u8_t *)((u8_t *)q->payload + payloadoffset), (u8_t *)((u8_t *)buffer + bufferoffset), (ETH_RX_BUF_SIZE - bufferoffset));
-
- DMARxDesc = (ETH_DMADESCTypeDef *)(DMARxDesc->Buffer2NextDescAddr);
- buffer = (unsigned char *)(DMARxDesc->Buffer1Addr);
- byteslefttocopy = byteslefttocopy - (ETH_RX_BUF_SIZE - bufferoffset);
- payloadoffset = payloadoffset + (ETH_RX_BUF_SIZE - bufferoffset);
- bufferoffset = 0;
- }
-
- memcpy((u8_t *)((u8_t *)q->payload + payloadoffset), (u8_t *)((u8_t *)buffer + bufferoffset), byteslefttocopy);
- bufferoffset = bufferoffset + byteslefttocopy;
- }
-
- DMARxDesc = frame.descriptor;
-
- for (i = 0; i < DMA_RX_FRAME_infos->Seg_Count; i++)
- {
- DMARxDesc->Status = ETH_DMARxDesc_OWN;
- DMARxDesc = (ETH_DMADESCTypeDef *)(DMARxDesc->Buffer2NextDescAddr);
- }
-
- DMA_RX_FRAME_infos->Seg_Count = 0;
-
- }
-
- if ((ETH->DMASR & ETH_DMASR_RBUS) != (u32)RESET)
- {
-
- ETH->DMASR = ETH_DMASR_RBUS;
-
- ETH->DMARPDR = 0;
- }
- return p;
- }
- void ethernetif_input(void *pvParameters)
- {
- struct pbuf *p;
- INT8U err;
- SYS_ARCH_DECL_PROTECT(sr);
- for (;;)
- {
- OSSemPend(g_enet_rx_sem, 0, &err);
- TRY_GET_NEXT_FRAME:
- SYS_ARCH_PROTECT(sr);
- p = low_level_input(low_netif);
- SYS_ARCH_UNPROTECT(sr);
- if (p != NULL)
- {
- if (ERR_OK != low_netif->input(p, low_netif))
- {
- pbuf_free(p);
- }
- else
- {
- goto TRY_GET_NEXT_FRAME;
- }
- }
- }
- }
- err_t ethernetif_eth_init(struct netif *netif)
- {
- LWIP_ASSERT("netif != NULL", (netif != NULL));
- #if LWIP_NETIF_HOSTNAME
-
- netif->hostname = "lwip";
- #endif
- netif->name[0] = IFNAME0;
- netif->name[1] = IFNAME1;
- netif->output = etharp_output;
- netif->linkoutput = low_level_output;
-
- low_level_init(netif);
- return ERR_OK;
- }
|