2022-03-09 01:34:35 +01:00
|
|
|
#![no_std]
|
|
|
|
#![no_main]
|
2022-03-25 21:46:14 +01:00
|
|
|
#![feature(generic_associated_types)]
|
2022-03-09 01:34:35 +01:00
|
|
|
#![feature(type_alias_impl_trait)]
|
|
|
|
|
|
|
|
use core::mem;
|
2022-04-02 22:35:03 +02:00
|
|
|
use defmt::{info, panic};
|
2022-03-09 01:34:35 +01:00
|
|
|
use embassy::executor::Spawner;
|
|
|
|
use embassy_nrf::interrupt;
|
|
|
|
use embassy_nrf::pac;
|
2022-04-02 22:35:03 +02:00
|
|
|
use embassy_nrf::usb::{Driver, Instance};
|
2022-03-09 01:34:35 +01:00
|
|
|
use embassy_nrf::Peripherals;
|
2022-04-02 22:35:03 +02:00
|
|
|
use embassy_usb::driver::{ReadError, WriteError};
|
2022-03-09 01:34:35 +01:00
|
|
|
use embassy_usb::{Config, UsbDeviceBuilder};
|
2022-03-30 01:18:37 +02:00
|
|
|
use embassy_usb_serial::{CdcAcmClass, State};
|
2022-03-30 02:16:34 +02:00
|
|
|
use futures::future::join;
|
2022-03-09 01:34:35 +01:00
|
|
|
|
2022-03-30 01:18:37 +02:00
|
|
|
use defmt_rtt as _; // global logger
|
|
|
|
use panic_probe as _;
|
2022-03-09 01:34:35 +01:00
|
|
|
|
|
|
|
#[embassy::main]
|
|
|
|
async fn main(_spawner: Spawner, p: Peripherals) {
|
|
|
|
let clock: pac::CLOCK = unsafe { mem::transmute(()) };
|
|
|
|
let power: pac::POWER = unsafe { mem::transmute(()) };
|
|
|
|
|
|
|
|
info!("Enabling ext hfosc...");
|
|
|
|
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");
|
|
|
|
|
2022-03-10 01:10:53 +01:00
|
|
|
// Create the driver, from the HAL.
|
2022-03-09 01:34:35 +01:00
|
|
|
let irq = interrupt::take!(USBD);
|
|
|
|
let driver = Driver::new(p.USBD, irq);
|
2022-03-10 01:10:53 +01:00
|
|
|
|
|
|
|
// Create embassy-usb Config
|
2022-03-09 01:34:35 +01:00
|
|
|
let config = Config::new(0xc0de, 0xcafe);
|
2022-03-10 01:10:53 +01:00
|
|
|
|
|
|
|
// Create embassy-usb DeviceBuilder using the driver and config.
|
|
|
|
// It needs some buffers for building the descriptors.
|
2022-03-09 01:34:35 +01:00
|
|
|
let mut device_descriptor = [0; 256];
|
|
|
|
let mut config_descriptor = [0; 256];
|
|
|
|
let mut bos_descriptor = [0; 256];
|
2022-03-29 21:09:24 +02:00
|
|
|
let mut control_buf = [0; 7];
|
2022-03-28 02:20:01 +02:00
|
|
|
|
|
|
|
let mut state = State::new();
|
|
|
|
|
2022-03-09 01:34:35 +01:00
|
|
|
let mut builder = UsbDeviceBuilder::new(
|
|
|
|
driver,
|
|
|
|
config,
|
|
|
|
&mut device_descriptor,
|
|
|
|
&mut config_descriptor,
|
|
|
|
&mut bos_descriptor,
|
2022-03-29 21:09:24 +02:00
|
|
|
&mut control_buf,
|
2022-03-09 01:34:35 +01:00
|
|
|
);
|
|
|
|
|
2022-03-10 01:10:53 +01:00
|
|
|
// Create classes on the builder.
|
2022-03-28 02:20:01 +02:00
|
|
|
let mut class = CdcAcmClass::new(&mut builder, &mut state, 64);
|
2022-03-09 01:34:35 +01:00
|
|
|
|
2022-03-10 01:10:53 +01:00
|
|
|
// Build the builder.
|
2022-04-07 04:10:18 +02:00
|
|
|
let mut usb = builder.build().await;
|
2022-03-09 23:06:27 +01:00
|
|
|
|
2022-03-10 01:10:53 +01:00
|
|
|
// Run the USB device.
|
2022-03-30 02:16:34 +02:00
|
|
|
let usb_fut = usb.run();
|
2022-03-10 01:10:53 +01:00
|
|
|
|
2022-03-30 02:16:34 +02:00
|
|
|
// Do stuff with the class!
|
|
|
|
let echo_fut = async {
|
2022-03-09 23:06:27 +01:00
|
|
|
loop {
|
2022-04-02 22:35:03 +02:00
|
|
|
class.wait_connection().await;
|
|
|
|
info!("Connected");
|
|
|
|
let _ = echo(&mut class).await;
|
|
|
|
info!("Disconnected");
|
2022-03-10 01:05:33 +01:00
|
|
|
}
|
|
|
|
};
|
2022-03-09 23:06:27 +01:00
|
|
|
|
2022-03-10 01:10:53 +01:00
|
|
|
// Run everything concurrently.
|
|
|
|
// If we had made everything `'static` above instead, we could do this using separate tasks instead.
|
2022-03-30 02:16:34 +02:00
|
|
|
join(usb_fut, echo_fut).await;
|
2022-03-09 01:34:35 +01:00
|
|
|
}
|
2022-04-02 22:35:03 +02:00
|
|
|
|
|
|
|
struct Disconnected {}
|
|
|
|
|
|
|
|
impl From<ReadError> for Disconnected {
|
|
|
|
fn from(val: ReadError) -> Self {
|
|
|
|
match val {
|
|
|
|
ReadError::BufferOverflow => panic!("Buffer overflow"),
|
|
|
|
ReadError::Disabled => Disconnected {},
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
impl From<WriteError> for Disconnected {
|
|
|
|
fn from(val: WriteError) -> Self {
|
|
|
|
match val {
|
|
|
|
WriteError::BufferOverflow => panic!("Buffer overflow"),
|
|
|
|
WriteError::Disabled => Disconnected {},
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
async fn echo<'d, T: Instance + 'd>(
|
|
|
|
class: &mut CdcAcmClass<'d, Driver<'d, T>>,
|
|
|
|
) -> Result<(), Disconnected> {
|
|
|
|
let mut buf = [0; 64];
|
|
|
|
loop {
|
|
|
|
let n = class.read_packet(&mut buf).await?;
|
|
|
|
let data = &buf[..n];
|
|
|
|
info!("data: {:x}", data);
|
|
|
|
class.write_packet(data).await?;
|
|
|
|
}
|
|
|
|
}
|