Remote wakeup bug fixes

This commit is contained in:
alexmoon 2022-04-11 12:00:05 -04:00
parent 3a30b08936
commit 7fde3abd5d
2 changed files with 30 additions and 24 deletions

View File

@ -171,21 +171,21 @@ impl<'d, D: Driver<'d>, M: RawMutex> UsbDevice<'d, D, M> {
h.reset(); h.reset();
} }
if let Some(h) = &mut self.handler { if let Some(h) = &self.handler {
h.reset(); h.reset();
} }
} }
Event::Resume => { Event::Resume => {
trace!("usb: resume"); trace!("usb: resume");
self.suspended = false; self.suspended = false;
if let Some(h) = &mut self.handler { if let Some(h) = &self.handler {
h.suspended(false); h.suspended(false);
} }
} }
Event::Suspend => { Event::Suspend => {
trace!("usb: suspend"); trace!("usb: suspend");
self.suspended = true; self.suspended = true;
if let Some(h) = &mut self.handler { if let Some(h) = &self.handler {
h.suspended(true); h.suspended(true);
} }
} }
@ -200,19 +200,25 @@ impl<'d, D: Driver<'d>, M: RawMutex> UsbDevice<'d, D, M> {
trace!("usb: disable"); trace!("usb: disable");
self.bus.disable(); self.bus.disable();
self.device_state = UsbDeviceState::Disabled; self.device_state = UsbDeviceState::Disabled;
if let Some(h) = &mut self.handler { if let Some(h) = &self.handler {
h.disabled(); h.disabled();
} }
self.wait_for_enable().await; self.wait_for_enable().await;
} }
DeviceCommand::RemoteWakeup => { DeviceCommand::RemoteWakeup => {
if self.remote_wakeup_enabled { trace!("usb: remote wakeup");
if self.suspended && self.remote_wakeup_enabled {
match self.bus.remote_wakeup().await { match self.bus.remote_wakeup().await {
Ok(()) => (), Ok(()) => {
self.suspended = false;
if let Some(h) = &self.handler {
h.suspended(false);
}
}
Err(Unsupported) => warn!("Remote wakeup is unsupported!"), Err(Unsupported) => warn!("Remote wakeup is unsupported!"),
} }
} else { } else {
warn!("Remote wakeup not enabled."); warn!("Remote wakeup requested when not enabled or not suspended.");
} }
} }
}, },
@ -250,14 +256,14 @@ impl<'d, D: Driver<'d>, M: RawMutex> UsbDevice<'d, D, M> {
(RequestType::Standard, Recipient::Device) => match (req.request, req.value) { (RequestType::Standard, Recipient::Device) => match (req.request, req.value) {
(Request::CLEAR_FEATURE, Request::FEATURE_DEVICE_REMOTE_WAKEUP) => { (Request::CLEAR_FEATURE, Request::FEATURE_DEVICE_REMOTE_WAKEUP) => {
self.remote_wakeup_enabled = false; self.remote_wakeup_enabled = false;
if let Some(h) = &mut self.handler { if let Some(h) = &self.handler {
h.remote_wakeup_enabled(false); h.remote_wakeup_enabled(false);
} }
self.control.accept(stage) self.control.accept(stage)
} }
(Request::SET_FEATURE, Request::FEATURE_DEVICE_REMOTE_WAKEUP) => { (Request::SET_FEATURE, Request::FEATURE_DEVICE_REMOTE_WAKEUP) => {
self.remote_wakeup_enabled = true; self.remote_wakeup_enabled = true;
if let Some(h) = &mut self.handler { if let Some(h) = &self.handler {
h.remote_wakeup_enabled(true); h.remote_wakeup_enabled(true);
} }
self.control.accept(stage) self.control.accept(stage)
@ -266,7 +272,7 @@ impl<'d, D: Driver<'d>, M: RawMutex> UsbDevice<'d, D, M> {
self.pending_address = addr as u8; self.pending_address = addr as u8;
self.bus.set_device_address(self.pending_address); self.bus.set_device_address(self.pending_address);
self.device_state = UsbDeviceState::Addressed; self.device_state = UsbDeviceState::Addressed;
if let Some(h) = &mut self.handler { if let Some(h) = &self.handler {
h.addressed(self.pending_address); h.addressed(self.pending_address);
} }
self.control.accept(stage) self.control.accept(stage)
@ -274,7 +280,7 @@ impl<'d, D: Driver<'d>, M: RawMutex> UsbDevice<'d, D, M> {
(Request::SET_CONFIGURATION, CONFIGURATION_VALUE_U16) => { (Request::SET_CONFIGURATION, CONFIGURATION_VALUE_U16) => {
self.device_state = UsbDeviceState::Configured; self.device_state = UsbDeviceState::Configured;
self.bus.set_configured(true); self.bus.set_configured(true);
if let Some(h) = &mut self.handler { if let Some(h) = &self.handler {
h.configured(true); h.configured(true);
} }
self.control.accept(stage) self.control.accept(stage)
@ -284,7 +290,7 @@ impl<'d, D: Driver<'d>, M: RawMutex> UsbDevice<'d, D, M> {
_ => { _ => {
self.device_state = UsbDeviceState::Addressed; self.device_state = UsbDeviceState::Addressed;
self.bus.set_configured(false); self.bus.set_configured(false);
if let Some(h) = &mut self.handler { if let Some(h) = &self.handler {
h.configured(false); h.configured(false);
} }
self.control.accept(stage) self.control.accept(stage)

View File

@ -121,9 +121,8 @@ 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(DeviceCommand::RemoteWakeup); USB_COMMANDS.send(DeviceCommand::RemoteWakeup).await;
} } else {
let report = KeyboardReport { let report = KeyboardReport {
keycodes: [4, 0, 0, 0, 0, 0], keycodes: [4, 0, 0, 0, 0, 0],
leds: 0, leds: 0,
@ -134,6 +133,7 @@ async fn main(_spawner: Spawner, p: Peripherals) {
Ok(()) => {} Ok(()) => {}
Err(e) => warn!("Failed to send report: {:?}", e), Err(e) => warn!("Failed to send report: {:?}", e),
}; };
}
button.wait_for_high().await; button.wait_for_high().await;
info!("RELEASED"); info!("RELEASED");