srdusr
aboutsummaryrefslogtreecommitdiffstats
path: root/include/wireframe/net/ethernet.hpp
blob: 2da4cc8cab1a0fb6e9e1f34649487e395f301b98 (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
#pragma once

#include <algorithm>
#include <array>
#include <cstdint>
#include <optional>
#include <span>

#include "wireframe/byteio.hpp"

namespace wireframe::net {

inline constexpr std::size_t kEthernetHeaderLen = 14;
inline constexpr std::uint16_t kEthertypeIPv4 = 0x0800;
inline constexpr std::uint16_t kEthertypeIPv6 = 0x86DD;
inline constexpr std::uint16_t kEthertypeArp = 0x0806;

struct MacAddress {
    std::array<unsigned char, 6> bytes;
};

struct EthernetHeader {
    MacAddress dst;
    MacAddress src;
    std::uint16_t ethertype;
};

struct EthernetFrame {
    EthernetHeader header;
    std::span<const unsigned char> payload;
};

inline std::optional<EthernetFrame> parse_ethernet(std::span<const unsigned char> bytes) {
    if (bytes.size() < kEthernetHeaderLen) return std::nullopt;

    EthernetHeader header{};
    std::copy_n(bytes.begin(), 6, header.dst.bytes.begin());
    std::copy_n(bytes.begin() + 6, 6, header.src.bytes.begin());
    header.ethertype = read_be16(bytes, 12);

    return EthernetFrame{header, bytes.subspan(kEthernetHeaderLen)};
}

}  // namespace wireframe::net