mirror of
https://github.com/saymrwulf/xous-core.git
synced 2026-11-16 08:38:26 +00:00
would be helpful to add the devices.rs file
This commit is contained in:
parent
c8decc85c2
commit
61e21cce19
1 changed files with 105 additions and 0 deletions
105
services/net/src/device.rs
Executable file
105
services/net/src/device.rs
Executable file
|
|
@ -0,0 +1,105 @@
|
|||
use com::Com;
|
||||
use com::api::NET_MTU;
|
||||
|
||||
use smoltcp::Result;
|
||||
use smoltcp::phy::{self, DeviceCapabilities, Device, Medium};
|
||||
|
||||
use smoltcp::iface::{InterfaceBuilder, NeighborCache, Routes};
|
||||
use smoltcp::socket::{IcmpEndpoint, IcmpPacketMetadata, IcmpSocket, IcmpSocketBuffer, SocketSet};
|
||||
use smoltcp::wire::{
|
||||
EthernetAddress, Icmpv4Packet, Icmpv4Repr, Icmpv6Packet, Icmpv6Repr, IpAddress, IpCidr,
|
||||
Ipv4Address, Ipv6Address,
|
||||
};
|
||||
use smoltcp::{
|
||||
time::{Duration, Instant},
|
||||
};
|
||||
|
||||
pub struct NetPhy {
|
||||
rx_buffer: [u8; NET_MTU],
|
||||
tx_buffer: [u8; NET_MTU],
|
||||
com: Com,
|
||||
rx_avail: Option<u16>,
|
||||
}
|
||||
|
||||
impl<'a> NetPhy {
|
||||
pub fn new(xns: &xous_names::XousNames) -> NetPhy {
|
||||
NetPhy {
|
||||
rx_buffer: [0; NET_MTU],
|
||||
tx_buffer: [0; NET_MTU],
|
||||
com: Com::new(&xns).unwrap(),
|
||||
rx_avail: None,
|
||||
}
|
||||
}
|
||||
// returns None if there was a slot to put the availability into
|
||||
// returns Some(len) if not
|
||||
pub fn push_rx_avail(&mut self, len: u16) -> Option<u16> {
|
||||
if self.rx_avail.is_none() {
|
||||
self.rx_avail = Some(len);
|
||||
None
|
||||
} else {
|
||||
Some(len)
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
impl<'a> phy::Device<'a> for NetPhy {
|
||||
type RxToken = NetPhyRxToken<'a>;
|
||||
type TxToken = NetPhyTxToken<'a>;
|
||||
|
||||
fn receive(&'a mut self) -> Option<(Self::RxToken, Self::TxToken)> {
|
||||
Some((NetPhyRxToken{buf: &mut self.rx_buffer[..], com: & self.com, rx_avail: self.rx_avail.take()},
|
||||
NetPhyTxToken{buf: &mut self.tx_buffer[..], com: & self.com}))
|
||||
}
|
||||
|
||||
fn transmit(&'a mut self) -> Option<Self::TxToken> {
|
||||
Some(NetPhyTxToken{buf: &mut self.tx_buffer[..], com: &self.com})
|
||||
}
|
||||
|
||||
fn capabilities(&self) -> DeviceCapabilities {
|
||||
let mut caps = DeviceCapabilities::default();
|
||||
caps.max_transmission_unit = NET_MTU;
|
||||
caps.max_burst_size = Some(1);
|
||||
caps.medium = Medium::Ethernet;
|
||||
caps
|
||||
}
|
||||
}
|
||||
|
||||
pub struct NetPhyRxToken<'a> {
|
||||
buf: &'a mut [u8],
|
||||
com: &'a Com,
|
||||
rx_avail: Option<u16>,
|
||||
}
|
||||
|
||||
impl<'a, 'c> phy::RxToken for NetPhyRxToken<'a> {
|
||||
fn consume<R, F>(mut self, _timestamp: Instant, f: F) -> Result<R>
|
||||
where F: FnOnce(&mut [u8]) -> Result<R>
|
||||
{
|
||||
if let Some(rx_len) = self.rx_avail {
|
||||
self.com.wlan_fetch_packet(&mut self.buf[..rx_len as usize]).unwrap();
|
||||
}
|
||||
// else, the buf is not updated -- and it would be empty, yielding no availability
|
||||
|
||||
let result = f(&mut self.buf);
|
||||
log::info!("rx called");
|
||||
result
|
||||
}
|
||||
}
|
||||
|
||||
pub struct NetPhyTxToken<'a> {
|
||||
buf: &'a mut [u8],
|
||||
com: &'a Com,
|
||||
}
|
||||
|
||||
impl<'a> phy::TxToken for NetPhyTxToken<'a> {
|
||||
fn consume<R, F>(self, _timestamp: Instant, len: usize, f: F) -> Result<R>
|
||||
where F: FnOnce(&mut [u8]) -> Result<R>
|
||||
{
|
||||
let result = f(&mut self.buf[..len]);
|
||||
log::info!("tx called {}", len);
|
||||
|
||||
if result.is_ok() {
|
||||
self.com.wlan_send_packet(self.buf).map_err(|_| smoltcp::Error::Dropped)?;
|
||||
}
|
||||
result
|
||||
}
|
||||
}
|
||||
Loading…
Reference in a new issue