lwip ping功能实现

最新推荐文章于 2023-11-20 18:23:50 发布

工程师-佩奇

最新推荐文章于 2023-11-20 18:23:50 发布

阅读量2.3k

点赞数

分类专栏： STM32 文章标签：单片机网络

本文链接：https://blog.csdn.net/william_ee/article/details/121523002

版权

STM32 专栏收录该内容

2 篇文章 0 订阅

订阅专栏

本文介绍了如何在物联网环境下使用ping命令发送ICMP报文，并处理来自目标设备的响应。重点展示了参数解析、IP地址获取、网络通信和错误处理的过程。通过实例代码，展示了如何利用FreeRTOS和raw库进行ICMP通信和IP地址转换。

摘要由CSDN通过智能技术生成

static BaseType_t prvPingCommand(char *pcWriteBuffer, size_t xWriteBufferLen, const char *pcCommandString)
{
	const char *pcParameter;
	BaseType_t xParameterStringLength;
	static UBaseType_t uxParameterNumber = 0;
	/* Remove compile time warnings about unused parameters, and check the
		write buffer is not NULL.  NOTE - for simplicity, this example assumes the
		write buffer length is adequate, so does not check for buffer overflows. */
	(void)pcCommandString;
	(void)xWriteBufferLen;
	configASSERT(pcWriteBuffer);

	if (!ping_mutex)
	{
		ping_mutex = xSemaphoreCreateBinary();
	}

	pcWriteBuffer[0] = 0;

	static struct raw_pcb *ping_pcb = NULL;
	ip_addr_t ipaddr;

	if (!ping_pcb)
	{
		ping_pcb = raw_new(IP_PROTO_ICMP);
		raw_recv(ping_pcb, raw_ping_callback, pcWriteBuffer);
		raw_bind(ping_pcb, IP_ADDR_ANY);
	}
	else
	{
		vTaskDelay(1000);
	}

	pcParameter = FreeRTOS_CLIGetParameter(
		pcCommandString,		/* The command string itself. */
		1,						/* Return the next parameter. */
		&xParameterStringLength /* Store the parameter string length. */
	);

	if (pcParameter == NULL)
	{
		sprintf(pcWriteBuffer, "Ip address is lack\r\n");
		return pdFALSE;
	}

	if (ipaddr_aton(pcParameter, &ipaddr) == 0)
	{
		if (netconn_gethostbyname(pcParameter, &ipaddr) != 0)
		{
			sprintf(pcWriteBuffer, "Ip address is invalid\r\n");
			return pdFALSE;
		}
	}

	ping_send(ping_pcb, &ipaddr);

	if (xSemaphoreTake(ping_mutex, 1000) != pdPASS)
	{
		sprintf(pcWriteBuffer, "unreachable....\r\n");
	}

	uxParameterNumber++;
	if (uxParameterNumber == 4)
	{
		uxParameterNumber = 0;
		return pdFALSE;
	}

	return pdTRUE;
}

void ping_send(struct raw_pcb *pcb, ip_addr_t *ipaddr)
{
	struct pbuf *p;
	struct icmp_echo_hdr *iecho;
	p = pbuf_alloc(PBUF_IP, 40, PBUF_RAM); //申请pbuf结构
	if (!p)
	{
		return;
	}
	if (p->len == p->tot_len && p->next == NULL)
	{
		iecho = (struct icmp_echo_hdr *)p->payload;
		ping_prepare_echo(iecho, 40); //填写ICMP首部各字段
		raw_sendto(pcb, p, ipaddr);	  //底层发送
	}

	pbuf_free(p);
}


int raw_ping_callback(void *arg, struct raw_pcb *pcb, struct pbuf *p, ip_addr_t *addr)
{
	char *buf = (char *)arg;
	if (!buf)
	{
		return 0;
	}

	struct ip_hdr *iphdr;
	if (p->tot_len >= (PBUF_IP_HLEN + 8))
	{
		iphdr = (struct ip_hdr *)((u8_t *)p->payload);
		sprintf((char *)buf, "Come from %d.%d.%d.%d to reply ..OK..\r\n", *(char *)addr, *((char *)addr + 1), *((char *)addr + 2), *((char *)addr + 3));
	}

	if (__get_IPSR() != 0)
	{
		BaseType_t xHigherPriorityTaskWoken = pdFALSE;
		if (ping_mutex)
		{
			xSemaphoreGiveFromISR(ping_mutex, &xHigherPriorityTaskWoken);
		}
		portYIELD_FROM_ISR(xHigherPriorityTaskWoken);
	}
	else
	{
		if (ping_mutex)
		{
			xSemaphoreGive(ping_mutex);
		}
	}

	return 0;
}