2020-06-09 09:52:27 +00:00
|
|
|
#![no_main]
|
|
|
|
#![no_std]
|
|
|
|
|
2021-04-14 09:49:34 +00:00
|
|
|
// this imports `beginner/apps/lib.rs` to retrieve our global logger + panicking-behavior
|
|
|
|
use firmware as _;
|
2020-06-09 09:52:27 +00:00
|
|
|
|
2022-01-07 16:24:21 +00:00
|
|
|
#[rtic::app(device = dk, peripherals = false)]
|
|
|
|
mod app {
|
|
|
|
|
|
|
|
use core::num::NonZeroU8;
|
|
|
|
|
|
|
|
use dk::{
|
|
|
|
peripheral::USBD,
|
|
|
|
usbd::{self, Ep0In, Event},
|
|
|
|
};
|
|
|
|
use usb2::{GetDescriptor as Descriptor, StandardRequest as Request, State};
|
|
|
|
|
|
|
|
#[local]
|
|
|
|
struct MyLocalResources {
|
2020-10-18 17:50:36 +00:00
|
|
|
usbd: USBD,
|
2020-06-09 09:52:27 +00:00
|
|
|
ep0in: Ep0In,
|
|
|
|
state: State,
|
|
|
|
}
|
|
|
|
|
2022-01-07 16:24:21 +00:00
|
|
|
#[shared]
|
|
|
|
struct MySharedResources {
|
|
|
|
|
|
|
|
}
|
2020-06-09 09:52:27 +00:00
|
|
|
#[init]
|
2022-01-07 16:24:21 +00:00
|
|
|
fn init(_cx: init::Context) -> (MySharedResources, MyLocalResources, init::Monotonics) {
|
2020-06-09 09:52:27 +00:00
|
|
|
let board = dk::init().unwrap();
|
|
|
|
|
|
|
|
usbd::init(board.power, &board.usbd);
|
|
|
|
|
2022-01-07 16:24:21 +00:00
|
|
|
(MySharedResources {}, MyLocalResources { usbd: board.usbd, ep0in: board.ep0in, state: State::Default, }, init::Monotonics())
|
2020-06-09 09:52:27 +00:00
|
|
|
}
|
|
|
|
|
2022-01-07 16:24:21 +00:00
|
|
|
#[task(binds = USBD, local = [usbd, ep0in, state])]
|
2020-06-25 17:14:39 +00:00
|
|
|
fn main(cx: main::Context) {
|
2022-01-07 16:24:21 +00:00
|
|
|
let usbd = cx.local.usbd;
|
|
|
|
let ep0in = cx.local.ep0in;
|
|
|
|
let state = cx.local.state;
|
2020-06-09 09:52:27 +00:00
|
|
|
|
|
|
|
while let Some(event) = usbd::next_event(usbd) {
|
2020-10-18 17:50:36 +00:00
|
|
|
on_event(usbd, ep0in, state, event)
|
2020-06-09 09:52:27 +00:00
|
|
|
}
|
|
|
|
}
|
2022-01-07 16:24:21 +00:00
|
|
|
fn on_event(usbd: &USBD, ep0in: &mut Ep0In, state: &mut State, event: Event) {
|
2022-01-12 16:33:45 +00:00
|
|
|
defmt::println!("USB: {} @ {}", event, dk::uptime());
|
2022-01-07 16:24:21 +00:00
|
|
|
|
|
|
|
match event {
|
|
|
|
Event::UsbReset => {
|
|
|
|
defmt::println!("USB reset condition detected");
|
|
|
|
*state = State::Default;
|
|
|
|
}
|
|
|
|
|
|
|
|
Event::UsbEp0DataDone => {
|
|
|
|
defmt::println!("EP0IN: transfer complete");
|
|
|
|
ep0in.end(usbd);
|
|
|
|
}
|
|
|
|
|
|
|
|
Event::UsbEp0Setup => {
|
|
|
|
if ep0setup(usbd, ep0in, state).is_err() {
|
|
|
|
defmt::warn!("EP0IN: unexpected request; stalling the endpoint");
|
|
|
|
usbd::ep0stall(usbd);
|
|
|
|
}
|
2020-06-09 09:52:27 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2022-01-07 16:24:21 +00:00
|
|
|
|
|
|
|
/// The `bConfigurationValue` of the only supported configuration
|
|
|
|
const CONFIG_VAL: u8 = 42;
|
|
|
|
|
|
|
|
fn ep0setup(usbd: &USBD, ep0in: &mut Ep0In, state: &mut State) -> Result<(), ()> {
|
|
|
|
let bmrequesttype = usbd.bmrequesttype.read().bits() as u8;
|
|
|
|
let brequest = usbd.brequest.read().brequest().bits();
|
|
|
|
let wlength = usbd::wlength(usbd);
|
|
|
|
let windex = usbd::windex(usbd);
|
|
|
|
let wvalue = usbd::wvalue(usbd);
|
|
|
|
|
|
|
|
defmt::println!(
|
|
|
|
"bmrequesttype: {}, brequest: {}, wlength: {}, windex: {}, wvalue: {}",
|
|
|
|
bmrequesttype,
|
|
|
|
brequest,
|
|
|
|
wlength,
|
|
|
|
windex,
|
|
|
|
wvalue
|
|
|
|
);
|
|
|
|
|
|
|
|
let request = Request::parse(bmrequesttype, brequest, wvalue, windex, wlength)
|
|
|
|
.expect("Error parsing request");
|
2022-01-12 16:33:45 +00:00
|
|
|
defmt::println!("EP0: {}", defmt::Debug2Format(&request));
|
2022-01-07 16:24:21 +00:00
|
|
|
// ^^^^^^^^^^^^^^^^^^^ this adapter is currently needed to log
|
|
|
|
// `StandardRequest` with `defmt`
|
|
|
|
|
|
|
|
match request {
|
|
|
|
// section 9.4.3
|
|
|
|
// this request is valid in any state
|
|
|
|
Request::GetDescriptor { descriptor, length } => match descriptor {
|
|
|
|
Descriptor::Device => {
|
|
|
|
let desc = usb2::device::Descriptor {
|
|
|
|
bDeviceClass: 0,
|
|
|
|
bDeviceProtocol: 0,
|
|
|
|
bDeviceSubClass: 0,
|
|
|
|
bMaxPacketSize0: usb2::device::bMaxPacketSize0::B64,
|
|
|
|
bNumConfigurations: core::num::NonZeroU8::new(1).unwrap(),
|
|
|
|
bcdDevice: 0x01_00, // 1.00
|
|
|
|
iManufacturer: None,
|
|
|
|
iProduct: None,
|
|
|
|
iSerialNumber: None,
|
|
|
|
idProduct: consts::PID,
|
|
|
|
idVendor: consts::VID,
|
2020-06-09 09:52:27 +00:00
|
|
|
};
|
2022-01-07 16:24:21 +00:00
|
|
|
let bytes = desc.bytes();
|
|
|
|
let _ = ep0in.start(&bytes[..core::cmp::min(bytes.len(), length.into())], usbd);
|
2020-06-09 09:52:27 +00:00
|
|
|
}
|
2022-01-07 16:24:21 +00:00
|
|
|
|
|
|
|
Descriptor::Configuration { index } => {
|
|
|
|
if index == 0 {
|
|
|
|
let mut resp = heapless::Vec::<u8, 64>::new();
|
|
|
|
|
|
|
|
let conf_desc = usb2::configuration::Descriptor {
|
|
|
|
wTotalLength: (usb2::configuration::Descriptor::SIZE
|
|
|
|
+ usb2::interface::Descriptor::SIZE)
|
|
|
|
.into(),
|
|
|
|
bNumInterfaces: NonZeroU8::new(1).unwrap(),
|
|
|
|
bConfigurationValue: core::num::NonZeroU8::new(CONFIG_VAL).unwrap(),
|
|
|
|
iConfiguration: None,
|
|
|
|
bmAttributes: usb2::configuration::bmAttributes {
|
|
|
|
self_powered: true,
|
|
|
|
remote_wakeup: false,
|
|
|
|
},
|
|
|
|
bMaxPower: 250, // 500 mA
|
|
|
|
};
|
|
|
|
|
|
|
|
let iface_desc = usb2::interface::Descriptor {
|
|
|
|
bInterfaceNumber: 0,
|
|
|
|
bAlternativeSetting: 0,
|
|
|
|
bNumEndpoints: 0,
|
|
|
|
bInterfaceClass: 0,
|
|
|
|
bInterfaceSubClass: 0,
|
|
|
|
bInterfaceProtocol: 0,
|
|
|
|
iInterface: None,
|
|
|
|
};
|
|
|
|
|
|
|
|
resp.extend_from_slice(&conf_desc.bytes()).unwrap();
|
|
|
|
resp.extend_from_slice(&iface_desc.bytes()).unwrap();
|
|
|
|
ep0in.start(&resp[..core::cmp::min(resp.len(), length.into())], usbd);
|
2020-06-09 09:52:27 +00:00
|
|
|
} else {
|
2022-01-07 16:24:21 +00:00
|
|
|
// out of bounds access: stall the endpoint
|
|
|
|
return Err(());
|
2020-06-09 09:52:27 +00:00
|
|
|
}
|
|
|
|
}
|
2022-01-07 16:24:21 +00:00
|
|
|
|
|
|
|
_ => return Err(()),
|
|
|
|
},
|
|
|
|
|
|
|
|
Request::SetAddress { address } => {
|
|
|
|
match state {
|
|
|
|
State::Default => {
|
|
|
|
if let Some(address) = address {
|
|
|
|
*state = State::Address(address);
|
|
|
|
} else {
|
|
|
|
// stay in the default state
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
State::Address(..) => {
|
|
|
|
if let Some(address) = address {
|
|
|
|
// use the new address
|
|
|
|
*state = State::Address(address);
|
|
|
|
} else {
|
|
|
|
*state = State::Default;
|
|
|
|
}
|
2020-06-09 09:52:27 +00:00
|
|
|
}
|
2022-01-07 16:24:21 +00:00
|
|
|
|
|
|
|
// unspecified behavior
|
|
|
|
State::Configured { .. } => return Err(()),
|
2020-06-09 09:52:27 +00:00
|
|
|
}
|
2022-01-07 16:24:21 +00:00
|
|
|
|
|
|
|
// the response to this request is handled in hardware
|
2020-06-09 09:52:27 +00:00
|
|
|
}
|
2022-01-07 16:24:21 +00:00
|
|
|
|
|
|
|
Request::SetConfiguration { value } => {
|
|
|
|
match *state {
|
|
|
|
// unspecified behavior
|
|
|
|
State::Default => return Err(()),
|
|
|
|
|
|
|
|
State::Address(address) => {
|
|
|
|
if let Some(value) = value {
|
|
|
|
if value.get() == CONFIG_VAL {
|
|
|
|
defmt::println!("entering the configured state");
|
|
|
|
*state = State::Configured { address, value };
|
|
|
|
} else {
|
|
|
|
defmt::error!("unsupported configuration value");
|
|
|
|
return Err(());
|
|
|
|
}
|
2020-06-09 09:52:27 +00:00
|
|
|
} else {
|
2022-01-07 16:24:21 +00:00
|
|
|
// stay in the address mode
|
2020-06-09 09:52:27 +00:00
|
|
|
}
|
|
|
|
}
|
2022-01-07 16:24:21 +00:00
|
|
|
|
|
|
|
State::Configured {
|
|
|
|
address,
|
|
|
|
value: curr_value,
|
|
|
|
} => {
|
|
|
|
if let Some(new_value) = value {
|
|
|
|
if new_value.get() == CONFIG_VAL {
|
|
|
|
if new_value != curr_value {
|
|
|
|
defmt::println!("changing configuration");
|
|
|
|
*state = State::Configured {
|
|
|
|
address,
|
|
|
|
value: new_value,
|
|
|
|
};
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
defmt::error!("unsupported configuration value");
|
|
|
|
return Err(());
|
2020-06-09 09:52:27 +00:00
|
|
|
}
|
|
|
|
} else {
|
2022-01-07 16:24:21 +00:00
|
|
|
defmt::println!("returned to the address state");
|
|
|
|
*state = State::Address(address);
|
2020-06-09 09:52:27 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2022-01-07 16:24:21 +00:00
|
|
|
|
|
|
|
usbd.tasks_ep0status
|
|
|
|
.write(|w| w.tasks_ep0status().set_bit());
|
2020-06-09 09:52:27 +00:00
|
|
|
}
|
2022-01-07 16:24:21 +00:00
|
|
|
|
|
|
|
// stall any other request
|
|
|
|
_ => return Err(()),
|
2020-06-09 09:52:27 +00:00
|
|
|
}
|
2022-01-07 16:24:21 +00:00
|
|
|
|
|
|
|
Ok(())
|
2020-06-09 09:52:27 +00:00
|
|
|
}
|
2022-01-07 16:24:21 +00:00
|
|
|
|
2020-06-09 09:52:27 +00:00
|
|
|
}
|
2022-01-07 16:24:21 +00:00
|
|
|
|