use std::{fmt, io, mem::size_of, num::NonZeroI32};
use byteorder::{ByteOrder, NativeEndian};
use netlink_packet_utils::DecodeError;
use crate::{Emitable, Field, Parseable, Rest};
const CODE: Field = 0..4;
const PAYLOAD: Rest = 4..;
const ERROR_HEADER_LEN: usize = PAYLOAD.start;
#[derive(Debug, PartialEq, Eq, Clone)]
#[non_exhaustive]
pub struct ErrorBuffer<T> {
buffer: T,
}
impl<T: AsRef<[u8]>> ErrorBuffer<T> {
pub fn new(buffer: T) -> ErrorBuffer<T> {
ErrorBuffer { buffer }
}
pub fn into_inner(self) -> T {
self.buffer
}
pub fn new_checked(buffer: T) -> Result<Self, 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 < ERROR_HEADER_LEN {
Err(format!(
"invalid ErrorBuffer: length is {len} but ErrorBuffer are \
at least {ERROR_HEADER_LEN} bytes"
)
.into())
} else {
Ok(())
}
}
pub fn code(&self) -> Option<NonZeroI32> {
let data = self.buffer.as_ref();
NonZeroI32::new(NativeEndian::read_i32(&data[CODE]))
}
}
impl<'a, T: AsRef<[u8]> + ?Sized> ErrorBuffer<&'a T> {
pub fn payload(&self) -> &'a [u8] {
let data = self.buffer.as_ref();
&data[PAYLOAD]
}
}
impl<'a, T: AsRef<[u8]> + AsMut<[u8]> + ?Sized> ErrorBuffer<&'a mut T> {
pub fn payload_mut(&mut self) -> &mut [u8] {
let data = self.buffer.as_mut();
&mut data[PAYLOAD]
}
}
impl<T: AsRef<[u8]> + AsMut<[u8]>> ErrorBuffer<T> {
pub fn set_code(&mut self, value: i32) {
let data = self.buffer.as_mut();
NativeEndian::write_i32(&mut data[CODE], value)
}
}
#[derive(Debug, Default, Clone, PartialEq, Eq)]
#[non_exhaustive]
pub struct ErrorMessage {
pub code: Option<NonZeroI32>,
pub header: Vec<u8>,
}
impl Emitable for ErrorMessage {
fn buffer_len(&self) -> usize {
size_of::<i32>() + self.header.len()
}
fn emit(&self, buffer: &mut [u8]) {
let mut buffer = ErrorBuffer::new(buffer);
buffer.set_code(self.raw_code());
buffer.payload_mut().copy_from_slice(&self.header)
}
}
impl<'buffer, T: AsRef<[u8]> + 'buffer> Parseable<ErrorBuffer<&'buffer T>>
for ErrorMessage
{
fn parse(
buf: &ErrorBuffer<&'buffer T>,
) -> Result<ErrorMessage, DecodeError> {
Ok(ErrorMessage {
code: buf.code(),
header: buf.payload().to_vec(),
})
}
}
impl ErrorMessage {
pub fn raw_code(&self) -> i32 {
self.code.map_or(0, NonZeroI32::get)
}
pub fn to_io(&self) -> io::Error {
io::Error::from_raw_os_error(self.raw_code().abs())
}
}
impl fmt::Display for ErrorMessage {
fn fmt(&self, f: &mut fmt::Formatter<'_>) -> fmt::Result {
fmt::Display::fmt(&self.to_io(), f)
}
}
impl From<ErrorMessage> for io::Error {
fn from(e: ErrorMessage) -> io::Error {
e.to_io()
}
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn into_io_error() {
let io_err = io::Error::from_raw_os_error(95);
let err_msg = ErrorMessage {
code: NonZeroI32::new(-95),
header: vec![],
};
let to_io: io::Error = err_msg.to_io();
assert_eq!(err_msg.to_string(), io_err.to_string());
assert_eq!(to_io.raw_os_error(), io_err.raw_os_error());
}
#[test]
fn parse_ack() {
let bytes = vec![0, 0, 0, 0];
let msg = ErrorBuffer::new_checked(&bytes)
.and_then(|buf| ErrorMessage::parse(&buf))
.expect("failed to parse NLMSG_ERROR");
assert_eq!(
ErrorMessage {
code: None,
header: Vec::new()
},
msg
);
assert_eq!(msg.raw_code(), 0);
}
#[test]
fn parse_nack() {
const ERROR_CODE: NonZeroI32 =
unsafe { NonZeroI32::new_unchecked(-1234) };
let mut bytes = vec![0, 0, 0, 0];
NativeEndian::write_i32(&mut bytes, ERROR_CODE.get());
let msg = ErrorBuffer::new_checked(&bytes)
.and_then(|buf| ErrorMessage::parse(&buf))
.expect("failed to parse NLMSG_ERROR");
assert_eq!(
ErrorMessage {
code: Some(ERROR_CODE),
header: Vec::new()
},
msg
);
assert_eq!(msg.raw_code(), ERROR_CODE.get());
}
}