1 | #include <stdio.h> |
---|
2 | #include <inttypes.h> |
---|
3 | #include <dlfcn.h> |
---|
4 | #include "libpacketdump.h" |
---|
5 | |
---|
6 | #define STRUCT icmp |
---|
7 | |
---|
8 | #define SAFE(x) \ |
---|
9 | ((unsigned int)len>=((char*)&STRUCT->x-(char*)STRUCT+sizeof(STRUCT->x))) |
---|
10 | #define DISPLAY_EXP(x,fmt,exp) \ |
---|
11 | if (SAFE(x)) \ |
---|
12 | printf(fmt,exp); \ |
---|
13 | else \ |
---|
14 | return; |
---|
15 | |
---|
16 | #define DISPLAY(x,fmt) DISPLAY_EXP(x,fmt,STRUCT->x) |
---|
17 | |
---|
18 | #define DISPLAYS(x,fmt) DISPLAY_EXP(x,fmt,htons(STRUCT->x)) |
---|
19 | #define DISPLAYL(x,fmt) DISPLAY_EXP(x,fmt,htonl(STRUCT->x)) |
---|
20 | #define DISPLAYIP(x,fmt) DISPLAY_EXP(x,fmt,inet_ntoa(*(struct in_addr*)&STRUCT->x)) |
---|
21 | |
---|
22 | static char *unreach_types[]={ |
---|
23 | "Destination Network Unreachable", |
---|
24 | "Destination Host Unreachable", |
---|
25 | "Destination Protocol Unreachable", |
---|
26 | "Destination Port Unreachable", |
---|
27 | "Fragmentation Required And Dont Fragment Set", |
---|
28 | "Source Route Failed", |
---|
29 | "Destination Network Unknown", |
---|
30 | "Destination Host Unknown", |
---|
31 | "Source Host Isolated", |
---|
32 | "Destination Network Administratively Prohibited", |
---|
33 | "Destination Host Administratively Prohibited", |
---|
34 | "Destination Network Unreachable For Type Of Service", |
---|
35 | "Destination Host Unreachable For Type Of Service", |
---|
36 | "Communication Administratively Prohibited", |
---|
37 | "Host Precedence Violation", |
---|
38 | "Precedence Cutoff In Effect", |
---|
39 | }; |
---|
40 | |
---|
41 | DLLEXPORT void decode(int link_type UNUSED,const char *packet,unsigned len) |
---|
42 | { |
---|
43 | libtrace_icmp_t *icmp = (libtrace_icmp_t*)packet; |
---|
44 | if (len<1) |
---|
45 | return; |
---|
46 | printf(" ICMP:"); |
---|
47 | switch(icmp->type) { |
---|
48 | case 0: |
---|
49 | printf(" Type: 0 (ICMP Echo Reply) Sequence: "); |
---|
50 | if (len < 4) |
---|
51 | printf("(Truncated)\n"); |
---|
52 | else |
---|
53 | printf("%u\n", ntohs(icmp->un.echo.sequence)); |
---|
54 | break; |
---|
55 | case 3: |
---|
56 | printf(" Type: 3 (ICMP Destination Unreachable)\n"); |
---|
57 | if (len<2) |
---|
58 | return; |
---|
59 | if (icmp->code<sizeof(unreach_types)) { |
---|
60 | printf(" ICMP: Code: %i (%s)\n",icmp->code, |
---|
61 | unreach_types[icmp->code]); |
---|
62 | } |
---|
63 | else { |
---|
64 | printf(" ICMP: Code: %i (Unknown)\n",icmp->code); |
---|
65 | } |
---|
66 | // Pretend that this was just passed up from ethernet |
---|
67 | decode_next(packet+8,len-8, |
---|
68 | "eth",0x0800); |
---|
69 | |
---|
70 | break; |
---|
71 | case 8: |
---|
72 | printf(" Type: 8 (ICMP Echo Request) Sequence: "); |
---|
73 | if (len < 4) |
---|
74 | printf("(Truncated)\n"); |
---|
75 | else |
---|
76 | printf("%u\n", ntohs(icmp->un.echo.sequence)); |
---|
77 | break; |
---|
78 | case 11: |
---|
79 | printf(" Type: 11 (ICMP TTL Exceeded)\n"); |
---|
80 | decode_next(packet+8,len-8, |
---|
81 | "eth",0x0800); |
---|
82 | break; |
---|
83 | default: |
---|
84 | printf(" Type: %i (Unknown)\n",icmp->type); |
---|
85 | break; |
---|
86 | |
---|
87 | } |
---|
88 | printf(" ICMP: Checksum: "); |
---|
89 | if (len < 8) |
---|
90 | printf("(Truncated)\n"); |
---|
91 | else |
---|
92 | printf("%u\n", ntohs(icmp->checksum)); |
---|
93 | |
---|
94 | |
---|
95 | return; |
---|
96 | } |
---|