Add DeviceStateHandler, DeviceCommand channel, and remote wakeup support

This commit is contained in:
alexmoon
2022-04-10 15:41:51 -04:00
parent 2217de24c0
commit f5656e3544
11 changed files with 472 additions and 110 deletions

View File

@ -4,8 +4,12 @@
#![feature(type_alias_impl_trait)]
use core::mem;
use core::sync::atomic::{AtomicBool, Ordering};
use defmt::*;
use embassy::blocking_mutex::raw::CriticalSectionRawMutex;
use embassy::channel::Channel;
use embassy::executor::Spawner;
use embassy::interrupt::InterruptExt;
use embassy::time::Duration;
use embassy_nrf::gpio::{Input, Pin, Pull};
use embassy_nrf::interrupt;
@ -13,7 +17,7 @@ use embassy_nrf::pac;
use embassy_nrf::usb::Driver;
use embassy_nrf::Peripherals;
use embassy_usb::control::OutResponse;
use embassy_usb::{Config, UsbDeviceBuilder};
use embassy_usb::{Config, DeviceCommand, DeviceStateHandler, UsbDeviceBuilder};
use embassy_usb_hid::{HidClass, ReportId, RequestHandler, State};
use futures::future::join;
use usbd_hid::descriptor::{KeyboardReport, SerializedDescriptor};
@ -21,6 +25,29 @@ use usbd_hid::descriptor::{KeyboardReport, SerializedDescriptor};
use defmt_rtt as _; // global logger
use panic_probe as _;
static USB_COMMANDS: Channel<CriticalSectionRawMutex, DeviceCommand, 1> = Channel::new();
static SUSPENDED: AtomicBool = AtomicBool::new(false);
fn on_power_interrupt(_: *mut ()) {
let regs = unsafe { &*pac::POWER::ptr() };
if regs.events_usbdetected.read().bits() != 0 {
regs.events_usbdetected.reset();
info!("Vbus detected, enabling USB...");
if USB_COMMANDS.try_send(DeviceCommand::Enable).is_err() {
warn!("Failed to send enable command to USB channel");
}
}
if regs.events_usbremoved.read().bits() != 0 {
regs.events_usbremoved.reset();
info!("Vbus removed, disabling USB...");
if USB_COMMANDS.try_send(DeviceCommand::Disable).is_err() {
warn!("Failed to send disable command to USB channel");
};
}
}
#[embassy::main]
async fn main(_spawner: Spawner, p: Peripherals) {
let clock: pac::CLOCK = unsafe { mem::transmute(()) };
@ -30,10 +57,6 @@ async fn main(_spawner: Spawner, p: Peripherals) {
clock.tasks_hfclkstart.write(|w| unsafe { w.bits(1) });
while clock.events_hfclkstarted.read().bits() != 1 {}
info!("Waiting for vbus...");
while !power.usbregstatus.read().vbusdetect().is_vbus_present() {}
info!("vbus OK");
// Create the driver, from the HAL.
let irq = interrupt::take!(USBD);
let driver = Driver::new(p.USBD, irq);
@ -45,6 +68,8 @@ async fn main(_spawner: Spawner, p: Peripherals) {
config.serial_number = Some("12345678");
config.max_power = 100;
config.max_packet_size_0 = 64;
config.supports_remote_wakeup = true;
config.start_enabled = false;
// Create embassy-usb DeviceBuilder using the driver and config.
// It needs some buffers for building the descriptors.
@ -53,16 +78,19 @@ async fn main(_spawner: Spawner, p: Peripherals) {
let mut bos_descriptor = [0; 256];
let mut control_buf = [0; 16];
let request_handler = MyRequestHandler {};
let device_state_handler = MyDeviceStateHandler::new();
let mut state = State::<8, 1>::new();
let mut builder = UsbDeviceBuilder::new(
let mut builder = UsbDeviceBuilder::new_with_channel(
driver,
config,
&mut device_descriptor,
&mut config_descriptor,
&mut bos_descriptor,
&mut control_buf,
Some(&device_state_handler),
&USB_COMMANDS,
);
// Create classes on the builder.
@ -76,7 +104,7 @@ async fn main(_spawner: Spawner, p: Peripherals) {
);
// Build the builder.
let mut usb = builder.build().await;
let mut usb = builder.build();
// Run the USB device.
let usb_fut = usb.run();
@ -90,6 +118,12 @@ async fn main(_spawner: Spawner, p: Peripherals) {
loop {
button.wait_for_low().await;
info!("PRESSED");
if SUSPENDED.load(Ordering::Acquire) {
info!("Triggering remote wakeup");
USB_COMMANDS.send(DeviceCommand::RemoteWakeup);
}
let report = KeyboardReport {
keycodes: [4, 0, 0, 0, 0, 0],
leds: 0,
@ -119,6 +153,16 @@ async fn main(_spawner: Spawner, p: Peripherals) {
let out_fut = async {
hid_out.run(false, &request_handler).await;
};
let power_irq = interrupt::take!(POWER_CLOCK);
power_irq.set_handler(on_power_interrupt);
power_irq.unpend();
power_irq.enable();
power
.intenset
.write(|w| w.usbdetected().set().usbremoved().set());
// Run everything concurrently.
// If we had made everything `'static` above instead, we could do this using separate tasks instead.
join(usb_fut, join(in_fut, out_fut)).await;
@ -146,3 +190,59 @@ impl RequestHandler for MyRequestHandler {
None
}
}
struct MyDeviceStateHandler {
configured: AtomicBool,
}
impl MyDeviceStateHandler {
fn new() -> Self {
MyDeviceStateHandler {
configured: AtomicBool::new(false),
}
}
}
impl DeviceStateHandler for MyDeviceStateHandler {
fn reset(&self) {
self.configured.store(false, Ordering::Relaxed);
info!("Bus reset, the Vbus current limit is 100mA");
}
fn addressed(&self, addr: u8) {
self.configured.store(false, Ordering::Relaxed);
info!("USB address set to: {}", addr);
}
fn configured(&self, configured: bool) {
self.configured.store(configured, Ordering::Relaxed);
if configured {
info!(
"Device configured, it may now draw up to the configured current limit from Vbus."
)
} else {
info!("Device is no longer configured, the Vbus current limit is 100mA.");
}
}
fn suspended(&self, suspended: bool) {
if suspended {
info!("Device suspended, the Vbus current limit is 500µA (or 2.5mA for high-power devices with remote wakeup enabled).");
SUSPENDED.store(true, Ordering::Release);
} else {
SUSPENDED.store(false, Ordering::Release);
if self.configured.load(Ordering::Relaxed) {
info!(
"Device resumed, it may now draw up to the configured current limit from Vbus"
);
} else {
info!("Device resumed, the Vbus current limit is 100mA");
}
}
}
fn disabled(&self) {
self.configured.store(false, Ordering::Relaxed);
info!("Device disabled");
}
}

View File

@ -61,6 +61,7 @@ async fn main(_spawner: Spawner, p: Peripherals) {
&mut config_descriptor,
&mut bos_descriptor,
&mut control_buf,
None,
);
// Create classes on the builder.
@ -74,7 +75,7 @@ async fn main(_spawner: Spawner, p: Peripherals) {
);
// Build the builder.
let mut usb = builder.build().await;
let mut usb = builder.build();
// Run the USB device.
let usb_fut = usb.run();

View File

@ -54,13 +54,14 @@ async fn main(_spawner: Spawner, p: Peripherals) {
&mut config_descriptor,
&mut bos_descriptor,
&mut control_buf,
None,
);
// Create classes on the builder.
let mut class = CdcAcmClass::new(&mut builder, &mut state, 64);
// Build the builder.
let mut usb = builder.build().await;
let mut usb = builder.build();
// Run the USB device.
let usb_fut = usb.run();

View File

@ -79,13 +79,14 @@ async fn main(spawner: Spawner, p: Peripherals) {
&mut res.config_descriptor,
&mut res.bos_descriptor,
&mut res.control_buf,
None,
);
// Create classes on the builder.
let class = CdcAcmClass::new(&mut builder, &mut res.serial_state, 64);
// Build the builder.
let usb = builder.build().await;
let usb = builder.build();
unwrap!(spawner.spawn(usb_task(usb)));
unwrap!(spawner.spawn(echo_task(class)));