75 lines
1.7 KiB
C
75 lines
1.7 KiB
C
|
#include <rtthread.h>
|
||
|
|
#include <lwip/sockets.h>
|
||
|
|
|
||
|
|
void udpserv(void* paramemter)
|
||
|
|
{
|
||
|
|
int sock;
|
||
|
|
int bytes_read;
|
||
|
|
char *recv_data;
|
||
|
|
rt_uint32_t addr_len;
|
||
|
|
struct sockaddr_in server_addr , client_addr;
|
||
|
|
|
||
|
|
recv_data = rt_malloc(1024);
|
||
|
|
if (recv_data == RT_NULL)
|
||
|
|
{
|
||
|
|
rt_kprintf("No memory\n");
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* create socket */
|
||
|
|
if ((sock = socket(AF_INET, SOCK_DGRAM, 0)) == -1)
|
||
|
|
{
|
||
|
|
rt_kprintf("Socket error\n");
|
||
|
|
|
||
|
|
/* release recv buffer */
|
||
|
|
rt_free(recv_data);
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* init server socket address */
|
||
|
|
server_addr.sin_family = AF_INET;
|
||
|
|
server_addr.sin_port = htons(5000);
|
||
|
|
server_addr.sin_addr.s_addr = INADDR_ANY;
|
||
|
|
rt_memset(&(server_addr.sin_zero),0, sizeof(server_addr.sin_zero));
|
||
|
|
|
||
|
|
if (bind(sock,(struct sockaddr *)&server_addr,
|
||
|
|
sizeof(struct sockaddr)) == -1)
|
||
|
|
{
|
||
|
|
rt_kprintf("Bind error\n");
|
||
|
|
|
||
|
|
/* release recv buffer */
|
||
|
|
rt_free(recv_data);
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
addr_len = sizeof(struct sockaddr);
|
||
|
|
|
||
|
|
rt_kprintf("UDPServer Waiting for client on port 5000...\n");
|
||
|
|
|
||
|
|
while (1)
|
||
|
|
{
|
||
|
|
bytes_read = recvfrom(sock, recv_data, 1024, 0,
|
||
|
|
(struct sockaddr *)&client_addr, &addr_len);
|
||
|
|
recv_data[bytes_read] = '\0';
|
||
|
|
rt_kprintf("\n(%s , %d) said : ",inet_ntoa(client_addr.sin_addr),
|
||
|
|
ntohs(client_addr.sin_port));
|
||
|
|
rt_kprintf("%s", recv_data);
|
||
|
|
|
||
|
|
if (strcmp(recv_data, "exit") == 0)
|
||
|
|
{
|
||
|
|
lwip_close(sock);
|
||
|
|
|
||
|
|
/* release recv buffer */
|
||
|
|
rt_free(recv_data);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
#ifdef RT_USING_FINSH
|
||
|
|
#include <finsh.h>
|
||
|
|
FINSH_FUNCTION_EXPORT(udpserv, startup udp server);
|
||
|
|
#endif
|