-
Notifications
You must be signed in to change notification settings - Fork 61
/
Copy pathusb_serial.rs
64 lines (52 loc) · 1.77 KB
/
usb_serial.rs
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
//! CDC-ACM serial port example using polling in a busy loop.
#![no_std]
#![no_main]
extern crate panic_semihosting;
use cortex_m_rt::entry;
use stm32l0xx_hal::usb::{UsbBus, USB};
use stm32l0xx_hal::{pac, prelude::*, rcc, syscfg::SYSCFG};
use usb_device::prelude::*;
use usbd_serial::{SerialPort, USB_CLASS_CDC};
#[entry]
fn main() -> ! {
let dp = pac::Peripherals::take().unwrap();
let mut rcc = dp.RCC.freeze(rcc::Config::hsi16());
let mut syscfg = SYSCFG::new(dp.SYSCFG, &mut rcc);
let hsi48 = rcc.enable_hsi48(&mut syscfg, dp.CRS);
let gpioa = dp.GPIOA.split(&mut rcc);
let usb = USB::new(dp.USB, gpioa.pa11, gpioa.pa12, hsi48);
let usb_bus = UsbBus::new(usb);
let mut serial = SerialPort::new(&usb_bus);
let mut usb_dev = UsbDeviceBuilder::new(&usb_bus, UsbVidPid(0x16c0, 0x27dd))
.manufacturer("Fake company")
.product("Serial port")
.serial_number("TEST")
.device_class(USB_CLASS_CDC)
.build();
loop {
if !usb_dev.poll(&mut [&mut serial]) {
continue;
}
let mut buf = [0u8; 64];
match serial.read(&mut buf) {
Ok(count) if count > 0 => {
// Echo back in upper case
for c in buf[0..count].iter_mut() {
if 0x61 <= *c && *c <= 0x7a {
*c &= !0x20;
}
}
let mut write_offset = 0;
while write_offset < count {
match serial.write(&buf[write_offset..count]) {
Ok(len) if len > 0 => {
write_offset += len;
}
_ => {}
}
}
}
_ => {}
}
}
}