rename

2 files changed, 138 insertions, 172 deletions

diff --git a/main.c b/main.c
index b114fc9..aa8aa07 100644
--- a/main.c
+++ b/main.c
@@ -1,34 +1,144 @@
-/* Sample UDP client */
-
+#include <malloc.h>
+#include <string.h>
+#include <math.h>
 #include <sys/socket.h>
-#include <netinet/in.h>
+#include <linux/if_packet.h>
+#include <linux/if_ether.h>
+#include <linux/ip.h>
+#include <linux/in.h>
+#include <linux/udp.h>
+#include <linux/if_arp.h>
 #include <stdio.h>
 
-int main(int argc, char**argv)
+//#define ETH_FRAME_LEN 1518
+unsigned short in_cksum(unsigned short *addr, int len)
 {
-   int sockfd,n,r;
-        int tolen;
-   char msg[123];
-   struct sockaddr myaddr, toaddr;
-   char minaddr[] = {0x08, 0x00, 0x27, 0xd9, 0x92, 0xd3};
-   char dinaddr[] = {0x08, 0x00, 0x27, 0xd9, 0x92, 0xd3};
-   char sendline[1000];
-   char recvline[1000];
-
-   //sockfd=socket(AF_INET,SOCK_PACKET, htons(ETH_P_ALL));
-   sockfd=socket(AF_INET,SOCK_RAW, htons(IPPROTO_RAW));
-
-   bzero(&myaddr, sizeof(myaddr));
-   myaddr.sa_family = AF_INET;
-   memcpy(myaddr.sa_data, &minaddr, 6);
-   //r = bind(sockfd, &myaddr, sizeof(struct sockaddr));
-
-   bzero(&toaddr, sizeof(toaddr));
-   toaddr.sa_family = AF_INET;
-   memcpy(toaddr.sa_data, &dinaddr, 6);
-        tolen = sizeof(toaddr);
-  r = sendto(sockfd, &msg, 100, 0, &toaddr, tolen);
-printf("Result: %d\n", r);
-return 0;
+	int nleft = len;
+	int sum = 0;
+	unsigned short *w = addr;
+	unsigned short answer = 0;
+	
+	while (nleft > 1) {
+		sum += *w++;
+		nleft -= 2;
+	}
+	
+	if (nleft == 1) {
+		*(unsigned char *) (&answer) = *(unsigned char *) w;
+		sum += answer;
+	}
+	
+	sum = (sum >> 16) + (sum & 0xFFFF);
+	sum += (sum >> 16);
+	answer = ~sum;
+	return (answer);
+}
+
+unsigned char hex(const unsigned char c) {
+    if ('0' <= c && c <= '9') return c - '0';
+    if ('a' <= c && c <= 'f') return c - 'a' + 10;
+    if ('A' <= c && c <= 'F') return c - 'A' + 10;
+    return -1;
+}
+
+unsigned char hex2(const unsigned char *p) {
+    int i;
+    unsigned char c;
+    i = hex(*p++);
+    if (i < 0) return i;
+    c = (i << 4);
+    i = hex(*p);
+    if (i < 0) return i;
+    return c | i;
+}
+
+void etherAddrton(unsigned char *dest, const unsigned char *mac) {
+	const unsigned char *p = mac;
+	int i = 0;
+
+	do {
+		if (*p == ':') {
+			continue;
+		}
+		printf("Reading %c and %c\n", *p, p[1]);
+		dest[i++] = hex2(p++);
+	} while (*p++ && *p);
+	printf("fra %s, Til: %X", mac, dest[1]);
 }
 
