Basic L2 binding

2 files changed, 64 insertions, 4 deletions

diff --git a/include/junk/network.h b/include/junk/network.h
index 494142f..73dd127 100644
--- a/include/junk/network.h
+++ b/include/junk/network.h
@@ -1,4 +1,13 @@
 #pragma once
 
 
-int tcp_ipv4_send_packet(char* ip, char* port, char* data);
+//Layer 4, TCP
+int tcp_ipv4_send(char* ip, char* port, char* data);
+int tcp_ipv4_recv(char* ip, char* port, char* data);
+int ipv4_bind(char* ip, char* port, char* data);
+
+
+//Layer 2, Ethernet
+int eth_bind(char address[]);
+int eth_send(int sockfd, char* data);
+int eth_recv(int sockfd);
diff --git a/src/network.c b/src/network.c
index eafe19f..418a457 100644
--- a/src/network.c
+++ b/src/network.c
@@ -1,4 +1,8 @@
 #include "junk/network.h"
+#include <sys/socket.h>
+#include <linux/if_packet.h>
+#include <linux/if_ether.h>
+#include <net/ethernet.h> /* the L2 protocols */
 #include <unistd.h>
 #include <errno.h>
 #include <netinet/in.h>
@@ -11,8 +15,7 @@
 
 #define TAG "network"
 
-//TCP SEND
-int tcp_ipv4_send_packet(char* ip, char* port, char* data) {
+int tcp_ipv4_send(char* ip, char* port, char* data) {
 
   int sock;
   struct addrinfo hints, *p, *res;
@@ -56,4 +59,52 @@ int tcp_ipv4_send_packet(char* ip, char* port, char* data) {
 }
 
 
-// TCP BIND
+/* eth_bind
+ * Bind to a L2 Ethernet address.
+ *
+ */
+int eth_bind(char address[]) {
+
+  int sock;
+  struct sockaddr_ll addrinfo;
+
+  if ((sock = socket(AF_PACKET, SOCK_DGRAM, htons(ETH_P_ARP))) == -1) {
+    fprintf(stderr, "%s: socket (%d): %s\n", TAG, errno, strerror(errno));
+    return errno;
+  }
+  fprintf(stderr, "%s: socket fd: (%d)\n", TAG, sock);
+
+  memset(&addrinfo, 0, sizeof addrinfo);
+  addrinfo.sll_family = AF_PACKET;
+  addrinfo.sll_protocol = htons(ETH_P_ARP);
+  addrinfo.sll_ifindex = 0;
+  addrinfo.sll_pkttype = PACKET_BROADCAST;
+  sscanf((char*)address, "%hhx:%hhx:%hhx:%hhx:%hhx:%hhx",
+    &addrinfo.sll_addr[0],
+    &addrinfo.sll_addr[1],
+    &addrinfo.sll_addr[2],
+    &addrinfo.sll_addr[3],
+    &addrinfo.sll_addr[4],
+    &addrinfo.sll_addr[5]
+  );
+  addrinfo.sll_halen = 6;
+
+  fprintf(stderr, "%s: target mac (%x:%x:%x:%x:%x:%x)\n", TAG, addrinfo.sll_addr[0], addrinfo.sll_addr[1], addrinfo.sll_addr[2], addrinfo.sll_addr[3], addrinfo.sll_addr[4], addrinfo.sll_addr[5]);
+
+  int status = 0;
+  if ((status = bind(sock, (struct sockaddr*) &addrinfo, sizeof(addrinfo))) != 0) {
+    fprintf(stderr, "%s: bind (%d): %s\n", TAG, errno, strerror(errno));
+    return status;
+  }
+
+  return sock;
+}
+
+/* eth_recv
+ * Recv on a L2 Ethernet address.
+ *
+ */
+int eth_recv(int sockfd) {
+
+  return sock;
+}