2023-02-07 01:18:35 +01:00
|
|
|
#![no_std]
|
|
|
|
#![no_main]
|
|
|
|
#![feature(type_alias_impl_trait)]
|
|
|
|
#![feature(async_fn_in_trait)]
|
|
|
|
|
|
|
|
use defmt::*;
|
|
|
|
use embassy_executor::Spawner;
|
|
|
|
use embassy_stm32::time::mhz;
|
|
|
|
use embassy_stm32::usb_otg::Driver;
|
|
|
|
use embassy_stm32::{interrupt, Config};
|
|
|
|
use embassy_usb::class::msc::subclass::scsi::block_device::{BlockDevice, BlockDeviceError};
|
|
|
|
use embassy_usb::class::msc::subclass::scsi::Scsi;
|
|
|
|
use embassy_usb::class::msc::transport::bulk_only::BulkOnlyTransport;
|
|
|
|
use embassy_usb::Builder;
|
|
|
|
use futures::future::join;
|
|
|
|
use {defmt_rtt as _, panic_probe as _};
|
|
|
|
|
2023-02-17 00:30:45 +01:00
|
|
|
// 512 is a standard block size supported by most systems
|
|
|
|
const BLOCK_SIZE: usize = 512;
|
|
|
|
|
2023-02-07 01:18:35 +01:00
|
|
|
struct RamBlockDevice {
|
2023-02-17 00:30:45 +01:00
|
|
|
data: [u8; BLOCK_SIZE * 128],
|
2023-02-07 01:18:35 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
impl BlockDevice for RamBlockDevice {
|
|
|
|
fn status(&self) -> Result<(), BlockDeviceError> {
|
|
|
|
Ok(())
|
|
|
|
}
|
|
|
|
|
|
|
|
fn block_size(&self) -> Result<usize, BlockDeviceError> {
|
2023-02-17 00:30:45 +01:00
|
|
|
Ok(BLOCK_SIZE)
|
2023-02-07 01:18:35 +01:00
|
|
|
}
|
|
|
|
|
2023-02-17 00:30:45 +01:00
|
|
|
fn num_blocks(&self) -> Result<u32, BlockDeviceError> {
|
|
|
|
Ok((self.data.len() / self.block_size().unwrap()) as u32)
|
2023-02-07 01:18:35 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
async fn read_block(&self, lba: u32, block: &mut [u8]) -> Result<(), BlockDeviceError> {
|
2023-02-17 00:30:45 +01:00
|
|
|
block.copy_from_slice(&self.data[lba as usize * BLOCK_SIZE..(lba as usize + 1) * BLOCK_SIZE]);
|
2023-02-07 01:18:35 +01:00
|
|
|
Ok(())
|
|
|
|
}
|
|
|
|
|
|
|
|
async fn write_block(&mut self, lba: u32, block: &[u8]) -> Result<(), BlockDeviceError> {
|
2023-02-17 00:30:45 +01:00
|
|
|
self.data[lba as usize * BLOCK_SIZE..(lba as usize + 1) * BLOCK_SIZE].copy_from_slice(block);
|
2023-02-07 01:18:35 +01:00
|
|
|
Ok(())
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
#[embassy_executor::main]
|
|
|
|
async fn main(_spawner: Spawner) {
|
|
|
|
info!("Hello World!");
|
|
|
|
|
|
|
|
let mut config = Config::default();
|
|
|
|
config.rcc.pll48 = true;
|
|
|
|
config.rcc.sys_ck = Some(mhz(48));
|
|
|
|
|
|
|
|
let p = embassy_stm32::init(config);
|
|
|
|
|
|
|
|
// Create the driver, from the HAL.
|
|
|
|
let irq = interrupt::take!(OTG_FS);
|
|
|
|
let mut ep_out_buffer = [0u8; 256];
|
|
|
|
let driver = Driver::new_fs(p.USB_OTG_FS, irq, p.PA12, p.PA11, &mut ep_out_buffer);
|
|
|
|
|
|
|
|
// Create embassy-usb Config
|
|
|
|
let mut config = embassy_usb::Config::new(0xc0de, 0xcafe);
|
|
|
|
config.manufacturer = Some("Embassy");
|
|
|
|
config.product = Some("MSC example");
|
|
|
|
config.serial_number = Some("12345678");
|
|
|
|
|
|
|
|
// Required for windows compatiblity.
|
|
|
|
// https://developer.nordicsemi.com/nRF_Connect_SDK/doc/1.9.1/kconfig/CONFIG_CDC_ACM_IAD.html#help
|
|
|
|
config.device_class = 0xEF;
|
|
|
|
config.device_sub_class = 0x02;
|
|
|
|
config.device_protocol = 0x01;
|
|
|
|
config.composite_with_iads = true;
|
|
|
|
|
|
|
|
// Create embassy-usb DeviceBuilder using the driver and config.
|
|
|
|
// It needs some buffers for building the descriptors.
|
|
|
|
let mut device_descriptor = [0; 256];
|
|
|
|
let mut config_descriptor = [0; 256];
|
|
|
|
let mut bos_descriptor = [0; 256];
|
|
|
|
let mut control_buf = [0; 64];
|
|
|
|
|
|
|
|
let mut state = Default::default();
|
|
|
|
|
|
|
|
let mut builder = Builder::new(
|
|
|
|
driver,
|
|
|
|
config,
|
|
|
|
&mut device_descriptor,
|
|
|
|
&mut config_descriptor,
|
|
|
|
&mut bos_descriptor,
|
|
|
|
&mut control_buf,
|
|
|
|
None,
|
|
|
|
);
|
|
|
|
|
|
|
|
// Create SCSI target for our block device
|
2023-02-17 00:30:45 +01:00
|
|
|
let mut scsi_buffer = [0u8; BLOCK_SIZE];
|
|
|
|
let scsi = Scsi::new(
|
|
|
|
RamBlockDevice {
|
|
|
|
data: [0u8; BLOCK_SIZE * 128],
|
|
|
|
},
|
|
|
|
&mut scsi_buffer,
|
|
|
|
"Embassy",
|
|
|
|
"MSC",
|
|
|
|
);
|
2023-02-07 01:18:35 +01:00
|
|
|
|
|
|
|
// Use bulk-only transport for our SCSI target
|
|
|
|
let mut msc_transport = BulkOnlyTransport::new(&mut builder, &mut state, 64, scsi);
|
|
|
|
|
|
|
|
// Build the builder.
|
|
|
|
let mut usb = builder.build();
|
|
|
|
|
|
|
|
// Run the USB device.
|
|
|
|
let usb_fut = usb.run();
|
|
|
|
|
|
|
|
// Run mass storage transport
|
|
|
|
let msc_fut = msc_transport.run();
|
|
|
|
|
|
|
|
// Run everything concurrently.
|
|
|
|
// If we had made everything `'static` above instead, we could do this using separate tasks instead.
|
|
|
|
join(usb_fut, msc_fut).await;
|
|
|
|
}
|