Skip to content
Merged
Show file tree
Hide file tree
Changes from all commits
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
27 changes: 8 additions & 19 deletions mctp-estack/src/usb.rs
Original file line number Diff line number Diff line change
Expand Up @@ -127,12 +127,11 @@ impl MctpUsbHandler {
return r.unborrowed().unwrap()
}
};
if Self::header(len, hdr).is_err() {
return SendOutput::Error {
err: Error::InternalError,
cookie: None,
};
}

// Can't fail since len is at most MCTP_USB_MAX, and thus can't overflow a u8
let header = Self::header(len).unwrap();
hdr.copy_from_slice(&header);

let slice = &self.tx_xfer[0..len + 4];
let res = xfer.send_xfer(slice);
if let Err(_e) = res {
Expand All @@ -145,27 +144,17 @@ impl MctpUsbHandler {
}
}

/// Creates a MCTP over USB Header.
/// Returns a MCTP over USB Header.
///
/// `mctplen` is the length of the remaining MCTP packet
/// after the header.
/// `hdr` must be a 4 byte slice.
pub fn header(mctp_len: usize, hdr: &mut [u8]) -> Result<()> {
if hdr.len() != 4 {
return Err(Error::BadArgument);
}

pub fn header(mctp_len: usize) -> Result<[u8; 4]> {
let usb_len: u8 = mctp_len
.checked_add(4)
.ok_or(Error::BadArgument)?
.try_into()
.map_err(|_| Error::BadArgument)?;

hdr[0] = 0x1a;
hdr[1] = 0xb4;
hdr[2] = 0;
hdr[3] = usb_len;
Ok(())
Ok([0x1a, 0xb4, 0, usb_len])
}
}

Expand Down
3 changes: 1 addition & 2 deletions mctp-usb-embassy/src/mctpusb.rs
Original file line number Diff line number Diff line change
Expand Up @@ -59,8 +59,7 @@ impl<'d, D: Driver<'d>> Sender<'d, D> {
return Err(mctp::Error::NoSpace);
}

let mut hdr = [0u8; 4];
MctpUsbHandler::header(pkt.len(), &mut hdr)?;
let hdr = MctpUsbHandler::header(pkt.len())?;
let _ = self.buf.extend_from_slice(&hdr);
let _ = self.buf.extend_from_slice(pkt);
Ok(())
Expand Down
Loading