d1acacb757
* Implemented queue_msg_waiting. * Fmt. * Adjusted changelog. * Fixed CI. * Fixed pointer mutability. * Implemented experimental sniffer api. * Fixed CI.. * Added safety comment. * Featured gated, PromiscuousPkt * Format. * Adjusted imports. * Added injection example. * Made RxControlInfo::from_raw public. * Format. * Added sniffer example.
124 lines
3.9 KiB
Rust
124 lines
3.9 KiB
Rust
//! WiFi frame injection example
|
|
//!
|
|
//! Periodically transmits a beacon frame.
|
|
|
|
//% FEATURES: esp-wifi esp-wifi/wifi-default esp-wifi/wifi esp-wifi/utils esp-wifi/sniffer
|
|
//% CHIPS: esp32 esp32s2 esp32s3 esp32c2 esp32c3 esp32c6
|
|
|
|
#![no_std]
|
|
#![no_main]
|
|
|
|
use core::marker::PhantomData;
|
|
|
|
use esp_backtrace as _;
|
|
use esp_hal::{
|
|
clock::ClockControl,
|
|
delay::Delay,
|
|
peripherals::Peripherals,
|
|
prelude::*,
|
|
rng::Rng,
|
|
system::SystemControl,
|
|
timer::{timg::TimerGroup, ErasedTimer, PeriodicTimer},
|
|
};
|
|
use esp_wifi::{initialize, wifi, EspWifiInitFor};
|
|
use ieee80211::{
|
|
common::{CapabilitiesInformation, FCFFlags},
|
|
element_chain,
|
|
elements::{DSSSParameterSetElement, RawIEEE80211Element, SSIDElement},
|
|
mgmt_frame::{body::BeaconBody, header::ManagementFrameHeader, BeaconFrame},
|
|
scroll::Pwrite,
|
|
supported_rates,
|
|
};
|
|
|
|
const SSID: &str = "esp-wifi 802.11 injection";
|
|
/// This is an arbitrary MAC address, used for the fake beacon frames.
|
|
const MAC_ADDRESS: [u8; 6] = [0x00, 0x80, 0x41, 0x13, 0x37, 0x42];
|
|
|
|
#[entry]
|
|
fn main() -> ! {
|
|
esp_println::logger::init_logger_from_env();
|
|
|
|
let peripherals = Peripherals::take();
|
|
|
|
let system = SystemControl::new(peripherals.SYSTEM);
|
|
let clocks = ClockControl::max(system.clock_control).freeze();
|
|
|
|
let delay = Delay::new(&clocks);
|
|
|
|
let timg0 = TimerGroup::new(peripherals.TIMG0, &clocks);
|
|
let timer0: ErasedTimer = timg0.timer0.into();
|
|
let timer = PeriodicTimer::new(timer0);
|
|
|
|
let init = initialize(
|
|
EspWifiInitFor::Wifi,
|
|
timer,
|
|
Rng::new(peripherals.RNG),
|
|
peripherals.RADIO_CLK,
|
|
&clocks,
|
|
)
|
|
.unwrap();
|
|
|
|
let wifi = peripherals.WIFI;
|
|
|
|
// We must initialize some kind of interface and start it.
|
|
let (_, mut controller) = wifi::new_with_mode(&init, wifi, wifi::WifiApDevice).unwrap();
|
|
controller.start().unwrap();
|
|
|
|
let mut sniffer = controller.take_sniffer().unwrap();
|
|
|
|
// Create a buffer, which can hold the enitre serialized beacon frame.
|
|
let mut beacon = [0u8; 300];
|
|
let length = beacon
|
|
.pwrite(
|
|
BeaconFrame {
|
|
header: ManagementFrameHeader {
|
|
fcf_flags: FCFFlags::new(),
|
|
duration: 0,
|
|
receiver_address: [0xff; 6].into(),
|
|
transmitter_address: MAC_ADDRESS.into(),
|
|
bssid: MAC_ADDRESS.into(),
|
|
..Default::default()
|
|
},
|
|
body: BeaconBody {
|
|
timestamp: 0,
|
|
// We transmit a beacon every 100 ms/TUs
|
|
beacon_interval: 100,
|
|
capabilities_info: CapabilitiesInformation::new().with_is_ess(true),
|
|
elements: element_chain! {
|
|
SSIDElement::new(SSID).unwrap(),
|
|
// These are known good values.
|
|
supported_rates![
|
|
1 B,
|
|
2 B,
|
|
5.5 B,
|
|
11 B,
|
|
6,
|
|
9,
|
|
12,
|
|
18
|
|
],
|
|
DSSSParameterSetElement {
|
|
current_channel: 1,
|
|
},
|
|
// This contains the Traffic Indication Map(TIM), for which `ieee80211-rs` currently lacks support.
|
|
RawIEEE80211Element {
|
|
tlv_type: 5,
|
|
slice: [0x01, 0x02, 0x00, 0x00].as_slice(),
|
|
_phantom: PhantomData
|
|
}
|
|
},
|
|
_phantom: PhantomData,
|
|
},
|
|
},
|
|
0,
|
|
)
|
|
.unwrap();
|
|
// Only use the actually written bytes.
|
|
let beacon = &beacon[..length];
|
|
|
|
loop {
|
|
sniffer.send_raw_frame(false, beacon, false).unwrap();
|
|
delay.delay(100.millis());
|
|
}
|
|
}
|