//rudp-sender.c 用rawsocket實現(xiàn)的發(fā)送UDP數(shù)據(jù)包工具,。
//引用時,,需要多源目的IP以及端口做些修改。linux下可以直接編譯。
#include <stdio.h> #include <stdlib.h> #include <sys/types.h> #include <sys/socket.h> #include <netinet/in.h> #include <arpa/inet.h> #include <string.h> #include <errno.h>
#define BUFLEN 38 #define PORT 8848 typedef struct ip_hdr{//ipv4頭部 unsigned int ip_length:4; /*little-endian*/ unsigned int ip_version:4; unsigned char ip_tos; unsigned short ip_total_length; unsigned short ip_id; unsigned short ip_flags; unsigned char ip_ttl; unsigned char ip_protocol; unsigned short ip_cksum; unsigned int ip_source; unsigned int ip_dest; }ip_hdr; typedef struct udp_hdr{//udp頭部 unsigned short s_port; unsigned short d_port; unsigned short length; unsigned short cksum; }udp_hdr;
typedef struct psd_header{//偽頭部,,用于計算校驗和
unsigned int s_ip;//source ip
unsigned int d_ip;//dest ip
unsigned char mbz;//0
unsigned char proto;//proto type
unsigned short plen;//length
}psd_header;
void swap(unsigned int *a, unsigned int *b)//交換 { *a = (*a)^(*b); *b = (*a)^(*b); *a = (*a)^(*b); }
unsigned short checksum(unsigned short* buffer, int size)//校驗和 { unsigned long cksum = 0; while(size>1) { cksum += *buffer++; size -= sizeof(unsigned short); } if(size) { cksum += *(unsigned char*)buffer; } cksum = (cksum>>16) + (cksum&0xffff); //將高16bit與低16bit相加
cksum += (cksum>>16); //將進(jìn)位到高位的16bit與低16bit 再相加
return (unsigned short)(~cksum); } int main(int argc, char *argv[]) { char buf[BUFLEN]; int sockfd = -1; struct sockaddr_in host_addr; if((sockfd = socket(AF_INET, SOCK_RAW, IPPROTO_UDP))<0) { printf("socket() error!\n"); exit(1); } memset(&host_addr, 0, sizeof(host_addr)); host_addr.sin_family = AF_INET; host_addr.sin_port = htons(PORT); host_addr.sin_addr.s_addr = inet_addr("200.200.30.42");
const int on = 1; if(setsockopt(sockfd, IPPROTO_IP, IP_HDRINCL, &on, sizeof(on))<0) { printf("setsockopt() error!\n"); exit(0); } int addr_len = sizeof(host_addr);
while(1) { ip_hdr *iphdr; iphdr = (ip_hdr*)buf; udp_hdr *udphdr; udphdr = (udp_hdr*)(buf+20); iphdr->ip_length = 5; iphdr->ip_version= 4; iphdr->ip_tos = 0; iphdr->ip_total_length = htons(sizeof(buf)); iphdr->ip_id = 0; iphdr->ip_flags = 0x40; iphdr->ip_ttl = 0x40; iphdr->ip_protocol = 0x11; iphdr->ip_cksum = 0; iphdr->ip_source = inet_addr("200.200.30.14");//源地址
iphdr->ip_dest = inet_addr("200.200.30.42");//目的地址 iphdr->ip_cksum = checksum((unsigned short*)buf, 20); udphdr->s_port = htons(80);//源端口 udphdr->d_port = htons(1024);//目的端口 udphdr->length = htons(sizeof(buf)-20); udphdr->cksum = 0; psd_header psd; psd.s_ip = iphdr->ip_source; psd.d_ip = iphdr->ip_dest; psd.mbz = 0; psd.proto = 0x11; psd.plen = udphdr->length; char tmp[sizeof(psd)+ntohs(udphdr->length)]; memcpy(tmp, &psd, sizeof(psd)); memcpy(tmp+sizeof(psd), buf+20, sizeof(buf)-20); udphdr->cksum = checksum((unsigned short*)tmp, sizeof(tmp)); int res =sendto(sockfd, buf, sizeof(buf), 0, (struct sockaddr*)&host_addr, sizeof(host_addr)); sleep(1); } return 0;
}
|