usb: simplify buffer handling for Control IN transfers.

This commit is contained in:
Dario Nieuwenhuis
2022-03-28 03:34:24 +02:00
parent bfce731982
commit e99a3a1da4
3 changed files with 21 additions and 63 deletions

View File

@ -131,6 +131,13 @@ pub enum OutResponse {
Rejected,
}
#[derive(Copy, Clone, Eq, PartialEq, Debug)]
#[cfg_attr(feature = "defmt", derive(defmt::Format))]
pub enum InResponse {
Accepted(usize),
Rejected,
}
/// A trait for implementing USB classes.
///
/// All methods are optional callbacks that will be called by
@ -171,54 +178,7 @@ pub trait ControlHandler {
///
/// * `req` - The request from the SETUP packet.
/// * `control` - The control pipe.
fn control_in<'a>(&mut self, req: Request, control: ControlIn<'a>) -> InResponse<'a> {
control.reject()
}
}
/// Handle for a control IN transfer. When implementing a class, use the methods of this object to
/// response to the transfer with either data or an error (STALL condition). To ignore the request
/// and pass it on to the next class, call [`Self::ignore()`].
pub struct ControlIn<'a> {
buf: &'a mut [u8],
}
#[derive(Eq, PartialEq, Debug)]
#[cfg_attr(feature = "defmt", derive(defmt::Format))]
pub struct InResponse<'a> {
pub(crate) response: OutResponse,
pub(crate) data: &'a [u8],
}
impl<'a> InResponse<'a> {
pub fn status(&self) -> OutResponse {
self.response
}
}
impl<'a> ControlIn<'a> {
pub(crate) fn new(buf: &'a mut [u8]) -> Self {
ControlIn { buf }
}
/// Accepts the transfer with the supplied buffer.
pub fn accept(self, data: &[u8]) -> InResponse<'a> {
assert!(data.len() < self.buf.len());
let buf = &mut self.buf[0..data.len()];
buf.copy_from_slice(data);
InResponse {
response: OutResponse::Accepted,
data: buf,
}
}
/// Rejects the transfer by stalling the pipe.
pub fn reject(self) -> InResponse<'a> {
InResponse {
response: OutResponse::Rejected,
data: &[],
}
fn control_in(&mut self, req: Request, resp: &mut [u8]) -> InResponse {
InResponse::Rejected
}
}

View File

@ -278,7 +278,6 @@ impl<'d, D: Driver<'d>> UsbDevice<'d, D> {
_ => self.control.reject(),
},
(RequestType::Class, Recipient::Interface) => {
let mut buf = [0; 128];
let handler = self
.interfaces
.iter_mut()
@ -286,10 +285,10 @@ impl<'d, D: Driver<'d>> UsbDevice<'d, D> {
.map(|(_, h)| h);
match handler {
Some(handler) => {
let resp = handler.control_in(req, ControlIn::new(&mut buf));
match resp.response {
OutResponse::Accepted => self.control.accept_in(resp.data).await,
OutResponse::Rejected => self.control.reject(),
let mut buf = [0; 128];
match handler.control_in(req, &mut buf) {
InResponse::Accepted(len) => self.control.accept_in(&buf[..len]).await,
InResponse::Rejected => self.control.reject(),
}
}
None => self.control.reject(),