| // Copyright 2016 The Fuchsia Authors. All rights reserved. |
| // Use of this source code is governed by a BSD-style license that can be |
| // found in the LICENSE file. |
| |
| #include <arpa/inet.h> |
| #include <errno.h> |
| #include <netdb.h> |
| #include <netinet/in.h> |
| #include <stdbool.h> |
| #include <stdio.h> |
| #include <stdlib.h> |
| #include <string.h> |
| #include <sys/socket.h> |
| #include <sys/types.h> |
| #include <unistd.h> |
| |
| const char* sa_to_str(const struct sockaddr* sa, char* str, size_t strlen) { |
| if (sa->sa_family == AF_INET) { |
| struct sockaddr_in* sin = (struct sockaddr_in*)sa; |
| return inet_ntop(AF_INET, &sin->sin_addr, str, strlen); |
| } else if (sa->sa_family == AF_INET6) { |
| struct sockaddr_in6* sin6 = (struct sockaddr_in6*)sa; |
| return inet_ntop(AF_INET6, &sin6->sin6_addr, str, strlen); |
| } else { |
| return NULL; |
| } |
| } |
| |
| void dump_ai(struct addrinfo* ai) { |
| char str[INET6_ADDRSTRLEN]; |
| printf( |
| "family %d, socktype %d, flags %d, protocol %d, addrlen %d, " |
| "addr %s\n", |
| ai->ai_family, ai->ai_socktype, ai->ai_flags, ai->ai_protocol, |
| ai->ai_addrlen, |
| ai->ai_addr ? sa_to_str(ai->ai_addr, str, sizeof(str)) : "NULL"); |
| } |
| |
| int client(const char* address, const char* service, const char* message, |
| bool use_connect) { |
| struct addrinfo hints; |
| struct addrinfo *result, *rp; |
| |
| memset(&hints, 0, sizeof(struct addrinfo)); |
| hints.ai_family = AF_UNSPEC; |
| hints.ai_socktype = SOCK_DGRAM; |
| hints.ai_flags = 0; |
| hints.ai_protocol = 0; |
| |
| int r; |
| r = getaddrinfo(address, service, &hints, &result); |
| if (r != 0) { |
| printf("getaddrinfo failed (%d, errno = %d)\n", r, errno); |
| return -1; |
| } |
| |
| // int i = 0; |
| // for (rp = result; rp != NULL; rp = rp->ai_next) { |
| // printf("[%d] ", i++); |
| // dump_ai(rp); |
| // } |
| |
| int s; |
| for (rp = result; rp != NULL; rp = rp->ai_next) { |
| s = socket(rp->ai_family, rp->ai_socktype, rp->ai_protocol); |
| if (s < 0) { |
| printf("socket failed (errno = %d)\n", errno); |
| continue; |
| } |
| |
| char str[INET6_ADDRSTRLEN]; |
| if (use_connect) { |
| printf("connecting to %s\n", sa_to_str(rp->ai_addr, str, sizeof(str))); |
| if (connect(s, rp->ai_addr, rp->ai_addrlen) < 0) { |
| printf("connect failed (errno = %d)\n", errno); |
| close(s); |
| continue; |
| } |
| int nwrite; |
| nwrite = write(s, message, strlen(message)); |
| if (nwrite < 0) { |
| printf("write failed (%d) (errno = %d)\n", nwrite, errno); |
| close(s); |
| return -1; |
| } |
| printf("write success (nwrite = %d)\n", nwrite); |
| } else { |
| printf("sending to %s\n", sa_to_str(rp->ai_addr, str, sizeof(str))); |
| int nsendto; |
| nsendto = |
| sendto(s, message, strlen(message), 0, rp->ai_addr, rp->ai_addrlen); |
| if (nsendto < 0) { |
| printf("sendto failed (%d) (errno = %d)\n", nsendto, errno); |
| close(s); |
| return -1; |
| } |
| printf("sendto success (nwrite = %d)\n", nsendto); |
| } |
| close(s); |
| break; |
| } |
| if (rp == NULL) { |
| printf("all connect attempts failed\n"); |
| return -1; |
| } |
| freeaddrinfo(result); |
| |
| return 0; |
| } |
| |
| int server(const char* service) { |
| int16_t port = atoi(service); |
| |
| int s = socket(AF_INET6, SOCK_DGRAM, 0); |
| if (s < 0) { |
| printf("socket failed (errno = %d)\n", errno); |
| return -1; |
| } |
| |
| struct sockaddr_in6 addr; |
| memset(&addr, 0, sizeof(addr)); |
| addr.sin6_family = AF_INET6; |
| addr.sin6_addr = in6addr_any; // works with IPv4 |
| addr.sin6_port = htons(port); |
| |
| if (bind(s, (struct sockaddr*)&addr, sizeof(addr)) < 0) { |
| printf("bind failed (errno = %d)\n", errno); |
| return -1; |
| } |
| |
| printf("waiting for a connection on port %d...\n", port); |
| |
| for (;;) { |
| char buf[128]; |
| int nrecv; |
| socklen_t addrlen = sizeof(addr); |
| nrecv = recvfrom(s, buf, sizeof(buf), 0, (struct sockaddr*)&addr, &addrlen); |
| if (nrecv < 0) { |
| printf("recvfrom failed (%d) (errno = %d)\n", nrecv, errno); |
| close(s); |
| return -1; |
| } |
| char str[INET6_ADDRSTRLEN]; |
| printf("connected from %s\n", |
| sa_to_str((struct sockaddr*)&addr, str, sizeof(str))); |
| |
| int n = write(1, buf, nrecv); |
| if (n < 0) { |
| printf("write failed (%d) (errno = %d)\n", n, errno); |
| close(s); |
| return -1; |
| } |
| printf("\n"); |
| } |
| |
| return 0; |
| } |
| |
| void usage(void) { |
| printf("usage: udptest server port\n"); |
| printf(" udptest client address port message\n"); |
| } |
| |
| int main(int argc, char** argv) { |
| if (argc > 1) { |
| switch (argv[1][0]) { |
| case 'c': // client sendto |
| if (argc == 5) |
| return client(argv[2], argv[3], argv[4], false); |
| case 'C': // client connect & write |
| if (argc == 5) |
| return client(argv[2], argv[3], argv[4], true); |
| case 's': // server |
| if (argc == 3) |
| return server(argv[2]); |
| } |
| } |
| usage(); |
| return -1; |
| } |