+int sendCustomUDP(const int socket, const char *sourcemac, const char *destmac, const char *sourceip, const int sourceport, const char *destip, const int destport, const char *data, const int datalen) {
+	struct sockaddr_ll socket_address;
+	struct in_addr srcipaddr;
+	struct in_addr dstipaddr;
+	void* buffer = (void*)malloc(ETH_FRAME_LEN);
+	struct ethhdr *eh = (struct ethhdr *)buffer;
+	struct iphdr *ip = (struct iphdr *)(buffer+14);
+	struct udphdr *udp = (struct udphdr *)(buffer+14+20);
+	unsigned char *resten = (unsigned char *)(buffer+20+14+sizeof(struct udphdr));
+	static unsigned int id = 1;
+	int send_result = 0;
+
+	// Ethernet header
+	etherAddrton(eh->h_source, sourcemac);
+	etherAddrton(eh->h_dest, destmac);
+	eh->h_proto = 8;
+
+	// SendTo struct
+	socket_address.sll_family   = PF_PACKET;	
+	socket_address.sll_protocol = htons(ETH_P_IP);	
+	socket_address.sll_ifindex  = 2;
+	socket_address.sll_hatype   = ARPHRD_ETHER;
+	socket_address.sll_pkttype  = PACKET_OTHERHOST;
+	socket_address.sll_halen    = ETH_ALEN;		
+
+	memcpy(socket_address.sll_addr, eh->h_source, 6);
+	socket_address.sll_addr[6]  = 0x00;/*not used*/
+	socket_address.sll_addr[7]  = 0x00;/*not used*/
+
+	// TODO: errorhandling
+	inet_aton(sourceip, &srcipaddr);
+	inet_aton(destip, &dstipaddr);
+
+	// IP Header
+	ip->version = 4;
+	ip->ihl = 5;
+	ip->tos = 0x10;
+	ip->tot_len = htons(datalen+8+20);
+	ip->id = htons(id++);
+	ip->frag_off = 0x0040;
+	ip->ttl = 64;
+	ip->protocol = 17; // UDP
+	ip->check = 0x0000;
+	ip->saddr = srcipaddr.s_addr;
+	ip->daddr = dstipaddr.s_addr;
+	ip->check = in_cksum((unsigned short *)ip, sizeof(struct iphdr));
+
+	// UDP Header
+	udp->source = htons(20561);
+	udp->dest = htons(20561);
+	udp->len = htons(sizeof(struct udphdr) + datalen);
+
+	memcpy(resten, data, datalen);
+
+	/*send the packet*/
+	send_result = sendto(socket, buffer, datalen+8+14+20, 0, (struct sockaddr*)&socket_address, sizeof(socket_address));
+	free(buffer);
+
+	return send_result;
+}
+
+int main (int argc, char **argv) {
+
+	int s; /*socketdescriptor*/
+	int j;
+	int result;
+	char data[11] = "1234567890";
+	s = socket(AF_PACKET, SOCK_RAW, htons(ETH_P_ALL));
+	printf("Sockid: %d\n", s);
+
+	result = sendCustomUDP(s, "00:19:db:66:e5::bf", "04:1e:64:ea:e5:15", "10.0.0.100", 20561, "255.255.255.255", 20561, data, 10);
+	result = sendCustomUDP(s, "00:19:db:66:e5::bf", "04:1e:64:ea:e5:15", "10.0.0.100", 20561, "255.255.255.255", 20561, data, 10);
+	printf("Send result: %d\n", result);
+
+	return 0;
+}
diff --git a/main2.c b/main2.c
deleted file mode 100644
index aa8aa07..0000000
--- a/main2.c
+++ /dev/null
@@ -1,144 +0,0 @@
-#include <malloc.h>
-#include <string.h>
-#include <math.h>
-#include <sys/socket.h>
-#include <linux/if_packet.h>
-#include <linux/if_ether.h>
-#include <linux/ip.h>
-#include <linux/in.h>
-#include <linux/udp.h>
-#include <linux/if_arp.h>
-#include <stdio.h>
-
-//#define ETH_FRAME_LEN 1518
-unsigned short in_cksum(unsigned short *addr, int len)
-{
-	int nleft = len;
-	int sum = 0;
-	unsigned short *w = addr;
-	unsigned short answer = 0;
-	
-	while (nleft > 1) {
-		sum += *w++;
-		nleft -= 2;
-	}
-	
-	if (nleft == 1) {
-		*(unsigned char *) (&answer) = *(unsigned char *) w;
-		sum += answer;
-	}
-	
-	sum = (sum >> 16) + (sum & 0xFFFF);
-	sum += (sum >> 16);
-	answer = ~sum;
-	return (answer);
-}
-
-unsigned char hex(const unsigned char c) {
-    if ('0' <= c && c <= '9') return c - '0';
-    if ('a' <= c && c <= 'f') return c - 'a' + 10;
-    if ('A' <= c && c <= 'F') return c - 'A' + 10;
-    return -1;
-}
-
-unsigned char hex2(const unsigned char *p) {
-    int i;
-    unsigned char c;
-    i = hex(*p++);
-    if (i < 0) return i;
-    c = (i << 4);
-    i = hex(*p);
-    if (i < 0) return i;
-    return c | i;
-}
-
-void etherAddrton(unsigned char *dest, const unsigned char *mac) {
-	const unsigned char *p = mac;
-	int i = 0;
-
-	do {
-		if (*p == ':') {
-			continue;
-		}
-		printf("Reading %c and %c\n", *p, p[1]);
-		dest[i++] = hex2(p++);
-	} while (*p++ && *p);
-	printf("fra %s, Til: %X", mac, dest[1]);
-}
-
-int sendCustomUDP(const int socket, const char *sourcemac, const char *destmac, const char *sourceip, const int sourceport, const char *destip, const int destport, const char *data, const int datalen) {
-	struct sockaddr_ll socket_address;
-	struct in_addr srcipaddr;
-	struct in_addr dstipaddr;
-	void* buffer = (void*)malloc(ETH_FRAME_LEN);
-	struct ethhdr *eh = (struct ethhdr *)buffer;
-	struct iphdr *ip = (struct iphdr *)(buffer+14);
-	struct udphdr *udp = (struct udphdr *)(buffer+14+20);
-	unsigned char *resten = (unsigned char *)(buffer+20+14+sizeof(struct udphdr));
-	static unsigned int id = 1;
-	int send_result = 0;
-
-	// Ethernet header
-	etherAddrton(eh->h_source, sourcemac);
-	etherAddrton(eh->h_dest, destmac);
-	eh->h_proto = 8;
-
-	// SendTo struct
-	socket_address.sll_family   = PF_PACKET;	
-	socket_address.sll_protocol = htons(ETH_P_IP);	
-	socket_address.sll_ifindex  = 2;
-	socket_address.sll_hatype   = ARPHRD_ETHER;
-	socket_address.sll_pkttype  = PACKET_OTHERHOST;
-	socket_address.sll_halen    = ETH_ALEN;		
-
-	memcpy(socket_address.sll_addr, eh->h_source, 6);
-	socket_address.sll_addr[6]  = 0x00;/*not used*/
-	socket_address.sll_addr[7]  = 0x00;/*not used*/
-
-	// TODO: errorhandling
-	inet_aton(sourceip, &srcipaddr);
-	inet_aton(destip, &dstipaddr);
-
-	// IP Header
-	ip->version = 4;
-	ip->ihl = 5;
-	ip->tos = 0x10;
-	ip->tot_len = htons(datalen+8+20);
-	ip->id = htons(id++);
-	ip->frag_off = 0x0040;
-	ip->ttl = 64;
-	ip->protocol = 17; // UDP
-	ip->check = 0x0000;
-	ip->saddr = srcipaddr.s_addr;
-	ip->daddr = dstipaddr.s_addr;
-	ip->check = in_cksum((unsigned short *)ip, sizeof(struct iphdr));
-
-	// UDP Header
-	udp->source = htons(20561);
-	udp->dest = htons(20561);
-	udp->len = htons(sizeof(struct udphdr) + datalen);
-
-	memcpy(resten, data, datalen);
-
-	/*send the packet*/
-	send_result = sendto(socket, buffer, datalen+8+14+20, 0, (struct sockaddr*)&socket_address, sizeof(socket_address));
-	free(buffer);
-
-	return send_result;
-}
-
-int main (int argc, char **argv) {
-
-	int s; /*socketdescriptor*/
-	int j;
-	int result;
-	char data[11] = "1234567890";
-	s = socket(AF_PACKET, SOCK_RAW, htons(ETH_P_ALL));
-	printf("Sockid: %d\n", s);
-
-	result = sendCustomUDP(s, "00:19:db:66:e5::bf", "04:1e:64:ea:e5:15", "10.0.0.100", 20561, "255.255.255.255", 20561, data, 10);
-	result = sendCustomUDP(s, "00:19:db:66:e5::bf", "04:1e:64:ea:e5:15", "10.0.0.100", 20561, "255.255.255.255", 20561, data, 10);
-	printf("Send result: %d\n", result);
-
-	return 0;
-}