recv_v6.lc 4.9 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677
  1. #include "trace.h"## 1 ##src/traceroute/recv_v6.c##
  2. /*## 2 ##src/traceroute/recv_v6.c##
  3. * Return: -3 on timeout## 3 ##src/traceroute/recv_v6.c##
  4. * -2 on ICMP time exceeded in transit (caller keeps going)## 4 ##src/traceroute/recv_v6.c##
  5. * -1 on ICMP port unreachable (caller is done)## 5 ##src/traceroute/recv_v6.c##
  6. * >= 0 return value is some other ICMP unreachable code## 6 ##src/traceroute/recv_v6.c##
  7. */## 7 ##src/traceroute/recv_v6.c##
  8. int## 8 ##src/traceroute/recv_v6.c##
  9. recv_v6(int seq, struct timeval *tv)## 9 ##src/traceroute/recv_v6.c##
  10. {## 10 ##src/traceroute/recv_v6.c##
  11. #ifdef IPV6## 11 ##src/traceroute/recv_v6.c##
  12. int hlen1, hlen2, icmp6len;## 12 ##src/traceroute/recv_v6.c##
  13. ssize_t n;## 13 ##src/traceroute/recv_v6.c##
  14. socklen_t len;## 14 ##src/traceroute/recv_v6.c##
  15. struct ip6_hdr *ip6, *hip6;## 15 ##src/traceroute/recv_v6.c##
  16. struct icmp6_hdr *icmp6;## 16 ##src/traceroute/recv_v6.c##
  17. struct udphdr *udp;## 17 ##src/traceroute/recv_v6.c##
  18. alarm(3);## 18 ##src/traceroute/recv_v6.c##
  19. for (;;) {## 19 ##src/traceroute/recv_v6.c##
  20. len = pr->salen;## 20 ##src/traceroute/recv_v6.c##
  21. n = recvfrom(recvfd, recvbuf, sizeof(recvbuf), 0, pr->sarecv, &len);## 21 ##src/traceroute/recv_v6.c##
  22. if (n < 0) {## 22 ##src/traceroute/recv_v6.c##
  23. if (errno == EINTR)## 23 ##src/traceroute/recv_v6.c##
  24. return (-3); /* alarm expired */## 24 ##src/traceroute/recv_v6.c##
  25. else## 25 ##src/traceroute/recv_v6.c##
  26. err_sys("recvfrom error");## 26 ##src/traceroute/recv_v6.c##
  27. }## 27 ##src/traceroute/recv_v6.c##
  28. Gettimeofday(tv, NULL); /* get time of packet arrival */## 28 ##src/traceroute/recv_v6.c##
  29. ip6 = (struct ip6_hdr *) recvbuf; /* start of IPv6 header */## 29 ##src/traceroute/recv_v6.c##
  30. hlen1 = sizeof(struct ip6_hdr);## 30 ##src/traceroute/recv_v6.c##
  31. icmp6 = (struct icmp6_hdr *) (recvbuf + hlen1); /* ICMP hdr */## 31 ##src/traceroute/recv_v6.c##
  32. if ((icmp6len = n - hlen1) < 8)## 32 ##src/traceroute/recv_v6.c##
  33. err_quit("icmp6len (%d) < 8", icmp6len);## 33 ##src/traceroute/recv_v6.c##
  34. if (icmp6->icmp6_type == ICMP6_TIME_EXCEEDED &&## 34 ##src/traceroute/recv_v6.c##
  35. icmp6->icmp6_code == ICMP6_TIME_EXCEED_TRANSIT) {## 35 ##src/traceroute/recv_v6.c##
  36. if (icmp6len < 8 + 40 + 8)## 36 ##src/traceroute/recv_v6.c##
  37. err_quit("icmp6len (%d) < 8 + 40 + 8", icmp6len);## 37 ##src/traceroute/recv_v6.c##
  38. hip6 = (struct ip6_hdr *) (recvbuf + hlen1 + 8);## 38 ##src/traceroute/recv_v6.c##
  39. hlen2 = sizeof(struct ip6_hdr);## 39 ##src/traceroute/recv_v6.c##
  40. udp = (struct udphdr *) (recvbuf + hlen1 + 8 + hlen2);## 40 ##src/traceroute/recv_v6.c##
  41. if (hip6->ip6_nxt == IPPROTO_UDP &&## 41 ##src/traceroute/recv_v6.c##
  42. udp->uh_sport == htons(sport) &&## 42 ##src/traceroute/recv_v6.c##
  43. udp->uh_dport == htons(dport + seq))## 43 ##src/traceroute/recv_v6.c##
  44. return (-2); /* we hit an intermediate router */## 44 ##src/traceroute/recv_v6.c##
  45. } else if (icmp6->icmp6_type == ICMP6_DST_UNREACH) {## 45 ##src/traceroute/recv_v6.c##
  46. if (icmp6len < 8 + 40 + 8)## 46 ##src/traceroute/recv_v6.c##
  47. err_quit("icmp6len (%d) < 8 + 40 + 8", icmp6len);## 47 ##src/traceroute/recv_v6.c##
  48. hip6 = (struct ip6_hdr *) (recvbuf + hlen1 + 8);## 48 ##src/traceroute/recv_v6.c##
  49. hlen2 = 40;## 49 ##src/traceroute/recv_v6.c##
  50. udp = (struct udphdr *) (recvbuf + hlen1 + 8 + hlen2);## 50 ##src/traceroute/recv_v6.c##
  51. if (hip6->ip6_nxt == IPPROTO_UDP &&## 51 ##src/traceroute/recv_v6.c##
  52. udp->uh_sport == htons(sport) &&## 52 ##src/traceroute/recv_v6.c##
  53. udp->uh_dport == htons(dport + seq)) {## 53 ##src/traceroute/recv_v6.c##
  54. if (icmp6->icmp6_code == ICMP6_DST_UNREACH_NOPORT)## 54 ##src/traceroute/recv_v6.c##
  55. return (-1); /* have reached destination */## 55 ##src/traceroute/recv_v6.c##
  56. else## 56 ##src/traceroute/recv_v6.c##
  57. return (icmp6->icmp6_code); /* 0, 1, 2, ... */## 57 ##src/traceroute/recv_v6.c##
  58. }## 58 ##src/traceroute/recv_v6.c##
  59. } else if (verbose) {## 59 ##src/traceroute/recv_v6.c##
  60. printf(" (from %s: type = %d, code = %d)\n",## 60 ##src/traceroute/recv_v6.c##
  61. Sock_ntop_host(pr->sarecv, pr->salen),## 61 ##src/traceroute/recv_v6.c##
  62. icmp6->icmp6_type, icmp6->icmp6_code);## 62 ##src/traceroute/recv_v6.c##
  63. }## 63 ##src/traceroute/recv_v6.c##
  64. /* Some other ICMP error, recvfrom() again */## 64 ##src/traceroute/recv_v6.c##
  65. }## 65 ##src/traceroute/recv_v6.c##
  66. #endif## 66 ##src/traceroute/recv_v6.c##
  67. }## 67 ##src/traceroute/recv_v6.c##