multicast_server.c 3.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120
  1. /*
  2. * Copyright (C) 2022 Amazon.com Inc. or its affiliates. All rights reserved.
  3. * SPDX-License-Identifier: Apache-2.0 WITH LLVM-exception
  4. */
  5. #include <arpa/inet.h>
  6. #include <stdio.h>
  7. #include <stdlib.h>
  8. #include <string.h>
  9. #include <sys/socket.h>
  10. #include <unistd.h>
  11. #ifdef __wasi__
  12. #include <wasi_socket_ext.h>
  13. #endif
  14. static int
  15. get_ip_addr_type(char *addr, char *buf)
  16. {
  17. if (inet_pton(AF_INET6, addr, buf)) {
  18. return AF_INET6;
  19. }
  20. if (inet_pton(AF_INET, addr, buf)) {
  21. return AF_INET;
  22. }
  23. return -1;
  24. }
  25. static int
  26. is_valid_addr_type(int addr_type)
  27. {
  28. return !(addr_type == -1
  29. || (addr_type != AF_INET && addr_type != AF_INET6));
  30. }
  31. static void
  32. init_sockaddr_inet(struct sockaddr_in *addr, char *addr_buffer)
  33. {
  34. addr->sin_family = AF_INET;
  35. addr->sin_port = htons(1234);
  36. memcpy(&(addr->sin_addr), addr_buffer, 4);
  37. }
  38. static void
  39. init_sockaddr_inet6(struct sockaddr_in6 *addr, char *addr_buffer)
  40. {
  41. addr->sin6_family = AF_INET6;
  42. addr->sin6_port = htons(1234);
  43. memcpy(&(addr->sin6_addr), addr_buffer, 16);
  44. }
  45. int
  46. main(int argc, char *argv[])
  47. {
  48. struct sockaddr_storage addr = { 0 };
  49. int sd;
  50. char *databuf = "Test message";
  51. int datalen = strlen(databuf) + 1;
  52. char multicast_addr_buffer[16];
  53. int addr_type = -1;
  54. int multicast_interface;
  55. int bool_opt = 1;
  56. if (argc < 2) {
  57. printf("Usage is <Multicast IP>\n");
  58. return EXIT_FAILURE;
  59. }
  60. addr_type = get_ip_addr_type(argv[1], multicast_addr_buffer);
  61. if (!is_valid_addr_type(addr_type)) {
  62. printf("Not a valid ipv4 or ipv6 address\n");
  63. return EXIT_FAILURE;
  64. }
  65. if ((sd = socket(addr_type, SOCK_DGRAM, 0)) == -1) {
  66. return EXIT_FAILURE;
  67. }
  68. if (setsockopt(sd, SOL_SOCKET, SO_REUSEADDR, &bool_opt, sizeof(bool_opt))
  69. == -1) {
  70. perror("Failed setting SO_REUSEADDR");
  71. goto fail;
  72. }
  73. if (addr_type == AF_INET) {
  74. multicast_interface = htonl(INADDR_ANY);
  75. if (setsockopt(sd, IPPROTO_IP, IP_MULTICAST_IF,
  76. (char *)&multicast_interface,
  77. sizeof(multicast_interface))) {
  78. perror("Failed setting local interface");
  79. goto fail;
  80. }
  81. init_sockaddr_inet((struct sockaddr_in *)&addr, multicast_addr_buffer);
  82. }
  83. else {
  84. multicast_interface = 0;
  85. if (setsockopt(sd, IPPROTO_IPV6, IPV6_MULTICAST_IF,
  86. (char *)&multicast_interface,
  87. sizeof(multicast_interface))) {
  88. perror("Failed setting local interface");
  89. goto fail;
  90. }
  91. init_sockaddr_inet6((struct sockaddr_in6 *)&addr,
  92. multicast_addr_buffer);
  93. }
  94. if (sendto(sd, databuf, datalen, 0, (struct sockaddr *)&addr, sizeof(addr))
  95. == -1) {
  96. perror("Failed sending datagram");
  97. goto fail;
  98. }
  99. printf("Datagram sent\n");
  100. close(sd);
  101. return EXIT_SUCCESS;
  102. fail:
  103. close(sd);
  104. return EXIT_FAILURE;
  105. }