diff options
| author | Dario Nieuwenhuis <[email protected]> | 2022-12-07 16:03:03 +0100 |
|---|---|---|
| committer | Dario Nieuwenhuis <[email protected]> | 2022-12-13 16:43:25 +0100 |
| commit | e9219405ca04e23b6543fb841fd97df54cf72f94 (patch) | |
| tree | 32d9129286949fdb887898adad1076ab352e95e9 /examples/stm32l5/src/bin/usb_ethernet.rs | |
| parent | aaaf5f23a8a3a0df1ad2186802e2afc061a74b72 (diff) | |
usb/cdc-ncm: add embassy-net Device implementation.
Diffstat (limited to 'examples/stm32l5/src/bin/usb_ethernet.rs')
| -rw-r--r-- | examples/stm32l5/src/bin/usb_ethernet.rs | 140 |
1 files changed, 17 insertions, 123 deletions
diff --git a/examples/stm32l5/src/bin/usb_ethernet.rs b/examples/stm32l5/src/bin/usb_ethernet.rs index 4f36d3f5a..b49329ea4 100644 --- a/examples/stm32l5/src/bin/usb_ethernet.rs +++ b/examples/stm32l5/src/bin/usb_ethernet.rs | |||
| @@ -2,20 +2,16 @@ | |||
| 2 | #![no_main] | 2 | #![no_main] |
| 3 | #![feature(type_alias_impl_trait)] | 3 | #![feature(type_alias_impl_trait)] |
| 4 | 4 | ||
| 5 | use core::sync::atomic::{AtomicBool, Ordering}; | ||
| 6 | use core::task::Waker; | ||
| 7 | |||
| 8 | use defmt::*; | 5 | use defmt::*; |
| 9 | use embassy_executor::Spawner; | 6 | use embassy_executor::Spawner; |
| 10 | use embassy_net::tcp::TcpSocket; | 7 | use embassy_net::tcp::TcpSocket; |
| 11 | use embassy_net::{PacketBox, PacketBoxExt, PacketBuf, Stack, StackResources}; | 8 | use embassy_net::{Stack, StackResources}; |
| 12 | use embassy_stm32::rcc::*; | 9 | use embassy_stm32::rcc::*; |
| 13 | use embassy_stm32::rng::Rng; | 10 | use embassy_stm32::rng::Rng; |
| 14 | use embassy_stm32::usb::Driver; | 11 | use embassy_stm32::usb::Driver; |
| 15 | use embassy_stm32::{interrupt, Config}; | 12 | use embassy_stm32::{interrupt, Config}; |
| 16 | use embassy_sync::blocking_mutex::raw::ThreadModeRawMutex; | 13 | use embassy_usb::class::cdc_ncm::embassy_net::{Device, Runner, State as NetState}; |
| 17 | use embassy_sync::channel::Channel; | 14 | use embassy_usb::class::cdc_ncm::{CdcNcmClass, State}; |
| 18 | use embassy_usb::class::cdc_ncm::{CdcNcmClass, Receiver, Sender, State}; | ||
| 19 | use embassy_usb::{Builder, UsbDevice}; | 15 | use embassy_usb::{Builder, UsbDevice}; |
| 20 | use embedded_io::asynch::Write; | 16 | use embedded_io::asynch::Write; |
| 21 | use rand_core::RngCore; | 17 | use rand_core::RngCore; |
| @@ -28,56 +24,25 @@ macro_rules! singleton { | |||
| 28 | ($val:expr) => {{ | 24 | ($val:expr) => {{ |
| 29 | type T = impl Sized; | 25 | type T = impl Sized; |
| 30 | static STATIC_CELL: StaticCell<T> = StaticCell::new(); | 26 | static STATIC_CELL: StaticCell<T> = StaticCell::new(); |
| 31 | STATIC_CELL.init_with(move || $val) | 27 | let (x,) = STATIC_CELL.init(($val,)); |
| 28 | x | ||
| 32 | }}; | 29 | }}; |
| 33 | } | 30 | } |
| 34 | 31 | ||
| 32 | const MTU: usize = 1514; | ||
| 33 | |||
| 35 | #[embassy_executor::task] | 34 | #[embassy_executor::task] |
| 36 | async fn usb_task(mut device: UsbDevice<'static, MyDriver>) -> ! { | 35 | async fn usb_task(mut device: UsbDevice<'static, MyDriver>) -> ! { |
| 37 | device.run().await | 36 | device.run().await |
| 38 | } | 37 | } |
| 39 | 38 | ||
| 40 | #[embassy_executor::task] | 39 | #[embassy_executor::task] |
| 41 | async fn usb_ncm_rx_task(mut class: Receiver<'static, MyDriver>) { | 40 | async fn usb_ncm_task(class: Runner<'static, MyDriver, MTU>) -> ! { |
| 42 | loop { | 41 | class.run().await |
| 43 | warn!("WAITING for connection"); | ||
| 44 | LINK_UP.store(false, Ordering::Relaxed); | ||
| 45 | |||
| 46 | class.wait_connection().await.unwrap(); | ||
| 47 | |||
| 48 | warn!("Connected"); | ||
| 49 | LINK_UP.store(true, Ordering::Relaxed); | ||
| 50 | |||
| 51 | loop { | ||
| 52 | let mut p = unwrap!(PacketBox::new(embassy_net::Packet::new())); | ||
| 53 | let n = match class.read_packet(&mut p[..]).await { | ||
| 54 | Ok(n) => n, | ||
| 55 | Err(e) => { | ||
| 56 | warn!("error reading packet: {:?}", e); | ||
| 57 | break; | ||
| 58 | } | ||
| 59 | }; | ||
| 60 | |||
| 61 | let buf = p.slice(0..n); | ||
| 62 | if RX_CHANNEL.try_send(buf).is_err() { | ||
| 63 | warn!("Failed pushing rx'd packet to channel."); | ||
| 64 | } | ||
| 65 | } | ||
| 66 | } | ||
| 67 | } | ||
| 68 | |||
| 69 | #[embassy_executor::task] | ||
| 70 | async fn usb_ncm_tx_task(mut class: Sender<'static, MyDriver>) { | ||
| 71 | loop { | ||
| 72 | let pkt = TX_CHANNEL.recv().await; | ||
| 73 | if let Err(e) = class.write_packet(&pkt[..]).await { | ||
| 74 | warn!("Failed to TX packet: {:?}", e); | ||
| 75 | } | ||
| 76 | } | ||
| 77 | } | 42 | } |
| 78 | 43 | ||
| 79 | #[embassy_executor::task] | 44 | #[embassy_executor::task] |
| 80 | async fn net_task(stack: &'static Stack<Device>) -> ! { | 45 | async fn net_task(stack: &'static Stack<Device<'static, MTU>>) -> ! { |
| 81 | stack.run().await | 46 | stack.run().await |
| 82 | } | 47 | } |
| 83 | 48 | ||
| @@ -106,55 +71,32 @@ async fn main(spawner: Spawner) { | |||
| 106 | config.device_sub_class = 0x02; | 71 | config.device_sub_class = 0x02; |
| 107 | config.device_protocol = 0x01; | 72 | config.device_protocol = 0x01; |
| 108 | 73 | ||
| 109 | struct Resources { | ||
| 110 | device_descriptor: [u8; 256], | ||
| 111 | config_descriptor: [u8; 256], | ||
| 112 | bos_descriptor: [u8; 256], | ||
| 113 | control_buf: [u8; 128], | ||
| 114 | serial_state: State<'static>, | ||
| 115 | } | ||
| 116 | let res: &mut Resources = singleton!(Resources { | ||
| 117 | device_descriptor: [0; 256], | ||
| 118 | config_descriptor: [0; 256], | ||
| 119 | bos_descriptor: [0; 256], | ||
| 120 | control_buf: [0; 128], | ||
| 121 | serial_state: State::new(), | ||
| 122 | }); | ||
| 123 | |||
| 124 | // Create embassy-usb DeviceBuilder using the driver and config. | 74 | // Create embassy-usb DeviceBuilder using the driver and config. |
| 125 | let mut builder = Builder::new( | 75 | let mut builder = Builder::new( |
| 126 | driver, | 76 | driver, |
| 127 | config, | 77 | config, |
| 128 | &mut res.device_descriptor, | 78 | &mut singleton!([0; 256])[..], |
| 129 | &mut res.config_descriptor, | 79 | &mut singleton!([0; 256])[..], |
| 130 | &mut res.bos_descriptor, | 80 | &mut singleton!([0; 256])[..], |
| 131 | &mut res.control_buf, | 81 | &mut singleton!([0; 128])[..], |
| 132 | None, | 82 | None, |
| 133 | ); | 83 | ); |
| 134 | 84 | ||
| 135 | // WARNINGS for Android ethernet tethering: | ||
| 136 | // - On Pixel 4a, it refused to work on Android 11, worked on Android 12. | ||
| 137 | // - if the host's MAC address has the "locally-administered" bit set (bit 1 of first byte), | ||
| 138 | // it doesn't work! The "Ethernet tethering" option in settings doesn't get enabled. | ||
| 139 | // This is due to regex spaghetti: https://android.googlesource.com/platform/frameworks/base/+/refs/tags/android-mainline-12.0.0_r84/core/res/res/values/config.xml#417 | ||
| 140 | // and this nonsense in the linux kernel: https://github.com/torvalds/linux/blob/c00c5e1d157bec0ef0b0b59aa5482eb8dc7e8e49/drivers/net/usb/usbnet.c#L1751-L1757 | ||
| 141 | |||
| 142 | // Our MAC addr. | 85 | // Our MAC addr. |
| 143 | let our_mac_addr = [0xCC, 0xCC, 0xCC, 0xCC, 0xCC, 0xCC]; | 86 | let our_mac_addr = [0xCC, 0xCC, 0xCC, 0xCC, 0xCC, 0xCC]; |
| 144 | // Host's MAC addr. This is the MAC the host "thinks" its USB-to-ethernet adapter has. | 87 | // Host's MAC addr. This is the MAC the host "thinks" its USB-to-ethernet adapter has. |
| 145 | let host_mac_addr = [0x88, 0x88, 0x88, 0x88, 0x88, 0x88]; | 88 | let host_mac_addr = [0x88, 0x88, 0x88, 0x88, 0x88, 0x88]; |
| 146 | 89 | ||
| 147 | // Create classes on the builder. | 90 | // Create classes on the builder. |
| 148 | let class = CdcNcmClass::new(&mut builder, &mut res.serial_state, host_mac_addr, 64); | 91 | let class = CdcNcmClass::new(&mut builder, singleton!(State::new()), host_mac_addr, 64); |
| 149 | 92 | ||
| 150 | // Build the builder. | 93 | // Build the builder. |
| 151 | let usb = builder.build(); | 94 | let usb = builder.build(); |
| 152 | 95 | ||
| 153 | unwrap!(spawner.spawn(usb_task(usb))); | 96 | unwrap!(spawner.spawn(usb_task(usb))); |
| 154 | 97 | ||
| 155 | let (tx, rx) = class.split(); | 98 | let (runner, device) = class.into_embassy_net_device::<MTU, 4, 4>(singleton!(NetState::new()), our_mac_addr); |
| 156 | unwrap!(spawner.spawn(usb_ncm_rx_task(rx))); | 99 | unwrap!(spawner.spawn(usb_ncm_task(runner))); |
| 157 | unwrap!(spawner.spawn(usb_ncm_tx_task(tx))); | ||
| 158 | 100 | ||
| 159 | let config = embassy_net::ConfigStrategy::Dhcp; | 101 | let config = embassy_net::ConfigStrategy::Dhcp; |
| 160 | //let config = embassy_net::ConfigStrategy::Static(embassy_net::Config { | 102 | //let config = embassy_net::ConfigStrategy::Static(embassy_net::Config { |
| @@ -168,7 +110,6 @@ async fn main(spawner: Spawner) { | |||
| 168 | let seed = rng.next_u64(); | 110 | let seed = rng.next_u64(); |
| 169 | 111 | ||
| 170 | // Init network stack | 112 | // Init network stack |
| 171 | let device = Device { mac_addr: our_mac_addr }; | ||
| 172 | let stack = &*singleton!(Stack::new( | 113 | let stack = &*singleton!(Stack::new( |
| 173 | device, | 114 | device, |
| 174 | config, | 115 | config, |
| @@ -221,50 +162,3 @@ async fn main(spawner: Spawner) { | |||
| 221 | } | 162 | } |
| 222 | } | 163 | } |
| 223 | } | 164 | } |
| 224 | |||
| 225 | static TX_CHANNEL: Channel<ThreadModeRawMutex, PacketBuf, 8> = Channel::new(); | ||
| 226 | static RX_CHANNEL: Channel<ThreadModeRawMutex, PacketBuf, 8> = Channel::new(); | ||
| 227 | static LINK_UP: AtomicBool = AtomicBool::new(false); | ||
| 228 | |||
| 229 | struct Device { | ||
| 230 | mac_addr: [u8; 6], | ||
| 231 | } | ||
| 232 | |||
| 233 | impl embassy_net::Device for Device { | ||
| 234 | fn register_waker(&mut self, waker: &Waker) { | ||
| 235 | // loopy loopy wakey wakey | ||
| 236 | waker.wake_by_ref() | ||
| 237 | } | ||
| 238 | |||
| 239 | fn link_state(&mut self) -> embassy_net::LinkState { | ||
| 240 | match LINK_UP.load(Ordering::Relaxed) { | ||
| 241 | true => embassy_net::LinkState::Up, | ||
| 242 | false => embassy_net::LinkState::Down, | ||
| 243 | } | ||
| 244 | } | ||
| 245 | |||
| 246 | fn capabilities(&self) -> embassy_net::DeviceCapabilities { | ||
| 247 | let mut caps = embassy_net::DeviceCapabilities::default(); | ||
| 248 | caps.max_transmission_unit = 1514; // 1500 IP + 14 ethernet header | ||
| 249 | caps.medium = embassy_net::Medium::Ethernet; | ||
| 250 | caps | ||
| 251 | } | ||
| 252 | |||
| 253 | fn is_transmit_ready(&mut self) -> bool { | ||
| 254 | true | ||
| 255 | } | ||
| 256 | |||
| 257 | fn transmit(&mut self, pkt: PacketBuf) { | ||
| 258 | if TX_CHANNEL.try_send(pkt).is_err() { | ||
| 259 | warn!("TX failed") | ||
| 260 | } | ||
| 261 | } | ||
| 262 | |||
| 263 | fn receive<'a>(&mut self) -> Option<PacketBuf> { | ||
| 264 | RX_CHANNEL.try_recv().ok() | ||
| 265 | } | ||
| 266 | |||
| 267 | fn ethernet_address(&self) -> [u8; 6] { | ||
| 268 | self.mac_addr | ||
| 269 | } | ||
| 270 | } | ||
