124 lines
3.2 KiB
C
124 lines
3.2 KiB
C
/* Net-suite test code: lwip netif API for creating test interface
|
|
|
|
This example code is in the Public Domain (or CC0 licensed, at your option.)
|
|
|
|
Unless required by applicable law or agreed to in writing, this
|
|
software is distributed on an "AS IS" BASIS, WITHOUT WARRANTIES OR
|
|
CONDITIONS OF ANY KIND, either express or implied.
|
|
*/
|
|
#include "lwip/opt.h"
|
|
|
|
#include "lwip/def.h"
|
|
#include "lwip/mem.h"
|
|
#include "lwip/pbuf.h"
|
|
#include "lwip/stats.h"
|
|
#include "lwip/snmp.h"
|
|
#include "lwip/ethip6.h"
|
|
#include "netif/etharp.h"
|
|
#include "netif/wlanif.h"
|
|
|
|
#include "esp_netif.h"
|
|
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
|
|
static struct netif *g_last_netif = NULL;
|
|
|
|
// LWIP netif specific defines
|
|
struct esp_netif_netstack_config {
|
|
err_t (*init_fn)(struct netif*);
|
|
void (*input_fn)(struct netif *netif, void *buffer, size_t len, void *eb);
|
|
};
|
|
|
|
err_t testnetif_init(struct netif *netif);
|
|
|
|
void testnetif_input(struct netif *netif, void *buffer, size_t len, void *eb);
|
|
|
|
const struct esp_netif_netstack_config _g_test_netif_stack_config = { testnetif_init, testnetif_input};
|
|
|
|
err_t testnetif_output(struct netif *netif, struct pbuf *p)
|
|
{
|
|
int i;
|
|
char *dat = p->payload;
|
|
|
|
/* output the packet to stdout */
|
|
printf("\nPacketOut:[");
|
|
for (i=0; i<p->len; i++) {
|
|
printf("%02x", *dat++);
|
|
}
|
|
printf("]\n");
|
|
|
|
return ERR_OK;
|
|
}
|
|
|
|
|
|
err_t testnetif_init(struct netif *netif)
|
|
{
|
|
|
|
g_last_netif = netif;
|
|
|
|
netif->hostname = CONFIG_LWIP_LOCAL_HOSTNAME;
|
|
|
|
/*
|
|
* Initialize the snmp variables and counters inside the struct netif.
|
|
* The last argument should be replaced with your link speed, in units
|
|
* of bits per second.
|
|
*/
|
|
NETIF_INIT_SNMP(netif, snmp_ifType_ethernet_csmacd, 100);
|
|
|
|
/* We directly use etharp_output() here to save a function call.
|
|
* You can instead declare your own function an call etharp_output()
|
|
* from it if you have to do some checks before sending (e.g. if link
|
|
* is available...) */
|
|
netif->output = etharp_output;
|
|
#if LWIP_IPV6
|
|
netif->output_ip6 = ethip6_output;
|
|
#endif /* LWIP_IPV6 */
|
|
netif->linkoutput = testnetif_output;
|
|
/* set MAC hardware address length */
|
|
netif->hwaddr_len = ETHARP_HWADDR_LEN;
|
|
|
|
/* set MAC hardware address */
|
|
|
|
/* maximum transfer unit */
|
|
netif->mtu = 1500;
|
|
|
|
/* device capabilities */
|
|
/* don't set NETIF_FLAG_ETHARP if this device is not an ethernet one */
|
|
netif->flags = NETIF_FLAG_BROADCAST | NETIF_FLAG_ETHARP | NETIF_FLAG_LINK_UP;
|
|
|
|
#if ESP_LWIP
|
|
#if LWIP_IGMP
|
|
netif->flags |= NETIF_FLAG_IGMP;
|
|
#endif
|
|
#endif
|
|
return ERR_OK;
|
|
|
|
}
|
|
|
|
void testnetif_input(struct netif *netif, void *buffer, size_t len, void *eb)
|
|
{
|
|
struct pbuf *p;
|
|
if (g_last_netif == NULL) {
|
|
printf("error!");
|
|
return;
|
|
}
|
|
|
|
printf("simul in: %d\n", len);
|
|
if (len==0) return;
|
|
|
|
p = pbuf_alloc(PBUF_RAW, len, PBUF_RAM);
|
|
p->l2_owner = NULL;
|
|
memcpy(p->payload, buffer, len);
|
|
|
|
/* full packet send to tcpip_thread to process
|
|
* on success - the packet is processed and deallocated in tcpip stack
|
|
* on failure - log error and deallocate the packet
|
|
*/
|
|
if (g_last_netif->input(p, g_last_netif) != ERR_OK) {
|
|
LWIP_DEBUGF(NETIF_DEBUG, ("ethernetif_input: IP input error\n"));
|
|
pbuf_free(p);
|
|
}
|
|
|
|
}
|