getservbyport_r.cc 1.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960
  1. #define _GNU_SOURCE
  2. #include <sys/types.h>
  3. #include <sys/socket.h>
  4. #include <netinet/in.h>
  5. #include <netdb.h>
  6. #include <inttypes.h>
  7. #include <errno.h>
  8. #include <string.h>
  9. #ifndef HAVE_GETSERVBYPORT_R
  10. extern "C" int getservbyport_r(int port, const char *prots,
  11. struct servent *se, char *buf, size_t buflen, struct servent **res)
  12. {
  13. int i;
  14. struct sockaddr_in sin = {
  15. .sin_family = AF_INET,
  16. .sin_port = (in_port_t) port,
  17. };
  18. if (!prots) {
  19. int r = getservbyport_r(port, "tcp", se, buf, buflen, res);
  20. if (r) r = getservbyport_r(port, "udp", se, buf, buflen, res);
  21. return r;
  22. }
  23. /* Align buffer */
  24. i = (uintptr_t)buf & sizeof(char *)-1;
  25. if (!i) i = sizeof(char *);
  26. if (buflen < 3*sizeof(char *)-i)
  27. return ERANGE;
  28. buf += sizeof(char *)-i;
  29. buflen -= sizeof(char *)-i;
  30. if (strcmp(prots, "tcp") && strcmp(prots, "udp")) return EINVAL;
  31. se->s_port = port;
  32. se->s_proto = (char *)prots;
  33. se->s_aliases = (char **)buf;
  34. buf += 2*sizeof(char *);
  35. buflen -= 2*sizeof(char *);
  36. se->s_aliases[1] = 0;
  37. se->s_aliases[0] = se->s_name = buf;
  38. switch (getnameinfo((const struct sockaddr *) &sin, sizeof sin, 0, 0, buf, buflen,
  39. strcmp(prots, "udp") ? 0 : NI_DGRAM)) {
  40. case EAI_MEMORY:
  41. case EAI_SYSTEM:
  42. return ENOMEM;
  43. default:
  44. return ENOENT;
  45. case 0:
  46. break;
  47. }
  48. *res = se;
  49. return 0;
  50. }
  51. #endif