1 /******************************************************************************
2 Author: Samuel Jero <sj323707@ohio.edu>
6 Description: Program to ping hosts using DCCP REQ packets to test for DCCP connectivity.
7 ******************************************************************************/
13 #include <sys/types.h>
17 #include <sys/socket.h>
18 #include <linux/dccp.h>
19 #include <netinet/ip.h>
20 #include <netinet/ip6.h>
21 #include <netinet/in.h>
23 #include <arpa/inet.h>
27 #include "checksums.h"
33 struct sockaddr_in *ipv4;
34 struct sockaddr_in6 *ipv6;
38 int debug=0; /*set to 1 to turn on debugging information*/
39 int count=-1; /*Default number of pings (-1 is infinity)*/
40 int dest_port=33434; /*Default port*/
41 int ttl=64; /*Default TTL*/
42 long interval=1000; /*Default delay between pings in ms*/
43 int ip_type=AF_UNSPEC; /*IPv4 or IPv6*/
44 ipaddr_ptr_t dest_addr;
45 ipaddr_ptr_t src_addr;
48 void getAddresses(char *src, char* dst);
50 void buildPacket(unsigned char* buffer, int *len);
51 void dbgprintf(int level, const char *fmt, ...);
52 void sanitize_environment();
56 /*Parse commandline options*/
57 int main(int argc, char *argv[])
64 sanitize_environment();
66 while ((c = getopt(argc, argv, "64c:p:i:dt:S:")) != -1) {
77 dbgprintf(0, "Error: count must be positive");
82 dest_port = atoi(optarg);
85 interval = (long)(atof(optarg) * 1000.0);
87 fprintf(stderr, "Invalid interval\n");
96 if (ttl < 1 || ttl > 255) {
97 fprintf(stderr, "Invalid TTL\n");
102 //r = inet_aton(optarg, &src_ip);
118 getAddresses(src, dst);
127 void getAddresses(char *src, char* dst){
128 struct addrinfo hint;
129 struct addrinfo *dtmp, *stmp;
130 struct ifaddrs *temp, *cur;
131 struct sockaddr_in6* iv6;
135 /*Lookup destination Address*/
136 memset(&hint,0,sizeof(struct addrinfo));
137 hint.ai_family=ip_type;
138 hint.ai_flags=AI_V4MAPPED | AI_ADDRCONFIG;
140 if((err=getaddrinfo(dst,NULL,&hint,&dtmp))!=0){
141 dbgprintf(0,"Error: Couldn't lookup destination %s (%s)\n", dst, gai_strerror(err));
145 dbgprintf(0,"Error: Unknown Host %s\n", dst);
148 addrlen=dtmp->ai_addrlen;
149 hint.ai_family=ip_type=dtmp->ai_family;
150 dest_addr.gen=malloc(dtmp->ai_addrlen);
151 if(dest_addr.gen==NULL){
152 dbgprintf(0,"Error: Can't allocate Memory\n");
155 memcpy(dest_addr.gen,dtmp->ai_addr,dtmp->ai_addrlen);
159 /*Get a meaningful source address*/
161 /*Use Commandline arg*/
162 if((err=getaddrinfo(src,NULL,&hint,&stmp))!=0){
163 dbgprintf(0,"Error: Source Address %s is invalid (%s)\n", src, gai_strerror(err));
167 dbgprintf(0,"Error: Unknown Host %s\n", dst);
170 addrlen=stmp->ai_addrlen;
171 src_addr.gen=malloc(stmp->ai_addrlen);
172 if(src_addr.gen==NULL){
173 dbgprintf(0,"Error: Can't allocate Memory\n");
176 memcpy(src_addr.gen,stmp->ai_addr,stmp->ai_addrlen);
180 /*Guess a good source address*/
184 if(cur->ifa_addr==NULL || cur->ifa_addr->sa_family!=ip_type){ /*Not matching ipv4/ipv6 of dest*/
188 if(cur->ifa_flags & IFF_LOOPBACK){ /*Don't use loopback addresses*/
192 if(cur->ifa_addr!=NULL && cur->ifa_addr->sa_family==AF_INET6){
193 iv6=(struct sockaddr_in6*)cur->ifa_addr;
195 if(iv6->sin6_scope_id!=0){ /*Not globally valid address, if ipv6*/
201 src_addr.gen=malloc(sizeof(struct sockaddr_storage));
202 if(src_addr.gen==NULL){
203 dbgprintf(0,"Error: Can't allocate Memory\n");
206 src_addr.gen->sa_family=ip_type;
207 memcpy(src_addr.gen,cur->ifa_addr,addrlen);
216 /*Preform the ping functionality*/
222 unsigned char sbuffer[slen];
223 unsigned char rbuffer[1000];
225 struct dccp_hdr *dhdr;
226 struct sockaddr_storage rcv_addr;
227 socklen_t rcv_addr_len=sizeof(struct sockaddr_storage);
228 struct sockaddr_in6 *tmp;
232 dbgprintf(0, "In doping()\n");
235 rs=socket(ip_type, SOCK_RAW | SOCK_NONBLOCK ,IPPROTO_RAW);
237 dbgprintf(0, "Error opening raw socket\n");
240 ds=socket(ip_type, SOCK_RAW | SOCK_NONBLOCK ,IPPROTO_DCCP);
242 dbgprintf(0, "Error opening raw DCCP socket\n");
245 is=socket(ip_type,SOCK_RAW | SOCK_NONBLOCK ,IPPROTO_ICMP);
247 dbgprintf(0,"Error opening raw ICMP socket\n");
251 /*opt=((unsigned char*)&dhdr->dccph_checksum) - &sbuffer[0];
252 if (setsockopt(ds, IPPROTO_IPV6, IPV6_CHECKSUM, &opt, sizeof(opt)) < 0){
253 dbgprintf(0, "Error setting up checksums on raw DCCP socket (%s)\n", strerror(errno));
257 buildPacket(sbuffer,&slen);
258 if(ip_type==AF_INET){
259 addrlen=sizeof(struct sockaddr_in);
261 addrlen=sizeof(struct sockaddr_in6);
266 if(sendto(rs, &sbuffer, slen, MSG_DONTWAIT,(struct sockaddr*)dest_addr.gen,addrlen)<0){
267 dbgprintf(0,"Error: sendto failed\n");
270 if(ip_type==AF_INET){
271 dbgprintf(0, "Sending DCCP Request to %s\n",inet_ntop(ip_type, (void*)&dest_addr.ipv4->sin_addr, pbuf, 1000));
273 dbgprintf(0, "Sending DCCP Request to %s\n",inet_ntop(ip_type, (void*)&dest_addr.ipv6->sin6_addr, pbuf, 1000));
276 rcv_addr_len=sizeof(struct sockaddr_storage);
277 if((rlen=recvfrom(ds, &rbuffer, 1000,MSG_DONTWAIT,(struct sockaddr*)&rcv_addr,&rcv_addr_len))<0){
279 dbgprintf(0, "Error on receive from DCCP socket (%s)\n",strerror(errno));
283 if(rlen< sizeof(struct dccp_hdr)){
284 dbgprintf(0,"Received Non-DCCP data!\n");
286 dhdr=(struct dccp_hdr*)rbuffer;
287 tmp=(struct sockaddr_in6*)&rcv_addr;
288 dbgprintf(0,"Response from %s (%i)\n", inet_ntop(ip_type, (void*)&tmp->sin6_addr, pbuf, 1000),dhdr->dccph_type);
291 if((rlen=recvfrom(is, &rbuffer, 1000,MSG_DONTWAIT,(struct sockaddr*)&rcv_addr,&rcv_addr_len))<0){
293 dbgprintf(0, "Error on receive from ICMP socket (%s)\n",strerror(errno));
297 dbgprintf(0,"Received ICMP data!\n");
307 sleep(interval/1000);
315 void buildPacket(unsigned char* buffer, int *len){
316 struct dccp_hdr *dhdr;
317 struct dccp_hdr_ext *dhdre;
318 struct dccp_hdr_request *dhdrr;
319 struct iphdr* ip4hdr;
320 struct ip6_hdr* ip6hdr;
323 int dccp_hdr_len=sizeof(struct dccp_hdr)+sizeof(struct dccp_hdr_ext)+sizeof(struct dccp_hdr_request);
326 memset(buffer, 0, *len);
330 if(ip_type==AF_INET){
331 ip_hdr_len=sizeof(struct iphdr);
332 ip4hdr=(struct iphdr*)buffer;
333 ip4hdr->check=htons(0);
334 memcpy(&ip4hdr->daddr, &dest_addr.ipv4->sin_addr, sizeof(dest_addr.ipv4->sin_addr));
335 ip4hdr->frag_off=htons(0);
336 ip4hdr->id=htons(1);//first
338 ip4hdr->protocol=IPPROTO_DCCP;
339 memcpy(&ip4hdr->saddr, &src_addr.ipv4->sin_addr, sizeof(src_addr.ipv4->sin_addr));
341 ip4hdr->tot_len=htons(ip_hdr_len+dccp_hdr_len);
345 ip_hdr_len=sizeof(struct ip6_hdr);
346 ip6hdr=(struct ip6_hdr*)buffer;
347 memcpy(&ip6hdr->ip6_dst, &dest_addr.ipv6->sin6_addr, sizeof(dest_addr.ipv6->sin6_addr));
348 memcpy(&ip6hdr->ip6_src, &src_addr.ipv6->sin6_addr, sizeof(src_addr.ipv6->sin6_addr));
349 ip6hdr->ip6_ctlun.ip6_un1.ip6_un1_flow=htonl(6<<28); //version, traffic class, flow label
350 ip6hdr->ip6_ctlun.ip6_un1.ip6_un1_hlim=ttl;
351 ip6hdr->ip6_ctlun.ip6_un1.ip6_un1_nxt=IPPROTO_DCCP;
352 ip6hdr->ip6_ctlun.ip6_un1.ip6_un1_plen=htons(dccp_hdr_len);
356 dhdr=(struct dccp_hdr*)(buffer+ip_hdr_len);
357 dhdre=(struct dccp_hdr_ext*)(buffer+ip_hdr_len+sizeof(struct dccp_hdr));
358 dhdrr=(struct dccp_hdr_request*)(buffer+ip_hdr_len+sizeof(struct dccp_hdr)+sizeof(struct dccp_hdr_ext));
360 dhdr->dccph_checksum=0;
362 dhdr->dccph_doff=dccp_hdr_len/4;
363 dhdr->dccph_dport=htons(dest_port);
364 dhdr->dccph_reserved=0;
365 dhdr->dccph_sport=htons(dest_port);
367 dhdr->dccph_type=DCCP_PKT_REQUEST;
368 dhdr->dccph_seq2=htonl(0); //Reserved if using 48 bit sequence numbers
369 dhdr->dccph_seq=htonl(0); //High 16bits of sequence number. Always make 0 for simplicity.
370 dhdre->dccph_seq_low=htonl(seq);
371 dhdrr->dccph_req_service= htonl(0x50455246);
374 if(ip_type==AF_INET){
375 dhdr->dccph_checksum=ipv4_pseudohdr_chksum((buffer+ip_hdr_len), dccp_hdr_len,
376 (unsigned char*) &dest_addr.ipv4->sin_addr,
377 (unsigned char*)&src_addr.ipv4->sin_addr, IPPROTO_DCCP);
378 ip4hdr->check=ipv4_chksum(buffer,ip_hdr_len);
380 dhdr->dccph_checksum=ipv6_pseudohdr_chksum((buffer+ip_hdr_len), dccp_hdr_len,
381 (unsigned char*) &dest_addr.ipv6->sin6_addr,
382 (unsigned char*)&src_addr.ipv6->sin6_addr, IPPROTO_DCCP);
384 *len=ip_hdr_len+dccp_hdr_len;
388 /*Usage information for program*/
391 dbgprintf(0, "dccpping: [-d] [-6|-4] [-c count] [-p port] [-i interval] [-t ttl] [-S srcaddress] remote_host\n");
395 /*Program will probably be run setuid, so be extra careful*/
396 void sanitize_environment()
398 #if defined(_SVID_SOURCE) || defined(_XOPEN_SOURCE)
401 extern char **environ;
407 void dbgprintf(int level, const char *fmt, ...)
412 vfprintf(stderr, fmt, args);