enderice2/Fennix
1
0
Fork 0
mirror of https://github.com/EnderIce2/Fennix.git synced 2025-07-02 10:59:15 +00:00
Code Issues Actions Releases Wiki Activity

Updated files

Browse Source
This commit is contained in:
Alex
2022-09-29 02:07:21 +03:00
parent b766196550
commit 884b50a351
24 changed files with 4254 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

150
tools/ReadEthernetPackets.c Normal file
View File

@ -0,0 +1,150 @@
/* I don't remember where I got this code from, but it seems to work fine for me. */
#include <arpa/inet.h>
#include <linux/if_packet.h>
#include <linux/ip.h>
#include <linux/udp.h>
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <sys/ioctl.h>
#include <sys/socket.h>
#include <net/if.h>
#include <netinet/ether.h>
enum FrameType
{
TYPE_IPV4 = 0x0800,
TYPE_ARP = 0x0806,
TYPE_RARP = 0x8035,
TYPE_IPV6 = 0x86DD
};
#define ETHER_TYPE TYPE_ARP
#define DEFAULT_IF "enp7s0"
#define BUF_SIZ 1024
int main(int argc, char *argv[])
{
char sender[INET6_ADDRSTRLEN];
int sockfd, ret, i;
int sockopt;
ssize_t numbytes;
struct ifreq ifopts;
struct ifreq if_ip;
struct sockaddr_storage their_addr;
uint8_t buf[BUF_SIZ];
char ifName[IFNAMSIZ];
int ether_type = TYPE_ARP;
if (argc > 1)
{
if (strcmp(argv[1], "-h") == 0 || strcmp(argv[1], "--help") == 0)
{
printf("Usage: sudo %s [type] [interface]\nTypes:\n 0 - IPv4 1 - ARP 2 - RARP 3 - IPv6\nExample: sudo %s 1 enp7s0", argv[0], argv[0]);
return 0;
}
if (argv[1] > '9' || argv[1] < '0')
{
switch (atoi(argv[1]))
{
case 0:
ether_type = TYPE_IPV4;
break;
case 1:
ether_type = TYPE_ARP;
break;
case 2:
ether_type = TYPE_RARP;
break;
case 3:
ether_type = TYPE_IPV6;
break;
default:
printf("Invalid type.\n");
return -1;
}
}
else
{
printf("Invalid ethernet type \"%d\".", atoi(argv[1]));
return -1;
}
}
if (argc > 2)
strcpy(ifName, argv[2]);
else
strcpy(ifName, DEFAULT_IF);
printf("Using interface \"%s\" with type %#lx \n", ifName, ether_type);
if (geteuid() != 0)
{
perror("You must be root to run this program.");
return -1;
}
struct ether_header *eh = (struct ether_header *)buf;
struct iphdr *iph = (struct iphdr *)(buf + sizeof(struct ether_header));
struct udphdr *udph = (struct udphdr *)(buf + sizeof(struct iphdr) + sizeof(struct ether_header));
memset(&if_ip, 0, sizeof(struct ifreq));
if ((sockfd = socket(PF_PACKET, SOCK_RAW, htons(ETHER_TYPE))) == -1)
{
perror("Error creating socket");
return -1;
}
strncpy(ifopts.ifr_name, ifName, IFNAMSIZ - 1);
ioctl(sockfd, SIOCGIFFLAGS, &ifopts);
ifopts.ifr_flags |= IFF_PROMISC;
ioctl(sockfd, SIOCSIFFLAGS, &ifopts);
if (setsockopt(sockfd, SOL_SOCKET, SO_REUSEADDR, &sockopt, sizeof sockopt) == -1)
{
perror("setsockopt failed");
close(sockfd);
exit(EXIT_FAILURE);
}
if (setsockopt(sockfd, SOL_SOCKET, SO_BINDTODEVICE, ifName, IFNAMSIZ - 1) == -1)
{
perror("Failed to bind socket to device");
close(sockfd);
exit(EXIT_FAILURE);
}
repeat:
printf("Waiting to recvfrom... ");
numbytes = recvfrom(sockfd, buf, BUF_SIZ, 0, NULL, NULL);
printf("got packet %lu bytes\n", numbytes);
if (eh->ether_dhost[0] == 0 && eh->ether_dhost[1] == 0 && eh->ether_dhost[2] == 0 && eh->ether_dhost[3] == 0 && eh->ether_dhost[4] == 0 && eh->ether_dhost[5] == 0)
printf("MAC <: %x:%x:%x:%x:%x:%x\n", eh->ether_dhost[0], eh->ether_dhost[1], eh->ether_dhost[2], eh->ether_dhost[3], eh->ether_dhost[4], eh->ether_dhost[5]);
else
{
printf("MAC X: %x:%x:%x:%x:%x:%x\n", eh->ether_dhost[0], eh->ether_dhost[1], eh->ether_dhost[2], eh->ether_dhost[3], eh->ether_dhost[4], eh->ether_dhost[5]);
ret = -1;
goto done;
}
((struct sockaddr_in *)&their_addr)->sin_addr.s_addr = iph->saddr;
inet_ntop(AF_INET, &((struct sockaddr_in *)&their_addr)->sin_addr, sender, sizeof sender);
strncpy(if_ip.ifr_name, ifName, IFNAMSIZ - 1);
if (ioctl(sockfd, SIOCGIFADDR, &if_ip) >= 0)
{
printf("Source IP: %s My IP: %s\n", sender, inet_ntoa(((struct sockaddr_in *)&if_ip.ifr_addr)->sin_addr));
if (strcmp(sender, inet_ntoa(((struct sockaddr_in *)&if_ip.ifr_addr)->sin_addr)) == 0)
{
ret = -1;
goto done;
}
}
ret = ntohs(udph->len) - sizeof(struct udphdr);
done:
goto repeat;
close(sockfd);
return ret;
}