1/*
2 * Copyright 2011 Daniel Drown
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 * http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 *
16 * dump.c - print various headers for debugging
17 */
18#include <stdio.h>
19#include <stdint.h>
20#include <stdlib.h>
21
22#include <arpa/inet.h>
23#include <netinet/in.h>
24#include <netinet/ip.h>
25#include <netinet/ip_icmp.h>
26#include <netinet/udp.h>
27#include <netinet/tcp.h>
28#include <netinet/ip6.h>
29#include <netinet/icmp6.h>
30#include <linux/icmp.h>
31
32#include "debug.h"
33#include "checksum.h"
34#include "clatd.h"
35#include "logging.h"
36
37#if CLAT_DEBUG
38
39/* print ip header */
40void dump_ip(struct iphdr *header) {
41  u_int16_t frag_flags;
42  char addrstr[INET6_ADDRSTRLEN];
43
44  frag_flags = ntohs(header->frag_off);
45
46  printf("IP packet\n");
47  printf("header_len = %x\n",header->ihl);
48  printf("version = %x\n",header->version);
49  printf("tos = %x\n",header->tos);
50  printf("tot_len = %x\n",ntohs(header->tot_len));
51  printf("id = %x\n",ntohs(header->id));
52  printf("frag: ");
53  if(frag_flags & IP_RF) {
54    printf("(RF) ");
55  }
56  if(frag_flags & IP_DF) {
57    printf("DF ");
58  }
59  if(frag_flags & IP_MF) {
60    printf("MF ");
61  }
62  printf("offset = %x\n",frag_flags & IP_OFFMASK);
63  printf("ttl = %x\n",header->ttl);
64  printf("protocol = %x\n",header->protocol);
65  printf("checksum = %x\n",ntohs(header->check));
66  inet_ntop(AF_INET, &header->saddr, addrstr, sizeof(addrstr));
67  printf("saddr = %s\n",addrstr);
68  inet_ntop(AF_INET, &header->daddr, addrstr, sizeof(addrstr));
69  printf("daddr = %s\n",addrstr);
70}
71
72/* print ip6 header */
73void dump_ip6(struct ip6_hdr *header) {
74  char addrstr[INET6_ADDRSTRLEN];
75
76  printf("ipv6\n");
77  printf("version = %x\n",header->ip6_vfc >> 4);
78  printf("traffic class = %x\n",header->ip6_flow >> 20);
79  printf("flow label = %x\n",ntohl(header->ip6_flow & 0x000fffff));
80  printf("payload len = %x\n",ntohs(header->ip6_plen));
81  printf("next header = %x\n",header->ip6_nxt);
82  printf("hop limit = %x\n",header->ip6_hlim);
83
84  inet_ntop(AF_INET6, &header->ip6_src, addrstr, sizeof(addrstr));
85  printf("source = %s\n",addrstr);
86
87  inet_ntop(AF_INET6, &header->ip6_dst, addrstr, sizeof(addrstr));
88  printf("dest = %s\n",addrstr);
89}
90
91/* print icmp header */
92void dump_icmp(struct icmphdr *icmp) {
93  printf("ICMP\n");
94
95  printf("icmp.type = %x ",icmp->type);
96  if(icmp->type == ICMP_ECHOREPLY) {
97    printf("echo reply");
98  } else if(icmp->type == ICMP_ECHO) {
99    printf("echo request");
100  } else {
101    printf("other");
102  }
103  printf("\n");
104  printf("icmp.code = %x\n",icmp->code);
105  printf("icmp.checksum = %x\n",ntohs(icmp->checksum));
106  if(icmp->type == ICMP_ECHOREPLY || icmp->type == ICMP_ECHO) {
107    printf("icmp.un.echo.id = %x\n",ntohs(icmp->un.echo.id));
108    printf("icmp.un.echo.sequence = %x\n",ntohs(icmp->un.echo.sequence));
109  }
110}
111
112/* print icmp6 header */
113void dump_icmp6(struct icmp6_hdr *icmp6) {
114  printf("ICMP6\n");
115  printf("type = %x",icmp6->icmp6_type);
116  if(icmp6->icmp6_type == ICMP6_ECHO_REQUEST) {
117    printf("(echo request)");
118  } else if(icmp6->icmp6_type == ICMP6_ECHO_REPLY) {
119    printf("(echo reply)");
120  }
121  printf("\n");
122  printf("code = %x\n",icmp6->icmp6_code);
123
124  printf("checksum = %x\n",icmp6->icmp6_cksum);
125
126  if((icmp6->icmp6_type == ICMP6_ECHO_REQUEST) || (icmp6->icmp6_type == ICMP6_ECHO_REPLY)) {
127    printf("icmp6_id = %x\n",icmp6->icmp6_id);
128    printf("icmp6_seq = %x\n",icmp6->icmp6_seq);
129  }
130}
131
132/* print udp header */
133void dump_udp_generic(const struct udphdr *udp, uint32_t temp_checksum,
134                      const uint8_t *payload, size_t payload_size) {
135  uint16_t my_checksum;
136
137  temp_checksum = ip_checksum_add(temp_checksum, udp, sizeof(struct udphdr));
138  temp_checksum = ip_checksum_add(temp_checksum, payload, payload_size);
139  my_checksum = ip_checksum_finish(temp_checksum);
140
141  printf("UDP\n");
142  printf("source = %x\n",ntohs(udp->source));
143  printf("dest = %x\n",ntohs(udp->dest));
144  printf("len = %x\n",ntohs(udp->len));
145  printf("check = %x (mine %x)\n",udp->check,my_checksum);
146}
147
148/* print ipv4/udp header */
149void dump_udp(const struct udphdr *udp, const struct iphdr *ip,
150              const uint8_t *payload, size_t payload_size) {
151  uint32_t temp_checksum;
152  temp_checksum = ipv4_pseudo_header_checksum(ip, sizeof(*udp) + payload_size);
153  dump_udp_generic(udp, temp_checksum, payload, payload_size);
154}
155
156/* print ipv6/udp header */
157void dump_udp6(const struct udphdr *udp, const struct ip6_hdr *ip6,
158               const uint8_t *payload, size_t payload_size) {
159  uint32_t temp_checksum;
160  temp_checksum = ipv6_pseudo_header_checksum(ip6, sizeof(*udp) + payload_size, IPPROTO_UDP);
161  dump_udp_generic(udp, temp_checksum, payload, payload_size);
162}
163
164/* print tcp header */
165void dump_tcp_generic(const struct tcphdr *tcp, const uint8_t *options, size_t options_size, uint32_t temp_checksum, const uint8_t *payload, size_t payload_size) {
166  uint16_t my_checksum;
167
168  temp_checksum = ip_checksum_add(temp_checksum, tcp, sizeof(struct tcphdr));
169  if(options) {
170    temp_checksum = ip_checksum_add(temp_checksum, options, options_size);
171  }
172  temp_checksum = ip_checksum_add(temp_checksum, payload, payload_size);
173  my_checksum = ip_checksum_finish(temp_checksum);
174
175  printf("TCP\n");
176  printf("source = %x\n",ntohs(tcp->source));
177  printf("dest = %x\n",ntohs(tcp->dest));
178  printf("seq = %x\n",ntohl(tcp->seq));
179  printf("ack = %x\n",ntohl(tcp->ack_seq));
180  printf("d_off = %x\n",tcp->doff);
181  printf("res1 = %x\n",tcp->res1);
182#ifdef __BIONIC__
183  printf("CWR = %x\n",tcp->cwr);
184  printf("ECE = %x\n",tcp->ece);
185#else
186  printf("CWR/ECE = %x\n",tcp->res2);
187#endif
188  printf("urg = %x  ack = %x  psh = %x  rst = %x  syn = %x  fin = %x\n",
189      tcp->urg, tcp->ack, tcp->psh, tcp->rst, tcp->syn, tcp->fin);
190  printf("window = %x\n",ntohs(tcp->window));
191  printf("check = %x [mine %x]\n",tcp->check,my_checksum);
192  printf("urgent = %x\n",tcp->urg_ptr);
193
194  if(options) {
195    size_t i;
196
197    printf("options: ");
198    for(i=0; i<options_size; i++) {
199      printf("%x ",*(options+i));
200    }
201    printf("\n");
202  }
203}
204
205/* print ipv4/tcp header */
206void dump_tcp(const struct tcphdr *tcp, const struct iphdr *ip,
207              const uint8_t *payload, size_t payload_size,
208              const uint8_t *options, size_t options_size) {
209  uint32_t temp_checksum;
210
211  temp_checksum = ipv4_pseudo_header_checksum(ip, sizeof(*tcp) + options_size + payload_size);
212  dump_tcp_generic(tcp, options, options_size, temp_checksum, payload, payload_size);
213}
214
215/* print ipv6/tcp header */
216void dump_tcp6(const struct tcphdr *tcp, const struct ip6_hdr *ip6,
217               const uint8_t *payload, size_t payload_size,
218               const uint8_t *options, size_t options_size) {
219  uint32_t temp_checksum;
220
221  temp_checksum = ipv6_pseudo_header_checksum(ip6, sizeof(*tcp) + options_size + payload_size, IPPROTO_TCP);
222  dump_tcp_generic(tcp, options, options_size, temp_checksum, payload, payload_size);
223}
224
225/* generic hex dump */
226void logcat_hexdump(const char *info, const uint8_t *data, size_t len) {
227  char output[PACKETLEN*3+2];
228  size_t i;
229
230  output[0] = '\0';
231  for(i = 0; i < len && i < PACKETLEN; i++) {
232    snprintf(output + i*3, 4, " %02x", data[i]);
233  }
234  output[len*3+3] = '\0';
235
236  logmsg(ANDROID_LOG_WARN,"info %s len %d data%s", info, len, output);
237}
238
239void dump_iovec(const struct iovec *iov, int iov_len) {
240  int i;
241  char *str;
242  for (i = 0; i < iov_len; i++) {
243    asprintf(&str, "iov[%d]: ", i);
244    logcat_hexdump(str, iov[i].iov_base, iov[i].iov_len);
245    free(str);
246  }
247}
248#endif  // CLAT_DEBUG
249