1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
|
#include <rtthread.h>
#include <lwip/sockets.h>
#define SERV_PORT 10012
#define BUF_SIZE 1024
static const char send_data[] = "This is UDP Server from RT-Thread.";
void udpserver6(void)
{
int sockfd;
struct sockaddr_in6 server_addr6;
struct sockaddr_in6 client_addr6;
int bytes_read;
char *recv_data;
rt_uint32_t addr_len;
recv_data = rt_malloc(BUF_SIZE);
if(recv_data == RT_NULL)
{
rt_kprintf("No memory\n");
return ;
}
if((sockfd = socket(AF_INET6, SOCK_DGRAM, 0)) == -1)
{
rt_kprintf("Socket error\n");
rt_free(recv_data);
return ;
}
server_addr6.sin6_family = AF_INET6;
server_addr6.sin6_port = htons(SERV_PORT);
memcpy(server_addr6.sin6_addr.s6_addr, IP6_ADDR_ANY, 16);
if(bind(sockfd, (struct sockaddr *)&server_addr6, sizeof(struct sockaddr)) == -1)
{
rt_kprintf("Bind error\n");
rt_free(recv_data);
return ;
}
rt_sprintf(recv_data, "%4d", SERV_PORT);
rt_kprintf("UDPServer Waiting for client on port %s...\n", recv_data);
addr_len = sizeof(struct sockaddr);
while(1)
{
bytes_read = recvfrom(sockfd, recv_data, BUF_SIZE - 1, 0, (struct sockaddr *)&client_addr6, &addr_len);
recv_data[bytes_read] = '\0';
rt_kprintf("\n(%s, %d) said:", inet6_ntoa(client_addr6.sin6_addr), ntohs(client_addr6.sin6_port));
rt_kprintf("%s", recv_data);
if(strcmp(recv_data, "exit") == 0)
{
closesocket(sockfd);
rt_free(recv_data);
break;
}
}
return ;
}
#ifdef RT_USING_FINSH
#include <finsh.h>
FINSH_FUNCTION_EXPORT(udpserver6, startup udp server via ipv6);
#endif
|
