Split UsbDevice::run into run and run_until_suspend
This commit is contained in:
parent
ff7c6b350e
commit
b0725c14d3
@ -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;
|
||||||
|
@ -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!");
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
Loading…
x
Reference in New Issue
Block a user