#![no_std]
#![no_main]
use panic_itm as _;
use cortex_m_rt::entry;
use stm32h7xx_hal::rcc::rec::UsbClkSel;
use stm32h7xx_hal::usb_hs::{UsbBus, USB1, USB2};
use stm32h7xx_hal::{prelude::*, stm32};
use usb_device::prelude::*;
static mut EP_MEMORY_1: [u32; 1024] = [0; 1024];
static mut EP_MEMORY_2: [u32; 1024] = [0; 1024];
#[entry]
fn main() -> ! {
let dp = stm32::Peripherals::take().unwrap();
let pwr = dp.PWR.constrain();
let vos = pwr.freeze();
let rcc = dp.RCC.constrain();
let mut ccdr = rcc.sys_ck(120.MHz()).freeze(vos, &dp.SYSCFG);
let _ = ccdr.clocks.hsi48_ck().expect("HSI48 must run");
ccdr.peripheral.kernel_usb_clk_mux(UsbClkSel::Hsi48);
let gpioa = dp.GPIOA.split(ccdr.peripheral.GPIOA);
let gpiob = dp.GPIOB.split(ccdr.peripheral.GPIOB);
let usb1 = USB1::new(
dp.OTG1_HS_GLOBAL,
dp.OTG1_HS_DEVICE,
dp.OTG1_HS_PWRCLK,
gpiob.pb14.into_alternate(),
gpiob.pb15.into_alternate(),
ccdr.peripheral.USB1OTG,
&ccdr.clocks,
);
let usb2 = USB2::new(
dp.OTG2_HS_GLOBAL,
dp.OTG2_HS_DEVICE,
dp.OTG2_HS_PWRCLK,
gpioa.pa11.into_alternate(),
gpioa.pa12.into_alternate(),
ccdr.peripheral.USB2OTG,
&ccdr.clocks,
);
let usb1_bus = UsbBus::new(usb1, unsafe { &mut EP_MEMORY_1 });
let mut serial1 = usbd_serial::SerialPort::new(&usb1_bus);
let mut usb1_dev =
UsbDeviceBuilder::new(&usb1_bus, UsbVidPid(0x16c0, 0x27dd))
.manufacturer("Fake company")
.product("Serial port")
.serial_number("TEST PORT 1")
.device_class(usbd_serial::USB_CLASS_CDC)
.build();
let usb2_bus = UsbBus::new(usb2, unsafe { &mut EP_MEMORY_2 });
let mut serial2 = usbd_serial::SerialPort::new(&usb2_bus);
let mut usb2_dev =
UsbDeviceBuilder::new(&usb2_bus, UsbVidPid(0x16c0, 0x27dd))
.manufacturer("Fake company")
.product("Serial port")
.serial_number("TEST PORT 2")
.device_class(usbd_serial::USB_CLASS_CDC)
.build();
loop {
let mut buf = [0u8; 64];
if usb1_dev.poll(&mut [&mut serial1]) {
match serial1.read(&mut buf) {
Ok(count) if count > 0 => {
write_serial(&mut serial1, &buf, count);
write_serial(&mut serial2, &buf, count);
}
_ => {}
}
}
if usb2_dev.poll(&mut [&mut serial2]) {
match serial2.read(&mut buf) {
Ok(count) if count > 0 => {
write_serial(&mut serial1, &buf, count);
write_serial(&mut serial2, &buf, count);
}
_ => {}
}
}
}
}
fn write_serial<P: usb_device::bus::UsbBus>(
serial: &mut usbd_serial::SerialPort<P>,
buf: &[u8],
count: usize,
) {
if serial.rts() {
let mut write_offset = 0;
while write_offset < count {
match serial.write(&buf[write_offset..count]) {
Ok(len) if len > 0 => {
write_offset += len;
}
_ => {}
}
}
}
}