Split UsbDevice::run into run and run_until_suspend

This commit is contained in:
alexmoon 2022-04-13 16:04:31 -04:00
parent ff7c6b350e
commit b0725c14d3
2 changed files with 113 additions and 76 deletions

View File

@ -100,7 +100,6 @@ pub struct UsbDevice<'d, D: Driver<'d>> {
device_state: UsbDeviceState, device_state: UsbDeviceState,
suspended: bool, suspended: bool,
in_control_handler: bool,
remote_wakeup_enabled: bool, remote_wakeup_enabled: bool,
self_powered: bool, self_powered: bool,
pending_address: u8, pending_address: u8,
@ -138,7 +137,6 @@ impl<'d, D: Driver<'d>> UsbDevice<'d, D> {
control_buf, control_buf,
device_state: UsbDeviceState::Disabled, device_state: UsbDeviceState::Disabled,
suspended: false, suspended: false,
in_control_handler: false,
remote_wakeup_enabled: false, remote_wakeup_enabled: false,
self_powered: false, self_powered: false,
pending_address: 0, pending_address: 0,
@ -146,7 +144,26 @@ impl<'d, D: Driver<'d>> UsbDevice<'d, D> {
} }
} }
/// Runs the `UsbDevice` forever.
///
/// This future may leave the bus in an invalid state if it is dropped.
/// After dropping the future, [`UsbDevice::disable()`] should be called
/// before calling any other `UsbDevice` methods to fully reset the
/// peripheral.
pub async fn run(&mut self) -> ! { pub async fn run(&mut self) -> ! {
loop {
self.run_until_suspend().await;
self.wait_resume().await;
}
}
/// Runs the `UsbDevice` until the bus is suspended.
///
/// This future may leave the bus in an invalid state if it is dropped.
/// After dropping the future, [`UsbDevice::disable()`] should be called
/// before calling any other `UsbDevice` methods to fully reset the
/// peripheral.
pub async fn run_until_suspend(&mut self) -> () {
if self.device_state == UsbDeviceState::Disabled { if self.device_state == UsbDeviceState::Disabled {
self.bus.enable().await; self.bus.enable().await;
self.device_state = UsbDeviceState::Default; self.device_state = UsbDeviceState::Default;
@ -154,66 +171,33 @@ impl<'d, D: Driver<'d>> UsbDevice<'d, D> {
if let Some(h) = &self.handler { if let Some(h) = &self.handler {
h.enabled(true); h.enabled(true);
} }
} else if self.in_control_handler {
warn!("usb: control request interrupted");
self.control.reject();
self.in_control_handler = false;
} }
loop { loop {
let control_fut = self.control.setup(); let control_fut = self.control.setup();
let bus_fut = self.bus.poll(); let bus_fut = self.bus.poll();
match select(bus_fut, control_fut).await { match select(bus_fut, control_fut).await {
Either::First(evt) => match evt { Either::First(evt) => {
Event::Reset => { self.handle_bus_event(evt);
trace!("usb: reset"); if self.suspended {
self.device_state = UsbDeviceState::Default; return;
self.suspended = false;
self.remote_wakeup_enabled = false;
self.pending_address = 0;
for (_, h) in self.interfaces.iter_mut() {
h.reset();
}
if let Some(h) = &self.handler {
h.reset();
}
} }
Event::Resume => {
trace!("usb: resume");
self.suspended = false;
if let Some(h) = &self.handler {
h.suspended(false);
}
}
Event::Suspend => {
trace!("usb: suspend");
self.suspended = true;
if let Some(h) = &self.handler {
h.suspended(true);
}
}
},
Either::Second(req) => {
self.in_control_handler = true;
match req {
Setup::DataIn(req, stage) => self.handle_control_in(req, stage).await,
Setup::DataOut(req, stage) => self.handle_control_out(req, stage).await,
}
self.in_control_handler = false;
} }
Either::Second(req) => match req {
Setup::DataIn(req, stage) => self.handle_control_in(req, stage).await,
Setup::DataOut(req, stage) => self.handle_control_out(req, stage).await,
},
} }
} }
} }
/// Disables the USB peripheral.
pub async fn disable(&mut self) { pub async fn disable(&mut self) {
if self.device_state != UsbDeviceState::Disabled { if self.device_state != UsbDeviceState::Disabled {
self.bus.disable().await; self.bus.disable().await;
self.device_state = UsbDeviceState::Disabled; self.device_state = UsbDeviceState::Disabled;
self.suspended = false; self.suspended = false;
self.remote_wakeup_enabled = false; self.remote_wakeup_enabled = false;
self.in_control_handler = false;
if let Some(h) = &self.handler { if let Some(h) = &self.handler {
h.enabled(false); h.enabled(false);
@ -221,11 +205,26 @@ impl<'d, D: Driver<'d>> UsbDevice<'d, D> {
} }
} }
/// Waits for a resume condition on the USB bus.
///
/// This future is cancel-safe.
pub async fn wait_resume(&mut self) {
while self.suspended {
let evt = self.bus.poll().await;
self.handle_bus_event(evt);
}
}
/// Initiates a device remote wakeup on the USB bus.
///
/// If the bus is not suspended or remote wakeup is not enabled, an error
/// will be returned.
///
/// This future may leave the bus in an inconsistent state if dropped.
/// After dropping the future, [`UsbDevice::disable()`] should be called
/// before calling any other `UsbDevice` methods to fully reset the peripheral.
pub async fn remote_wakeup(&mut self) -> Result<(), RemoteWakeupError> { pub async fn remote_wakeup(&mut self) -> Result<(), RemoteWakeupError> {
if self.device_state == UsbDeviceState::Configured if self.suspended && self.remote_wakeup_enabled {
&& self.suspended
&& self.remote_wakeup_enabled
{
self.bus.remote_wakeup().await?; self.bus.remote_wakeup().await?;
self.suspended = false; self.suspended = false;
@ -239,6 +238,40 @@ impl<'d, D: Driver<'d>> UsbDevice<'d, D> {
} }
} }
fn handle_bus_event(&mut self, evt: Event) {
match evt {
Event::Reset => {
trace!("usb: reset");
self.device_state = UsbDeviceState::Default;
self.suspended = false;
self.remote_wakeup_enabled = false;
self.pending_address = 0;
for (_, h) in self.interfaces.iter_mut() {
h.reset();
}
if let Some(h) = &self.handler {
h.reset();
}
}
Event::Resume => {
trace!("usb: resume");
self.suspended = false;
if let Some(h) = &self.handler {
h.suspended(false);
}
}
Event::Suspend => {
trace!("usb: suspend");
self.suspended = true;
if let Some(h) = &self.handler {
h.suspended(true);
}
}
}
}
async fn handle_control_out(&mut self, req: Request, stage: DataOutStage) { async fn handle_control_out(&mut self, req: Request, stage: DataOutStage) {
const CONFIGURATION_NONE_U16: u16 = CONFIGURATION_NONE as u16; const CONFIGURATION_NONE_U16: u16 = CONFIGURATION_NONE as u16;
const CONFIGURATION_VALUE_U16: u16 = CONFIGURATION_VALUE as u16; const CONFIGURATION_VALUE_U16: u16 = CONFIGURATION_VALUE as u16;

View File

@ -6,12 +6,11 @@
use core::mem; use core::mem;
use core::sync::atomic::{AtomicBool, Ordering}; use core::sync::atomic::{AtomicBool, Ordering};
use defmt::*; use defmt::*;
use embassy::blocking_mutex::raw::CriticalSectionRawMutex; use embassy::channel::Signal;
use embassy::channel::Channel;
use embassy::executor::Spawner; use embassy::executor::Spawner;
use embassy::interrupt::InterruptExt; use embassy::interrupt::InterruptExt;
use embassy::time::Duration; use embassy::time::Duration;
use embassy::util::select; use embassy::util::{select, select3, Either, Either3};
use embassy_nrf::gpio::{Input, Pin, Pull}; use embassy_nrf::gpio::{Input, Pin, Pull};
use embassy_nrf::interrupt; use embassy_nrf::interrupt;
use embassy_nrf::pac; use embassy_nrf::pac;
@ -26,14 +25,7 @@ use usbd_hid::descriptor::{KeyboardReport, SerializedDescriptor};
use defmt_rtt as _; // global logger use defmt_rtt as _; // global logger
use panic_probe as _; use panic_probe as _;
#[derive(defmt::Format)] static ENABLE_USB: Signal<bool> = Signal::new();
enum Command {
Enable,
Disable,
RemoteWakeup,
}
static USB_COMMANDS: Channel<CriticalSectionRawMutex, Command, 1> = Channel::new();
static SUSPENDED: AtomicBool = AtomicBool::new(false); static SUSPENDED: AtomicBool = AtomicBool::new(false);
fn on_power_interrupt(_: *mut ()) { fn on_power_interrupt(_: *mut ()) {
@ -42,17 +34,13 @@ fn on_power_interrupt(_: *mut ()) {
if regs.events_usbdetected.read().bits() != 0 { if regs.events_usbdetected.read().bits() != 0 {
regs.events_usbdetected.reset(); regs.events_usbdetected.reset();
info!("Vbus detected, enabling USB..."); info!("Vbus detected, enabling USB...");
if USB_COMMANDS.try_send(Command::Enable).is_err() { ENABLE_USB.signal(true);
warn!("Failed to send enable command to USB channel");
}
} }
if regs.events_usbremoved.read().bits() != 0 { if regs.events_usbremoved.read().bits() != 0 {
regs.events_usbremoved.reset(); regs.events_usbremoved.reset();
info!("Vbus removed, disabling USB..."); info!("Vbus removed, disabling USB...");
if USB_COMMANDS.try_send(Command::Disable).is_err() { ENABLE_USB.signal(false);
warn!("Failed to send disable command to USB channel");
};
} }
} }
@ -112,20 +100,35 @@ async fn main(_spawner: Spawner, p: Peripherals) {
// Build the builder. // Build the builder.
let mut usb = builder.build(); let mut usb = builder.build();
let remote_wakeup = Signal::new();
// Run the USB device. // Run the USB device.
let usb_fut = async { let usb_fut = async {
enable_command().await; enable_command().await;
loop { loop {
match select(usb.run(), USB_COMMANDS.recv()).await { match select(usb.run_until_suspend(), ENABLE_USB.wait()).await {
embassy::util::Either::First(_) => defmt::unreachable!(), Either::First(_) => {}
embassy::util::Either::Second(cmd) => match cmd { Either::Second(enable) => {
Command::Enable => warn!("Enable when already enabled!"), if enable {
Command::Disable => { warn!("Enable when already enabled!");
} else {
usb.disable().await; usb.disable().await;
enable_command().await; enable_command().await;
} }
Command::RemoteWakeup => unwrap!(usb.remote_wakeup().await), }
}, }
match select3(usb.wait_resume(), ENABLE_USB.wait(), remote_wakeup.wait()).await {
Either3::First(_) => (),
Either3::Second(enable) => {
if enable {
warn!("Enable when already enabled!");
} else {
usb.disable().await;
enable_command().await;
}
}
Either3::Third(_) => unwrap!(usb.remote_wakeup().await),
} }
} }
}; };
@ -142,7 +145,7 @@ async fn main(_spawner: Spawner, p: Peripherals) {
if SUSPENDED.load(Ordering::Acquire) { if SUSPENDED.load(Ordering::Acquire) {
info!("Triggering remote wakeup"); info!("Triggering remote wakeup");
USB_COMMANDS.send(Command::RemoteWakeup).await; remote_wakeup.signal(());
} else { } else {
let report = KeyboardReport { let report = KeyboardReport {
keycodes: [4, 0, 0, 0, 0, 0], keycodes: [4, 0, 0, 0, 0, 0],
@ -191,9 +194,10 @@ async fn main(_spawner: Spawner, p: Peripherals) {
async fn enable_command() { async fn enable_command() {
loop { loop {
match USB_COMMANDS.recv().await { if ENABLE_USB.wait().await {
Command::Enable => break, break;
cmd => warn!("Received command {:?} when disabled!", cmd), } else {
warn!("Received disable signal when already disabled!");
} }
} }
} }