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 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404
// SPDX-License-Identifier: MIT
use byteorder::{ByteOrder, NativeEndian};
use netlink_packet_utils::DecodeError;
use crate::{Field, Rest};
const LENGTH: Field = 0..4;
const MESSAGE_TYPE: Field = 4..6;
const FLAGS: Field = 6..8;
const SEQUENCE_NUMBER: Field = 8..12;
const PORT_NUMBER: Field = 12..16;
const PAYLOAD: Rest = 16..;
/// Length of a Netlink packet header
pub const NETLINK_HEADER_LEN: usize = PAYLOAD.start;
// Prevent some doctest snippers to be formatted, since we cannot add
// the attribute directly in the doctest
#[rustfmt::skip]
#[derive(Debug, PartialEq, Eq, Clone)]
/// A raw Netlink buffer that provides getters and setter for the various header fields, and to
/// retrieve the payloads.
///
/// # Example: reading a packet
///
/// ```rust
/// use netlink_packet_core::{NetlinkBuffer, NLM_F_MATCH, NLM_F_REQUEST, NLM_F_ROOT};
///
/// const RTM_GETLINK: u16 = 18;
///
/// fn main() {
/// // Artificially create an array of bytes that represents a netlink packet.
/// // Normally, we would read it from a socket.
/// let buffer = vec![
/// 0x28, 0x00, 0x00, 0x00, // length = 40
/// 0x12, 0x00, // message type = 18 (RTM_GETLINK)
/// 0x01, 0x03, // flags = Request + Specify Tree Root + Return All Matching
/// 0x34, 0x0e, 0xf9, 0x5a, // sequence number = 1526271540
/// 0x00, 0x00, 0x00, 0x00, // port id = 0
/// // payload
/// 0x11, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
/// 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
/// 0x08, 0x00, 0x1d, 0x00, 0x01, 0x00, 0x00, 0x00];
///
/// // Wrap the storage into a NetlinkBuffer
/// let packet = NetlinkBuffer::new_checked(&buffer[..]).unwrap();
///
/// // Check that the different accessor return the expected values
/// assert_eq!(packet.length(), 40);
/// assert_eq!(packet.message_type(), RTM_GETLINK);
/// assert_eq!(packet.sequence_number(), 1526271540);
/// assert_eq!(packet.port_number(), 0);
/// assert_eq!(packet.payload_length(), 24);
/// assert_eq!(packet.payload(), &buffer[16..]);
/// assert_eq!(
/// Into::<u16>::into(packet.flags()),
/// NLM_F_ROOT | NLM_F_REQUEST | NLM_F_MATCH
/// );
/// }
/// ```
///
/// # Example: writing a packet
///
/// ```rust
/// use netlink_packet_core::{NetlinkBuffer, NLM_F_MATCH, NLM_F_REQUEST, NLM_F_ROOT};
///
/// const RTM_GETLINK: u16 = 18;
///
/// fn main() {
/// // The packet we want to write.
/// let expected_buffer = vec![
/// 0x28, 0x00, 0x00, 0x00, // length = 40
/// 0x12, 0x00, // message type = 18 (RTM_GETLINK)
/// 0x01, 0x03, // flags = Request + Specify Tree Root + Return All Matching
/// 0x34, 0x0e, 0xf9, 0x5a, // sequence number = 1526271540
/// 0x00, 0x00, 0x00, 0x00, // port id = 0
/// // payload
/// 0x11, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
/// 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
/// 0x08, 0x00, 0x1d, 0x00, 0x01, 0x00, 0x00, 0x00];
///
/// // Create a storage that is big enough for our packet
/// let mut buf = vec![0; 40];
/// // the extra scope is to restrict the scope of the borrow
/// {
/// // Create a NetlinkBuffer.
/// let mut packet = NetlinkBuffer::new(&mut buf);
/// // Set the various fields
/// packet.set_length(40);
/// packet.set_message_type(RTM_GETLINK);
/// packet.set_sequence_number(1526271540);
/// packet.set_port_number(0);
/// packet.set_flags(From::from(NLM_F_ROOT | NLM_F_REQUEST | NLM_F_MATCH));
/// // we kind of cheat here to keep the example short
/// packet.payload_mut().copy_from_slice(&expected_buffer[16..]);
/// }
/// // Check that the storage contains the expected values
/// assert_eq!(&buf[..], &expected_buffer[..]);
/// }
/// ```
///
/// Note that in this second example we don't call
/// [`new_checked()`](struct.NetlinkBuffer.html#method.new_checked) because the length field is
/// initialized to 0, so `new_checked()` would return an error.
#[non_exhaustive]
pub struct NetlinkBuffer<T> {
pub buffer: T,
}
// Prevent some doc strings to be formatted, since we cannot add the
// attribute directly in the doctest
#[rustfmt::skip]
impl<T: AsRef<[u8]>> NetlinkBuffer<T> {
/// Create a new `NetlinkBuffer` that uses the given buffer as storage. Note that when calling
/// this method no check is performed, so trying to access fields may panic. If you're not sure
/// the given buffer contains a valid netlink packet, use
/// [`new_checked()`](struct.NetlinkBuffer.html#method.new_checked) instead.
pub fn new(buffer: T) -> NetlinkBuffer<T> {
NetlinkBuffer { buffer }
}
// Prevent some doc strings to be formatted, since we cannot add
// the attribute directly in the doctest
#[rustfmt::skip]
/// Check the length of the given buffer and make sure it's big enough so that trying to access
/// packet fields won't panic. If the buffer is big enough, create a new `NewlinkBuffer` that
/// uses this buffer as storage.
///
/// # Example
///
/// With a buffer that does not even contain a full header:
///
/// ```rust
/// use netlink_packet_core::NetlinkBuffer;
/// static BYTES: [u8; 4] = [0x28, 0x00, 0x00, 0x00];
/// assert!(NetlinkBuffer::new_checked(&BYTES[..]).is_err());
/// ```
///
/// Here is a slightly more tricky error, where technically, the buffer is big enough to
/// contains a valid packet. Here, accessing the packet header fields would not panic but
/// accessing the payload would, so `new_checked` also checks the length field in the packet
/// header:
///
/// ```rust
/// use netlink_packet_core::NetlinkBuffer;
/// // The buffer is 24 bytes long. It contains a valid header but a truncated payload
/// static BYTES: [u8; 24] = [
/// // The length field says the buffer is 40 bytes long
/// 0x28, 0x00, 0x00, 0x00,
/// 0x12, 0x00, // message type
/// 0x01, 0x03, // flags
/// 0x34, 0x0e, 0xf9, 0x5a, // sequence number
/// 0x00, 0x00, 0x00, 0x00, // port id
/// // payload
/// 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00];
/// assert!(NetlinkBuffer::new_checked(&BYTES[..]).is_err());
/// ```
pub fn new_checked(buffer: T) -> Result<NetlinkBuffer<T>, DecodeError> {
let packet = Self::new(buffer);
packet.check_buffer_length()?;
Ok(packet)
}
fn check_buffer_length(&self) -> Result<(), DecodeError> {
let len = self.buffer.as_ref().len();
if len < PORT_NUMBER.end {
Err(format!(
"invalid netlink buffer: length is {} but netlink packets are at least {} bytes",
len, PORT_NUMBER.end
)
.into())
} else if len < self.length() as usize {
Err(format!(
"invalid netlink buffer: length field says {} the buffer is {} bytes long",
self.length(),
len
)
.into())
} else if (self.length() as usize) < PORT_NUMBER.end {
Err(format!(
"invalid netlink buffer: length field says {} but netlink packets are at least {} bytes",
self.length(),
len
).into())
} else {
Ok(())
}
}
/// Return the payload length.
///
/// # Panic
///
/// This panic is the underlying storage is too small or if the `length` field in the header is
/// set to a value that exceeds the storage length (see
/// [`new_checked()`](struct.NetlinkBuffer.html#method.new_checked))
pub fn payload_length(&self) -> usize {
let total_length = self.length() as usize;
let payload_offset = PAYLOAD.start;
// This may panic!
total_length - payload_offset
}
/// Consume the packet, returning the underlying buffer.
pub fn into_inner(self) -> T {
self.buffer
}
/// Return the `length` field
///
/// # Panic
///
/// This panic is the underlying storage is too small (see [`new_checked()`](struct.NetlinkBuffer.html#method.new_checked))
pub fn length(&self) -> u32 {
let data = self.buffer.as_ref();
NativeEndian::read_u32(&data[LENGTH])
}
/// Return the `type` field
///
/// # Panic
///
/// This panic is the underlying storage is too small (see [`new_checked()`](struct.NetlinkBuffer.html#method.new_checked))
pub fn message_type(&self) -> u16 {
let data = self.buffer.as_ref();
NativeEndian::read_u16(&data[MESSAGE_TYPE])
}
/// Return the `flags` field
///
/// # Panic
///
/// This panic is the underlying storage is too small (see [`new_checked()`](struct.NetlinkBuffer.html#method.new_checked))
pub fn flags(&self) -> u16 {
let data = self.buffer.as_ref();
NativeEndian::read_u16(&data[FLAGS])
}
/// Return the `sequence_number` field
///
/// # Panic
///
/// This panic is the underlying storage is too small (see [`new_checked()`](struct.NetlinkBuffer.html#method.new_checked))
pub fn sequence_number(&self) -> u32 {
let data = self.buffer.as_ref();
NativeEndian::read_u32(&data[SEQUENCE_NUMBER])
}
/// Return the `port_number` field
///
/// # Panic
///
/// This panic is the underlying storage is too small (see [`new_checked()`](struct.NetlinkBuffer.html#method.new_checked))
pub fn port_number(&self) -> u32 {
let data = self.buffer.as_ref();
NativeEndian::read_u32(&data[PORT_NUMBER])
}
}
impl<T: AsRef<[u8]> + AsMut<[u8]>> NetlinkBuffer<T> {
/// Set the packet header `length` field
///
/// # Panic
///
/// This panic is the underlying storage is too small (see
/// [`new_checked()`](struct.NetlinkBuffer.html#method.new_checked))
pub fn set_length(&mut self, value: u32) {
let data = self.buffer.as_mut();
NativeEndian::write_u32(&mut data[LENGTH], value)
}
/// Set the packet header `message_type` field
///
/// # Panic
///
/// This panic is the underlying storage is too small (see
/// [`new_checked()`](struct.NetlinkBuffer.html#method.new_checked))
pub fn set_message_type(&mut self, value: u16) {
let data = self.buffer.as_mut();
NativeEndian::write_u16(&mut data[MESSAGE_TYPE], value)
}
/// Set the packet header `flags` field
///
/// # Panic
///
/// This panic is the underlying storage is too small (see
/// [`new_checked()`](struct.NetlinkBuffer.html#method.new_checked))
pub fn set_flags(&mut self, value: u16) {
let data = self.buffer.as_mut();
NativeEndian::write_u16(&mut data[FLAGS], value)
}
/// Set the packet header `sequence_number` field
///
/// # Panic
///
/// This panic is the underlying storage is too small (see
/// [`new_checked()`](struct.NetlinkBuffer.html#method.new_checked))
pub fn set_sequence_number(&mut self, value: u32) {
let data = self.buffer.as_mut();
NativeEndian::write_u32(&mut data[SEQUENCE_NUMBER], value)
}
/// Set the packet header `port_number` field
///
/// # Panic
///
/// This panic is the underlying storage is too small (see
/// [`new_checked()`](struct.NetlinkBuffer.html#method.new_checked))
pub fn set_port_number(&mut self, value: u32) {
let data = self.buffer.as_mut();
NativeEndian::write_u32(&mut data[PORT_NUMBER], value)
}
}
impl<'a, T: AsRef<[u8]> + ?Sized> NetlinkBuffer<&'a T> {
/// Return a pointer to the packet payload.
///
/// # Panic
///
/// This panic is the underlying storage is too small or if the `length`
/// field in the header is set to a value that exceeds the storage
/// length (see [`new_checked()`](struct.NetlinkBuffer.html#method.
/// new_checked))
pub fn payload(&self) -> &'a [u8] {
let range = PAYLOAD.start..self.length() as usize;
let data = self.buffer.as_ref();
&data[range]
}
}
impl<'a, T: AsRef<[u8]> + AsMut<[u8]> + ?Sized> NetlinkBuffer<&'a mut T> {
/// Return a mutable pointer to the payload.
///
/// # Panic
///
/// This panic is the underlying storage is too small or if the `length`
/// field in the header is set to a value that exceeds the storage
/// length (see [`new_checked()`](struct.NetlinkBuffer.html#method.
/// new_checked))
pub fn payload_mut(&mut self) -> &mut [u8] {
let range = PAYLOAD.start..self.length() as usize;
let data = self.buffer.as_mut();
&mut data[range]
}
}
#[cfg(test)]
mod tests {
use crate::{
constants::{NLM_F_MATCH, NLM_F_REQUEST, NLM_F_ROOT},
NetlinkBuffer,
};
const RTM_GETLINK: u16 = 18;
// a packet captured with tcpdump that was sent when running `ip link show`
#[rustfmt::skip]
static IP_LINK_SHOW_PKT: [u8; 40] = [
0x28, 0x00, 0x00, 0x00, // length = 40
0x12, 0x00, // message type = 18 (RTM_GETLINK)
0x01, 0x03, // flags = Request + Specify Tree Root + Return All Matching
0x34, 0x0e, 0xf9, 0x5a, // sequence number = 1526271540
0x00, 0x00, 0x00, 0x00, // port id = 0
// payload
0x11, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
0x08, 0x00, 0x1d, 0x00, 0x01, 0x00, 0x00, 0x00];
#[test]
fn packet_read() {
let packet = NetlinkBuffer::new(&IP_LINK_SHOW_PKT[..]);
assert_eq!(packet.length(), 40);
assert_eq!(packet.message_type(), RTM_GETLINK);
assert_eq!(packet.sequence_number(), 1526271540);
assert_eq!(packet.port_number(), 0);
let flags = packet.flags();
assert!(flags & NLM_F_ROOT == NLM_F_ROOT);
assert!(flags & NLM_F_REQUEST == NLM_F_REQUEST);
assert!(flags & NLM_F_MATCH == NLM_F_MATCH);
assert_eq!(flags, NLM_F_ROOT | NLM_F_REQUEST | NLM_F_MATCH);
assert_eq!(packet.payload_length(), 24);
assert_eq!(packet.payload(), &IP_LINK_SHOW_PKT[16..]);
}
#[test]
fn packet_build() {
let mut buf = vec![0; 40];
{
let mut packet = NetlinkBuffer::new(&mut buf);
packet.set_length(40);
packet.set_message_type(RTM_GETLINK);
packet.set_sequence_number(1526271540);
packet.set_port_number(0);
packet.set_flags(NLM_F_ROOT | NLM_F_REQUEST | NLM_F_MATCH);
packet
.payload_mut()
.copy_from_slice(&IP_LINK_SHOW_PKT[16..]);
}
assert_eq!(&buf[..], &IP_LINK_SHOW_PKT[..]);
}
}