|
| 1 | +// SPDX-License-Identifier: MIT |
| 2 | + |
| 3 | +use std::net::Ipv4Addr; |
| 4 | + |
| 5 | +use crate::ip::parse_ipv4_addr; |
| 6 | +use anyhow::Context; |
| 7 | +use byteorder::{ByteOrder, NetworkEndian}; |
| 8 | +use netlink_packet_utils::{ |
| 9 | + nla::{DefaultNla, Nla, NlaBuffer}, |
| 10 | + parsers::{parse_u16_be, parse_u32_be, parse_u8}, |
| 11 | + DecodeError, Parseable, |
| 12 | +}; |
| 13 | + |
| 14 | +use super::{ |
| 15 | + GreEncapFlags, GreEncapType, GreIOFlags, IFLA_GRE_COLLECT_METADATA, |
| 16 | + IFLA_GRE_ENCAP_DPORT, IFLA_GRE_ENCAP_FLAGS, IFLA_GRE_ENCAP_SPORT, |
| 17 | + IFLA_GRE_ENCAP_TYPE, IFLA_GRE_FWMARK, IFLA_GRE_IFLAGS, IFLA_GRE_IKEY, |
| 18 | + IFLA_GRE_LOCAL, IFLA_GRE_OFLAGS, IFLA_GRE_OKEY, IFLA_GRE_PMTUDISC, |
| 19 | + IFLA_GRE_REMOTE, IFLA_GRE_TOS, IFLA_GRE_TTL, IFLA_GRE_UNSPEC, |
| 20 | +}; |
| 21 | + |
| 22 | +#[derive(Debug, PartialEq, Eq, Clone)] |
| 23 | +#[non_exhaustive] |
| 24 | +pub enum InfoGreTun { |
| 25 | + Unspec, |
| 26 | + //Link, |
| 27 | + IFlags(GreIOFlags), |
| 28 | + OFlags(GreIOFlags), |
| 29 | + IKey(u32), |
| 30 | + OKey(u32), |
| 31 | + Local(Ipv4Addr), |
| 32 | + Remote(Ipv4Addr), |
| 33 | + Ttl(u8), |
| 34 | + Tos(u8), |
| 35 | + PathMTUDiscovery(bool), |
| 36 | + //Flags, |
| 37 | + EncapType(GreEncapType), |
| 38 | + EncapFlags(GreEncapFlags), |
| 39 | + SourcePort(u16), |
| 40 | + DestinationPort(u16), |
| 41 | + CollectMetadata, |
| 42 | + FwMask(u32), |
| 43 | + Other(DefaultNla), |
| 44 | +} |
| 45 | + |
| 46 | +impl Nla for InfoGreTun { |
| 47 | + fn value_len(&self) -> usize { |
| 48 | + match self { |
| 49 | + Self::Unspec => 0, |
| 50 | + Self::IFlags(_) | Self::OFlags(_) => const { size_of::<u16>() }, |
| 51 | + Self::IKey(_) | Self::OKey(_) => const { size_of::<u32>() }, |
| 52 | + Self::Local(_) | Self::Remote(_) => const { size_of::<Ipv4Addr>() }, |
| 53 | + Self::Ttl(_) | Self::Tos(_) | Self::PathMTUDiscovery(_) => { |
| 54 | + const { size_of::<u8>() } |
| 55 | + } |
| 56 | + Self::EncapType(_) => const { size_of::<GreEncapType>() }, |
| 57 | + Self::EncapFlags(_) => const { size_of::<u16>() }, |
| 58 | + Self::SourcePort(_) | Self::DestinationPort(_) => { |
| 59 | + const { size_of::<u16>() } |
| 60 | + } |
| 61 | + Self::CollectMetadata => 0, |
| 62 | + Self::FwMask(_) => const { size_of::<u32>() }, |
| 63 | + Self::Other(nla) => nla.value_len(), |
| 64 | + } |
| 65 | + } |
| 66 | + |
| 67 | + fn emit_value(&self, buffer: &mut [u8]) { |
| 68 | + match self { |
| 69 | + Self::Unspec => {} |
| 70 | + Self::IFlags(flags) | Self::OFlags(flags) => { |
| 71 | + NetworkEndian::write_u16(buffer, flags.bits()) |
| 72 | + } |
| 73 | + Self::IKey(key) | Self::OKey(key) => { |
| 74 | + NetworkEndian::write_u32(buffer, *key) |
| 75 | + } |
| 76 | + Self::Local(ip) | Self::Remote(ip) => { |
| 77 | + buffer.copy_from_slice(&ip.octets()); |
| 78 | + } |
| 79 | + Self::Ttl(value) | Self::Tos(value) => buffer[0] = *value, |
| 80 | + Self::PathMTUDiscovery(discover) => { |
| 81 | + buffer[0] = if *discover { 1 } else { 0 } |
| 82 | + } |
| 83 | + Self::EncapType(t) => NetworkEndian::write_u16(buffer, *t as u16), |
| 84 | + Self::EncapFlags(flags) => { |
| 85 | + NetworkEndian::write_u16(buffer, flags.bits()) |
| 86 | + } |
| 87 | + Self::SourcePort(port) | Self::DestinationPort(port) => { |
| 88 | + NetworkEndian::write_u16(buffer, *port) |
| 89 | + } |
| 90 | + Self::CollectMetadata => {} |
| 91 | + Self::FwMask(fw_mask) => NetworkEndian::write_u32(buffer, *fw_mask), |
| 92 | + Self::Other(nla) => nla.emit_value(buffer), |
| 93 | + } |
| 94 | + } |
| 95 | + |
| 96 | + fn kind(&self) -> u16 { |
| 97 | + match self { |
| 98 | + Self::Unspec => IFLA_GRE_UNSPEC, |
| 99 | + Self::IFlags(_) => IFLA_GRE_IFLAGS, |
| 100 | + Self::OFlags(_) => IFLA_GRE_OFLAGS, |
| 101 | + Self::IKey(_) => IFLA_GRE_IKEY, |
| 102 | + Self::Local(_) => IFLA_GRE_LOCAL, |
| 103 | + Self::Remote(_) => IFLA_GRE_REMOTE, |
| 104 | + Self::OKey(_) => IFLA_GRE_OKEY, |
| 105 | + Self::Ttl(_) => IFLA_GRE_TTL, |
| 106 | + Self::Tos(_) => IFLA_GRE_TOS, |
| 107 | + Self::PathMTUDiscovery(_) => IFLA_GRE_PMTUDISC, |
| 108 | + Self::EncapType(_) => IFLA_GRE_ENCAP_TYPE, |
| 109 | + Self::EncapFlags(_) => IFLA_GRE_ENCAP_FLAGS, |
| 110 | + Self::SourcePort(_) => IFLA_GRE_ENCAP_SPORT, |
| 111 | + Self::DestinationPort(_) => IFLA_GRE_ENCAP_DPORT, |
| 112 | + Self::CollectMetadata => IFLA_GRE_COLLECT_METADATA, |
| 113 | + Self::FwMask(_) => IFLA_GRE_FWMARK, |
| 114 | + Self::Other(nla) => nla.kind(), |
| 115 | + } |
| 116 | + } |
| 117 | +} |
| 118 | + |
| 119 | +impl<'a, T: AsRef<[u8]> + ?Sized> Parseable<NlaBuffer<&'a T>> for InfoGreTun { |
| 120 | + fn parse(buf: &NlaBuffer<&'a T>) -> Result<Self, DecodeError> { |
| 121 | + let payload = buf.value(); |
| 122 | + Ok(match buf.kind() { |
| 123 | + IFLA_GRE_UNSPEC => Self::Unspec, |
| 124 | + IFLA_GRE_IFLAGS => Self::IFlags(GreIOFlags::from_bits_retain( |
| 125 | + parse_u16_be(payload) |
| 126 | + .context("invalid IFLA_GRE_IFLAGS value")?, |
| 127 | + )), |
| 128 | + IFLA_GRE_OFLAGS => Self::OFlags(GreIOFlags::from_bits_retain( |
| 129 | + parse_u16_be(payload) |
| 130 | + .context("invalid IFLA_GRE_OFLAGS value")?, |
| 131 | + )), |
| 132 | + IFLA_GRE_IKEY => Self::IKey( |
| 133 | + parse_u32_be(payload).context("invalid IFLA_GRE_IKEY value")?, |
| 134 | + ), |
| 135 | + IFLA_GRE_OKEY => Self::OKey( |
| 136 | + parse_u32_be(payload).context("invalid IFLA_GRE_OKEY value")?, |
| 137 | + ), |
| 138 | + IFLA_GRE_LOCAL => Self::Local( |
| 139 | + parse_ipv4_addr(payload) |
| 140 | + .context("invalid IFLA_GRE_LOCAL value")?, |
| 141 | + ), |
| 142 | + IFLA_GRE_REMOTE => Self::Remote( |
| 143 | + parse_ipv4_addr(payload) |
| 144 | + .context("invalid IFLA_GRE_LOCAL value")?, |
| 145 | + ), |
| 146 | + IFLA_GRE_TTL => Self::Ttl( |
| 147 | + parse_u8(payload).context("invalid IFLA_GRE_TTL value")?, |
| 148 | + ), |
| 149 | + IFLA_GRE_TOS => Self::Tos( |
| 150 | + parse_u8(payload).context("invalid IFLA_GRE_TOS value")?, |
| 151 | + ), |
| 152 | + IFLA_GRE_PMTUDISC => Self::PathMTUDiscovery( |
| 153 | + parse_u8(payload).context("invalid IFLA_GRE_TOS value")? == 1, |
| 154 | + ), |
| 155 | + IFLA_GRE_ENCAP_TYPE => Self::EncapType(GreEncapType::try_from( |
| 156 | + parse_u16_be(payload) |
| 157 | + .context("invalid IFLA_GRE_ENCAP_TYPE value")?, |
| 158 | + )?), |
| 159 | + IFLA_GRE_ENCAP_FLAGS => { |
| 160 | + Self::EncapFlags(GreEncapFlags::from_bits_retain( |
| 161 | + parse_u16_be(payload) |
| 162 | + .context("invalid IFLA_GRE_ENCAP_FLAGS value")?, |
| 163 | + )) |
| 164 | + } |
| 165 | + IFLA_GRE_ENCAP_SPORT => Self::SourcePort( |
| 166 | + parse_u16_be(payload) |
| 167 | + .context("invalid IFLA_GRE_ENCAP_SPORT value")?, |
| 168 | + ), |
| 169 | + IFLA_GRE_ENCAP_DPORT => Self::DestinationPort( |
| 170 | + parse_u16_be(payload) |
| 171 | + .context("invalid IFLA_GRE_ENCAP_DPORT value")?, |
| 172 | + ), |
| 173 | + IFLA_GRE_COLLECT_METADATA => Self::CollectMetadata, |
| 174 | + IFLA_GRE_FWMARK => Self::FwMask( |
| 175 | + parse_u32_be(payload) |
| 176 | + .context("invalid IFLA_GRE_FWMARK value")?, |
| 177 | + ), |
| 178 | + kind => Self::Other( |
| 179 | + DefaultNla::parse(buf) |
| 180 | + .context(format!("unknown NLA type {kind} for ip6gre"))?, |
| 181 | + ), |
| 182 | + }) |
| 183 | + } |
| 184 | +} |
0 commit comments