1: /*
2: * $smu-mark$
3: * $name: sendicmp.c$
4: * $author: Salvatore Sanfilippo <antirez@invece.org>$
5: * $copyright: Copyright (C) 1999 by Salvatore Sanfilippo$
6: * $license: This software is under GPL version 2 of license$
7: * $date: Fri Nov 5 11:55:49 MET 1999$
8: * $rev: 8$
9: */
10:
11: /* $Id: sendicmp.c,v 1.1.1.1 2012/02/21 22:11:37 misho Exp $ */
12:
13: #include <sys/types.h> /* this should be not needed, but ip_icmp.h lacks it */
14: #include <stdio.h>
15: #include <time.h>
16: #include <sys/time.h>
17: #include <stdlib.h>
18: #include <unistd.h>
19: #include <string.h>
20: #include <signal.h>
21: #include <errno.h>
22:
23: #include "hping2.h"
24: #include "globals.h"
25:
26: static int _icmp_seq = 0;
27:
28: void send_icmp_echo(void);
29: void send_icmp_other(void);
30: void send_icmp_timestamp(void);
31: void send_icmp_address(void);
32:
33: void send_icmp(void)
34: {
35: switch(opt_icmptype)
36: {
37: case ICMP_ECHO: /* type 8 */
38: case ICMP_ECHOREPLY: /* type 0 */
39: send_icmp_echo();
40: break;
41: case ICMP_DEST_UNREACH: /* type 3 */
42: case ICMP_SOURCE_QUENCH: /* type 4 */
43: case ICMP_REDIRECT: /* type 5 */
44: case ICMP_TIME_EXCEEDED: /* type 11 */
45: send_icmp_other();
46: break;
47: case ICMP_TIMESTAMP:
48: case ICMP_TIMESTAMPREPLY:
49: send_icmp_timestamp();
50: break;
51: case ICMP_ADDRESS:
52: case ICMP_ADDRESSREPLY:
53: send_icmp_address();
54: break;
55: default:
56: if (opt_force_icmp) {
57: send_icmp_other();
58: break;
59: } else {
60: printf("[send_icmp] Unsupported icmp type!\n");
61: exit(1);
62: }
63: }
64: }
65:
66: void send_icmp_echo(void)
67: {
68: char *packet, *data;
69: struct myicmphdr *icmp;
70:
71: packet = malloc(ICMPHDR_SIZE + data_size);
72: if (packet == NULL) {
73: perror("[send_icmp] malloc");
74: return;
75: }
76:
77: memset(packet, 0, ICMPHDR_SIZE + data_size);
78:
79: icmp = (struct myicmphdr*) packet;
80: data = packet + ICMPHDR_SIZE;
81:
82: /* fill icmp hdr */
83: icmp->type = opt_icmptype; /* echo replay or echo request */
84: icmp->code = opt_icmpcode; /* should be indifferent */
85: icmp->checksum = 0;
86: icmp->un.echo.id = getpid() & 0xffff;
87: icmp->un.echo.sequence = _icmp_seq;
88:
89: /* data */
90: data_handler(data, data_size);
91:
92: /* icmp checksum */
93: if (icmp_cksum == -1)
94: icmp->checksum = cksum((u_short*)packet, ICMPHDR_SIZE + data_size);
95: else
96: icmp->checksum = icmp_cksum;
97:
98: /* adds this pkt in delaytable */
99: if (opt_icmptype == ICMP_ECHO)
100: delaytable_add(_icmp_seq, 0, time(NULL), get_usec(), S_SENT);
101:
102: /* send packet */
103: send_ip_handler(packet, ICMPHDR_SIZE + data_size);
104: free (packet);
105:
106: _icmp_seq++;
107: }
108:
109: void send_icmp_timestamp(void)
110: {
111: char *packet;
112: struct myicmphdr *icmp;
113: struct icmp_tstamp_data *tstamp_data;
114:
115: packet = malloc(ICMPHDR_SIZE + sizeof(struct icmp_tstamp_data));
116: if (packet == NULL) {
117: perror("[send_icmp] malloc");
118: return;
119: }
120:
121: memset(packet, 0, ICMPHDR_SIZE + sizeof(struct icmp_tstamp_data));
122:
123: icmp = (struct myicmphdr*) packet;
124: tstamp_data = (struct icmp_tstamp_data*) (packet + ICMPHDR_SIZE);
125:
126: /* fill icmp hdr */
127: icmp->type = opt_icmptype; /* echo replay or echo request */
128: icmp->code = 0;
129: icmp->checksum = 0;
130: icmp->un.echo.id = getpid() & 0xffff;
131: icmp->un.echo.sequence = _icmp_seq;
132: tstamp_data->orig = htonl(get_midnight_ut_ms());
133: tstamp_data->recv = tstamp_data->tran = 0;
134:
135: /* icmp checksum */
136: if (icmp_cksum == -1)
137: icmp->checksum = cksum((u_short*)packet, ICMPHDR_SIZE +
138: sizeof(struct icmp_tstamp_data));
139: else
140: icmp->checksum = icmp_cksum;
141:
142: /* adds this pkt in delaytable */
143: if (opt_icmptype == ICMP_TIMESTAMP)
144: delaytable_add(_icmp_seq, 0, time(NULL), get_usec(), S_SENT);
145:
146: /* send packet */
147: send_ip_handler(packet, ICMPHDR_SIZE + sizeof(struct icmp_tstamp_data));
148: free (packet);
149:
150: _icmp_seq++;
151: }
152:
153: void send_icmp_address(void)
154: {
155: char *packet;
156: struct myicmphdr *icmp;
157:
158: packet = malloc(ICMPHDR_SIZE + 4);
159: if (packet == NULL) {
160: perror("[send_icmp] malloc");
161: return;
162: }
163:
164: memset(packet, 0, ICMPHDR_SIZE + 4);
165:
166: icmp = (struct myicmphdr*) packet;
167:
168: /* fill icmp hdr */
169: icmp->type = opt_icmptype; /* echo replay or echo request */
170: icmp->code = 0;
171: icmp->checksum = 0;
172: icmp->un.echo.id = getpid() & 0xffff;
173: icmp->un.echo.sequence = _icmp_seq;
174: memset(packet+ICMPHDR_SIZE, 0, 4);
175:
176: /* icmp checksum */
177: if (icmp_cksum == -1)
178: icmp->checksum = cksum((u_short*)packet, ICMPHDR_SIZE + 4);
179: else
180: icmp->checksum = icmp_cksum;
181:
182: /* adds this pkt in delaytable */
183: if (opt_icmptype == ICMP_TIMESTAMP)
184: delaytable_add(_icmp_seq, 0, time(NULL), get_usec(), S_SENT);
185:
186: /* send packet */
187: send_ip_handler(packet, ICMPHDR_SIZE + 4);
188: free (packet);
189:
190: _icmp_seq++;
191: }
192:
193: void send_icmp_other(void)
194: {
195: char *packet, *data, *ph_buf;
196: struct myicmphdr *icmp;
197: struct myiphdr icmp_ip;
198: struct myudphdr *icmp_udp;
199: int udp_data_len = 0;
200: struct pseudohdr *pseudoheader;
201: int left_space = IPHDR_SIZE + UDPHDR_SIZE + data_size;
202:
203: packet = malloc(ICMPHDR_SIZE + IPHDR_SIZE + UDPHDR_SIZE + data_size);
204: ph_buf = malloc(PSEUDOHDR_SIZE + UDPHDR_SIZE + udp_data_len);
205: if (packet == NULL || ph_buf == NULL) {
206: perror("[send_icmp] malloc");
207: return;
208: }
209:
210: memset(packet, 0, ICMPHDR_SIZE + IPHDR_SIZE + UDPHDR_SIZE + data_size);
211: memset(ph_buf, 0, PSEUDOHDR_SIZE + UDPHDR_SIZE + udp_data_len);
212:
213: icmp = (struct myicmphdr*) packet;
214: data = packet + ICMPHDR_SIZE;
215: pseudoheader = (struct pseudohdr *) ph_buf;
216: icmp_udp = (struct myudphdr *) (ph_buf + PSEUDOHDR_SIZE);
217:
218: /* fill icmp hdr */
219: icmp->type = opt_icmptype; /* ICMP_TIME_EXCEEDED */
220: icmp->code = opt_icmpcode; /* should be 0 (TTL) or 1 (FRAGTIME) */
221: icmp->checksum = 0;
222: if (opt_icmptype == ICMP_REDIRECT)
223: memcpy(&icmp->un.gateway, &icmp_gw.sin_addr.s_addr, 4);
224: else
225: icmp->un.gateway = 0; /* not used, MUST be 0 */
226:
227: /* concerned packet headers */
228: /* IP header */
229: icmp_ip.version = icmp_ip_version; /* 4 */
230: icmp_ip.ihl = icmp_ip_ihl; /* IPHDR_SIZE >> 2 */
231: icmp_ip.tos = icmp_ip_tos; /* 0 */
232: icmp_ip.tot_len = htons((icmp_ip_tot_len ? icmp_ip_tot_len : (icmp_ip_ihl<<2) + UDPHDR_SIZE + udp_data_len));
233: icmp_ip.id = htons(getpid() & 0xffff);
234: icmp_ip.frag_off = 0; /* 0 */
235: icmp_ip.ttl = 64; /* 64 */
236: icmp_ip.protocol = icmp_ip_protocol; /* 6 (TCP) */
237: icmp_ip.check = 0;
238: memcpy(&icmp_ip.saddr, &icmp_ip_src.sin_addr.s_addr, 4);
239: memcpy(&icmp_ip.daddr, &icmp_ip_dst.sin_addr.s_addr, 4);
240: icmp_ip.check = cksum((__u16 *) &icmp_ip, IPHDR_SIZE);
241:
242: /* UDP header */
243: memcpy(&pseudoheader->saddr, &icmp_ip_src.sin_addr.s_addr, 4);
244: memcpy(&pseudoheader->daddr, &icmp_ip_dst.sin_addr.s_addr, 4);
245: pseudoheader->protocol = icmp_ip.protocol;
246: pseudoheader->lenght = icmp_ip.tot_len;
247: icmp_udp->uh_sport = htons(icmp_ip_srcport);
248: icmp_udp->uh_dport = htons(icmp_ip_dstport);
249: icmp_udp->uh_ulen = htons(UDPHDR_SIZE + udp_data_len);
250: icmp_udp->uh_sum = cksum((__u16 *) ph_buf, PSEUDOHDR_SIZE + UDPHDR_SIZE + udp_data_len);
251:
252: /* filling icmp body with concerned packet header */
253:
254: /* fill IP */
255: if (left_space == 0) goto no_space_left;
256: memcpy(packet+ICMPHDR_SIZE, &icmp_ip, left_space);
257: left_space -= IPHDR_SIZE;
258: data += IPHDR_SIZE;
259: if (left_space <= 0) goto no_space_left;
260:
261: /* fill UDP */
262: memcpy(packet+ICMPHDR_SIZE+IPHDR_SIZE, icmp_udp, left_space);
263: left_space -= UDPHDR_SIZE;
264: data += UDPHDR_SIZE;
265: if (left_space <= 0) goto no_space_left;
266:
267: /* fill DATA */
268: data_handler(data, left_space);
269: no_space_left:
270:
271: /* icmp checksum */
272: if (icmp_cksum == -1)
273: icmp->checksum = cksum((u_short*)packet, ICMPHDR_SIZE + IPHDR_SIZE + UDPHDR_SIZE + data_size);
274: else
275: icmp->checksum = icmp_cksum;
276:
277: /* send packet */
278: send_ip_handler(packet, ICMPHDR_SIZE + IPHDR_SIZE + UDPHDR_SIZE + data_size);
279: free (packet);
280: free (ph_buf);
281: }
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/icons/cvsweb/back.gif){kind=icon}
Return to sendicmp.c CVS log ![[TXT]](/icons/cvsweb/text.gif){kind=icon}
![[DIR]](/icons/cvsweb/dir.gif){kind=icon}
Up to [ELWIX - Embedded LightWeight unIX -] / embedaddon / hping2