|
| 1 | +// SPDX-License-Identifier: MIT |
| 2 | + |
| 3 | +use anyhow::Context; |
| 4 | +use byteorder::{ByteOrder, NativeEndian}; |
| 5 | +use netlink_packet_utils::{ |
| 6 | + nla::{DefaultNla, Nla, NlaBuffer, NlasIterator, NLA_F_NESTED}, |
| 7 | + parsers::parse_u32, |
| 8 | + DecodeError, Emitable, Parseable, |
| 9 | +}; |
| 10 | + |
| 11 | +use crate::{EthtoolAttr, EthtoolHeader}; |
| 12 | + |
| 13 | +const ETHTOOL_A_CHANNELS_HEADER: u16 = 1; |
| 14 | +const ETHTOOL_A_CHANNELS_RX_MAX: u16 = 2; |
| 15 | +const ETHTOOL_A_CHANNELS_TX_MAX: u16 = 3; |
| 16 | +const ETHTOOL_A_CHANNELS_OTHER_MAX: u16 = 4; |
| 17 | +const ETHTOOL_A_CHANNELS_COMBINED_MAX: u16 = 5; |
| 18 | +const ETHTOOL_A_CHANNELS_RX_COUNT: u16 = 6; |
| 19 | +const ETHTOOL_A_CHANNELS_TX_COUNT: u16 = 7; |
| 20 | +const ETHTOOL_A_CHANNELS_OTHER_COUNT: u16 = 8; |
| 21 | +const ETHTOOL_A_CHANNELS_COMBINED_COUNT: u16 = 9; |
| 22 | + |
| 23 | +#[derive(Debug, PartialEq, Eq, Clone)] |
| 24 | +pub enum EthtoolChannelAttr { |
| 25 | + Header(Vec<EthtoolHeader>), |
| 26 | + RxMax(u32), |
| 27 | + TxMax(u32), |
| 28 | + OtherMax(u32), |
| 29 | + CombinedMax(u32), |
| 30 | + RxCount(u32), |
| 31 | + TxCount(u32), |
| 32 | + OtherCount(u32), |
| 33 | + CombinedCount(u32), |
| 34 | + Other(DefaultNla), |
| 35 | +} |
| 36 | + |
| 37 | +impl Nla for EthtoolChannelAttr { |
| 38 | + fn value_len(&self) -> usize { |
| 39 | + match self { |
| 40 | + Self::Header(hdrs) => hdrs.as_slice().buffer_len(), |
| 41 | + Self::RxMax(_) |
| 42 | + | Self::TxMax(_) |
| 43 | + | Self::OtherMax(_) |
| 44 | + | Self::CombinedMax(_) |
| 45 | + | Self::RxCount(_) |
| 46 | + | Self::TxCount(_) |
| 47 | + | Self::OtherCount(_) |
| 48 | + | Self::CombinedCount(_) => 4, |
| 49 | + Self::Other(attr) => attr.value_len(), |
| 50 | + } |
| 51 | + } |
| 52 | + |
| 53 | + fn kind(&self) -> u16 { |
| 54 | + match self { |
| 55 | + Self::Header(_) => ETHTOOL_A_CHANNELS_HEADER | NLA_F_NESTED, |
| 56 | + Self::RxMax(_) => ETHTOOL_A_CHANNELS_RX_MAX, |
| 57 | + Self::TxMax(_) => ETHTOOL_A_CHANNELS_TX_MAX, |
| 58 | + Self::OtherMax(_) => ETHTOOL_A_CHANNELS_OTHER_MAX, |
| 59 | + Self::CombinedMax(_) => ETHTOOL_A_CHANNELS_COMBINED_MAX, |
| 60 | + Self::RxCount(_) => ETHTOOL_A_CHANNELS_RX_COUNT, |
| 61 | + Self::TxCount(_) => ETHTOOL_A_CHANNELS_TX_COUNT, |
| 62 | + Self::OtherCount(_) => ETHTOOL_A_CHANNELS_OTHER_COUNT, |
| 63 | + Self::CombinedCount(_) => ETHTOOL_A_CHANNELS_COMBINED_COUNT, |
| 64 | + Self::Other(attr) => attr.kind(), |
| 65 | + } |
| 66 | + } |
| 67 | + |
| 68 | + fn emit_value(&self, buffer: &mut [u8]) { |
| 69 | + match self { |
| 70 | + Self::Header(ref nlas) => nlas.as_slice().emit(buffer), |
| 71 | + Self::RxMax(d) |
| 72 | + | Self::TxMax(d) |
| 73 | + | Self::OtherMax(d) |
| 74 | + | Self::CombinedMax(d) |
| 75 | + | Self::RxCount(d) |
| 76 | + | Self::TxCount(d) |
| 77 | + | Self::OtherCount(d) |
| 78 | + | Self::CombinedCount(d) => NativeEndian::write_u32(buffer, *d), |
| 79 | + Self::Other(ref attr) => attr.emit(buffer), |
| 80 | + } |
| 81 | + } |
| 82 | +} |
| 83 | + |
| 84 | +impl<'a, T: AsRef<[u8]> + ?Sized> Parseable<NlaBuffer<&'a T>> |
| 85 | + for EthtoolChannelAttr |
| 86 | +{ |
| 87 | + fn parse(buf: &NlaBuffer<&'a T>) -> Result<Self, DecodeError> { |
| 88 | + let payload = buf.value(); |
| 89 | + Ok(match buf.kind() { |
| 90 | + ETHTOOL_A_CHANNELS_HEADER => { |
| 91 | + let mut nlas = Vec::new(); |
| 92 | + let error_msg = "failed to parse channel header attributes"; |
| 93 | + for nla in NlasIterator::new(payload) { |
| 94 | + let nla = &nla.context(error_msg)?; |
| 95 | + let parsed = |
| 96 | + EthtoolHeader::parse(nla).context(error_msg)?; |
| 97 | + nlas.push(parsed); |
| 98 | + } |
| 99 | + Self::Header(nlas) |
| 100 | + } |
| 101 | + ETHTOOL_A_CHANNELS_RX_MAX => Self::RxMax( |
| 102 | + parse_u32(payload) |
| 103 | + .context("Invalid ETHTOOL_A_CHANNELS_RX_MAX value")?, |
| 104 | + ), |
| 105 | + ETHTOOL_A_CHANNELS_TX_MAX => Self::TxMax( |
| 106 | + parse_u32(payload) |
| 107 | + .context("Invalid ETHTOOL_A_CHANNELS_RX_MAX value")?, |
| 108 | + ), |
| 109 | + ETHTOOL_A_CHANNELS_OTHER_MAX => Self::OtherMax( |
| 110 | + parse_u32(payload) |
| 111 | + .context("Invalid ETHTOOL_A_CHANNELS_RX_MAX value")?, |
| 112 | + ), |
| 113 | + ETHTOOL_A_CHANNELS_COMBINED_MAX => Self::CombinedMax( |
| 114 | + parse_u32(payload) |
| 115 | + .context("Invalid ETHTOOL_A_CHANNELS_RX_MAX value")?, |
| 116 | + ), |
| 117 | + ETHTOOL_A_CHANNELS_RX_COUNT => Self::RxCount( |
| 118 | + parse_u32(payload) |
| 119 | + .context("Invalid ETHTOOL_A_CHANNELS_RX_COUNT value")?, |
| 120 | + ), |
| 121 | + ETHTOOL_A_CHANNELS_TX_COUNT => Self::TxCount( |
| 122 | + parse_u32(payload) |
| 123 | + .context("Invalid ETHTOOL_A_CHANNELS_RX_COUNT value")?, |
| 124 | + ), |
| 125 | + ETHTOOL_A_CHANNELS_OTHER_COUNT => Self::OtherCount( |
| 126 | + parse_u32(payload) |
| 127 | + .context("Invalid ETHTOOL_A_CHANNELS_RX_COUNT value")?, |
| 128 | + ), |
| 129 | + ETHTOOL_A_CHANNELS_COMBINED_COUNT => Self::CombinedCount( |
| 130 | + parse_u32(payload) |
| 131 | + .context("Invalid ETHTOOL_A_CHANNELS_RX_COUNT value")?, |
| 132 | + ), |
| 133 | + kind => { |
| 134 | + Self::Other(DefaultNla::parse(buf).context(format!( |
| 135 | + "invalid ethtool channel NLA kind {kind}" |
| 136 | + ))?) |
| 137 | + } |
| 138 | + }) |
| 139 | + } |
| 140 | +} |
| 141 | + |
| 142 | +pub(crate) fn parse_channel_nlas( |
| 143 | + buffer: &[u8], |
| 144 | +) -> Result<Vec<EthtoolAttr>, DecodeError> { |
| 145 | + let mut nlas = Vec::new(); |
| 146 | + for nla in NlasIterator::new(buffer) { |
| 147 | + let error_msg = format!( |
| 148 | + "Failed to parse ethtool channel message attribute {nla:?}" |
| 149 | + ); |
| 150 | + let nla = &nla.context(error_msg.clone())?; |
| 151 | + let parsed = EthtoolChannelAttr::parse(nla).context(error_msg)?; |
| 152 | + nlas.push(EthtoolAttr::Channel(parsed)); |
| 153 | + } |
| 154 | + Ok(nlas) |
| 155 | +} |
0 commit comments