1 | /*
|
---|
2 | * Test name: test04_srv.c
|
---|
3 | *
|
---|
4 | * Objective: Test a simple UDP server
|
---|
5 | *
|
---|
6 | * Description: Implements a simple echo server using the UDP protocol. Instead
|
---|
7 | * of blocking on read(), it performs a select call first blocking there
|
---|
8 | * until there is data to be read
|
---|
9 | */
|
---|
10 |
|
---|
11 | #include <sys/types.h>
|
---|
12 | #include <sys/ioctl.h>
|
---|
13 | #include <sys/select.h>
|
---|
14 | #include <stdio.h>
|
---|
15 | #include <string.h>
|
---|
16 | #include <stdlib.h>
|
---|
17 | #include <stdarg.h>
|
---|
18 | #include <fcntl.h>
|
---|
19 | #include <errno.h>
|
---|
20 | #include <unistd.h>
|
---|
21 | #include <net/netlib.h>
|
---|
22 | #include <net/gen/netdb.h>
|
---|
23 | #include <net/gen/in.h>
|
---|
24 | #include <net/gen/udp.h>
|
---|
25 | #include <net/gen/udp_hdr.h>
|
---|
26 | #include <net/gen/udp_io.h>
|
---|
27 | #include <net/hton.h>
|
---|
28 |
|
---|
29 | #define PORT 6000L
|
---|
30 |
|
---|
31 | /* type for received data */
|
---|
32 | typedef struct
|
---|
33 | {
|
---|
34 | udp_io_hdr_t header;
|
---|
35 | char data[1024];
|
---|
36 | } udp_buffer_t;
|
---|
37 |
|
---|
38 | int udp_conf(long port) {
|
---|
39 |
|
---|
40 | char *udp_device;
|
---|
41 | int netfd;
|
---|
42 | nwio_udpopt_t udpopt;
|
---|
43 |
|
---|
44 | /* Get default UDP device */
|
---|
45 | if ((udp_device = getenv("UDP_DEVICE")) == NULL)
|
---|
46 | udp_device = UDP_DEVICE;
|
---|
47 |
|
---|
48 | /* Open UDP connection */
|
---|
49 | if ((netfd = open(udp_device, O_RDWR)) < 0)
|
---|
50 | {
|
---|
51 | fprintf(stderr,"Error opening UDP connection\n");
|
---|
52 | return -1;
|
---|
53 | }
|
---|
54 |
|
---|
55 | /* Configure UDP connection */
|
---|
56 | udpopt.nwuo_flags = NWUO_COPY | NWUO_LP_SET | NWUO_EN_LOC | NWUO_DI_BROAD
|
---|
57 | | NWUO_RP_ANY | NWUO_RA_ANY | NWUO_RWDATALL | NWUO_DI_IPOPT;
|
---|
58 |
|
---|
59 | udpopt.nwuo_locport = (udpport_t) htons(port);
|
---|
60 |
|
---|
61 | if ((ioctl(netfd, NWIOSUDPOPT, &udpopt))<0)
|
---|
62 | {
|
---|
63 | fprintf(stderr,"Error configuring the connection\n");
|
---|
64 | close(netfd);
|
---|
65 | return -1;
|
---|
66 | }
|
---|
67 |
|
---|
68 | /* Get conf options */
|
---|
69 | if ((ioctl(netfd, NWIOGUDPOPT, &udpopt))<0)
|
---|
70 | {
|
---|
71 | fprintf(stderr,"Error getting the conf\n");
|
---|
72 | close(netfd);
|
---|
73 | return -1;
|
---|
74 | }
|
---|
75 |
|
---|
76 | return netfd;
|
---|
77 | }
|
---|
78 |
|
---|
79 | int main(int argc,char *argv[]) {
|
---|
80 | int fd;
|
---|
81 | ssize_t data_read;
|
---|
82 | udp_buffer_t buffer;
|
---|
83 | ipaddr_t tmp_addr;
|
---|
84 | udpport_t tmp_port;
|
---|
85 | int ret;
|
---|
86 | fd_set fds_read;
|
---|
87 |
|
---|
88 | if ((fd = udp_conf(PORT)) < 0) {
|
---|
89 | fprintf(stderr, "Error configuring UDP connection\n");
|
---|
90 | exit(-1);
|
---|
91 | }
|
---|
92 | printf("Waiting for messages on port: %ld\n", PORT);
|
---|
93 | fflush(stdout);
|
---|
94 | /* Initialize fd_set */
|
---|
95 | FD_ZERO(&fds_read);
|
---|
96 | FD_SET(fd, &fds_read);
|
---|
97 |
|
---|
98 | while (1)
|
---|
99 | {
|
---|
100 | /* Wait for data available to be read (no timeout) */
|
---|
101 | ret = select(4, &fds_read, NULL, NULL, NULL);
|
---|
102 | if (ret < 0) {
|
---|
103 | fprintf(stderr, "Error on select: %d", errno);
|
---|
104 | exit(-1);
|
---|
105 | }
|
---|
106 | if (!FD_ISSET(fd, &fds_read)) {
|
---|
107 | printf("Error: network fd is not ready (?)\n");
|
---|
108 | exit(-1);
|
---|
109 | }
|
---|
110 | printf("Ready to receive...\n");
|
---|
111 | /* Read received data */
|
---|
112 | data_read = read(fd, &buffer, sizeof(udp_buffer_t));
|
---|
113 | printf("Received data: %s\n", buffer.data);
|
---|
114 |
|
---|
115 | /* Can exit if the received string == exit */
|
---|
116 | if (!strcmp(buffer.data,"exit"))
|
---|
117 | break;
|
---|
118 |
|
---|
119 | /* Send data back, swap addresses */
|
---|
120 | tmp_addr = buffer.header.uih_src_addr;
|
---|
121 | buffer.header.uih_src_addr = buffer.header.uih_dst_addr;
|
---|
122 | buffer.header.uih_dst_addr = tmp_addr;
|
---|
123 |
|
---|
124 | /* Swap ports */
|
---|
125 | tmp_port = buffer.header.uih_src_port;
|
---|
126 | buffer.header.uih_src_port = buffer.header.uih_dst_port;
|
---|
127 | buffer.header.uih_dst_port = tmp_port;
|
---|
128 |
|
---|
129 | /* Write the same back */
|
---|
130 | write(fd, &buffer, data_read);
|
---|
131 | }
|
---|
132 |
|
---|
133 | close(fd);
|
---|
134 | }
|
---|