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