diff options
| -rw-r--r-- | .gitignore | 1 | ||||
| -rw-r--r-- | Makefile | 12 | ||||
| -rw-r--r-- | src/include/if_ether.h | 57 | ||||
| -rw-r--r-- | src/link/if_ether.c | 71 | ||||
| -rw-r--r-- | src/main.c | 130 |
5 files changed, 271 insertions, 0 deletions
diff --git a/.gitignore b/.gitignore new file mode 100644 index 0000000..e660fd9 --- /dev/null +++ b/.gitignore @@ -0,0 +1 @@ +bin/ diff --git a/Makefile b/Makefile new file mode 100644 index 0000000..e949046 --- /dev/null +++ b/Makefile @@ -0,0 +1,12 @@ +CFILES = $(shell find src/ -name "*.c") +CFLAGS = -Isrc/include/ -pedantic +OUTPUT = bin/otrx +CC = gcc + +.PHONY: all +all: bin + $(CC) $(CFILES) $(CFLAGS) -o $(OUTPUT) + +.PHONY: bin +bin: + mkdir -p $@ diff --git a/src/include/if_ether.h b/src/include/if_ether.h new file mode 100644 index 0000000..a71bd21 --- /dev/null +++ b/src/include/if_ether.h @@ -0,0 +1,57 @@ +/* + * Copyright (c) 2023-2025 Ian Marco Moffett and the Osmora Team. + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are met: + * + * 1. Redistributions of source code must retain the above copyright notice, + * this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. Neither the name of Hyra nor the names of its + * contributors may be used to endorse or promote products derived from + * this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" + * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE + * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + */ + +#ifndef IF_ETHER_H +#define IF_ETHER_H + +#include <stdint.h> + +#define HW_ADDR_LEN 6 +#define PROTO_IPV4 0x0800 +#define PROTO_ARP 0x0806 + +typedef uint64_t mac_addr_t; + +struct ether_hdr { + uint8_t dest[HW_ADDR_LEN]; + uint8_t source[HW_ADDR_LEN]; + uint16_t proto; +} __attribute__((packed)); + +/* + * Load the source and dest routes into an ethernet + * frame. + * + * @src: Source address to use + * @dest: Dest address to use + * @res: Result is written here + */ +int ether_load_route(mac_addr_t src, mac_addr_t dest, struct ether_hdr *res); + +#endif /* !IF_ETHER_H */ diff --git a/src/link/if_ether.c b/src/link/if_ether.c new file mode 100644 index 0000000..e0db260 --- /dev/null +++ b/src/link/if_ether.c @@ -0,0 +1,71 @@ +/* + * Copyright (c) 2023-2025 Ian Marco Moffett and the Osmora Team. + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are met: + * + * 1. Redistributions of source code must retain the above copyright notice, + * this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. Neither the name of Hyra nor the names of its + * contributors may be used to endorse or promote products derived from + * this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" + * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE + * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + */ + +#include <sys/errno.h> +#include <byteswap.h> +#include <string.h> +#include "if_ether.h" + +/* + * Using the protocol ID 0xFD for testing, + * see RFC 3692 + */ +#define PROTO_ID 0xFD00 + +/* 48-bit mask for MAC addresses */ +#define MAC_MASK 0xFFFFFFFFFFFF + +#include <stdio.h> +int +ether_load_route(mac_addr_t src, mac_addr_t dest, struct ether_hdr *res) +{ + uint32_t *p; + + if (res == NULL) { + return -EINVAL; + } + + /* Set up the source */ + res->source[0] = (src >> 40) & 0xFF; + res->source[1] = (src >> 32) & 0xFF; + res->source[2] = (src >> 24) & 0xFF; + res->source[3] = (src >> 16) & 0xFF; + res->source[4] = (src >> 8) & 0xFF; + res->source[5] = src & 0xFF; + + /* Set up the destination */ + res->dest[0] = (dest >> 40) & 0xFF; + res->dest[1] = (dest >> 32) & 0xFF; + res->dest[2] = (dest >> 24) & 0xFF; + res->dest[3] = (dest >> 16) & 0xFF; + res->dest[4] = (dest >> 8) & 0xFF; + res->dest[5] = dest & 0xFF; + res->proto = PROTO_ID; + return 0; +} diff --git a/src/main.c b/src/main.c new file mode 100644 index 0000000..4616d12 --- /dev/null +++ b/src/main.c @@ -0,0 +1,130 @@ +/* + * Copyright (c) 2023-2025 Ian Marco Moffett and the Osmora Team. + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are met: + * + * 1. Redistributions of source code must retain the above copyright notice, + * this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. Neither the name of Hyra nor the names of its + * contributors may be used to endorse or promote products derived from + * this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" + * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE + * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + */ + +#include <sys/socket.h> +#include <sys/ioctl.h> +#include <linux/if_packet.h> +#include <netinet/in.h> +#include <net/if.h> +#include <net/ethernet.h> +#include <stdio.h> +#include <stdlib.h> +#include <unistd.h> +#include <string.h> +#include "if_ether.h" + +#define TEST_STR "Hello from o.1p!! Meow meow!" + +static const char *iface = NULL; + +static void +help(char **argv) +{ + printf( + "usage: %s -i <iface>\n" + "[-h] Show this message\n" + "[-i] Interface to use\n", + argv[0] + ); +} + +static int +data_send(void) +{ + char data[256], *p; + struct sockaddr_ll saddr; + struct ether_hdr *eth; + struct ifreq ifr; + int error, sockfd; + + memset(data, 0, sizeof(data)); + eth = (struct ether_hdr *)data; + p = &data[sizeof(eth) + 100]; + memcpy(p, TEST_STR, sizeof(TEST_STR)); + + sockfd = socket(AF_PACKET, SOCK_RAW, IPPROTO_RAW); + if (sockfd < 0) { + printf("error: failed to create socket (error=%d)\n", sockfd); + return sockfd; + } + + /* Set the interface that we want to use */ + strlcpy(ifr.ifr_name, iface, IFNAMSIZ); + error = ioctl(sockfd, SIOGIFINDEX, &ifr); + if (error < 0) { + printf("ioctl[SIOGIFINDEX]: bad iface \"%s\"\n", iface); + return error; + } + + /* + * Set up link layer sockaddr, load up the frame + * and send it off. + */ + saddr.sll_ifindex = ifr.ifr_ifindex; + saddr.sll_halen = ETH_ALEN; + ether_load_route(0x54E1AD2CAE48, 0xFFFFFFFFFFFF, eth); + sendto( + sockfd, &data, sizeof(data), 0, + (struct sockaddr *)&saddr, sizeof(struct sockaddr_ll) + ); + + close(sockfd); + return 0; +} + +int +main(int argc, char **argv) +{ + int opt; + + if (argc < 2) { + printf("error: too few arguments!\n"); + help(argv); + return -1; + } + + while ((opt = getopt(argc, argv, "i:h")) != -1) { + switch (opt) { + case 'h': + help(argv); + return -1; + case 'i': + iface = optarg; + break; + } + } + + /* We need an interface */ + if (iface == NULL) { + printf("error: interface not supplied\n"); + return -1; + } + + return data_send(); +} |