Merge branch 'master' into wlan_read_fix
This commit is contained in:
commit
c1fa46bd36
@ -14,7 +14,7 @@ firmware-logs = []
|
|||||||
embassy-time = { version = "0.1.0" }
|
embassy-time = { version = "0.1.0" }
|
||||||
embassy-sync = { version = "0.1.0" }
|
embassy-sync = { version = "0.1.0" }
|
||||||
embassy-futures = { version = "0.1.0" }
|
embassy-futures = { version = "0.1.0" }
|
||||||
embassy-net = { version = "0.1.0" }
|
embassy-net-driver-channel = { version = "0.1.0" }
|
||||||
atomic-polyfill = "0.1.5"
|
atomic-polyfill = "0.1.5"
|
||||||
|
|
||||||
defmt = { version = "0.3", optional = true }
|
defmt = { version = "0.3", optional = true }
|
||||||
|
@ -9,7 +9,7 @@ cyw43 = { path = "../../", features = ["defmt", "firmware-logs"]}
|
|||||||
embassy-executor = { version = "0.1.0", features = ["defmt", "integrated-timers"] }
|
embassy-executor = { version = "0.1.0", features = ["defmt", "integrated-timers"] }
|
||||||
embassy-time = { version = "0.1.0", features = ["defmt", "defmt-timestamp-uptime"] }
|
embassy-time = { version = "0.1.0", features = ["defmt", "defmt-timestamp-uptime"] }
|
||||||
embassy-rp = { version = "0.1.0", features = ["defmt", "unstable-traits", "nightly", "unstable-pac", "time-driver"] }
|
embassy-rp = { version = "0.1.0", features = ["defmt", "unstable-traits", "nightly", "unstable-pac", "time-driver"] }
|
||||||
embassy-net = { version = "0.1.0", features = ["defmt", "tcp", "dhcpv4", "medium-ethernet", "pool-16", "unstable-traits", "nightly"] }
|
embassy-net = { version = "0.1.0", features = ["defmt", "tcp", "dhcpv4", "medium-ethernet", "unstable-traits", "nightly"] }
|
||||||
atomic-polyfill = "0.1.5"
|
atomic-polyfill = "0.1.5"
|
||||||
static_cell = "1.0"
|
static_cell = "1.0"
|
||||||
|
|
||||||
@ -28,12 +28,14 @@ heapless = "0.7.15"
|
|||||||
|
|
||||||
|
|
||||||
[patch.crates-io]
|
[patch.crates-io]
|
||||||
embassy-executor = { git = "https://github.com/embassy-rs/embassy", rev = "645fb66a5122bdc8180e0e65d076ca103431a426" }
|
embassy-executor = { git = "https://github.com/embassy-rs/embassy", rev = "771806be790a2758f1314d6460defe7c2f0d3e99" }
|
||||||
embassy-time = { git = "https://github.com/embassy-rs/embassy", rev = "645fb66a5122bdc8180e0e65d076ca103431a426" }
|
embassy-time = { git = "https://github.com/embassy-rs/embassy", rev = "771806be790a2758f1314d6460defe7c2f0d3e99" }
|
||||||
embassy-futures = { git = "https://github.com/embassy-rs/embassy", rev = "645fb66a5122bdc8180e0e65d076ca103431a426" }
|
embassy-futures = { git = "https://github.com/embassy-rs/embassy", rev = "771806be790a2758f1314d6460defe7c2f0d3e99" }
|
||||||
embassy-sync = { git = "https://github.com/embassy-rs/embassy", rev = "645fb66a5122bdc8180e0e65d076ca103431a426" }
|
embassy-sync = { git = "https://github.com/embassy-rs/embassy", rev = "771806be790a2758f1314d6460defe7c2f0d3e99" }
|
||||||
embassy-rp = { git = "https://github.com/embassy-rs/embassy", rev = "645fb66a5122bdc8180e0e65d076ca103431a426" }
|
embassy-rp = { git = "https://github.com/embassy-rs/embassy", rev = "771806be790a2758f1314d6460defe7c2f0d3e99" }
|
||||||
embassy-net = { git = "https://github.com/embassy-rs/embassy", rev = "645fb66a5122bdc8180e0e65d076ca103431a426" }
|
embassy-net = { git = "https://github.com/embassy-rs/embassy", rev = "771806be790a2758f1314d6460defe7c2f0d3e99" }
|
||||||
|
embassy-net-driver = { git = "https://github.com/embassy-rs/embassy", rev = "771806be790a2758f1314d6460defe7c2f0d3e99" }
|
||||||
|
embassy-net-driver-channel = { git = "https://github.com/embassy-rs/embassy", rev = "771806be790a2758f1314d6460defe7c2f0d3e99" }
|
||||||
|
|
||||||
[profile.dev]
|
[profile.dev]
|
||||||
debug = 2
|
debug = 2
|
||||||
@ -43,7 +45,7 @@ overflow-checks = true
|
|||||||
|
|
||||||
[profile.release]
|
[profile.release]
|
||||||
codegen-units = 1
|
codegen-units = 1
|
||||||
debug = 2
|
debug = 1
|
||||||
debug-assertions = false
|
debug-assertions = false
|
||||||
incremental = false
|
incremental = false
|
||||||
lto = 'fat'
|
lto = 'fat'
|
||||||
|
@ -34,7 +34,7 @@ async fn wifi_task(
|
|||||||
}
|
}
|
||||||
|
|
||||||
#[embassy_executor::task]
|
#[embassy_executor::task]
|
||||||
async fn net_task(stack: &'static Stack<cyw43::NetDevice<'static>>) -> ! {
|
async fn net_task(stack: &'static Stack<cyw43::NetDriver<'static>>) -> ! {
|
||||||
stack.run().await
|
stack.run().await
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -66,11 +66,11 @@ async fn main(spawner: Spawner) {
|
|||||||
let spi = ExclusiveDevice::new(bus, cs);
|
let spi = ExclusiveDevice::new(bus, cs);
|
||||||
|
|
||||||
let state = singleton!(cyw43::State::new());
|
let state = singleton!(cyw43::State::new());
|
||||||
let (mut control, runner) = cyw43::new(state, pwr, spi, fw).await;
|
let (net_device, mut control, runner) = cyw43::new(state, pwr, spi, fw).await;
|
||||||
|
|
||||||
spawner.spawn(wifi_task(runner)).unwrap();
|
spawner.spawn(wifi_task(runner)).unwrap();
|
||||||
|
|
||||||
let net_device = control.init(clm).await;
|
control.init(clm).await;
|
||||||
|
|
||||||
//control.join_open(env!("WIFI_NETWORK")).await;
|
//control.join_open(env!("WIFI_NETWORK")).await;
|
||||||
control.join_wpa2(env!("WIFI_NETWORK"), env!("WIFI_PASSWORD")).await;
|
control.join_wpa2(env!("WIFI_NETWORK"), env!("WIFI_PASSWORD")).await;
|
||||||
|
186
src/lib.rs
186
src/lib.rs
@ -15,14 +15,10 @@ mod structs;
|
|||||||
use core::cell::Cell;
|
use core::cell::Cell;
|
||||||
use core::cmp::{max, min};
|
use core::cmp::{max, min};
|
||||||
use core::slice;
|
use core::slice;
|
||||||
use core::sync::atomic::Ordering;
|
|
||||||
use core::task::Waker;
|
|
||||||
|
|
||||||
use atomic_polyfill::AtomicBool;
|
use ch::driver::LinkState;
|
||||||
use embassy_futures::yield_now;
|
use embassy_futures::yield_now;
|
||||||
use embassy_net::{PacketBoxExt, PacketBuf};
|
use embassy_net_driver_channel as ch;
|
||||||
use embassy_sync::blocking_mutex::raw::NoopRawMutex;
|
|
||||||
use embassy_sync::channel::Channel;
|
|
||||||
use embassy_time::{block_for, Duration, Timer};
|
use embassy_time::{block_for, Duration, Timer};
|
||||||
use embedded_hal_1::digital::OutputPin;
|
use embedded_hal_1::digital::OutputPin;
|
||||||
use embedded_hal_async::spi::{SpiBusRead, SpiBusWrite, SpiDevice};
|
use embedded_hal_async::spi::{SpiBusRead, SpiBusWrite, SpiDevice};
|
||||||
@ -32,6 +28,8 @@ use crate::consts::*;
|
|||||||
use crate::events::Event;
|
use crate::events::Event;
|
||||||
use crate::structs::*;
|
use crate::structs::*;
|
||||||
|
|
||||||
|
const MTU: usize = 1514;
|
||||||
|
|
||||||
#[derive(Clone, Copy)]
|
#[derive(Clone, Copy)]
|
||||||
pub enum IoctlType {
|
pub enum IoctlType {
|
||||||
Get = 0,
|
Get = 0,
|
||||||
@ -128,30 +126,25 @@ enum IoctlState {
|
|||||||
|
|
||||||
pub struct State {
|
pub struct State {
|
||||||
ioctl_state: Cell<IoctlState>,
|
ioctl_state: Cell<IoctlState>,
|
||||||
|
ch: ch::State<MTU, 4, 4>,
|
||||||
tx_channel: Channel<NoopRawMutex, PacketBuf, 8>,
|
|
||||||
rx_channel: Channel<NoopRawMutex, PacketBuf, 8>,
|
|
||||||
link_up: AtomicBool,
|
|
||||||
}
|
}
|
||||||
|
|
||||||
impl State {
|
impl State {
|
||||||
pub fn new() -> Self {
|
pub fn new() -> Self {
|
||||||
Self {
|
Self {
|
||||||
ioctl_state: Cell::new(IoctlState::Idle),
|
ioctl_state: Cell::new(IoctlState::Idle),
|
||||||
|
ch: ch::State::new(),
|
||||||
tx_channel: Channel::new(),
|
|
||||||
rx_channel: Channel::new(),
|
|
||||||
link_up: AtomicBool::new(true), // TODO set up/down as we join/deassociate
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
pub struct Control<'a> {
|
pub struct Control<'a> {
|
||||||
state: &'a State,
|
state_ch: ch::StateRunner<'a>,
|
||||||
|
ioctl_state: &'a Cell<IoctlState>,
|
||||||
}
|
}
|
||||||
|
|
||||||
impl<'a> Control<'a> {
|
impl<'a> Control<'a> {
|
||||||
pub async fn init(&mut self, clm: &[u8]) -> NetDevice<'a> {
|
pub async fn init(&mut self, clm: &[u8]) {
|
||||||
const CHUNK_SIZE: usize = 1024;
|
const CHUNK_SIZE: usize = 1024;
|
||||||
|
|
||||||
info!("Downloading CLM...");
|
info!("Downloading CLM...");
|
||||||
@ -258,12 +251,10 @@ impl<'a> Control<'a> {
|
|||||||
|
|
||||||
Timer::after(Duration::from_millis(100)).await;
|
Timer::after(Duration::from_millis(100)).await;
|
||||||
|
|
||||||
info!("INIT DONE");
|
self.state_ch.set_ethernet_address(mac_addr);
|
||||||
|
self.state_ch.set_link_state(LinkState::Up); // TODO do on join/leave
|
||||||
|
|
||||||
NetDevice {
|
info!("INIT DONE");
|
||||||
state: self.state,
|
|
||||||
mac_addr,
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
pub async fn join_open(&mut self, ssid: &str) {
|
pub async fn join_open(&mut self, ssid: &str) {
|
||||||
@ -381,75 +372,30 @@ impl<'a> Control<'a> {
|
|||||||
async fn ioctl(&mut self, kind: IoctlType, cmd: u32, iface: u32, buf: &mut [u8]) -> usize {
|
async fn ioctl(&mut self, kind: IoctlType, cmd: u32, iface: u32, buf: &mut [u8]) -> usize {
|
||||||
// TODO cancel ioctl on future drop.
|
// TODO cancel ioctl on future drop.
|
||||||
|
|
||||||
while !matches!(self.state.ioctl_state.get(), IoctlState::Idle) {
|
while !matches!(self.ioctl_state.get(), IoctlState::Idle) {
|
||||||
yield_now().await;
|
yield_now().await;
|
||||||
}
|
}
|
||||||
|
|
||||||
self.state
|
self.ioctl_state.set(IoctlState::Pending { kind, cmd, iface, buf });
|
||||||
.ioctl_state
|
|
||||||
.set(IoctlState::Pending { kind, cmd, iface, buf });
|
|
||||||
|
|
||||||
let resp_len = loop {
|
let resp_len = loop {
|
||||||
if let IoctlState::Done { resp_len } = self.state.ioctl_state.get() {
|
if let IoctlState::Done { resp_len } = self.ioctl_state.get() {
|
||||||
break resp_len;
|
break resp_len;
|
||||||
}
|
}
|
||||||
yield_now().await;
|
yield_now().await;
|
||||||
};
|
};
|
||||||
|
|
||||||
self.state.ioctl_state.set(IoctlState::Idle);
|
self.ioctl_state.set(IoctlState::Idle);
|
||||||
|
|
||||||
resp_len
|
resp_len
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
pub struct NetDevice<'a> {
|
|
||||||
state: &'a State,
|
|
||||||
mac_addr: [u8; 6],
|
|
||||||
}
|
|
||||||
|
|
||||||
impl<'a> embassy_net::Device for NetDevice<'a> {
|
|
||||||
fn register_waker(&mut self, waker: &Waker) {
|
|
||||||
// loopy loopy wakey wakey
|
|
||||||
waker.wake_by_ref()
|
|
||||||
}
|
|
||||||
|
|
||||||
fn link_state(&mut self) -> embassy_net::LinkState {
|
|
||||||
match self.state.link_up.load(Ordering::Relaxed) {
|
|
||||||
true => embassy_net::LinkState::Up,
|
|
||||||
false => embassy_net::LinkState::Down,
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
fn capabilities(&self) -> embassy_net::DeviceCapabilities {
|
|
||||||
let mut caps = embassy_net::DeviceCapabilities::default();
|
|
||||||
caps.max_transmission_unit = 1514; // 1500 IP + 14 ethernet header
|
|
||||||
caps.medium = embassy_net::Medium::Ethernet;
|
|
||||||
caps
|
|
||||||
}
|
|
||||||
|
|
||||||
fn is_transmit_ready(&mut self) -> bool {
|
|
||||||
true
|
|
||||||
}
|
|
||||||
|
|
||||||
fn transmit(&mut self, pkt: PacketBuf) {
|
|
||||||
if self.state.tx_channel.try_send(pkt).is_err() {
|
|
||||||
warn!("TX failed")
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
fn receive(&mut self) -> Option<PacketBuf> {
|
|
||||||
self.state.rx_channel.try_recv().ok()
|
|
||||||
}
|
|
||||||
|
|
||||||
fn ethernet_address(&self) -> [u8; 6] {
|
|
||||||
self.mac_addr
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
pub struct Runner<'a, PWR, SPI> {
|
pub struct Runner<'a, PWR, SPI> {
|
||||||
|
ch: ch::Runner<'a, MTU>,
|
||||||
bus: Bus<PWR, SPI>,
|
bus: Bus<PWR, SPI>,
|
||||||
|
|
||||||
state: &'a State,
|
ioctl_state: &'a Cell<IoctlState>,
|
||||||
ioctl_id: u16,
|
ioctl_id: u16,
|
||||||
sdpcm_seq: u8,
|
sdpcm_seq: u8,
|
||||||
sdpcm_seq_max: u8,
|
sdpcm_seq_max: u8,
|
||||||
@ -466,21 +412,27 @@ struct LogState {
|
|||||||
buf_count: usize,
|
buf_count: usize,
|
||||||
}
|
}
|
||||||
|
|
||||||
|
pub type NetDriver<'a> = ch::Device<'a, MTU>;
|
||||||
|
|
||||||
pub async fn new<'a, PWR, SPI>(
|
pub async fn new<'a, PWR, SPI>(
|
||||||
state: &'a State,
|
state: &'a mut State,
|
||||||
pwr: PWR,
|
pwr: PWR,
|
||||||
spi: SPI,
|
spi: SPI,
|
||||||
firmware: &[u8],
|
firmware: &[u8],
|
||||||
) -> (Control<'a>, Runner<'a, PWR, SPI>)
|
) -> (NetDriver<'a>, Control<'a>, Runner<'a, PWR, SPI>)
|
||||||
where
|
where
|
||||||
PWR: OutputPin,
|
PWR: OutputPin,
|
||||||
SPI: SpiDevice,
|
SPI: SpiDevice,
|
||||||
SPI::Bus: SpiBusRead<u32> + SpiBusWrite<u32>,
|
SPI::Bus: SpiBusRead<u32> + SpiBusWrite<u32>,
|
||||||
{
|
{
|
||||||
|
let (ch_runner, device) = ch::new(&mut state.ch, [0; 6]);
|
||||||
|
let state_ch = ch_runner.state_runner();
|
||||||
|
|
||||||
let mut runner = Runner {
|
let mut runner = Runner {
|
||||||
|
ch: ch_runner,
|
||||||
bus: Bus::new(pwr, spi),
|
bus: Bus::new(pwr, spi),
|
||||||
|
|
||||||
state,
|
ioctl_state: &state.ioctl_state,
|
||||||
ioctl_id: 0,
|
ioctl_id: 0,
|
||||||
sdpcm_seq: 0,
|
sdpcm_seq: 0,
|
||||||
sdpcm_seq_max: 1,
|
sdpcm_seq_max: 1,
|
||||||
@ -496,7 +448,14 @@ where
|
|||||||
|
|
||||||
runner.init(firmware).await;
|
runner.init(firmware).await;
|
||||||
|
|
||||||
(Control { state }, runner)
|
(
|
||||||
|
device,
|
||||||
|
Control {
|
||||||
|
state_ch,
|
||||||
|
ioctl_state: &state.ioctl_state,
|
||||||
|
},
|
||||||
|
runner,
|
||||||
|
)
|
||||||
}
|
}
|
||||||
|
|
||||||
impl<'a, PWR, SPI> Runner<'a, PWR, SPI>
|
impl<'a, PWR, SPI> Runner<'a, PWR, SPI>
|
||||||
@ -662,43 +621,14 @@ where
|
|||||||
if !self.has_credit() {
|
if !self.has_credit() {
|
||||||
warn!("TX stalled");
|
warn!("TX stalled");
|
||||||
} else {
|
} else {
|
||||||
if let IoctlState::Pending { kind, cmd, iface, buf } = self.state.ioctl_state.get() {
|
if let IoctlState::Pending { kind, cmd, iface, buf } = self.ioctl_state.get() {
|
||||||
self.send_ioctl(kind, cmd, iface, unsafe { &*buf }).await;
|
self.send_ioctl(kind, cmd, iface, unsafe { &*buf }).await;
|
||||||
self.state.ioctl_state.set(IoctlState::Sent { buf });
|
self.ioctl_state.set(IoctlState::Sent { buf });
|
||||||
}
|
}
|
||||||
if !self.has_credit() {
|
if !self.has_credit() {
|
||||||
warn!("TX stalled");
|
warn!("TX stalled");
|
||||||
} else {
|
} else {
|
||||||
if let Ok(p) = self.state.tx_channel.try_recv() {
|
if let Some(packet) = self.ch.try_tx_buf() {
|
||||||
self.send_packet(&p).await;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
// Receive stuff
|
|
||||||
let irq = self.bus.read16(FUNC_BUS, REG_BUS_INTERRUPT).await;
|
|
||||||
|
|
||||||
if irq & IRQ_F2_PACKET_AVAILABLE != 0 {
|
|
||||||
let mut status = 0xFFFF_FFFF;
|
|
||||||
while status == 0xFFFF_FFFF {
|
|
||||||
status = self.bus.read32(FUNC_BUS, REG_BUS_STATUS).await;
|
|
||||||
}
|
|
||||||
|
|
||||||
if status & STATUS_F2_PKT_AVAILABLE != 0 {
|
|
||||||
let len = (status & STATUS_F2_PKT_LEN_MASK) >> STATUS_F2_PKT_LEN_SHIFT;
|
|
||||||
|
|
||||||
self.bus.wlan_read(&mut buf, len).await;
|
|
||||||
trace!("rx {:02x}", &slice8_mut(&mut buf)[..(len as usize).min(48)]);
|
|
||||||
self.rx(&slice8_mut(&mut buf)[..len as usize]);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
// TODO use IRQs
|
|
||||||
yield_now().await;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
async fn send_packet(&mut self, packet: &[u8]) {
|
|
||||||
trace!("tx pkt {:02x}", &packet[..packet.len().min(48)]);
|
trace!("tx pkt {:02x}", &packet[..packet.len().min(48)]);
|
||||||
|
|
||||||
let mut buf = [0; 512];
|
let mut buf = [0; 512];
|
||||||
@ -739,6 +669,31 @@ where
|
|||||||
trace!(" {:02x}", &buf8[..total_len.min(48)]);
|
trace!(" {:02x}", &buf8[..total_len.min(48)]);
|
||||||
|
|
||||||
self.bus.wlan_write(&buf[..(total_len / 4)]).await;
|
self.bus.wlan_write(&buf[..(total_len / 4)]).await;
|
||||||
|
self.ch.tx_done();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
// Receive stuff
|
||||||
|
let irq = self.bus.read16(FUNC_BUS, REG_BUS_INTERRUPT).await;
|
||||||
|
|
||||||
|
if irq & IRQ_F2_PACKET_AVAILABLE != 0 {
|
||||||
|
let mut status = 0xFFFF_FFFF;
|
||||||
|
while status == 0xFFFF_FFFF {
|
||||||
|
status = self.bus.read32(FUNC_BUS, REG_BUS_STATUS).await;
|
||||||
|
}
|
||||||
|
|
||||||
|
if status & STATUS_F2_PKT_AVAILABLE != 0 {
|
||||||
|
let len = (status & STATUS_F2_PKT_LEN_MASK) >> STATUS_F2_PKT_LEN_SHIFT;
|
||||||
|
self.bus.wlan_read(&mut buf, len).await;
|
||||||
|
trace!("rx {:02x}", &slice8_mut(&mut buf)[..(len as usize).min(48)]);
|
||||||
|
self.rx(&slice8_mut(&mut buf)[..len as usize]);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
// TODO use IRQs
|
||||||
|
yield_now().await;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
fn rx(&mut self, packet: &[u8]) {
|
fn rx(&mut self, packet: &[u8]) {
|
||||||
@ -775,7 +730,7 @@ where
|
|||||||
let cdc_header = CdcHeader::from_bytes(payload[..CdcHeader::SIZE].try_into().unwrap());
|
let cdc_header = CdcHeader::from_bytes(payload[..CdcHeader::SIZE].try_into().unwrap());
|
||||||
trace!(" {:?}", cdc_header);
|
trace!(" {:?}", cdc_header);
|
||||||
|
|
||||||
if let IoctlState::Sent { buf } = self.state.ioctl_state.get() {
|
if let IoctlState::Sent { buf } = self.ioctl_state.get() {
|
||||||
if cdc_header.id == self.ioctl_id {
|
if cdc_header.id == self.ioctl_id {
|
||||||
if cdc_header.status != 0 {
|
if cdc_header.status != 0 {
|
||||||
// TODO: propagate error instead
|
// TODO: propagate error instead
|
||||||
@ -786,7 +741,7 @@ where
|
|||||||
info!("IOCTL Response: {:02x}", &payload[CdcHeader::SIZE..][..resp_len]);
|
info!("IOCTL Response: {:02x}", &payload[CdcHeader::SIZE..][..resp_len]);
|
||||||
|
|
||||||
(unsafe { &mut *buf }[..resp_len]).copy_from_slice(&payload[CdcHeader::SIZE..][..resp_len]);
|
(unsafe { &mut *buf }[..resp_len]).copy_from_slice(&payload[CdcHeader::SIZE..][..resp_len]);
|
||||||
self.state.ioctl_state.set(IoctlState::Done { resp_len });
|
self.ioctl_state.set(IoctlState::Done { resp_len });
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@ -859,11 +814,12 @@ where
|
|||||||
let packet = &payload[packet_start..];
|
let packet = &payload[packet_start..];
|
||||||
trace!("rx pkt {:02x}", &packet[..(packet.len() as usize).min(48)]);
|
trace!("rx pkt {:02x}", &packet[..(packet.len() as usize).min(48)]);
|
||||||
|
|
||||||
let mut p = unwrap!(embassy_net::PacketBox::new(embassy_net::Packet::new()));
|
match self.ch.try_rx_buf() {
|
||||||
p[..packet.len()].copy_from_slice(packet);
|
Some(buf) => {
|
||||||
|
buf[..packet.len()].copy_from_slice(packet);
|
||||||
if let Err(_) = self.state.rx_channel.try_send(p.slice(0..packet.len())) {
|
self.ch.rx_done(packet.len())
|
||||||
warn!("failed to push rxd packet to the channel.")
|
}
|
||||||
|
None => warn!("failed to push rxd packet to the channel."),
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
_ => {}
|
_ => {}
|
||||||
|
Loading…
Reference in New Issue
Block a user