embassy/examples/stm32wb/src/bin/mac_ffd.rs

207 lines
7.0 KiB
Rust
Raw Normal View History

2023-07-10 17:54:48 +02:00
#![no_std]
#![no_main]
#![feature(type_alias_impl_trait)]
use defmt::*;
use embassy_executor::Spawner;
use embassy_stm32::bind_interrupts;
use embassy_stm32::ipcc::{Config, ReceiveInterruptHandler, TransmitInterruptHandler};
2023-07-15 21:47:34 +02:00
use embassy_stm32_wpan::mac::commands::{AssociateResponse, ResetRequest, SetRequest, StartRequest};
use embassy_stm32_wpan::mac::event::MacEvent;
use embassy_stm32_wpan::mac::typedefs::{MacChannel, MacStatus, PanId, PibId, SecurityLevel};
2023-07-10 17:54:48 +02:00
use embassy_stm32_wpan::sub::mm;
use embassy_stm32_wpan::TlMbox;
use {defmt_rtt as _, panic_probe as _};
bind_interrupts!(struct Irqs{
IPCC_C1_RX => ReceiveInterruptHandler;
IPCC_C1_TX => TransmitInterruptHandler;
});
#[embassy_executor::task]
async fn run_mm_queue(memory_manager: mm::MemoryManager) {
memory_manager.run_queue().await;
}
#[embassy_executor::main]
async fn main(spawner: Spawner) {
/*
How to make this work:
- Obtain a NUCLEO-STM32WB55 from your preferred supplier.
- Download and Install STM32CubeProgrammer.
- Download stm32wb5x_FUS_fw.bin, stm32wb5x_BLE_Stack_full_fw.bin, and Release_Notes.html from
gh:STMicroelectronics/STM32CubeWB@2234d97/Projects/STM32WB_Copro_Wireless_Binaries/STM32WB5x
- Open STM32CubeProgrammer
- On the right-hand pane, click "firmware upgrade" to upgrade the st-link firmware.
- Once complete, click connect to connect to the device.
- On the left hand pane, click the RSS signal icon to open "Firmware Upgrade Services".
- In the Release_Notes.html, find the memory address that corresponds to your device for the stm32wb5x_FUS_fw.bin file
- Select that file, the memory address, "verify download", and then "Firmware Upgrade".
- Once complete, in the Release_Notes.html, find the memory address that corresponds to your device for the
stm32wb5x_BLE_Stack_full_fw.bin file. It should not be the same memory address.
- Select that file, the memory address, "verify download", and then "Firmware Upgrade".
- Select "Start Wireless Stack".
- Disconnect from the device.
- In the examples folder for stm32wb, modify the memory.x file to match your target device.
- Run this example.
Note: extended stack versions are not supported at this time. Do not attempt to install a stack with "extended" in the name.
*/
let p = embassy_stm32::init(Default::default());
info!("Hello World!");
let config = Config::default();
let mbox = TlMbox::init(p.IPCC, Irqs, config);
spawner.spawn(run_mm_queue(mbox.mm_subsystem)).unwrap();
let sys_event = mbox.sys_subsystem.read().await;
info!("sys event: {}", sys_event.payload());
core::mem::drop(sys_event);
let result = mbox.sys_subsystem.shci_c2_mac_802_15_4_init().await;
info!("initialized mac: {}", result);
info!("resetting");
2023-07-12 16:06:56 +02:00
mbox.mac_subsystem
2023-07-16 19:41:57 +02:00
.send_command(&ResetRequest {
set_default_pib: true,
..Default::default()
})
2023-07-12 16:06:56 +02:00
.await
.unwrap();
{
let evt = mbox.mac_subsystem.read().await.unwrap();
defmt::info!("{:#x}", *evt);
}
2023-07-10 17:54:48 +02:00
info!("setting extended address");
let extended_address: u64 = 0xACDE480000000001;
2023-07-12 16:06:56 +02:00
mbox.mac_subsystem
.send_command(&SetRequest {
2023-07-10 17:54:48 +02:00
pib_attribute_ptr: &extended_address as *const _ as *const u8,
2023-07-11 17:07:33 +02:00
pib_attribute: PibId::ExtendedAddress,
})
2023-07-12 16:06:56 +02:00
.await
.unwrap();
{
let evt = mbox.mac_subsystem.read().await.unwrap();
defmt::info!("{:#x}", *evt);
}
2023-07-11 17:07:33 +02:00
info!("setting short address");
let short_address: u16 = 0x1122;
2023-07-12 16:06:56 +02:00
mbox.mac_subsystem
.send_command(&SetRequest {
2023-07-11 17:07:33 +02:00
pib_attribute_ptr: &short_address as *const _ as *const u8,
pib_attribute: PibId::ShortAddress,
})
2023-07-12 16:06:56 +02:00
.await
.unwrap();
{
let evt = mbox.mac_subsystem.read().await.unwrap();
defmt::info!("{:#x}", *evt);
}
2023-07-11 17:07:33 +02:00
info!("setting association permit");
let association_permit: bool = true;
2023-07-12 16:06:56 +02:00
mbox.mac_subsystem
.send_command(&SetRequest {
2023-07-11 17:07:33 +02:00
pib_attribute_ptr: &association_permit as *const _ as *const u8,
pib_attribute: PibId::AssociationPermit,
})
2023-07-12 16:06:56 +02:00
.await
.unwrap();
{
let evt = mbox.mac_subsystem.read().await.unwrap();
defmt::info!("{:#x}", *evt);
}
2023-07-11 17:07:33 +02:00
info!("setting TX power");
let transmit_power: i8 = 2;
2023-07-12 16:06:56 +02:00
mbox.mac_subsystem
.send_command(&SetRequest {
2023-07-11 17:07:33 +02:00
pib_attribute_ptr: &transmit_power as *const _ as *const u8,
pib_attribute: PibId::TransmitPower,
})
2023-07-12 16:06:56 +02:00
.await
.unwrap();
{
let evt = mbox.mac_subsystem.read().await.unwrap();
defmt::info!("{:#x}", *evt);
}
2023-07-11 17:07:33 +02:00
info!("starting FFD device");
2023-07-12 16:06:56 +02:00
mbox.mac_subsystem
.send_command(&StartRequest {
2023-07-13 16:20:50 +02:00
pan_id: PanId([0x1A, 0xAA]),
2023-07-12 16:06:56 +02:00
channel_number: MacChannel::Channel16,
2023-07-11 17:07:33 +02:00
beacon_order: 0x0F,
superframe_order: 0x0F,
pan_coordinator: true,
battery_life_extension: false,
..Default::default()
})
2023-07-12 16:06:56 +02:00
.await
.unwrap();
{
let evt = mbox.mac_subsystem.read().await.unwrap();
defmt::info!("{:#x}", *evt);
}
2023-07-11 17:07:33 +02:00
info!("setting RX on when idle");
let rx_on_while_idle: bool = true;
2023-07-12 16:06:56 +02:00
mbox.mac_subsystem
.send_command(&SetRequest {
2023-07-11 17:07:33 +02:00
pib_attribute_ptr: &rx_on_while_idle as *const _ as *const u8,
pib_attribute: PibId::RxOnWhenIdle,
2023-07-10 17:54:48 +02:00
})
2023-07-12 16:06:56 +02:00
.await
.unwrap();
{
let evt = mbox.mac_subsystem.read().await.unwrap();
defmt::info!("{:#x}", *evt);
}
2023-07-12 16:06:56 +02:00
loop {
let evt = mbox.mac_subsystem.read().await;
if let Ok(evt) = evt {
2023-07-17 00:28:34 +02:00
defmt::info!("parsed mac event");
defmt::info!("{:#x}", *evt);
2023-07-17 00:28:34 +02:00
match *evt {
2023-07-13 16:20:50 +02:00
MacEvent::MlmeAssociateInd(association) => mbox
.mac_subsystem
.send_command(&AssociateResponse {
device_address: association.device_address,
assoc_short_address: [0x33, 0x44],
status: MacStatus::Success,
security_level: SecurityLevel::Unsecure,
..Default::default()
})
.await
.unwrap(),
MacEvent::McpsDataInd(data_ind) => {
2023-07-17 00:28:34 +02:00
let payload = data_ind.payload();
let ref_payload = b"Hello from embassy!";
info!("{}", payload);
2023-07-13 17:29:29 +02:00
2023-07-17 00:28:34 +02:00
if payload == ref_payload {
2023-07-13 17:29:29 +02:00
info!("success");
2023-07-17 00:28:34 +02:00
} else {
info!("ref payload: {}", ref_payload);
2023-07-13 17:29:29 +02:00
}
2023-07-13 16:20:50 +02:00
}
2023-07-17 00:28:34 +02:00
_ => {
defmt::info!("other mac event");
}
2023-07-13 16:20:50 +02:00
}
2023-07-17 00:28:34 +02:00
} else {
defmt::info!("failed to parse mac event");
2023-07-13 16:20:50 +02:00
}
2023-07-12 16:06:56 +02:00
}
2023-07-10 17:54:48 +02:00
}