diff options
| author | Tyler <[email protected]> | 2023-07-01 15:41:11 -0500 |
|---|---|---|
| committer | GitHub <[email protected]> | 2023-07-01 15:41:11 -0500 |
| commit | 3aedbce5c2775ff1ab10c3ca95ea1311043f4be4 (patch) | |
| tree | 3cbd9c15c68c7ee3859a17ec6d6fc7150e569686 /tests | |
| parent | 1f2be2dac5eeed739d2866b9b63ca06fdd84c276 (diff) | |
| parent | ba4344429264fa7beb99ab19c09059c2d531716d (diff) | |
Merge pull request #1 from embassy-rs/main
Pull changes from embassy main
Diffstat (limited to 'tests')
| -rw-r--r-- | tests/nrf/Cargo.toml | 4 | ||||
| -rw-r--r-- | tests/nrf/src/bin/wifi_esp_hosted_perf.rs | 270 | ||||
| -rw-r--r-- | tests/rp/src/bin/cyw43-perf.rs | 13 | ||||
| -rw-r--r-- | tests/stm32/Cargo.toml | 3 | ||||
| -rw-r--r-- | tests/stm32/src/bin/tl_mbox.rs | 220 |
5 files changed, 478 insertions, 32 deletions
diff --git a/tests/nrf/Cargo.toml b/tests/nrf/Cargo.toml index 9735c87d9..4f9ecc47a 100644 --- a/tests/nrf/Cargo.toml +++ b/tests/nrf/Cargo.toml | |||
| @@ -13,6 +13,10 @@ embassy-executor = { version = "0.2.0", path = "../../embassy-executor", feature | |||
| 13 | embassy-time = { version = "0.1.0", path = "../../embassy-time", features = ["defmt", "nightly", "defmt-timestamp-uptime"] } | 13 | embassy-time = { version = "0.1.0", path = "../../embassy-time", features = ["defmt", "nightly", "defmt-timestamp-uptime"] } |
| 14 | embassy-nrf = { version = "0.1.0", path = "../../embassy-nrf", features = ["defmt", "nightly", "unstable-traits", "nrf52840", "time-driver-rtc1", "gpiote", "unstable-pac"] } | 14 | embassy-nrf = { version = "0.1.0", path = "../../embassy-nrf", features = ["defmt", "nightly", "unstable-traits", "nrf52840", "time-driver-rtc1", "gpiote", "unstable-pac"] } |
| 15 | embedded-io = { version = "0.4.0", features = ["async"] } | 15 | embedded-io = { version = "0.4.0", features = ["async"] } |
| 16 | embassy-net = { version = "0.1.0", path = "../../embassy-net", features = ["defmt", "tcp", "dhcpv4", "medium-ethernet", "nightly"] } | ||
| 17 | embassy-net-esp-hosted = { version = "0.1.0", path = "../../embassy-net-esp-hosted", features = ["defmt"] } | ||
| 18 | embedded-hal-async = { version = "0.2.0-alpha.1" } | ||
| 19 | static_cell = { version = "1.1", features = [ "nightly" ] } | ||
| 16 | 20 | ||
| 17 | defmt = "0.3" | 21 | defmt = "0.3" |
| 18 | defmt-rtt = "0.4" | 22 | defmt-rtt = "0.4" |
diff --git a/tests/nrf/src/bin/wifi_esp_hosted_perf.rs b/tests/nrf/src/bin/wifi_esp_hosted_perf.rs new file mode 100644 index 000000000..277b985c5 --- /dev/null +++ b/tests/nrf/src/bin/wifi_esp_hosted_perf.rs | |||
| @@ -0,0 +1,270 @@ | |||
| 1 | #![no_std] | ||
| 2 | #![no_main] | ||
| 3 | #![feature(type_alias_impl_trait)] | ||
| 4 | |||
| 5 | #[path = "../common.rs"] | ||
| 6 | mod common; | ||
| 7 | |||
| 8 | use defmt::{error, info, unwrap}; | ||
| 9 | use embassy_executor::Spawner; | ||
| 10 | use embassy_futures::join::join; | ||
| 11 | use embassy_net::tcp::TcpSocket; | ||
| 12 | use embassy_net::{Config, Ipv4Address, Stack, StackResources}; | ||
| 13 | use embassy_nrf::gpio::{AnyPin, Input, Level, Output, OutputDrive, Pin, Pull}; | ||
| 14 | use embassy_nrf::rng::Rng; | ||
| 15 | use embassy_nrf::spim::{self, Spim}; | ||
| 16 | use embassy_nrf::{bind_interrupts, peripherals}; | ||
| 17 | use embassy_time::{with_timeout, Duration, Timer}; | ||
| 18 | use embedded_hal_async::spi::ExclusiveDevice; | ||
| 19 | use static_cell::make_static; | ||
| 20 | use {defmt_rtt as _, embassy_net_esp_hosted as hosted, panic_probe as _}; | ||
| 21 | |||
| 22 | teleprobe_meta::timeout!(120); | ||
| 23 | |||
| 24 | bind_interrupts!(struct Irqs { | ||
| 25 | SPIM3 => spim::InterruptHandler<peripherals::SPI3>; | ||
| 26 | RNG => embassy_nrf::rng::InterruptHandler<peripherals::RNG>; | ||
| 27 | }); | ||
| 28 | |||
| 29 | #[embassy_executor::task] | ||
| 30 | async fn wifi_task( | ||
| 31 | runner: hosted::Runner< | ||
| 32 | 'static, | ||
| 33 | ExclusiveDevice<Spim<'static, peripherals::SPI3>, Output<'static, peripherals::P0_31>>, | ||
| 34 | Input<'static, AnyPin>, | ||
| 35 | Output<'static, peripherals::P1_05>, | ||
| 36 | >, | ||
| 37 | ) -> ! { | ||
| 38 | runner.run().await | ||
| 39 | } | ||
| 40 | |||
| 41 | type MyDriver = hosted::NetDriver<'static>; | ||
| 42 | |||
| 43 | #[embassy_executor::task] | ||
| 44 | async fn net_task(stack: &'static Stack<MyDriver>) -> ! { | ||
| 45 | stack.run().await | ||
| 46 | } | ||
| 47 | |||
| 48 | #[embassy_executor::main] | ||
| 49 | async fn main(spawner: Spawner) { | ||
| 50 | info!("Hello World!"); | ||
| 51 | |||
| 52 | let p = embassy_nrf::init(Default::default()); | ||
| 53 | |||
| 54 | let miso = p.P0_28; | ||
| 55 | let sck = p.P0_29; | ||
| 56 | let mosi = p.P0_30; | ||
| 57 | let cs = Output::new(p.P0_31, Level::High, OutputDrive::HighDrive); | ||
| 58 | let handshake = Input::new(p.P1_01.degrade(), Pull::Up); | ||
| 59 | let ready = Input::new(p.P1_04.degrade(), Pull::None); | ||
| 60 | let reset = Output::new(p.P1_05, Level::Low, OutputDrive::Standard); | ||
| 61 | |||
| 62 | let mut config = spim::Config::default(); | ||
| 63 | config.frequency = spim::Frequency::M32; | ||
| 64 | config.mode = spim::MODE_2; // !!! | ||
| 65 | let spi = spim::Spim::new(p.SPI3, Irqs, sck, miso, mosi, config); | ||
| 66 | let spi = ExclusiveDevice::new(spi, cs); | ||
| 67 | |||
| 68 | let (device, mut control, runner) = embassy_net_esp_hosted::new( | ||
| 69 | make_static!(embassy_net_esp_hosted::State::new()), | ||
| 70 | spi, | ||
| 71 | handshake, | ||
| 72 | ready, | ||
| 73 | reset, | ||
| 74 | ) | ||
| 75 | .await; | ||
| 76 | |||
| 77 | unwrap!(spawner.spawn(wifi_task(runner))); | ||
| 78 | |||
| 79 | control.init().await; | ||
| 80 | control.join(WIFI_NETWORK, WIFI_PASSWORD).await; | ||
| 81 | |||
| 82 | // Generate random seed | ||
| 83 | let mut rng = Rng::new(p.RNG, Irqs); | ||
| 84 | let mut seed = [0; 8]; | ||
| 85 | rng.blocking_fill_bytes(&mut seed); | ||
| 86 | let seed = u64::from_le_bytes(seed); | ||
| 87 | |||
| 88 | // Init network stack | ||
| 89 | let stack = &*make_static!(Stack::new( | ||
| 90 | device, | ||
| 91 | Config::dhcpv4(Default::default()), | ||
| 92 | make_static!(StackResources::<2>::new()), | ||
| 93 | seed | ||
| 94 | )); | ||
| 95 | |||
| 96 | unwrap!(spawner.spawn(net_task(stack))); | ||
| 97 | |||
| 98 | info!("Waiting for DHCP up..."); | ||
| 99 | while stack.config_v4().is_none() { | ||
| 100 | Timer::after(Duration::from_millis(100)).await; | ||
| 101 | } | ||
| 102 | info!("IP addressing up!"); | ||
| 103 | |||
| 104 | let down = test_download(stack).await; | ||
| 105 | let up = test_upload(stack).await; | ||
| 106 | let updown = test_upload_download(stack).await; | ||
| 107 | |||
| 108 | assert!(down > TEST_EXPECTED_DOWNLOAD_KBPS); | ||
| 109 | assert!(up > TEST_EXPECTED_UPLOAD_KBPS); | ||
| 110 | assert!(updown > TEST_EXPECTED_UPLOAD_DOWNLOAD_KBPS); | ||
| 111 | |||
| 112 | info!("Test OK"); | ||
| 113 | cortex_m::asm::bkpt(); | ||
| 114 | } | ||
| 115 | |||
| 116 | // Test-only wifi network, no internet access! | ||
| 117 | const WIFI_NETWORK: &str = "EmbassyTest"; | ||
| 118 | const WIFI_PASSWORD: &str = "V8YxhKt5CdIAJFud"; | ||
| 119 | |||
| 120 | const TEST_DURATION: usize = 10; | ||
| 121 | const TEST_EXPECTED_DOWNLOAD_KBPS: usize = 150; | ||
| 122 | const TEST_EXPECTED_UPLOAD_KBPS: usize = 150; | ||
| 123 | const TEST_EXPECTED_UPLOAD_DOWNLOAD_KBPS: usize = 150; | ||
| 124 | const RX_BUFFER_SIZE: usize = 4096; | ||
| 125 | const TX_BUFFER_SIZE: usize = 4096; | ||
| 126 | const SERVER_ADDRESS: Ipv4Address = Ipv4Address::new(192, 168, 2, 2); | ||
| 127 | const DOWNLOAD_PORT: u16 = 4321; | ||
| 128 | const UPLOAD_PORT: u16 = 4322; | ||
| 129 | const UPLOAD_DOWNLOAD_PORT: u16 = 4323; | ||
| 130 | |||
| 131 | async fn test_download(stack: &'static Stack<MyDriver>) -> usize { | ||
| 132 | info!("Testing download..."); | ||
| 133 | |||
| 134 | let mut rx_buffer = [0; RX_BUFFER_SIZE]; | ||
| 135 | let mut tx_buffer = [0; TX_BUFFER_SIZE]; | ||
| 136 | let mut socket = TcpSocket::new(stack, &mut rx_buffer, &mut tx_buffer); | ||
| 137 | socket.set_timeout(Some(Duration::from_secs(10))); | ||
| 138 | |||
| 139 | info!("connecting to {:?}:{}...", SERVER_ADDRESS, DOWNLOAD_PORT); | ||
| 140 | if let Err(e) = socket.connect((SERVER_ADDRESS, DOWNLOAD_PORT)).await { | ||
| 141 | error!("connect error: {:?}", e); | ||
| 142 | return 0; | ||
| 143 | } | ||
| 144 | info!("connected, testing..."); | ||
| 145 | |||
| 146 | let mut rx_buf = [0; 4096]; | ||
| 147 | let mut total: usize = 0; | ||
| 148 | with_timeout(Duration::from_secs(TEST_DURATION as _), async { | ||
| 149 | loop { | ||
| 150 | match socket.read(&mut rx_buf).await { | ||
| 151 | Ok(0) => { | ||
| 152 | error!("read EOF"); | ||
| 153 | return 0; | ||
| 154 | } | ||
| 155 | Ok(n) => total += n, | ||
| 156 | Err(e) => { | ||
| 157 | error!("read error: {:?}", e); | ||
| 158 | return 0; | ||
| 159 | } | ||
| 160 | } | ||
| 161 | } | ||
| 162 | }) | ||
| 163 | .await | ||
| 164 | .ok(); | ||
| 165 | |||
| 166 | let kbps = (total + 512) / 1024 / TEST_DURATION; | ||
| 167 | info!("download: {} kB/s", kbps); | ||
| 168 | kbps | ||
| 169 | } | ||
| 170 | |||
| 171 | async fn test_upload(stack: &'static Stack<MyDriver>) -> usize { | ||
| 172 | info!("Testing upload..."); | ||
| 173 | |||
| 174 | let mut rx_buffer = [0; RX_BUFFER_SIZE]; | ||
| 175 | let mut tx_buffer = [0; TX_BUFFER_SIZE]; | ||
| 176 | let mut socket = TcpSocket::new(stack, &mut rx_buffer, &mut tx_buffer); | ||
| 177 | socket.set_timeout(Some(Duration::from_secs(10))); | ||
| 178 | |||
| 179 | info!("connecting to {:?}:{}...", SERVER_ADDRESS, UPLOAD_PORT); | ||
| 180 | if let Err(e) = socket.connect((SERVER_ADDRESS, UPLOAD_PORT)).await { | ||
| 181 | error!("connect error: {:?}", e); | ||
| 182 | return 0; | ||
| 183 | } | ||
| 184 | info!("connected, testing..."); | ||
| 185 | |||
| 186 | let buf = [0; 4096]; | ||
| 187 | let mut total: usize = 0; | ||
| 188 | with_timeout(Duration::from_secs(TEST_DURATION as _), async { | ||
| 189 | loop { | ||
| 190 | match socket.write(&buf).await { | ||
| 191 | Ok(0) => { | ||
| 192 | error!("write zero?!??!?!"); | ||
| 193 | return 0; | ||
| 194 | } | ||
| 195 | Ok(n) => total += n, | ||
| 196 | Err(e) => { | ||
| 197 | error!("write error: {:?}", e); | ||
| 198 | return 0; | ||
| 199 | } | ||
| 200 | } | ||
| 201 | } | ||
| 202 | }) | ||
| 203 | .await | ||
| 204 | .ok(); | ||
| 205 | |||
| 206 | let kbps = (total + 512) / 1024 / TEST_DURATION; | ||
| 207 | info!("upload: {} kB/s", kbps); | ||
| 208 | kbps | ||
| 209 | } | ||
| 210 | |||
| 211 | async fn test_upload_download(stack: &'static Stack<MyDriver>) -> usize { | ||
| 212 | info!("Testing upload+download..."); | ||
| 213 | |||
| 214 | let mut rx_buffer = [0; RX_BUFFER_SIZE]; | ||
| 215 | let mut tx_buffer = [0; TX_BUFFER_SIZE]; | ||
| 216 | let mut socket = TcpSocket::new(stack, &mut rx_buffer, &mut tx_buffer); | ||
| 217 | socket.set_timeout(Some(Duration::from_secs(10))); | ||
| 218 | |||
| 219 | info!("connecting to {:?}:{}...", SERVER_ADDRESS, UPLOAD_DOWNLOAD_PORT); | ||
| 220 | if let Err(e) = socket.connect((SERVER_ADDRESS, UPLOAD_DOWNLOAD_PORT)).await { | ||
| 221 | error!("connect error: {:?}", e); | ||
| 222 | return 0; | ||
| 223 | } | ||
| 224 | info!("connected, testing..."); | ||
| 225 | |||
| 226 | let (mut reader, mut writer) = socket.split(); | ||
| 227 | |||
| 228 | let tx_buf = [0; 4096]; | ||
| 229 | let mut rx_buf = [0; 4096]; | ||
| 230 | let mut total: usize = 0; | ||
| 231 | let tx_fut = async { | ||
| 232 | loop { | ||
| 233 | match writer.write(&tx_buf).await { | ||
| 234 | Ok(0) => { | ||
| 235 | error!("write zero?!??!?!"); | ||
| 236 | return 0; | ||
| 237 | } | ||
| 238 | Ok(_) => {} | ||
| 239 | Err(e) => { | ||
| 240 | error!("write error: {:?}", e); | ||
| 241 | return 0; | ||
| 242 | } | ||
| 243 | } | ||
| 244 | } | ||
| 245 | }; | ||
| 246 | |||
| 247 | let rx_fut = async { | ||
| 248 | loop { | ||
| 249 | match reader.read(&mut rx_buf).await { | ||
| 250 | Ok(0) => { | ||
| 251 | error!("read EOF"); | ||
| 252 | return 0; | ||
| 253 | } | ||
| 254 | Ok(n) => total += n, | ||
| 255 | Err(e) => { | ||
| 256 | error!("read error: {:?}", e); | ||
| 257 | return 0; | ||
| 258 | } | ||
| 259 | } | ||
| 260 | } | ||
| 261 | }; | ||
| 262 | |||
| 263 | with_timeout(Duration::from_secs(TEST_DURATION as _), join(tx_fut, rx_fut)) | ||
| 264 | .await | ||
| 265 | .ok(); | ||
| 266 | |||
| 267 | let kbps = (total + 512) / 1024 / TEST_DURATION; | ||
| 268 | info!("upload+download: {} kB/s", kbps); | ||
| 269 | kbps | ||
| 270 | } | ||
diff --git a/tests/rp/src/bin/cyw43-perf.rs b/tests/rp/src/bin/cyw43-perf.rs index 7a94ea191..1ecaab266 100644 --- a/tests/rp/src/bin/cyw43-perf.rs +++ b/tests/rp/src/bin/cyw43-perf.rs | |||
| @@ -44,8 +44,8 @@ async fn main(spawner: Spawner) { | |||
| 44 | } | 44 | } |
| 45 | 45 | ||
| 46 | // cyw43 firmware needs to be flashed manually: | 46 | // cyw43 firmware needs to be flashed manually: |
| 47 | // probe-rs-cli download 43439A0.bin --format bin --chip RP2040 --base-address 0x101c0000 | 47 | // probe-rs download 43439A0.bin --format bin --chip RP2040 --base-address 0x101c0000 |
| 48 | // probe-rs-cli download 43439A0_clm.bin --format bin --chip RP2040 --base-address 0x101f8000 | 48 | // probe-rs download 43439A0_clm.bin --format bin --chip RP2040 --base-address 0x101f8000 |
| 49 | let fw = unsafe { core::slice::from_raw_parts(0x101c0000 as *const u8, 224190) }; | 49 | let fw = unsafe { core::slice::from_raw_parts(0x101c0000 as *const u8, 224190) }; |
| 50 | let clm = unsafe { core::slice::from_raw_parts(0x101f8000 as *const u8, 4752) }; | 50 | let clm = unsafe { core::slice::from_raw_parts(0x101f8000 as *const u8, 4752) }; |
| 51 | 51 | ||
| @@ -63,20 +63,13 @@ async fn main(spawner: Spawner) { | |||
| 63 | .set_power_management(cyw43::PowerManagementMode::PowerSave) | 63 | .set_power_management(cyw43::PowerManagementMode::PowerSave) |
| 64 | .await; | 64 | .await; |
| 65 | 65 | ||
| 66 | let config = Config::dhcpv4(Default::default()); | ||
| 67 | //let config = embassy_net::Config::Static(embassy_net::Config { | ||
| 68 | // address: Ipv4Cidr::new(Ipv4Address::new(192, 168, 69, 2), 24), | ||
| 69 | // dns_servers: Vec::new(), | ||
| 70 | // gateway: Some(Ipv4Address::new(192, 168, 69, 1)), | ||
| 71 | //}); | ||
| 72 | |||
| 73 | // Generate random seed | 66 | // Generate random seed |
| 74 | let seed = 0x0123_4567_89ab_cdef; // chosen by fair dice roll. guarenteed to be random. | 67 | let seed = 0x0123_4567_89ab_cdef; // chosen by fair dice roll. guarenteed to be random. |
| 75 | 68 | ||
| 76 | // Init network stack | 69 | // Init network stack |
| 77 | let stack = &*make_static!(Stack::new( | 70 | let stack = &*make_static!(Stack::new( |
| 78 | net_device, | 71 | net_device, |
| 79 | config, | 72 | Config::dhcpv4(Default::default()), |
| 80 | make_static!(StackResources::<2>::new()), | 73 | make_static!(StackResources::<2>::new()), |
| 81 | seed | 74 | seed |
| 82 | )); | 75 | )); |
diff --git a/tests/stm32/Cargo.toml b/tests/stm32/Cargo.toml index fe646927a..c2422f7bc 100644 --- a/tests/stm32/Cargo.toml +++ b/tests/stm32/Cargo.toml | |||
| @@ -46,6 +46,9 @@ rand_chacha = { version = "0.3", default-features = false } | |||
| 46 | 46 | ||
| 47 | chrono = { version = "^0.4", default-features = false, optional = true} | 47 | chrono = { version = "^0.4", default-features = false, optional = true} |
| 48 | 48 | ||
| 49 | [patch.crates-io] | ||
| 50 | stm32wb-hci = { git = "https://github.com/OueslatiGhaith/stm32wb-hci", rev = "9f663be"} | ||
| 51 | |||
| 49 | # BEGIN TESTS | 52 | # BEGIN TESTS |
| 50 | # Generated by gen_test.py. DO NOT EDIT. | 53 | # Generated by gen_test.py. DO NOT EDIT. |
| 51 | [[bin]] | 54 | [[bin]] |
diff --git a/tests/stm32/src/bin/tl_mbox.rs b/tests/stm32/src/bin/tl_mbox.rs index f47a89b6f..af3832709 100644 --- a/tests/stm32/src/bin/tl_mbox.rs +++ b/tests/stm32/src/bin/tl_mbox.rs | |||
| @@ -6,21 +6,33 @@ | |||
| 6 | #[path = "../common.rs"] | 6 | #[path = "../common.rs"] |
| 7 | mod common; | 7 | mod common; |
| 8 | 8 | ||
| 9 | use core::mem; | 9 | use core::time::Duration; |
| 10 | 10 | ||
| 11 | use common::*; | 11 | use common::*; |
| 12 | use embassy_executor::Spawner; | 12 | use embassy_executor::Spawner; |
| 13 | use embassy_futures::poll_once; | ||
| 14 | use embassy_stm32::bind_interrupts; | 13 | use embassy_stm32::bind_interrupts; |
| 15 | use embassy_stm32::ipcc::{Config, ReceiveInterruptHandler, TransmitInterruptHandler}; | 14 | use embassy_stm32::ipcc::{Config, ReceiveInterruptHandler, TransmitInterruptHandler}; |
| 16 | use embassy_stm32_wpan::{mm, TlMbox}; | 15 | use embassy_stm32_wpan::hci::host::uart::UartHci; |
| 17 | use embassy_time::{Duration, Timer}; | 16 | use embassy_stm32_wpan::hci::host::{AdvertisingFilterPolicy, EncryptionKey, HostHci, OwnAddressType}; |
| 17 | use embassy_stm32_wpan::hci::types::AdvertisingType; | ||
| 18 | use embassy_stm32_wpan::hci::vendor::stm32wb::command::gap::{ | ||
| 19 | AdvertisingDataType, DiscoverableParameters, GapCommands, Role, | ||
| 20 | }; | ||
| 21 | use embassy_stm32_wpan::hci::vendor::stm32wb::command::gatt::GattCommands; | ||
| 22 | use embassy_stm32_wpan::hci::vendor::stm32wb::command::hal::{ConfigData, HalCommands, PowerLevel}; | ||
| 23 | use embassy_stm32_wpan::hci::BdAddr; | ||
| 24 | use embassy_stm32_wpan::lhci::LhciC1DeviceInformationCcrp; | ||
| 25 | use embassy_stm32_wpan::sub::mm; | ||
| 26 | use embassy_stm32_wpan::TlMbox; | ||
| 27 | use {defmt_rtt as _, panic_probe as _}; | ||
| 18 | 28 | ||
| 19 | bind_interrupts!(struct Irqs{ | 29 | bind_interrupts!(struct Irqs{ |
| 20 | IPCC_C1_RX => ReceiveInterruptHandler; | 30 | IPCC_C1_RX => ReceiveInterruptHandler; |
| 21 | IPCC_C1_TX => TransmitInterruptHandler; | 31 | IPCC_C1_TX => TransmitInterruptHandler; |
| 22 | }); | 32 | }); |
| 23 | 33 | ||
| 34 | const BLE_GAP_DEVICE_NAME_LENGTH: u8 = 7; | ||
| 35 | |||
| 24 | #[embassy_executor::task] | 36 | #[embassy_executor::task] |
| 25 | async fn run_mm_queue(memory_manager: mm::MemoryManager) { | 37 | async fn run_mm_queue(memory_manager: mm::MemoryManager) { |
| 26 | memory_manager.run_queue().await; | 38 | memory_manager.run_queue().await; |
| @@ -32,17 +44,12 @@ async fn main(spawner: Spawner) { | |||
| 32 | info!("Hello World!"); | 44 | info!("Hello World!"); |
| 33 | 45 | ||
| 34 | let config = Config::default(); | 46 | let config = Config::default(); |
| 35 | let mbox = TlMbox::init(p.IPCC, Irqs, config); | 47 | let mut mbox = TlMbox::init(p.IPCC, Irqs, config); |
| 36 | 48 | ||
| 37 | spawner.spawn(run_mm_queue(mbox.mm_subsystem)).unwrap(); | 49 | spawner.spawn(run_mm_queue(mbox.mm_subsystem)).unwrap(); |
| 38 | 50 | ||
| 39 | let ready_event = mbox.sys_subsystem.read().await; | 51 | let sys_event = mbox.sys_subsystem.read().await; |
| 40 | let _ = poll_once(mbox.sys_subsystem.read()); // clear rx not | 52 | info!("sys event: {}", sys_event.payload()); |
| 41 | |||
| 42 | info!("sys event {:x} : {:x}", ready_event.stub().kind, ready_event.payload()); | ||
| 43 | |||
| 44 | // test memory manager | ||
| 45 | mem::drop(ready_event); | ||
| 46 | 53 | ||
| 47 | let fw_info = mbox.sys_subsystem.wireless_fw_info().unwrap(); | 54 | let fw_info = mbox.sys_subsystem.wireless_fw_info().unwrap(); |
| 48 | let version_major = fw_info.version_major(); | 55 | let version_major = fw_info.version_major(); |
| @@ -57,19 +64,188 @@ async fn main(spawner: Spawner) { | |||
| 57 | version_major, version_minor, subversion, sram2a_size, sram2b_size | 64 | version_major, version_minor, subversion, sram2a_size, sram2b_size |
| 58 | ); | 65 | ); |
| 59 | 66 | ||
| 60 | Timer::after(Duration::from_millis(50)).await; | 67 | mbox.sys_subsystem.shci_c2_ble_init(Default::default()).await; |
| 68 | |||
| 69 | info!("resetting BLE..."); | ||
| 70 | mbox.ble_subsystem.reset().await; | ||
| 71 | let response = mbox.ble_subsystem.read().await.unwrap(); | ||
| 72 | info!("{}", response); | ||
| 73 | |||
| 74 | info!("config public address..."); | ||
| 75 | mbox.ble_subsystem | ||
| 76 | .write_config_data(&ConfigData::public_address(get_bd_addr()).build()) | ||
| 77 | .await; | ||
| 78 | let response = mbox.ble_subsystem.read().await.unwrap(); | ||
| 79 | info!("{}", response); | ||
| 80 | |||
| 81 | info!("config random address..."); | ||
| 82 | mbox.ble_subsystem | ||
| 83 | .write_config_data(&ConfigData::random_address(get_random_addr()).build()) | ||
| 84 | .await; | ||
| 85 | let response = mbox.ble_subsystem.read().await.unwrap(); | ||
| 86 | info!("{}", response); | ||
| 87 | |||
| 88 | info!("config identity root..."); | ||
| 89 | mbox.ble_subsystem | ||
| 90 | .write_config_data(&ConfigData::identity_root(&get_irk()).build()) | ||
| 91 | .await; | ||
| 92 | let response = mbox.ble_subsystem.read().await.unwrap(); | ||
| 93 | info!("{}", response); | ||
| 94 | |||
| 95 | info!("config encryption root..."); | ||
| 96 | mbox.ble_subsystem | ||
| 97 | .write_config_data(&ConfigData::encryption_root(&get_erk()).build()) | ||
| 98 | .await; | ||
| 99 | let response = mbox.ble_subsystem.read().await.unwrap(); | ||
| 100 | info!("{}", response); | ||
| 101 | |||
| 102 | info!("config tx power level..."); | ||
| 103 | mbox.ble_subsystem.set_tx_power_level(PowerLevel::ZerodBm).await; | ||
| 104 | let response = mbox.ble_subsystem.read().await.unwrap(); | ||
| 105 | info!("{}", response); | ||
| 106 | |||
| 107 | info!("GATT init..."); | ||
| 108 | mbox.ble_subsystem.init_gatt().await; | ||
| 109 | let response = mbox.ble_subsystem.read().await.unwrap(); | ||
| 110 | info!("{}", response); | ||
| 111 | |||
| 112 | info!("GAP init..."); | ||
| 113 | mbox.ble_subsystem | ||
| 114 | .init_gap(Role::PERIPHERAL, false, BLE_GAP_DEVICE_NAME_LENGTH) | ||
| 115 | .await; | ||
| 116 | let response = mbox.ble_subsystem.read().await.unwrap(); | ||
| 117 | info!("{}", response); | ||
| 118 | |||
| 119 | // info!("set scan response..."); | ||
| 120 | // mbox.ble_subsystem.le_set_scan_response_data(&[]).await.unwrap(); | ||
| 121 | // let response = mbox.ble_subsystem.read().await.unwrap(); | ||
| 122 | // info!("{}", response); | ||
| 123 | |||
| 124 | info!("set discoverable..."); | ||
| 125 | mbox.ble_subsystem | ||
| 126 | .set_discoverable(&DiscoverableParameters { | ||
| 127 | advertising_type: AdvertisingType::NonConnectableUndirected, | ||
| 128 | advertising_interval: Some((Duration::from_millis(250), Duration::from_millis(250))), | ||
| 129 | address_type: OwnAddressType::Public, | ||
| 130 | filter_policy: AdvertisingFilterPolicy::AllowConnectionAndScan, | ||
| 131 | local_name: None, | ||
| 132 | advertising_data: &[], | ||
| 133 | conn_interval: (None, None), | ||
| 134 | }) | ||
| 135 | .await | ||
| 136 | .unwrap(); | ||
| 137 | |||
| 138 | let response = mbox.ble_subsystem.read().await; | ||
| 139 | info!("{}", response); | ||
| 140 | |||
| 141 | // remove some advertisement to decrease the packet size | ||
| 142 | info!("delete tx power ad type..."); | ||
| 143 | mbox.ble_subsystem | ||
| 144 | .delete_ad_type(AdvertisingDataType::TxPowerLevel) | ||
| 145 | .await; | ||
| 146 | let response = mbox.ble_subsystem.read().await.unwrap(); | ||
| 147 | info!("{}", response); | ||
| 148 | |||
| 149 | info!("delete conn interval ad type..."); | ||
| 150 | mbox.ble_subsystem | ||
| 151 | .delete_ad_type(AdvertisingDataType::PeripheralConnectionInterval) | ||
| 152 | .await; | ||
| 153 | let response = mbox.ble_subsystem.read().await.unwrap(); | ||
| 154 | info!("{}", response); | ||
| 155 | |||
| 156 | info!("update advertising data..."); | ||
| 157 | mbox.ble_subsystem | ||
| 158 | .update_advertising_data(&eddystone_advertising_data()) | ||
| 159 | .await | ||
| 160 | .unwrap(); | ||
| 161 | let response = mbox.ble_subsystem.read().await.unwrap(); | ||
| 162 | info!("{}", response); | ||
| 163 | |||
| 164 | info!("update advertising data type..."); | ||
| 165 | mbox.ble_subsystem | ||
| 166 | .update_advertising_data(&[3, AdvertisingDataType::UuidCompleteList16 as u8, 0xaa, 0xfe]) | ||
| 167 | .await | ||
| 168 | .unwrap(); | ||
| 169 | let response = mbox.ble_subsystem.read().await.unwrap(); | ||
| 170 | info!("{}", response); | ||
| 171 | |||
| 172 | info!("update advertising data flags..."); | ||
| 173 | mbox.ble_subsystem | ||
| 174 | .update_advertising_data(&[ | ||
| 175 | 2, | ||
| 176 | AdvertisingDataType::Flags as u8, | ||
| 177 | (0x02 | 0x04) as u8, // BLE general discoverable, without BR/EDR support | ||
| 178 | ]) | ||
| 179 | .await | ||
| 180 | .unwrap(); | ||
| 181 | let response = mbox.ble_subsystem.read().await.unwrap(); | ||
| 182 | info!("{}", response); | ||
| 183 | |||
| 184 | info!("Test OK"); | ||
| 185 | cortex_m::asm::bkpt(); | ||
| 186 | } | ||
| 187 | |||
| 188 | fn get_bd_addr() -> BdAddr { | ||
| 189 | let mut bytes = [0u8; 6]; | ||
| 61 | 190 | ||
| 62 | let result = mbox.sys_subsystem.shci_c2_ble_init(Default::default()).await; | 191 | let lhci_info = LhciC1DeviceInformationCcrp::new(); |
| 63 | info!("subsystem initialization: {}", result); | 192 | bytes[0] = (lhci_info.uid64 & 0xff) as u8; |
| 193 | bytes[1] = ((lhci_info.uid64 >> 8) & 0xff) as u8; | ||
| 194 | bytes[2] = ((lhci_info.uid64 >> 16) & 0xff) as u8; | ||
| 195 | bytes[3] = lhci_info.device_type_id; | ||
| 196 | bytes[4] = (lhci_info.st_company_id & 0xff) as u8; | ||
| 197 | bytes[5] = (lhci_info.st_company_id >> 8 & 0xff) as u8; | ||
| 64 | 198 | ||
| 65 | info!("starting ble..."); | 199 | BdAddr(bytes) |
| 66 | mbox.ble_subsystem.write(0x0c, &[]).await; | 200 | } |
| 67 | 201 | ||
| 68 | info!("waiting for ble..."); | 202 | fn get_random_addr() -> BdAddr { |
| 69 | let ble_event = mbox.ble_subsystem.read().await; | 203 | let mut bytes = [0u8; 6]; |
| 70 | 204 | ||
| 71 | info!("ble event {:x} : {:x}", ble_event.stub().kind, ble_event.payload()); | 205 | let lhci_info = LhciC1DeviceInformationCcrp::new(); |
| 206 | bytes[0] = (lhci_info.uid64 & 0xff) as u8; | ||
| 207 | bytes[1] = ((lhci_info.uid64 >> 8) & 0xff) as u8; | ||
| 208 | bytes[2] = ((lhci_info.uid64 >> 16) & 0xff) as u8; | ||
| 209 | bytes[3] = 0; | ||
| 210 | bytes[4] = 0x6E; | ||
| 211 | bytes[5] = 0xED; | ||
| 72 | 212 | ||
| 73 | info!("Test OK"); | 213 | BdAddr(bytes) |
| 74 | cortex_m::asm::bkpt(); | 214 | } |
| 215 | |||
| 216 | const BLE_CFG_IRK: [u8; 16] = [ | ||
| 217 | 0x12, 0x34, 0x56, 0x78, 0x9a, 0xbc, 0xde, 0xf0, 0x12, 0x34, 0x56, 0x78, 0x9a, 0xbc, 0xde, 0xf0, | ||
| 218 | ]; | ||
| 219 | const BLE_CFG_ERK: [u8; 16] = [ | ||
| 220 | 0xfe, 0xdc, 0xba, 0x09, 0x87, 0x65, 0x43, 0x21, 0xfe, 0xdc, 0xba, 0x09, 0x87, 0x65, 0x43, 0x21, | ||
| 221 | ]; | ||
| 222 | |||
| 223 | fn get_irk() -> EncryptionKey { | ||
| 224 | EncryptionKey(BLE_CFG_IRK) | ||
| 225 | } | ||
| 226 | |||
| 227 | fn get_erk() -> EncryptionKey { | ||
| 228 | EncryptionKey(BLE_CFG_ERK) | ||
| 229 | } | ||
| 230 | |||
| 231 | fn eddystone_advertising_data() -> [u8; 24] { | ||
| 232 | const EDDYSTONE_URL: &[u8] = b"www.rust-lang.com"; | ||
| 233 | |||
| 234 | let mut service_data = [0u8; 24]; | ||
| 235 | let url_len = EDDYSTONE_URL.len(); | ||
| 236 | |||
| 237 | service_data[0] = 6 + url_len as u8; | ||
| 238 | service_data[1] = AdvertisingDataType::ServiceData as u8; | ||
| 239 | |||
| 240 | // 16-bit eddystone uuid | ||
| 241 | service_data[2] = 0xaa; | ||
| 242 | service_data[3] = 0xFE; | ||
| 243 | |||
| 244 | service_data[4] = 0x10; // URL frame type | ||
| 245 | service_data[5] = 22_i8 as u8; // calibrated TX power at 0m | ||
| 246 | service_data[6] = 0x03; // eddystone url prefix = https | ||
| 247 | |||
| 248 | service_data[7..(7 + url_len)].copy_from_slice(EDDYSTONE_URL); | ||
| 249 | |||
| 250 | service_data | ||
| 75 | } | 251 | } |
