123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958 |
- use core::cmp;
- use managed::{ManagedSlice, ManagedMap};
- use crate::{Error, Result};
- use crate::phy::{Device, DeviceCapabilities, RxToken, TxToken, Medium};
- use crate::time::{Duration, Instant};
- use crate::wire::*;
- use crate::socket::*;
- #[cfg(feature = "medium-ethernet")]
- use crate::iface::{NeighborCache, NeighborAnswer};
- use crate::iface::Routes;
- pub struct Interface<'a, DeviceT: for<'d> Device<'d>> {
- device: DeviceT,
- inner: InterfaceInner<'a>,
- }
- struct InterfaceInner<'a> {
- #[cfg(feature = "medium-ethernet")]
- neighbor_cache: Option<NeighborCache<'a>>,
- #[cfg(feature = "medium-ethernet")]
- ethernet_addr: Option<EthernetAddress>,
- ip_addrs: ManagedSlice<'a, IpCidr>,
- #[cfg(feature = "proto-ipv4")]
- any_ip: bool,
- routes: Routes<'a>,
- #[cfg(feature = "proto-igmp")]
- ipv4_multicast_groups: ManagedMap<'a, Ipv4Address, ()>,
-
- #[cfg(feature = "proto-igmp")]
- igmp_report_state: IgmpReportState,
- device_capabilities: DeviceCapabilities,
- }
- pub struct InterfaceBuilder <'a, DeviceT: for<'d> Device<'d>> {
- device: DeviceT,
- #[cfg(feature = "medium-ethernet")]
- ethernet_addr: Option<EthernetAddress>,
- #[cfg(feature = "medium-ethernet")]
- neighbor_cache: Option<NeighborCache<'a>>,
- ip_addrs: ManagedSlice<'a, IpCidr>,
- #[cfg(feature = "proto-ipv4")]
- any_ip: bool,
- routes: Routes<'a>,
-
- #[cfg(feature = "proto-igmp")]
- ipv4_multicast_groups: ManagedMap<'a, Ipv4Address, ()>,
- }
- impl<'a, DeviceT> InterfaceBuilder<'a, DeviceT>
- where DeviceT: for<'d> Device<'d> {
-
-
- #[cfg_attr(feature = "medium-ethernet", doc = r##"
- # Examples
- ```
- # use std::collections::BTreeMap;
- use smoltcp::iface::{InterfaceBuilder, NeighborCache};
- # use smoltcp::phy::{Loopback, Medium};
- use smoltcp::wire::{EthernetAddress, IpCidr, IpAddress};
- let device = // ...
- # Loopback::new(Medium::Ethernet);
- let hw_addr = // ...
- # EthernetAddress::default();
- let neighbor_cache = // ...
- # NeighborCache::new(BTreeMap::new());
- let ip_addrs = // ...
- # [];
- let iface = InterfaceBuilder::new(device)
- .ethernet_addr(hw_addr)
- .neighbor_cache(neighbor_cache)
- .ip_addrs(ip_addrs)
- .finalize();
- ```
- "##)]
- pub fn new(device: DeviceT) -> Self {
- InterfaceBuilder {
- device: device,
- #[cfg(feature = "medium-ethernet")]
- ethernet_addr: None,
- #[cfg(feature = "medium-ethernet")]
- neighbor_cache: None,
- ip_addrs: ManagedSlice::Borrowed(&mut []),
- #[cfg(feature = "proto-ipv4")]
- any_ip: false,
- routes: Routes::new(ManagedMap::Borrowed(&mut [])),
- #[cfg(feature = "proto-igmp")]
- ipv4_multicast_groups: ManagedMap::Borrowed(&mut []),
- }
- }
-
-
-
-
-
-
-
- #[cfg(feature = "medium-ethernet")]
- pub fn ethernet_addr(mut self, addr: EthernetAddress) -> Self {
- InterfaceInner::check_ethernet_addr(&addr);
- self.ethernet_addr = Some(addr);
- self
- }
-
-
-
-
-
-
-
- pub fn ip_addrs<T>(mut self, ip_addrs: T) -> Self
- where T: Into<ManagedSlice<'a, IpCidr>>
- {
- let ip_addrs = ip_addrs.into();
- InterfaceInner::check_ip_addrs(&ip_addrs);
- self.ip_addrs = ip_addrs;
- self
- }
-
-
-
-
-
-
-
-
-
-
-
-
-
- #[cfg(feature = "proto-ipv4")]
- pub fn any_ip(mut self, enabled: bool) -> Self {
- self.any_ip = enabled;
- self
- }
-
-
-
-
- pub fn routes<T>(mut self, routes: T) -> InterfaceBuilder<'a, DeviceT>
- where T: Into<Routes<'a>>
- {
- self.routes = routes.into();
- self
- }
-
-
-
-
-
-
-
-
-
-
- #[cfg(feature = "proto-igmp")]
- pub fn ipv4_multicast_groups<T>(mut self, ipv4_multicast_groups: T) -> Self
- where T: Into<ManagedMap<'a, Ipv4Address, ()>>
- {
- self.ipv4_multicast_groups = ipv4_multicast_groups.into();
- self
- }
-
- #[cfg(feature = "medium-ethernet")]
- pub fn neighbor_cache(mut self, neighbor_cache: NeighborCache<'a>) -> Self {
- self.neighbor_cache = Some(neighbor_cache);
- self
- }
-
-
-
-
-
-
-
-
-
-
-
- pub fn finalize(self) -> Interface<'a, DeviceT> {
- let device_capabilities = self.device.capabilities();
- #[cfg(feature = "medium-ethernet")]
- let (ethernet_addr, neighbor_cache) = match device_capabilities.medium {
- Medium::Ethernet => (
- Some(self.ethernet_addr.expect("ethernet_addr required option was not set")),
- Some(self.neighbor_cache.expect("neighbor_cache required option was not set"))
- ),
- #[cfg(feature = "medium-ip")]
- Medium::Ip => {
- assert!(self.ethernet_addr.is_none(), "ethernet_addr is set, but device medium is IP");
- assert!(self.neighbor_cache.is_none(), "neighbor_cache is set, but device medium is IP");
- (None, None)
- }
- };
- Interface {
- device: self.device,
- inner: InterfaceInner {
- #[cfg(feature = "medium-ethernet")]
- ethernet_addr,
- ip_addrs: self.ip_addrs,
- #[cfg(feature = "proto-ipv4")]
- any_ip: self.any_ip,
- routes: self.routes,
- device_capabilities,
- #[cfg(feature = "medium-ethernet")]
- neighbor_cache,
- #[cfg(feature = "proto-igmp")]
- ipv4_multicast_groups: self.ipv4_multicast_groups,
- #[cfg(feature = "proto-igmp")]
- igmp_report_state: IgmpReportState::Inactive,
- }
- }
- }
- }
- #[derive(Debug, PartialEq)]
- #[cfg_attr(feature = "defmt", derive(defmt::Format))]
- #[cfg(feature = "medium-ethernet")]
- enum EthernetPacket<'a> {
- #[cfg(feature = "proto-ipv4")]
- Arp(ArpRepr),
- Ip(IpPacket<'a>),
- }
- #[derive(Debug, PartialEq)]
- #[cfg_attr(feature = "defmt", derive(defmt::Format))]
- pub(crate) enum IpPacket<'a> {
- #[cfg(feature = "proto-ipv4")]
- Icmpv4((Ipv4Repr, Icmpv4Repr<'a>)),
- #[cfg(feature = "proto-igmp")]
- Igmp((Ipv4Repr, IgmpRepr)),
- #[cfg(feature = "proto-ipv6")]
- Icmpv6((Ipv6Repr, Icmpv6Repr<'a>)),
- #[cfg(feature = "socket-raw")]
- Raw((IpRepr, &'a [u8])),
- #[cfg(feature = "socket-udp")]
- Udp((IpRepr, UdpRepr, &'a [u8])),
- #[cfg(feature = "socket-tcp")]
- Tcp((IpRepr, TcpRepr<'a>)),
- #[cfg(feature = "socket-dhcpv4")]
- Dhcpv4((Ipv4Repr, UdpRepr, DhcpRepr<'a>)),
- }
- impl<'a> IpPacket<'a> {
- pub(crate) fn ip_repr(&self) -> IpRepr {
- match self {
- #[cfg(feature = "proto-ipv4")]
- IpPacket::Icmpv4((ipv4_repr, _)) => IpRepr::Ipv4(*ipv4_repr),
- #[cfg(feature = "proto-igmp")]
- IpPacket::Igmp((ipv4_repr, _)) => IpRepr::Ipv4(*ipv4_repr),
- #[cfg(feature = "proto-ipv6")]
- IpPacket::Icmpv6((ipv6_repr, _)) => IpRepr::Ipv6(*ipv6_repr),
- #[cfg(feature = "socket-raw")]
- IpPacket::Raw((ip_repr, _)) => ip_repr.clone(),
- #[cfg(feature = "socket-udp")]
- IpPacket::Udp((ip_repr, _, _)) => ip_repr.clone(),
- #[cfg(feature = "socket-tcp")]
- IpPacket::Tcp((ip_repr, _)) => ip_repr.clone(),
- #[cfg(feature = "socket-dhcpv4")]
- IpPacket::Dhcpv4((ipv4_repr, _, _)) => IpRepr::Ipv4(*ipv4_repr),
- }
- }
- pub(crate) fn emit_payload(&self, _ip_repr: IpRepr, payload: &mut [u8], caps: &DeviceCapabilities) {
- match self {
- #[cfg(feature = "proto-ipv4")]
- IpPacket::Icmpv4((_, icmpv4_repr)) =>
- icmpv4_repr.emit(&mut Icmpv4Packet::new_unchecked(payload), &caps.checksum),
- #[cfg(feature = "proto-igmp")]
- IpPacket::Igmp((_, igmp_repr)) =>
- igmp_repr.emit(&mut IgmpPacket::new_unchecked(payload)),
- #[cfg(feature = "proto-ipv6")]
- IpPacket::Icmpv6((_, icmpv6_repr)) =>
- icmpv6_repr.emit(&_ip_repr.src_addr(), &_ip_repr.dst_addr(),
- &mut Icmpv6Packet::new_unchecked(payload), &caps.checksum),
- #[cfg(feature = "socket-raw")]
- IpPacket::Raw((_, raw_packet)) =>
- payload.copy_from_slice(raw_packet),
- #[cfg(feature = "socket-udp")]
- IpPacket::Udp((_, udp_repr, inner_payload)) =>
- udp_repr.emit(&mut UdpPacket::new_unchecked(payload),
- &_ip_repr.src_addr(), &_ip_repr.dst_addr(),
- inner_payload.len(), |buf| buf.copy_from_slice(inner_payload),
- &caps.checksum),
- #[cfg(feature = "socket-tcp")]
- IpPacket::Tcp((_, mut tcp_repr)) => {
-
-
-
-
-
-
-
- if let Some(max_burst_size) = caps.max_burst_size {
- let mut max_segment_size = caps.max_transmission_unit;
- max_segment_size -= _ip_repr.buffer_len();
- max_segment_size -= tcp_repr.header_len();
- let max_window_size = max_burst_size * max_segment_size;
- if tcp_repr.window_len as usize > max_window_size {
- tcp_repr.window_len = max_window_size as u16;
- }
- }
- tcp_repr.emit(&mut TcpPacket::new_unchecked(payload),
- &_ip_repr.src_addr(), &_ip_repr.dst_addr(),
- &caps.checksum);
- }
- #[cfg(feature = "socket-dhcpv4")]
- IpPacket::Dhcpv4((_, udp_repr, dhcp_repr)) =>
- udp_repr.emit(&mut UdpPacket::new_unchecked(payload),
- &_ip_repr.src_addr(), &_ip_repr.dst_addr(),
- dhcp_repr.buffer_len(),
- |buf| dhcp_repr.emit(&mut DhcpPacket::new_unchecked(buf)).unwrap(),
- &caps.checksum),
- }
- }
- }
- #[cfg(any(feature = "proto-ipv4", feature = "proto-ipv6"))]
- fn icmp_reply_payload_len(len: usize, mtu: usize, header_len: usize) -> usize {
-
-
-
-
-
-
-
-
- cmp::min(len, mtu - header_len * 2 - 8)
- }
- #[cfg(feature = "proto-igmp")]
- enum IgmpReportState {
- Inactive,
- ToGeneralQuery {
- version: IgmpVersion,
- timeout: Instant,
- interval: Duration,
- next_index: usize
- },
- ToSpecificQuery {
- version: IgmpVersion,
- timeout: Instant,
- group: Ipv4Address
- },
- }
- impl<'a, DeviceT> Interface<'a, DeviceT>
- where DeviceT: for<'d> Device<'d> {
-
-
-
-
- #[cfg(feature = "medium-ethernet")]
- pub fn ethernet_addr(&self) -> EthernetAddress {
- self.inner.ethernet_addr.unwrap()
- }
-
-
-
-
-
- #[cfg(feature = "medium-ethernet")]
- pub fn set_ethernet_addr(&mut self, addr: EthernetAddress) {
- assert!(self.device.capabilities().medium == Medium::Ethernet);
- InterfaceInner::check_ethernet_addr(&addr);
- self.inner.ethernet_addr = Some(addr);
- }
-
- pub fn device(&self) -> &DeviceT {
- &self.device
- }
-
-
-
-
-
-
-
- pub fn device_mut(&mut self) -> &mut DeviceT {
- &mut self.device
- }
-
-
-
-
- pub fn join_multicast_group<T: Into<IpAddress>>(&mut self, addr: T, _timestamp: Instant) -> Result<bool> {
- match addr.into() {
- #[cfg(feature = "proto-igmp")]
- IpAddress::Ipv4(addr) => {
- let is_not_new = self.inner.ipv4_multicast_groups.insert(addr, ())
- .map_err(|_| Error::Exhausted)?
- .is_some();
- if is_not_new {
- Ok(false)
- } else if let Some(pkt) =
- self.inner.igmp_report_packet(IgmpVersion::Version2, addr) {
-
- let tx_token = self.device.transmit().ok_or(Error::Exhausted)?;
- self.inner.dispatch_ip(tx_token, _timestamp, pkt)?;
- Ok(true)
- } else {
- Ok(false)
- }
- }
-
- _ => Err(Error::Unaddressable)
- }
- }
-
-
-
-
- pub fn leave_multicast_group<T: Into<IpAddress>>(&mut self, addr: T, _timestamp: Instant) -> Result<bool> {
- match addr.into() {
- #[cfg(feature = "proto-igmp")]
- IpAddress::Ipv4(addr) => {
- let was_not_present = self.inner.ipv4_multicast_groups.remove(&addr)
- .is_none();
- if was_not_present {
- Ok(false)
- } else if let Some(pkt) = self.inner.igmp_leave_packet(addr) {
-
- let tx_token = self.device.transmit().ok_or(Error::Exhausted)?;
- self.inner.dispatch_ip(tx_token, _timestamp, pkt)?;
- Ok(true)
- } else {
- Ok(false)
- }
- }
-
- _ => Err(Error::Unaddressable)
- }
- }
-
- pub fn has_multicast_group<T: Into<IpAddress>>(&self, addr: T) -> bool {
- self.inner.has_multicast_group(addr)
- }
-
- pub fn ip_addrs(&self) -> &[IpCidr] {
- self.inner.ip_addrs.as_ref()
- }
-
- #[cfg(feature = "proto-ipv4")]
- pub fn ipv4_addr(&self) -> Option<Ipv4Address> {
- self.ip_addrs().iter()
- .filter_map(|cidr| match cidr.address() {
- IpAddress::Ipv4(addr) => Some(addr),
- _ => None,
- }).next()
- }
-
-
-
-
- pub fn update_ip_addrs<F: FnOnce(&mut ManagedSlice<'a, IpCidr>)>(&mut self, f: F) {
- f(&mut self.inner.ip_addrs);
- InterfaceInner::check_ip_addrs(&self.inner.ip_addrs)
- }
-
- pub fn has_ip_addr<T: Into<IpAddress>>(&self, addr: T) -> bool {
- self.inner.has_ip_addr(addr)
- }
-
- #[cfg(feature = "proto-ipv4")]
- pub fn ipv4_address(&self) -> Option<Ipv4Address> {
- self.inner.ipv4_address()
- }
- pub fn routes(&self) -> &Routes<'a> {
- &self.inner.routes
- }
- pub fn routes_mut(&mut self) -> &mut Routes<'a> {
- &mut self.inner.routes
- }
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
- pub fn poll(&mut self, sockets: &mut SocketSet, timestamp: Instant) -> Result<bool> {
- let mut readiness_may_have_changed = false;
- loop {
- let processed_any = self.socket_ingress(sockets, timestamp);
- let emitted_any = self.socket_egress(sockets, timestamp)?;
- #[cfg(feature = "proto-igmp")]
- self.igmp_egress(timestamp)?;
- if processed_any || emitted_any {
- readiness_may_have_changed = true;
- } else {
- break
- }
- }
- Ok(readiness_may_have_changed)
- }
-
-
-
-
-
-
-
-
- pub fn poll_at(&self, sockets: &SocketSet, timestamp: Instant) -> Option<Instant> {
- sockets.iter().filter_map(|socket| {
- let socket_poll_at = socket.poll_at();
- match socket.meta().poll_at(socket_poll_at, |ip_addr|
- self.inner.has_neighbor(&ip_addr, timestamp)) {
- PollAt::Ingress => None,
- PollAt::Time(instant) => Some(instant),
- PollAt::Now => Some(Instant::from_millis(0)),
- }
- }).min()
- }
-
-
-
-
-
-
-
-
- pub fn poll_delay(&self, sockets: &SocketSet, timestamp: Instant) -> Option<Duration> {
- match self.poll_at(sockets, timestamp) {
- Some(poll_at) if timestamp < poll_at => {
- Some(poll_at - timestamp)
- }
- Some(_) => {
- Some(Duration::from_millis(0))
- }
- _ => None
- }
- }
- fn socket_ingress(&mut self, sockets: &mut SocketSet, timestamp: Instant) -> bool {
- let mut processed_any = false;
- let &mut Self { ref mut device, ref mut inner } = self;
- while let Some((rx_token, tx_token)) = device.receive() {
- if let Err(err) = rx_token.consume(timestamp, |frame| {
- match inner.device_capabilities.medium {
- #[cfg(feature = "medium-ethernet")]
- Medium::Ethernet => {
- match inner.process_ethernet(sockets, timestamp, &frame) {
- Ok(response) => {
- processed_any = true;
- if let Some(packet) = response {
- if let Err(err) = inner.dispatch(tx_token, timestamp, packet) {
- net_debug!("Failed to send response: {}", err);
- }
- }
- }
- Err(err) => {
- net_debug!("cannot process ingress packet: {}", err);
- #[cfg(not(feature = "defmt"))]
- net_debug!("packet dump follows:\n{}",
- PrettyPrinter::<EthernetFrame<&[u8]>>::new("", &frame));
- }
- }
- }
- #[cfg(feature = "medium-ip")]
- Medium::Ip => {
- match inner.process_ip(sockets, timestamp, &frame) {
- Ok(response) => {
- processed_any = true;
- if let Some(packet) = response {
- if let Err(err) = inner.dispatch_ip(tx_token, timestamp, packet) {
- net_debug!("Failed to send response: {}", err);
- }
- }
- }
- Err(err) => net_debug!("cannot process ingress packet: {}", err),
- }
- }
- }
- Ok(())
- }) {
- net_debug!("Failed to consume RX token: {}", err);
- }
- }
- processed_any
- }
- fn socket_egress(&mut self, sockets: &mut SocketSet, timestamp: Instant) -> Result<bool> {
- let _caps = self.device.capabilities();
- let mut emitted_any = false;
- for mut socket in sockets.iter_mut() {
- if !socket.meta_mut().egress_permitted(timestamp, |ip_addr|
- self.inner.has_neighbor(&ip_addr, timestamp)) {
- continue
- }
- let mut neighbor_addr = None;
- let mut device_result = Ok(());
- let &mut Self { ref mut device, ref mut inner } = self;
- macro_rules! respond {
- ($response:expr) => ({
- let response = $response;
- neighbor_addr = Some(response.ip_repr().dst_addr());
- let tx_token = device.transmit().ok_or(Error::Exhausted)?;
- device_result = inner.dispatch_ip(tx_token, timestamp, response);
- device_result
- })
- }
- let _ip_mtu = match _caps.medium {
- #[cfg(feature = "medium-ethernet")]
- Medium::Ethernet => _caps.max_transmission_unit - EthernetFrame::<&[u8]>::header_len(),
- #[cfg(feature = "medium-ip")]
- Medium::Ip => _caps.max_transmission_unit,
- };
- let socket_result =
- match *socket {
- #[cfg(feature = "socket-raw")]
- Socket::Raw(ref mut socket) =>
- socket.dispatch(&_caps.checksum, |response|
- respond!(IpPacket::Raw(response))),
- #[cfg(all(feature = "socket-icmp", any(feature = "proto-ipv4", feature = "proto-ipv6")))]
- Socket::Icmp(ref mut socket) =>
- socket.dispatch(|response| {
- match response {
- #[cfg(feature = "proto-ipv4")]
- (IpRepr::Ipv4(ipv4_repr), IcmpRepr::Ipv4(icmpv4_repr)) =>
- respond!(IpPacket::Icmpv4((ipv4_repr, icmpv4_repr))),
- #[cfg(feature = "proto-ipv6")]
- (IpRepr::Ipv6(ipv6_repr), IcmpRepr::Ipv6(icmpv6_repr)) =>
- respond!(IpPacket::Icmpv6((ipv6_repr, icmpv6_repr))),
- _ => Err(Error::Unaddressable)
- }
- }),
- #[cfg(feature = "socket-udp")]
- Socket::Udp(ref mut socket) =>
- socket.dispatch(|response|
- respond!(IpPacket::Udp(response))),
- #[cfg(feature = "socket-tcp")]
- Socket::Tcp(ref mut socket) => {
- socket.dispatch(timestamp, _ip_mtu, |response|
- respond!(IpPacket::Tcp(response)))
- }
- #[cfg(feature = "socket-dhcpv4")]
- Socket::Dhcpv4(ref mut socket) =>
-
- socket.dispatch(timestamp, inner.ethernet_addr.unwrap(), _ip_mtu, |response|
- respond!(IpPacket::Dhcpv4(response))),
- };
- match (device_result, socket_result) {
- (Err(Error::Exhausted), _) => break,
- (Ok(()), Err(Error::Exhausted)) => (),
- (Err(Error::Unaddressable), _) => {
-
-
-
-
- socket.meta_mut().neighbor_missing(timestamp,
- neighbor_addr.expect("non-IP response packet"));
- break
- }
- (Err(err), _) | (_, Err(err)) => {
- net_debug!("{}: cannot dispatch egress packet: {}",
- socket.meta().handle, err);
- return Err(err)
- }
- (Ok(()), Ok(())) => emitted_any = true
- }
- }
- Ok(emitted_any)
- }
-
-
- #[cfg(feature = "proto-igmp")]
- fn igmp_egress(&mut self, timestamp: Instant) -> Result<bool> {
- match self.inner.igmp_report_state {
- IgmpReportState::ToSpecificQuery { version, timeout, group }
- if timestamp >= timeout => {
- if let Some(pkt) = self.inner.igmp_report_packet(version, group) {
-
- let tx_token = self.device.transmit().ok_or(Error::Exhausted)?;
- self.inner.dispatch_ip(tx_token, timestamp, pkt)?;
- }
- self.inner.igmp_report_state = IgmpReportState::Inactive;
- Ok(true)
- }
- IgmpReportState::ToGeneralQuery { version, timeout, interval, next_index }
- if timestamp >= timeout => {
- let addr = self.inner.ipv4_multicast_groups
- .iter()
- .nth(next_index)
- .map(|(addr, ())| *addr);
- match addr {
- Some(addr) => {
- if let Some(pkt) = self.inner.igmp_report_packet(version, addr) {
-
- let tx_token = self.device.transmit().ok_or(Error::Exhausted)?;
- self.inner.dispatch_ip(tx_token, timestamp, pkt)?;
- }
- let next_timeout = (timeout + interval).max(timestamp);
- self.inner.igmp_report_state = IgmpReportState::ToGeneralQuery {
- version, timeout: next_timeout, interval, next_index: next_index + 1
- };
- Ok(true)
- }
- None => {
- self.inner.igmp_report_state = IgmpReportState::Inactive;
- Ok(false)
- }
- }
- }
- _ => Ok(false)
- }
- }
- }
- impl<'a> InterfaceInner<'a> {
- #[cfg(feature = "medium-ethernet")]
- fn check_ethernet_addr(addr: &EthernetAddress) {
- if addr.is_multicast() {
- panic!("Ethernet address {} is not unicast", addr)
- }
- }
- fn check_ip_addrs(addrs: &[IpCidr]) {
- for cidr in addrs {
- if !cidr.address().is_unicast() && !cidr.address().is_unspecified() {
- panic!("IP address {} is not unicast", cidr.address())
- }
- }
- }
-
-
-
-
-
- #[cfg(feature = "proto-ipv6")]
- pub fn has_solicited_node(&self, addr: Ipv6Address) -> bool {
- self.ip_addrs.iter().any(|cidr| {
- match *cidr {
- IpCidr::Ipv6(cidr) if cidr.address() != Ipv6Address::LOOPBACK=> {
-
-
- addr.as_bytes()[14..] == cidr.address().as_bytes()[14..]
- }
- _ => false,
- }
- })
- }
-
- fn has_ip_addr<T: Into<IpAddress>>(&self, addr: T) -> bool {
- let addr = addr.into();
- self.ip_addrs.iter().any(|probe| probe.address() == addr)
- }
-
- #[cfg(feature = "proto-ipv4")]
- pub fn ipv4_address(&self) -> Option<Ipv4Address> {
- self.ip_addrs.iter()
- .filter_map(
- |addr| match *addr {
- IpCidr::Ipv4(cidr) => Some(cidr.address()),
- #[cfg(feature = "proto-ipv6")]
- IpCidr::Ipv6(_) => None
- })
- .next()
- }
-
-
-
-
- pub fn has_multicast_group<T: Into<IpAddress>>(&self, addr: T) -> bool {
- match addr.into() {
- #[cfg(feature = "proto-igmp")]
- IpAddress::Ipv4(key) =>
- key == Ipv4Address::MULTICAST_ALL_SYSTEMS ||
- self.ipv4_multicast_groups.get(&key).is_some(),
- _ =>
- false,
- }
- }
- #[cfg(feature = "medium-ethernet")]
- fn process_ethernet<'frame, T: AsRef<[u8]>>
- (&mut self, sockets: &mut SocketSet, timestamp: Instant, frame: &'frame T) ->
- Result<Option<EthernetPacket<'frame>>>
- {
- let eth_frame = EthernetFrame::new_checked(frame)?;
-
- if !eth_frame.dst_addr().is_broadcast() &&
- !eth_frame.dst_addr().is_multicast() &&
- eth_frame.dst_addr() != self.ethernet_addr.unwrap()
- {
- return Ok(None)
- }
- match eth_frame.ethertype() {
- #[cfg(feature = "proto-ipv4")]
- EthernetProtocol::Arp =>
- self.process_arp(timestamp, ð_frame),
- #[cfg(feature = "proto-ipv4")]
- EthernetProtocol::Ipv4 => {
- let ipv4_packet = Ipv4Packet::new_checked(eth_frame.payload())?;
- if eth_frame.src_addr().is_unicast() && ipv4_packet.src_addr().is_unicast() {
-
- let ip_addr = IpAddress::Ipv4(ipv4_packet.src_addr());
- if self.in_same_network(&ip_addr) {
- self.neighbor_cache.as_mut().unwrap().fill(ip_addr, eth_frame.src_addr(), timestamp);
- }
- }
- self.process_ipv4(sockets, timestamp, &ipv4_packet).map(|o| o.map(EthernetPacket::Ip))
- }
- #[cfg(feature = "proto-ipv6")]
- EthernetProtocol::Ipv6 => {
- let ipv6_packet = Ipv6Packet::new_checked(eth_frame.payload())?;
- if eth_frame.src_addr().is_unicast() && ipv6_packet.src_addr().is_unicast() {
-
- let ip_addr = IpAddress::Ipv6(ipv6_packet.src_addr());
- if self.in_same_network(&ip_addr) &&
- self.neighbor_cache.as_mut().unwrap().lookup(&ip_addr, timestamp).found() {
- self.neighbor_cache.as_mut().unwrap().fill(ip_addr, eth_frame.src_addr(), timestamp);
- }
- }
- self.process_ipv6(sockets, timestamp, &ipv6_packet).map(|o| o.map(EthernetPacket::Ip))
- }
-
- _ => Err(Error::Unrecognized),
- }
- }
- #[cfg(feature = "medium-ip")]
- fn process_ip<'frame, T: AsRef<[u8]>>
- (&mut self, sockets: &mut SocketSet, timestamp: Instant, ip_payload: &'frame T) ->
- Result<Option<IpPacket<'frame>>>
- {
- match IpVersion::of_packet(ip_payload.as_ref()) {
- #[cfg(feature = "proto-ipv4")]
- Ok(IpVersion::Ipv4) => {
- let ipv4_packet = Ipv4Packet::new_checked(ip_payload)?;
- self.process_ipv4(sockets, timestamp, &ipv4_packet)
- }
- #[cfg(feature = "proto-ipv6")]
- Ok(IpVersion::Ipv6) => {
- let ipv6_packet = Ipv6Packet::new_checked(ip_payload)?;
- self.process_ipv6(sockets, timestamp, &ipv6_packet)
- }
-
- _ => Err(Error::Unrecognized),
- }
- }
- #[cfg(all(feature = "medium-ethernet", feature = "proto-ipv4"))]
- fn process_arp<'frame, T: AsRef<[u8]>>
- (&mut self, timestamp: Instant, eth_frame: &EthernetFrame<&'frame T>) ->
- Result<Option<EthernetPacket<'frame>>>
- {
- let arp_packet = ArpPacket::new_checked(eth_frame.payload())?;
- let arp_repr = ArpRepr::parse(&arp_packet)?;
- match arp_repr {
-
-
-
- ArpRepr::EthernetIpv4 {
- operation, source_hardware_addr, source_protocol_addr, target_protocol_addr, ..
- } => {
- if source_protocol_addr.is_unicast() && source_hardware_addr.is_unicast() {
- self.neighbor_cache.as_mut().unwrap().fill(source_protocol_addr.into(),
- source_hardware_addr,
- timestamp);
- } else {
-
- net_debug!("non-unicast source address");
- return Err(Error::Malformed)
- }
- if operation == ArpOperation::Request && self.has_ip_addr(target_protocol_addr) {
- Ok(Some(EthernetPacket::Arp(ArpRepr::EthernetIpv4 {
- operation: ArpOperation::Reply,
- source_hardware_addr: self.ethernet_addr.unwrap(),
- source_protocol_addr: target_protocol_addr,
- target_hardware_addr: source_hardware_addr,
- target_protocol_addr: source_protocol_addr
- })))
- } else {
- Ok(None)
- }
- }
- }
- }
- #[cfg(all(any(feature = "proto-ipv4", feature = "proto-ipv6"), feature = "socket-raw"))]
- fn raw_socket_filter<'frame>(&mut self, sockets: &mut SocketSet, ip_repr: &IpRepr,
- ip_payload: &'frame [u8]) -> bool {
- let checksum_caps = self.device_capabilities.checksum.clone();
- let mut handled_by_raw_socket = false;
-
- for mut raw_socket in sockets.iter_mut().filter_map(RawSocket::downcast) {
- if !raw_socket.accepts(&ip_repr) { continue }
- match raw_socket.process(&ip_repr, ip_payload, &checksum_caps) {
-
- Ok(()) => handled_by_raw_socket = true,
-
- Err(Error::Exhausted) | Err(Error::Truncated) => (),
-
- Err(_) => unreachable!(),
- }
- }
- handled_by_raw_socket
- }
- #[cfg(feature = "proto-ipv6")]
- fn process_ipv6<'frame, T: AsRef<[u8]> + ?Sized>
- (&mut self, sockets: &mut SocketSet, timestamp: Instant,
- ipv6_packet: &Ipv6Packet<&'frame T>) ->
- Result<Option<IpPacket<'frame>>> {
- let ipv6_repr = Ipv6Repr::parse(&ipv6_packet)?;
- if !ipv6_repr.src_addr.is_unicast() {
-
- net_debug!("non-unicast source address");
- return Err(Error::Malformed)
- }
- let ip_payload = ipv6_packet.payload();
- #[cfg(feature = "socket-raw")]
- let handled_by_raw_socket = self.raw_socket_filter(sockets, &ipv6_repr.into(), ip_payload);
- #[cfg(not(feature = "socket-raw"))]
- let handled_by_raw_socket = false;
- self.process_nxt_hdr(sockets, timestamp, ipv6_repr, ipv6_repr.next_header,
- handled_by_raw_socket, ip_payload)
- }
-
-
- #[cfg(feature = "proto-ipv6")]
- fn process_nxt_hdr<'frame>
- (&mut self, sockets: &mut SocketSet, timestamp: Instant, ipv6_repr: Ipv6Repr,
- nxt_hdr: IpProtocol, handled_by_raw_socket: bool, ip_payload: &'frame [u8])
- -> Result<Option<IpPacket<'frame>>>
- {
- match nxt_hdr {
- IpProtocol::Icmpv6 =>
- self.process_icmpv6(sockets, timestamp, ipv6_repr.into(), ip_payload),
- #[cfg(feature = "socket-udp")]
- IpProtocol::Udp =>
- self.process_udp(sockets, ipv6_repr.into(), handled_by_raw_socket, ip_payload),
- #[cfg(feature = "socket-tcp")]
- IpProtocol::Tcp =>
- self.process_tcp(sockets, timestamp, ipv6_repr.into(), ip_payload),
- IpProtocol::HopByHop =>
- self.process_hopbyhop(sockets, timestamp, ipv6_repr, handled_by_raw_socket, ip_payload),
- #[cfg(feature = "socket-raw")]
- _ if handled_by_raw_socket =>
- Ok(None),
- _ => {
-
- let payload_len = icmp_reply_payload_len(ip_payload.len(), IPV6_MIN_MTU,
- ipv6_repr.buffer_len());
- let icmp_reply_repr = Icmpv6Repr::ParamProblem {
- reason: Icmpv6ParamProblem::UnrecognizedNxtHdr,
-
- pointer: ipv6_repr.buffer_len() as u32,
- header: ipv6_repr,
- data: &ip_payload[0..payload_len]
- };
- Ok(self.icmpv6_reply(ipv6_repr, icmp_reply_repr))
- },
- }
- }
- #[cfg(feature = "proto-ipv4")]
- fn process_ipv4<'frame, T: AsRef<[u8]> + ?Sized>
- (&mut self, sockets: &mut SocketSet, timestamp: Instant,
- ipv4_packet: &Ipv4Packet<&'frame T>) ->
- Result<Option<IpPacket<'frame>>>
- {
- let checksum_caps = self.device_capabilities.checksum.clone();
- let ipv4_repr = Ipv4Repr::parse(&ipv4_packet, &checksum_caps)?;
- if !self.is_unicast_v4(ipv4_repr.src_addr) {
-
- net_debug!("non-unicast source address");
- return Err(Error::Malformed)
- }
- let ip_repr = IpRepr::Ipv4(ipv4_repr);
- let ip_payload = ipv4_packet.payload();
- #[cfg(feature = "socket-raw")]
- let handled_by_raw_socket = self.raw_socket_filter(sockets, &ip_repr, ip_payload);
- #[cfg(not(feature = "socket-raw"))]
- let handled_by_raw_socket = false;
- #[cfg(feature = "socket-dhcpv4")]
- {
- if ipv4_repr.protocol == IpProtocol::Udp && self.ethernet_addr.is_some() {
-
-
- let udp_packet = UdpPacket::new_checked(ip_payload)?;
- if udp_packet.src_port() == DHCP_SERVER_PORT && udp_packet.dst_port() == DHCP_CLIENT_PORT {
- if let Some(mut dhcp_socket) = sockets.iter_mut().filter_map(Dhcpv4Socket::downcast).next() {
- let (src_addr, dst_addr) = (ip_repr.src_addr(), ip_repr.dst_addr());
- let checksum_caps = self.device_capabilities.checksum.clone();
- let udp_repr = UdpRepr::parse(&udp_packet, &src_addr, &dst_addr, &checksum_caps)?;
- let udp_payload = udp_packet.payload();
-
- let ethernet_addr = self.ethernet_addr.unwrap();
- match dhcp_socket.process(timestamp, ethernet_addr, &ipv4_repr, &udp_repr, udp_payload) {
-
- Ok(()) => return Ok(None),
-
- Err(e) => return Err(e)
- }
- }
- }
- }
- }
- if !self.has_ip_addr(ipv4_repr.dst_addr) &&
- !self.has_multicast_group(ipv4_repr.dst_addr) &&
- !self.is_broadcast_v4(ipv4_repr.dst_addr) {
-
-
- if !self.any_ip ||
- self.routes.lookup(&IpAddress::Ipv4(ipv4_repr.dst_addr), timestamp)
- .map_or(true, |router_addr| !self.has_ip_addr(router_addr)) {
- return Ok(None);
- }
- }
- match ipv4_repr.protocol {
- IpProtocol::Icmp =>
- self.process_icmpv4(sockets, ip_repr, ip_payload),
- #[cfg(feature = "proto-igmp")]
- IpProtocol::Igmp =>
- self.process_igmp(timestamp, ipv4_repr, ip_payload),
- #[cfg(feature = "socket-udp")]
- IpProtocol::Udp =>
- self.process_udp(sockets, ip_repr, handled_by_raw_socket, ip_payload),
- #[cfg(feature = "socket-tcp")]
- IpProtocol::Tcp =>
- self.process_tcp(sockets, timestamp, ip_repr, ip_payload),
- _ if handled_by_raw_socket =>
- Ok(None),
- _ => {
-
- let payload_len = icmp_reply_payload_len(ip_payload.len(), IPV4_MIN_MTU,
- ipv4_repr.buffer_len());
- let icmp_reply_repr = Icmpv4Repr::DstUnreachable {
- reason: Icmpv4DstUnreachable::ProtoUnreachable,
- header: ipv4_repr,
- data: &ip_payload[0..payload_len]
- };
- Ok(self.icmpv4_reply(ipv4_repr, icmp_reply_repr))
- }
- }
- }
-
-
- #[cfg(feature = "proto-ipv4")]
- fn is_subnet_broadcast(&self, address: Ipv4Address) -> bool {
- self.ip_addrs.iter()
- .filter_map(|own_cidr| match own_cidr {
- IpCidr::Ipv4(own_ip) => Some(own_ip.broadcast()?),
- #[cfg(feature = "proto-ipv6")]
- IpCidr::Ipv6(_) => None
- })
- .any(|broadcast_address| address == broadcast_address)
- }
-
-
- #[cfg(feature = "proto-ipv4")]
- fn is_broadcast_v4(&self, address: Ipv4Address) -> bool {
- address.is_broadcast() || self.is_subnet_broadcast(address)
- }
-
- #[cfg(feature = "proto-ipv4")]
- fn is_unicast_v4(&self, address: Ipv4Address) -> bool {
- address.is_unicast() && !self.is_subnet_broadcast(address)
- }
-
-
-
-
-
- #[cfg(feature = "proto-igmp")]
- fn process_igmp<'frame>(&mut self, timestamp: Instant, ipv4_repr: Ipv4Repr,
- ip_payload: &'frame [u8]) -> Result<Option<IpPacket<'frame>>> {
- let igmp_packet = IgmpPacket::new_checked(ip_payload)?;
- let igmp_repr = IgmpRepr::parse(&igmp_packet)?;
-
- match igmp_repr {
- IgmpRepr::MembershipQuery { group_addr, version, max_resp_time } => {
-
- if group_addr.is_unspecified() &&
- ipv4_repr.dst_addr == Ipv4Address::MULTICAST_ALL_SYSTEMS {
-
- if self.ipv4_multicast_groups.iter().next().is_some() {
- let interval = match version {
- IgmpVersion::Version1 =>
- Duration::from_millis(100),
- IgmpVersion::Version2 => {
-
-
-
- let intervals = self.ipv4_multicast_groups.len() as u32 + 1;
- max_resp_time / intervals
- }
- };
- self.igmp_report_state = IgmpReportState::ToGeneralQuery {
- version, timeout: timestamp + interval, interval, next_index: 0
- };
- }
- } else {
-
- if self.has_multicast_group(group_addr) && ipv4_repr.dst_addr == group_addr {
-
- let timeout = max_resp_time / 4;
- self.igmp_report_state = IgmpReportState::ToSpecificQuery {
- version, timeout: timestamp + timeout, group: group_addr
- };
- }
- }
- },
-
- IgmpRepr::MembershipReport { .. } => (),
-
- IgmpRepr::LeaveGroup{ .. } => (),
- }
- Ok(None)
- }
- #[cfg(feature = "proto-ipv6")]
- fn process_icmpv6<'frame>(&mut self, _sockets: &mut SocketSet, _timestamp: Instant,
- ip_repr: IpRepr, ip_payload: &'frame [u8]) -> Result<Option<IpPacket<'frame>>>
- {
- let icmp_packet = Icmpv6Packet::new_checked(ip_payload)?;
- let checksum_caps = self.device_capabilities.checksum.clone();
- let icmp_repr = Icmpv6Repr::parse(&ip_repr.src_addr(), &ip_repr.dst_addr(),
- &icmp_packet, &checksum_caps)?;
- #[cfg(feature = "socket-icmp")]
- let mut handled_by_icmp_socket = false;
- #[cfg(all(feature = "socket-icmp", feature = "proto-ipv6"))]
- for mut icmp_socket in _sockets.iter_mut().filter_map(IcmpSocket::downcast) {
- if !icmp_socket.accepts(&ip_repr, &icmp_repr.into(), &checksum_caps) { continue }
- match icmp_socket.process(&ip_repr, &icmp_repr.into(), &checksum_caps) {
-
- Ok(()) => handled_by_icmp_socket = true,
-
- Err(Error::Exhausted) => (),
-
- Err(_) => unreachable!(),
- }
- }
- match icmp_repr {
-
- Icmpv6Repr::EchoRequest { ident, seq_no, data } => {
- match ip_repr {
- IpRepr::Ipv6(ipv6_repr) => {
- let icmp_reply_repr = Icmpv6Repr::EchoReply { ident, seq_no, data };
- Ok(self.icmpv6_reply(ipv6_repr, icmp_reply_repr))
- },
- _ => Err(Error::Unrecognized),
- }
- }
-
- Icmpv6Repr::EchoReply { .. } => Ok(None),
-
- #[cfg(feature = "medium-ethernet")]
- Icmpv6Repr::Ndisc(repr) if ip_repr.hop_limit() == 0xff => match ip_repr {
- IpRepr::Ipv6(ipv6_repr) => self.process_ndisc(_timestamp, ipv6_repr, repr),
- _ => Ok(None)
- },
-
-
- #[cfg(feature = "socket-icmp")]
- _ if handled_by_icmp_socket => Ok(None),
-
- _ => Err(Error::Unrecognized),
- }
- }
- #[cfg(all(feature = "medium-ethernet", feature = "proto-ipv6"))]
- fn process_ndisc<'frame>(&mut self, timestamp: Instant, ip_repr: Ipv6Repr,
- repr: NdiscRepr<'frame>) -> Result<Option<IpPacket<'frame>>> {
- match repr {
- NdiscRepr::NeighborAdvert { lladdr, target_addr, flags } => {
- let ip_addr = ip_repr.src_addr.into();
- match lladdr {
- Some(lladdr) if lladdr.is_unicast() && target_addr.is_unicast() => {
- if flags.contains(NdiscNeighborFlags::OVERRIDE) ||
- !self.neighbor_cache.as_mut().unwrap().lookup(&ip_addr, timestamp).found() {
- self.neighbor_cache.as_mut().unwrap().fill(ip_addr, lladdr, timestamp)
- }
- },
- _ => (),
- }
- Ok(None)
- }
- NdiscRepr::NeighborSolicit { target_addr, lladdr, .. } => {
- match lladdr {
- Some(lladdr) if lladdr.is_unicast() && target_addr.is_unicast() => {
- self.neighbor_cache.as_mut().unwrap().fill(ip_repr.src_addr.into(), lladdr, timestamp)
- },
- _ => (),
- }
- if self.has_solicited_node(ip_repr.dst_addr) && self.has_ip_addr(target_addr) {
- let advert = Icmpv6Repr::Ndisc(NdiscRepr::NeighborAdvert {
- flags: NdiscNeighborFlags::SOLICITED,
- target_addr: target_addr,
- lladdr: Some(self.ethernet_addr.unwrap())
- });
- let ip_repr = Ipv6Repr {
- src_addr: target_addr,
- dst_addr: ip_repr.src_addr,
- next_header: IpProtocol::Icmpv6,
- hop_limit: 0xff,
- payload_len: advert.buffer_len()
- };
- Ok(Some(IpPacket::Icmpv6((ip_repr, advert))))
- } else {
- Ok(None)
- }
- }
- _ => Ok(None)
- }
- }
- #[cfg(feature = "proto-ipv6")]
- fn process_hopbyhop<'frame>(&mut self, sockets: &mut SocketSet, timestamp: Instant,
- ipv6_repr: Ipv6Repr, handled_by_raw_socket: bool,
- ip_payload: &'frame [u8]) -> Result<Option<IpPacket<'frame>>>
- {
- let hbh_pkt = Ipv6HopByHopHeader::new_checked(ip_payload)?;
- let hbh_repr = Ipv6HopByHopRepr::parse(&hbh_pkt)?;
- for result in hbh_repr.options() {
- let opt_repr = result?;
- match opt_repr {
- Ipv6OptionRepr::Pad1 | Ipv6OptionRepr::PadN(_) => (),
- Ipv6OptionRepr::Unknown { type_, .. } => {
- match Ipv6OptionFailureType::from(type_) {
- Ipv6OptionFailureType::Skip => (),
- Ipv6OptionFailureType::Discard => {
- return Ok(None);
- },
- _ => {
-
-
- return Err(Error::Unrecognized);
- }
- }
- }
- }
- }
- self.process_nxt_hdr(sockets, timestamp, ipv6_repr, hbh_repr.next_header,
- handled_by_raw_socket, &ip_payload[hbh_repr.buffer_len()..])
- }
- #[cfg(feature = "proto-ipv4")]
- fn process_icmpv4<'frame>(&self, _sockets: &mut SocketSet, ip_repr: IpRepr,
- ip_payload: &'frame [u8]) -> Result<Option<IpPacket<'frame>>>
- {
- let icmp_packet = Icmpv4Packet::new_checked(ip_payload)?;
- let checksum_caps = self.device_capabilities.checksum.clone();
- let icmp_repr = Icmpv4Repr::parse(&icmp_packet, &checksum_caps)?;
- #[cfg(feature = "socket-icmp")]
- let mut handled_by_icmp_socket = false;
- #[cfg(all(feature = "socket-icmp", feature = "proto-ipv4"))]
- for mut icmp_socket in _sockets.iter_mut().filter_map(IcmpSocket::downcast) {
- if !icmp_socket.accepts(&ip_repr, &icmp_repr.into(), &checksum_caps) { continue }
- match icmp_socket.process(&ip_repr, &icmp_repr.into(), &checksum_caps) {
-
- Ok(()) => handled_by_icmp_socket = true,
-
- Err(Error::Exhausted) => (),
-
- Err(_) => unreachable!(),
- }
- }
- match icmp_repr {
-
- #[cfg(feature = "proto-ipv4")]
- Icmpv4Repr::EchoRequest { ident, seq_no, data } => {
- let icmp_reply_repr = Icmpv4Repr::EchoReply { ident, seq_no, data };
- match ip_repr {
- IpRepr::Ipv4(ipv4_repr) => Ok(self.icmpv4_reply(ipv4_repr, icmp_reply_repr)),
- _ => Err(Error::Unrecognized),
- }
- },
-
- Icmpv4Repr::EchoReply { .. } => Ok(None),
-
-
- #[cfg(feature = "socket-icmp")]
- _ if handled_by_icmp_socket => Ok(None),
-
- _ => Err(Error::Unrecognized),
- }
- }
- #[cfg(feature = "proto-ipv4")]
- fn icmpv4_reply<'frame, 'icmp: 'frame>
- (&self, ipv4_repr: Ipv4Repr, icmp_repr: Icmpv4Repr<'icmp>) ->
- Option<IpPacket<'frame>>
- {
- if !self.is_unicast_v4(ipv4_repr.src_addr) {
-
- None
- } else if self.is_unicast_v4(ipv4_repr.dst_addr) {
-
- let ipv4_reply_repr = Ipv4Repr {
- src_addr: ipv4_repr.dst_addr,
- dst_addr: ipv4_repr.src_addr,
- protocol: IpProtocol::Icmp,
- payload_len: icmp_repr.buffer_len(),
- hop_limit: 64
- };
- Some(IpPacket::Icmpv4((ipv4_reply_repr, icmp_repr)))
- } else if self.is_broadcast_v4(ipv4_repr.dst_addr) {
-
- match icmp_repr {
- Icmpv4Repr::EchoReply {..} => match self.ipv4_address() {
- Some(src_addr) => {
- let ipv4_reply_repr = Ipv4Repr {
- src_addr: src_addr,
- dst_addr: ipv4_repr.src_addr,
- protocol: IpProtocol::Icmp,
- payload_len: icmp_repr.buffer_len(),
- hop_limit: 64
- };
- Some(IpPacket::Icmpv4((ipv4_reply_repr, icmp_repr)))
- },
- None => None,
- },
- _ => None,
- }
- } else {
- None
- }
- }
- #[cfg(feature = "proto-ipv6")]
- fn icmpv6_reply<'frame, 'icmp: 'frame>
- (&self, ipv6_repr: Ipv6Repr, icmp_repr: Icmpv6Repr<'icmp>) ->
- Option<IpPacket<'frame>>
- {
- if ipv6_repr.dst_addr.is_unicast() {
- let ipv6_reply_repr = Ipv6Repr {
- src_addr: ipv6_repr.dst_addr,
- dst_addr: ipv6_repr.src_addr,
- next_header: IpProtocol::Icmpv6,
- payload_len: icmp_repr.buffer_len(),
- hop_limit: 64
- };
- Some(IpPacket::Icmpv6((ipv6_reply_repr, icmp_repr)))
- } else {
-
- None
- }
- }
- #[cfg(feature = "socket-udp")]
- fn process_udp<'frame>(&self, sockets: &mut SocketSet,
- ip_repr: IpRepr, handled_by_raw_socket: bool, ip_payload: &'frame [u8]) ->
- Result<Option<IpPacket<'frame>>>
- {
- let (src_addr, dst_addr) = (ip_repr.src_addr(), ip_repr.dst_addr());
- let udp_packet = UdpPacket::new_checked(ip_payload)?;
- let checksum_caps = self.device_capabilities.checksum.clone();
- let udp_repr = UdpRepr::parse(&udp_packet, &src_addr, &dst_addr, &checksum_caps)?;
- let udp_payload = udp_packet.payload();
- for mut udp_socket in sockets.iter_mut().filter_map(UdpSocket::downcast) {
- if !udp_socket.accepts(&ip_repr, &udp_repr) { continue }
- match udp_socket.process(&ip_repr, &udp_repr, udp_payload) {
-
- Ok(()) => return Ok(None),
-
- Err(e) => return Err(e)
- }
- }
-
- match ip_repr {
- #[cfg(feature = "proto-ipv4")]
- IpRepr::Ipv4(_) if handled_by_raw_socket =>
- Ok(None),
- #[cfg(feature = "proto-ipv6")]
- IpRepr::Ipv6(_) if handled_by_raw_socket =>
- Ok(None),
- #[cfg(feature = "proto-ipv4")]
- IpRepr::Ipv4(ipv4_repr) => {
- let payload_len = icmp_reply_payload_len(ip_payload.len(), IPV4_MIN_MTU,
- ipv4_repr.buffer_len());
- let icmpv4_reply_repr = Icmpv4Repr::DstUnreachable {
- reason: Icmpv4DstUnreachable::PortUnreachable,
- header: ipv4_repr,
- data: &ip_payload[0..payload_len]
- };
- Ok(self.icmpv4_reply(ipv4_repr, icmpv4_reply_repr))
- },
- #[cfg(feature = "proto-ipv6")]
- IpRepr::Ipv6(ipv6_repr) => {
- let payload_len = icmp_reply_payload_len(ip_payload.len(), IPV6_MIN_MTU,
- ipv6_repr.buffer_len());
- let icmpv6_reply_repr = Icmpv6Repr::DstUnreachable {
- reason: Icmpv6DstUnreachable::PortUnreachable,
- header: ipv6_repr,
- data: &ip_payload[0..payload_len]
- };
- Ok(self.icmpv6_reply(ipv6_repr, icmpv6_reply_repr))
- },
- IpRepr::Unspecified { .. } => Err(Error::Unaddressable),
- }
- }
- #[cfg(feature = "socket-tcp")]
- fn process_tcp<'frame>(&self, sockets: &mut SocketSet, timestamp: Instant,
- ip_repr: IpRepr, ip_payload: &'frame [u8]) ->
- Result<Option<IpPacket<'frame>>>
- {
- let (src_addr, dst_addr) = (ip_repr.src_addr(), ip_repr.dst_addr());
- let tcp_packet = TcpPacket::new_checked(ip_payload)?;
- let checksum_caps = self.device_capabilities.checksum.clone();
- let tcp_repr = TcpRepr::parse(&tcp_packet, &src_addr, &dst_addr, &checksum_caps)?;
- for mut tcp_socket in sockets.iter_mut().filter_map(TcpSocket::downcast) {
- if !tcp_socket.accepts(&ip_repr, &tcp_repr) { continue }
- match tcp_socket.process(timestamp, &ip_repr, &tcp_repr) {
-
- Ok(reply) => return Ok(reply.map(IpPacket::Tcp)),
-
-
- Err(e) => return Err(e)
- }
- }
- if tcp_repr.control == TcpControl::Rst {
-
- Ok(None)
- } else {
-
- Ok(Some(IpPacket::Tcp(TcpSocket::rst_reply(&ip_repr, &tcp_repr))))
- }
- }
- #[cfg(feature = "medium-ethernet")]
- fn dispatch<Tx>(&mut self, tx_token: Tx, timestamp: Instant,
- packet: EthernetPacket) -> Result<()>
- where Tx: TxToken
- {
- match packet {
- #[cfg(feature = "proto-ipv4")]
- EthernetPacket::Arp(arp_repr) => {
- let dst_hardware_addr =
- match arp_repr {
- ArpRepr::EthernetIpv4 { target_hardware_addr, .. } => target_hardware_addr,
- };
- self.dispatch_ethernet(tx_token, timestamp, arp_repr.buffer_len(), |mut frame| {
- frame.set_dst_addr(dst_hardware_addr);
- frame.set_ethertype(EthernetProtocol::Arp);
- let mut packet = ArpPacket::new_unchecked(frame.payload_mut());
- arp_repr.emit(&mut packet);
- })
- },
- EthernetPacket::Ip(packet) => {
- self.dispatch_ip(tx_token, timestamp, packet)
- },
- }
- }
- #[cfg(feature = "medium-ethernet")]
- fn dispatch_ethernet<Tx, F>(&mut self, tx_token: Tx, timestamp: Instant,
- buffer_len: usize, f: F) -> Result<()>
- where Tx: TxToken, F: FnOnce(EthernetFrame<&mut [u8]>)
- {
- let tx_len = EthernetFrame::<&[u8]>::buffer_len(buffer_len);
- tx_token.consume(timestamp, tx_len, |tx_buffer| {
- debug_assert!(tx_buffer.as_ref().len() == tx_len);
- let mut frame = EthernetFrame::new_unchecked(tx_buffer);
- frame.set_src_addr(self.ethernet_addr.unwrap());
- f(frame);
- Ok(())
- })
- }
- fn in_same_network(&self, addr: &IpAddress) -> bool {
- self.ip_addrs
- .iter()
- .any(|cidr| cidr.contains_addr(addr))
- }
- fn route(&self, addr: &IpAddress, timestamp: Instant) -> Result<IpAddress> {
-
- if self.in_same_network(addr) || addr.is_broadcast() {
- return Ok(*addr)
- }
-
- match self.routes.lookup(addr, timestamp) {
- Some(router_addr) => Ok(router_addr),
- None => Err(Error::Unaddressable),
- }
- }
- fn has_neighbor(&self, addr: &IpAddress, timestamp: Instant) -> bool {
- match self.route(addr, timestamp) {
- Ok(_routed_addr) => {
- match self.device_capabilities.medium {
- #[cfg(feature = "medium-ethernet")]
- Medium::Ethernet => self.neighbor_cache.as_ref().unwrap()
- .lookup(&_routed_addr, timestamp)
- .found(),
- #[cfg(feature = "medium-ip")]
- Medium::Ip => true,
- }
- }
- Err(_) => false
- }
- }
- #[cfg(feature = "medium-ethernet")]
- fn lookup_hardware_addr<Tx>(&mut self, tx_token: Tx, timestamp: Instant,
- src_addr: &IpAddress, dst_addr: &IpAddress) ->
- Result<(EthernetAddress, Tx)>
- where Tx: TxToken
- {
- if dst_addr.is_multicast() {
- let b = dst_addr.as_bytes();
- let hardware_addr =
- match *dst_addr {
- IpAddress::Unspecified =>
- None,
- #[cfg(feature = "proto-ipv4")]
- IpAddress::Ipv4(_addr) =>
- Some(EthernetAddress::from_bytes(&[
- 0x01, 0x00,
- 0x5e, b[1] & 0x7F,
- b[2], b[3],
- ])),
- #[cfg(feature = "proto-ipv6")]
- IpAddress::Ipv6(_addr) =>
- Some(EthernetAddress::from_bytes(&[
- 0x33, 0x33,
- b[12], b[13],
- b[14], b[15],
- ])),
- };
- if let Some(hardware_addr) = hardware_addr {
- return Ok((hardware_addr, tx_token))
- }
- }
- let dst_addr = self.route(dst_addr, timestamp)?;
- match self.neighbor_cache.as_mut().unwrap().lookup(&dst_addr, timestamp) {
- NeighborAnswer::Found(hardware_addr) =>
- return Ok((hardware_addr, tx_token)),
- NeighborAnswer::RateLimited =>
- return Err(Error::Unaddressable),
- NeighborAnswer::NotFound => (),
- }
- match (src_addr, dst_addr) {
- #[cfg(feature = "proto-ipv4")]
- (&IpAddress::Ipv4(src_addr), IpAddress::Ipv4(dst_addr)) => {
- net_debug!("address {} not in neighbor cache, sending ARP request",
- dst_addr);
- let arp_repr = ArpRepr::EthernetIpv4 {
- operation: ArpOperation::Request,
- source_hardware_addr: self.ethernet_addr.unwrap(),
- source_protocol_addr: src_addr,
- target_hardware_addr: EthernetAddress::BROADCAST,
- target_protocol_addr: dst_addr,
- };
- self.dispatch_ethernet(tx_token, timestamp, arp_repr.buffer_len(), |mut frame| {
- frame.set_dst_addr(EthernetAddress::BROADCAST);
- frame.set_ethertype(EthernetProtocol::Arp);
- arp_repr.emit(&mut ArpPacket::new_unchecked(frame.payload_mut()))
- })?;
- }
- #[cfg(feature = "proto-ipv6")]
- (&IpAddress::Ipv6(src_addr), IpAddress::Ipv6(dst_addr)) => {
- net_debug!("address {} not in neighbor cache, sending Neighbor Solicitation",
- dst_addr);
- let solicit = Icmpv6Repr::Ndisc(NdiscRepr::NeighborSolicit {
- target_addr: dst_addr,
- lladdr: Some(self.ethernet_addr.unwrap()),
- });
- let packet = IpPacket::Icmpv6((
- Ipv6Repr {
- src_addr: src_addr,
- dst_addr: dst_addr.solicited_node(),
- next_header: IpProtocol::Icmpv6,
- payload_len: solicit.buffer_len(),
- hop_limit: 0xff
- },
- solicit,
- ));
- self.dispatch_ip(tx_token, timestamp, packet)?;
- }
- _ => ()
- }
-
- self.neighbor_cache.as_mut().unwrap().limit_rate(timestamp);
- Err(Error::Unaddressable)
- }
- fn dispatch_ip<Tx: TxToken>(&mut self, tx_token: Tx, timestamp: Instant,
- packet: IpPacket) -> Result<()> {
- let ip_repr = packet.ip_repr().lower(&self.ip_addrs)?;
- let caps = self.device_capabilities.clone();
- match self.device_capabilities.medium {
- #[cfg(feature = "medium-ethernet")]
- Medium::Ethernet => {
- let (dst_hardware_addr, tx_token) =
- self.lookup_hardware_addr(tx_token, timestamp,
- &ip_repr.src_addr(), &ip_repr.dst_addr())?;
- self.dispatch_ethernet(tx_token, timestamp, ip_repr.total_len(), |mut frame| {
- frame.set_dst_addr(dst_hardware_addr);
- match ip_repr {
- #[cfg(feature = "proto-ipv4")]
- IpRepr::Ipv4(_) => frame.set_ethertype(EthernetProtocol::Ipv4),
- #[cfg(feature = "proto-ipv6")]
- IpRepr::Ipv6(_) => frame.set_ethertype(EthernetProtocol::Ipv6),
- _ => return
- }
- ip_repr.emit(frame.payload_mut(), &caps.checksum);
- let payload = &mut frame.payload_mut()[ip_repr.buffer_len()..];
- packet.emit_payload(ip_repr, payload, &caps);
- })
- }
- #[cfg(feature = "medium-ip")]
- Medium::Ip => {
- let tx_len = ip_repr.total_len();
- tx_token.consume(timestamp, tx_len, |mut tx_buffer| {
- debug_assert!(tx_buffer.as_ref().len() == tx_len);
- ip_repr.emit(&mut tx_buffer, &caps.checksum);
- let payload = &mut tx_buffer[ip_repr.buffer_len()..];
- packet.emit_payload(ip_repr, payload, &caps);
- Ok(())
- })
- }
- }
- }
- #[cfg(feature = "proto-igmp")]
- fn igmp_report_packet<'any>(&self, version: IgmpVersion, group_addr: Ipv4Address) -> Option<IpPacket<'any>> {
- let iface_addr = self.ipv4_address()?;
- let igmp_repr = IgmpRepr::MembershipReport {
- group_addr,
- version,
- };
- let pkt = IpPacket::Igmp((Ipv4Repr {
- src_addr: iface_addr,
-
- dst_addr: group_addr,
- protocol: IpProtocol::Igmp,
- payload_len: igmp_repr.buffer_len(),
- hop_limit: 1,
-
-
- }, igmp_repr));
- Some(pkt)
- }
- #[cfg(feature = "proto-igmp")]
- fn igmp_leave_packet<'any>(&self, group_addr: Ipv4Address) -> Option<IpPacket<'any>> {
- self.ipv4_address().map(|iface_addr| {
- let igmp_repr = IgmpRepr::LeaveGroup { group_addr };
- IpPacket::Igmp((Ipv4Repr {
- src_addr: iface_addr,
- dst_addr: Ipv4Address::MULTICAST_ALL_ROUTERS,
- protocol: IpProtocol::Igmp,
- payload_len: igmp_repr.buffer_len(),
- hop_limit: 1,
- }, igmp_repr))
- })
- }
- }
- #[cfg(test)]
- mod test {
- #[cfg(feature = "proto-igmp")]
- use std::vec::Vec;
- use std::collections::BTreeMap;
- use super::*;
- use crate::{Result, Error};
- #[cfg(feature = "medium-ethernet")]
- use crate::iface::NeighborCache;
- use crate::iface::Interface;
- #[cfg(feature = "proto-igmp")]
- use crate::time::Instant;
- use crate::socket::SocketSet;
- use crate::phy::{Loopback, ChecksumCapabilities};
- #[allow(unused)]
- fn fill_slice(s: &mut [u8], val: u8) {
- for x in s.iter_mut() {
- *x = val
- }
- }
- fn create_loopback<'a>() -> (Interface<'a, Loopback>, SocketSet<'a>) {
- #[cfg(feature = "medium-ethernet")]
- return create_loopback_ethernet();
- #[cfg(not(feature = "medium-ethernet"))]
- return create_loopback_ip();
- }
- #[cfg(all(feature = "medium-ip"))]
- #[allow(unused)]
- fn create_loopback_ip<'a>() -> (Interface<'a, Loopback>, SocketSet<'a>) {
-
- let device = Loopback::new(Medium::Ip);
- let ip_addrs = [
- #[cfg(feature = "proto-ipv4")]
- IpCidr::new(IpAddress::v4(127, 0, 0, 1), 8),
- #[cfg(feature = "proto-ipv6")]
- IpCidr::new(IpAddress::v6(0, 0, 0, 0, 0, 0, 0, 1), 128),
- #[cfg(feature = "proto-ipv6")]
- IpCidr::new(IpAddress::v6(0xfdbe, 0, 0, 0, 0, 0, 0, 1), 64),
- ];
- let iface_builder = InterfaceBuilder::new(device)
- .ip_addrs(ip_addrs);
- #[cfg(feature = "proto-igmp")]
- let iface_builder = iface_builder
- .ipv4_multicast_groups(BTreeMap::new());
- let iface = iface_builder
- .finalize();
- (iface, SocketSet::new(vec![]))
- }
- #[cfg(all(feature = "medium-ethernet"))]
- fn create_loopback_ethernet<'a>() -> (Interface<'a, Loopback>, SocketSet<'a>) {
-
- let device = Loopback::new(Medium::Ethernet);
- let ip_addrs = [
- #[cfg(feature = "proto-ipv4")]
- IpCidr::new(IpAddress::v4(127, 0, 0, 1), 8),
- #[cfg(feature = "proto-ipv6")]
- IpCidr::new(IpAddress::v6(0, 0, 0, 0, 0, 0, 0, 1), 128),
- #[cfg(feature = "proto-ipv6")]
- IpCidr::new(IpAddress::v6(0xfdbe, 0, 0, 0, 0, 0, 0, 1), 64),
- ];
- let iface_builder = InterfaceBuilder::new(device)
- .ethernet_addr(EthernetAddress::default())
- .neighbor_cache(NeighborCache::new(BTreeMap::new()))
- .ip_addrs(ip_addrs);
- #[cfg(feature = "proto-igmp")]
- let iface_builder = iface_builder
- .ipv4_multicast_groups(BTreeMap::new());
- let iface = iface_builder
- .finalize();
- (iface, SocketSet::new(vec![]))
- }
- #[cfg(feature = "proto-igmp")]
- fn recv_all(iface: &mut Interface<'_, Loopback>, timestamp: Instant) -> Vec<Vec<u8>> {
- let mut pkts = Vec::new();
- while let Some((rx, _tx)) = iface.device.receive() {
- rx.consume(timestamp, |pkt| {
- pkts.push(pkt.to_vec());
- Ok(())
- }).unwrap();
- }
- pkts
- }
- #[derive(Debug, PartialEq)]
- #[cfg_attr(feature = "defmt", derive(defmt::Format))]
- struct MockTxToken;
- impl TxToken for MockTxToken {
- fn consume<R, F>(self, _: Instant, _: usize, _: F) -> Result<R>
- where F: FnOnce(&mut [u8]) -> Result<R> {
- Err(Error::Unaddressable)
- }
- }
- #[test]
- #[should_panic(expected = "ethernet_addr required option was not set")]
- #[cfg(all(feature = "medium-ethernet"))]
- fn test_builder_initialization_panic() {
- InterfaceBuilder::new(Loopback::new(Medium::Ethernet)).finalize();
- }
- #[test]
- #[cfg(feature = "proto-ipv4")]
- fn test_no_icmp_no_unicast_ipv4() {
- let (mut iface, mut socket_set) = create_loopback();
-
-
-
-
-
- let repr = IpRepr::Ipv4(Ipv4Repr {
- src_addr: Ipv4Address([0x7f, 0x00, 0x00, 0x01]),
- dst_addr: Ipv4Address::BROADCAST,
- protocol: IpProtocol::Unknown(0x0c),
- payload_len: 0,
- hop_limit: 0x40
- });
- let mut bytes = vec![0u8; 54];
- repr.emit(&mut bytes, &ChecksumCapabilities::default());
- let frame = Ipv4Packet::new_unchecked(&bytes);
-
-
-
- assert_eq!(iface.inner.process_ipv4(&mut socket_set, Instant::from_millis(0), &frame),
- Ok(None));
- }
- #[test]
- #[cfg(feature = "proto-ipv6")]
- fn test_no_icmp_no_unicast_ipv6() {
- let (mut iface, mut socket_set) = create_loopback();
-
-
-
-
-
- let repr = IpRepr::Ipv6(Ipv6Repr {
- src_addr: Ipv6Address::new(0xfe80, 0, 0, 0, 0, 0, 0, 1),
- dst_addr: Ipv6Address::LINK_LOCAL_ALL_NODES,
- next_header: IpProtocol::Unknown(0x0c),
- payload_len: 0,
- hop_limit: 0x40
- });
- let mut bytes = vec![0u8; 54];
- repr.emit(&mut bytes, &ChecksumCapabilities::default());
- let frame = Ipv6Packet::new_unchecked(&bytes);
-
-
-
- assert_eq!(iface.inner.process_ipv6(&mut socket_set, Instant::from_millis(0), &frame),
- Ok(None));
- }
- #[test]
- #[cfg(feature = "proto-ipv4")]
- fn test_icmp_error_no_payload() {
- static NO_BYTES: [u8; 0] = [];
- let (mut iface, mut socket_set) = create_loopback();
-
- let repr = IpRepr::Ipv4(Ipv4Repr {
- src_addr: Ipv4Address([0x7f, 0x00, 0x00, 0x02]),
- dst_addr: Ipv4Address([0x7f, 0x00, 0x00, 0x01]),
- protocol: IpProtocol::Unknown(0x0c),
- payload_len: 0,
- hop_limit: 0x40
- });
- let mut bytes = vec![0u8; 34];
- repr.emit(&mut bytes, &ChecksumCapabilities::default());
- let frame = Ipv4Packet::new_unchecked(&bytes);
-
-
- let icmp_repr = Icmpv4Repr::DstUnreachable {
- reason: Icmpv4DstUnreachable::ProtoUnreachable,
- header: Ipv4Repr {
- src_addr: Ipv4Address([0x7f, 0x00, 0x00, 0x02]),
- dst_addr: Ipv4Address([0x7f, 0x00, 0x00, 0x01]),
- protocol: IpProtocol::Unknown(12),
- payload_len: 0,
- hop_limit: 64
- },
- data: &NO_BYTES
- };
- let expected_repr = IpPacket::Icmpv4((
- Ipv4Repr {
- src_addr: Ipv4Address([0x7f, 0x00, 0x00, 0x01]),
- dst_addr: Ipv4Address([0x7f, 0x00, 0x00, 0x02]),
- protocol: IpProtocol::Icmp,
- payload_len: icmp_repr.buffer_len(),
- hop_limit: 64
- },
- icmp_repr
- ));
-
-
- assert_eq!(iface.inner.process_ipv4(&mut socket_set, Instant::from_millis(0), &frame),
- Ok(Some(expected_repr)));
- }
- #[test]
- #[cfg(feature = "proto-ipv4")]
- fn test_local_subnet_broadcasts() {
- let (mut iface, _) = create_loopback();
- iface.update_ip_addrs(|addrs| {
- addrs.iter_mut().next().map(|addr| {
- *addr = IpCidr::Ipv4(Ipv4Cidr::new(Ipv4Address([192, 168, 1, 23]), 24));
- });
- });
- assert_eq!(iface.inner.is_subnet_broadcast(Ipv4Address([192, 168, 1, 255])), true);
- assert_eq!(iface.inner.is_subnet_broadcast(Ipv4Address([192, 168, 1, 254])), false);
- iface.update_ip_addrs(|addrs| {
- addrs.iter_mut().next().map(|addr| {
- *addr = IpCidr::Ipv4(Ipv4Cidr::new(Ipv4Address([192, 168, 23, 24]), 16));
- });
- });
- assert_eq!(iface.inner.is_subnet_broadcast(Ipv4Address([192, 168, 23, 255])), false);
- assert_eq!(iface.inner.is_subnet_broadcast(Ipv4Address([192, 168, 23, 254])), false);
- assert_eq!(iface.inner.is_subnet_broadcast(Ipv4Address([192, 168, 255, 254])), false);
- assert_eq!(iface.inner.is_subnet_broadcast(Ipv4Address([192, 168, 255, 255])), true);
- iface.update_ip_addrs(|addrs| {
- addrs.iter_mut().next().map(|addr| {
- *addr = IpCidr::Ipv4(Ipv4Cidr::new(Ipv4Address([192, 168, 23, 24]), 8));
- });
- });
- assert_eq!(iface.inner.is_subnet_broadcast(Ipv4Address([192, 23, 1, 255])), false);
- assert_eq!(iface.inner.is_subnet_broadcast(Ipv4Address([192, 23, 1, 254])), false);
- assert_eq!(iface.inner.is_subnet_broadcast(Ipv4Address([192, 255, 255, 254])), false);
- assert_eq!(iface.inner.is_subnet_broadcast(Ipv4Address([192, 255, 255, 255])), true);
- }
- #[test]
- #[cfg(all(feature = "socket-udp", feature = "proto-ipv4"))]
- fn test_icmp_error_port_unreachable() {
- static UDP_PAYLOAD: [u8; 12] = [
- 0x48, 0x65, 0x6c, 0x6c,
- 0x6f, 0x2c, 0x20, 0x57,
- 0x6f, 0x6c, 0x64, 0x21
- ];
- let (iface, mut socket_set) = create_loopback();
- let mut udp_bytes_unicast = vec![0u8; 20];
- let mut udp_bytes_broadcast = vec![0u8; 20];
- let mut packet_unicast = UdpPacket::new_unchecked(&mut udp_bytes_unicast);
- let mut packet_broadcast = UdpPacket::new_unchecked(&mut udp_bytes_broadcast);
- let udp_repr = UdpRepr {
- src_port: 67,
- dst_port: 68,
- };
- let ip_repr = IpRepr::Ipv4(Ipv4Repr {
- src_addr: Ipv4Address([0x7f, 0x00, 0x00, 0x02]),
- dst_addr: Ipv4Address([0x7f, 0x00, 0x00, 0x01]),
- protocol: IpProtocol::Udp,
- payload_len: udp_repr.header_len() + UDP_PAYLOAD.len(),
- hop_limit: 64
- });
-
- udp_repr.emit(&mut packet_unicast, &ip_repr.src_addr(),
- &ip_repr.dst_addr(),
- UDP_PAYLOAD.len(), |buf| buf.copy_from_slice( &UDP_PAYLOAD),
- &ChecksumCapabilities::default());
- let data = packet_unicast.into_inner();
-
-
- let icmp_repr = Icmpv4Repr::DstUnreachable {
- reason: Icmpv4DstUnreachable::PortUnreachable,
- header: Ipv4Repr {
- src_addr: Ipv4Address([0x7f, 0x00, 0x00, 0x02]),
- dst_addr: Ipv4Address([0x7f, 0x00, 0x00, 0x01]),
- protocol: IpProtocol::Udp,
- payload_len: udp_repr.header_len() + UDP_PAYLOAD.len(),
- hop_limit: 64
- },
- data: &data
- };
- let expected_repr = IpPacket::Icmpv4((
- Ipv4Repr {
- src_addr: Ipv4Address([0x7f, 0x00, 0x00, 0x01]),
- dst_addr: Ipv4Address([0x7f, 0x00, 0x00, 0x02]),
- protocol: IpProtocol::Icmp,
- payload_len: icmp_repr.buffer_len(),
- hop_limit: 64
- },
- icmp_repr
- ));
-
-
- assert_eq!(iface.inner.process_udp(&mut socket_set, ip_repr, false, data),
- Ok(Some(expected_repr)));
- let ip_repr = IpRepr::Ipv4(Ipv4Repr {
- src_addr: Ipv4Address([0x7f, 0x00, 0x00, 0x02]),
- dst_addr: Ipv4Address::BROADCAST,
- protocol: IpProtocol::Udp,
- payload_len: udp_repr.header_len() + UDP_PAYLOAD.len(),
- hop_limit: 64
- });
-
- udp_repr.emit(&mut packet_broadcast, &ip_repr.src_addr(),
- &IpAddress::Ipv4(Ipv4Address::BROADCAST),
- UDP_PAYLOAD.len(), |buf| buf.copy_from_slice( &UDP_PAYLOAD),
- &ChecksumCapabilities::default());
-
-
-
- assert_eq!(iface.inner.process_udp(&mut socket_set, ip_repr,
- false, packet_broadcast.into_inner()), Ok(None));
- }
- #[test]
- #[cfg(feature = "socket-udp")]
- fn test_handle_udp_broadcast() {
- use crate::socket::{UdpSocket, UdpSocketBuffer, UdpPacketMetadata};
- use crate::wire::IpEndpoint;
- static UDP_PAYLOAD: [u8; 5] = [0x48, 0x65, 0x6c, 0x6c, 0x6f];
- let (iface, mut socket_set) = create_loopback();
- let rx_buffer = UdpSocketBuffer::new(vec![UdpPacketMetadata::EMPTY], vec![0; 15]);
- let tx_buffer = UdpSocketBuffer::new(vec![UdpPacketMetadata::EMPTY], vec![0; 15]);
- let udp_socket = UdpSocket::new(rx_buffer, tx_buffer);
- let mut udp_bytes = vec![0u8; 13];
- let mut packet = UdpPacket::new_unchecked(&mut udp_bytes);
- let socket_handle = socket_set.add(udp_socket);
- #[cfg(feature = "proto-ipv6")]
- let src_ip = Ipv6Address::new(0xfe80, 0, 0, 0, 0, 0, 0, 1);
- #[cfg(all(not(feature = "proto-ipv6"), feature = "proto-ipv4"))]
- let src_ip = Ipv4Address::new(0x7f, 0x00, 0x00, 0x02);
- let udp_repr = UdpRepr {
- src_port: 67,
- dst_port: 68,
- };
- #[cfg(feature = "proto-ipv6")]
- let ip_repr = IpRepr::Ipv6(Ipv6Repr {
- src_addr: src_ip,
- dst_addr: Ipv6Address::LINK_LOCAL_ALL_NODES,
- next_header: IpProtocol::Udp,
- payload_len: udp_repr.header_len() + UDP_PAYLOAD.len(),
- hop_limit: 0x40
- });
- #[cfg(all(not(feature = "proto-ipv6"), feature = "proto-ipv4"))]
- let ip_repr = IpRepr::Ipv4(Ipv4Repr {
- src_addr: src_ip,
- dst_addr: Ipv4Address::BROADCAST,
- protocol: IpProtocol::Udp,
- payload_len: udp_repr.header_len() + UDP_PAYLOAD.len(),
- hop_limit: 0x40
- });
- {
-
- let mut socket = socket_set.get::<UdpSocket>(socket_handle);
- assert_eq!(socket.bind(68), Ok(()));
- assert!(!socket.can_recv());
- assert!(socket.can_send());
- }
- udp_repr.emit(&mut packet, &ip_repr.src_addr(), &ip_repr.dst_addr(),
- UDP_PAYLOAD.len(), |buf| buf.copy_from_slice( &UDP_PAYLOAD),
- &ChecksumCapabilities::default());
-
- assert_eq!(iface.inner.process_udp(&mut socket_set, ip_repr, false, packet.into_inner()),
- Ok(None));
- {
-
-
- let mut socket = socket_set.get::<UdpSocket>(socket_handle);
- assert!(socket.can_recv());
- assert_eq!(socket.recv(), Ok((&UDP_PAYLOAD[..], IpEndpoint::new(src_ip.into(), 67))));
- }
- }
- #[test]
- #[cfg(feature = "proto-ipv4")]
- fn test_handle_ipv4_broadcast() {
- use crate::wire::{Ipv4Packet, Icmpv4Repr, Icmpv4Packet};
- let (mut iface, mut socket_set) = create_loopback();
- let our_ipv4_addr = iface.ipv4_address().unwrap();
- let src_ipv4_addr = Ipv4Address([127, 0, 0, 2]);
-
- let icmpv4_data: [u8; 4] = [0xaa, 0x00, 0x00, 0xff];
- let icmpv4_repr = Icmpv4Repr::EchoRequest {
- ident: 0x1234, seq_no: 0xabcd, data: &icmpv4_data
- };
-
- let ipv4_repr = Ipv4Repr {
- src_addr: src_ipv4_addr,
- dst_addr: Ipv4Address::BROADCAST,
- protocol: IpProtocol::Icmp,
- hop_limit: 64,
- payload_len: icmpv4_repr.buffer_len(),
- };
-
- let mut bytes = vec![0u8;
- ipv4_repr.buffer_len() + icmpv4_repr.buffer_len()
- ];
- let frame = {
- ipv4_repr.emit(
- &mut Ipv4Packet::new_unchecked(&mut bytes),
- &ChecksumCapabilities::default());
- icmpv4_repr.emit(
- &mut Icmpv4Packet::new_unchecked(
- &mut bytes[ipv4_repr.buffer_len()..]),
- &ChecksumCapabilities::default());
- Ipv4Packet::new_unchecked(&bytes)
- };
-
- let expected_icmpv4_repr = Icmpv4Repr::EchoReply {
- ident: 0x1234, seq_no: 0xabcd, data: &icmpv4_data };
- let expected_ipv4_repr = Ipv4Repr {
- src_addr: our_ipv4_addr,
- dst_addr: src_ipv4_addr,
- protocol: IpProtocol::Icmp,
- hop_limit: 64,
- payload_len: expected_icmpv4_repr.buffer_len(),
- };
- let expected_packet = IpPacket::Icmpv4((expected_ipv4_repr, expected_icmpv4_repr));
- assert_eq!(iface.inner.process_ipv4(&mut socket_set, Instant::from_millis(0), &frame),
- Ok(Some(expected_packet)));
- }
- #[test]
- #[cfg(feature = "socket-udp")]
- fn test_icmp_reply_size() {
- #[cfg(all(feature = "proto-ipv4", not(feature = "proto-ipv6")))]
- use crate::wire::IPV4_MIN_MTU as MIN_MTU;
- #[cfg(feature = "proto-ipv6")]
- use crate::wire::Icmpv6DstUnreachable;
- #[cfg(feature = "proto-ipv6")]
- use crate::wire::IPV6_MIN_MTU as MIN_MTU;
- #[cfg(all(feature = "proto-ipv4", not(feature = "proto-ipv6")))]
- const MAX_PAYLOAD_LEN: usize = 528;
- #[cfg(feature = "proto-ipv6")]
- const MAX_PAYLOAD_LEN: usize = 1192;
- let (iface, mut socket_set) = create_loopback();
- #[cfg(all(feature = "proto-ipv4", not(feature = "proto-ipv6")))]
- let src_addr = Ipv4Address([192, 168, 1, 1]);
- #[cfg(all(feature = "proto-ipv4", not(feature = "proto-ipv6")))]
- let dst_addr = Ipv4Address([192, 168, 1, 2]);
- #[cfg(feature = "proto-ipv6")]
- let src_addr = Ipv6Address::new(0xfe80, 0, 0, 0, 0, 0, 0, 1);
- #[cfg(feature = "proto-ipv6")]
- let dst_addr = Ipv6Address::new(0xfe80, 0, 0, 0, 0, 0, 0, 2);
-
-
- let udp_repr = UdpRepr {
- src_port: 67,
- dst_port: 68,
- };
- let mut bytes = vec![0xff; udp_repr.header_len() + MAX_PAYLOAD_LEN];
- let mut packet = UdpPacket::new_unchecked(&mut bytes[..]);
- udp_repr.emit(&mut packet, &src_addr.into(), &dst_addr.into(),
- MAX_PAYLOAD_LEN, |buf| fill_slice(buf, 0x2a),
- &ChecksumCapabilities::default());
- #[cfg(all(feature = "proto-ipv4", not(feature = "proto-ipv6")))]
- let ip_repr = Ipv4Repr {
- src_addr: src_addr,
- dst_addr: dst_addr,
- protocol: IpProtocol::Udp,
- hop_limit: 64,
- payload_len: udp_repr.header_len() + MAX_PAYLOAD_LEN
- };
- #[cfg(feature = "proto-ipv6")]
- let ip_repr = Ipv6Repr {
- src_addr: src_addr,
- dst_addr: dst_addr,
- next_header: IpProtocol::Udp,
- hop_limit: 64,
- payload_len: udp_repr.header_len() + MAX_PAYLOAD_LEN
- };
- let payload = packet.into_inner();
-
- #[cfg(feature = "proto-ipv6")]
- let expected_icmp_repr = Icmpv6Repr::DstUnreachable {
- reason: Icmpv6DstUnreachable::PortUnreachable,
- header: ip_repr,
- data: &payload[..MAX_PAYLOAD_LEN]
- };
- #[cfg(feature = "proto-ipv6")]
- let expected_ip_repr = Ipv6Repr {
- src_addr: dst_addr,
- dst_addr: src_addr,
- next_header: IpProtocol::Icmpv6,
- hop_limit: 64,
- payload_len: expected_icmp_repr.buffer_len()
- };
- #[cfg(all(feature = "proto-ipv4", not(feature = "proto-ipv6")))]
- let expected_icmp_repr = Icmpv4Repr::DstUnreachable {
- reason: Icmpv4DstUnreachable::PortUnreachable,
- header: ip_repr,
- data: &payload[..MAX_PAYLOAD_LEN]
- };
- #[cfg(all(feature = "proto-ipv4", not(feature = "proto-ipv6")))]
- let expected_ip_repr = Ipv4Repr {
- src_addr: dst_addr,
- dst_addr: src_addr,
- protocol: IpProtocol::Icmp,
- hop_limit: 64,
- payload_len: expected_icmp_repr.buffer_len()
- };
-
- assert_eq!(expected_ip_repr.buffer_len() + expected_icmp_repr.buffer_len(), MIN_MTU);
-
- #[cfg(all(feature = "proto-ipv4", not(feature = "proto-ipv6")))]
- assert_eq!(iface.inner.process_udp(&mut socket_set, ip_repr.into(), false, payload),
- Ok(Some(IpPacket::Icmpv4((expected_ip_repr, expected_icmp_repr)))));
- #[cfg(feature = "proto-ipv6")]
- assert_eq!(iface.inner.process_udp(&mut socket_set, ip_repr.into(), false, payload),
- Ok(Some(IpPacket::Icmpv6((expected_ip_repr, expected_icmp_repr)))));
- }
- #[test]
- #[cfg(all(feature = "medium-ethernet", feature = "proto-ipv4"))]
- fn test_handle_valid_arp_request() {
- let (mut iface, mut socket_set) = create_loopback_ethernet();
- let mut eth_bytes = vec![0u8; 42];
- let local_ip_addr = Ipv4Address([0x7f, 0x00, 0x00, 0x01]);
- let remote_ip_addr = Ipv4Address([0x7f, 0x00, 0x00, 0x02]);
- let local_hw_addr = EthernetAddress([0x00, 0x00, 0x00, 0x00, 0x00, 0x00]);
- let remote_hw_addr = EthernetAddress([0x52, 0x54, 0x00, 0x00, 0x00, 0x00]);
- let repr = ArpRepr::EthernetIpv4 {
- operation: ArpOperation::Request,
- source_hardware_addr: remote_hw_addr,
- source_protocol_addr: remote_ip_addr,
- target_hardware_addr: EthernetAddress::default(),
- target_protocol_addr: local_ip_addr,
- };
- let mut frame = EthernetFrame::new_unchecked(&mut eth_bytes);
- frame.set_dst_addr(EthernetAddress::BROADCAST);
- frame.set_src_addr(remote_hw_addr);
- frame.set_ethertype(EthernetProtocol::Arp);
- {
- let mut packet = ArpPacket::new_unchecked(frame.payload_mut());
- repr.emit(&mut packet);
- }
-
- assert_eq!(iface.inner.process_ethernet(&mut socket_set, Instant::from_millis(0), frame.into_inner()),
- Ok(Some(EthernetPacket::Arp(ArpRepr::EthernetIpv4 {
- operation: ArpOperation::Reply,
- source_hardware_addr: local_hw_addr,
- source_protocol_addr: local_ip_addr,
- target_hardware_addr: remote_hw_addr,
- target_protocol_addr: remote_ip_addr
- }))));
-
- assert_eq!(iface.inner.lookup_hardware_addr(MockTxToken, Instant::from_secs(0),
- &IpAddress::Ipv4(local_ip_addr), &IpAddress::Ipv4(remote_ip_addr)),
- Ok((remote_hw_addr, MockTxToken)));
- }
- #[test]
- #[cfg(all(feature = "medium-ethernet", feature = "proto-ipv6"))]
- fn test_handle_valid_ndisc_request() {
- let (mut iface, mut socket_set) = create_loopback_ethernet();
- let mut eth_bytes = vec![0u8; 86];
- let local_ip_addr = Ipv6Address::new(0xfdbe, 0, 0, 0, 0, 0, 0, 1);
- let remote_ip_addr = Ipv6Address::new(0xfdbe, 0, 0, 0, 0, 0, 0, 2);
- let local_hw_addr = EthernetAddress([0x00, 0x00, 0x00, 0x00, 0x00, 0x00]);
- let remote_hw_addr = EthernetAddress([0x52, 0x54, 0x00, 0x00, 0x00, 0x00]);
- let solicit = Icmpv6Repr::Ndisc(NdiscRepr::NeighborSolicit {
- target_addr: local_ip_addr,
- lladdr: Some(remote_hw_addr),
- });
- let ip_repr = IpRepr::Ipv6(Ipv6Repr {
- src_addr: remote_ip_addr,
- dst_addr: local_ip_addr.solicited_node(),
- next_header: IpProtocol::Icmpv6,
- hop_limit: 0xff,
- payload_len: solicit.buffer_len()
- });
- let mut frame = EthernetFrame::new_unchecked(&mut eth_bytes);
- frame.set_dst_addr(EthernetAddress([0x33, 0x33, 0x00, 0x00, 0x00, 0x00]));
- frame.set_src_addr(remote_hw_addr);
- frame.set_ethertype(EthernetProtocol::Ipv6);
- {
- ip_repr.emit(frame.payload_mut(), &ChecksumCapabilities::default());
- solicit.emit(&remote_ip_addr.into(), &local_ip_addr.solicited_node().into(),
- &mut Icmpv6Packet::new_unchecked(
- &mut frame.payload_mut()[ip_repr.buffer_len()..]),
- &ChecksumCapabilities::default());
- }
- let icmpv6_expected = Icmpv6Repr::Ndisc(NdiscRepr::NeighborAdvert {
- flags: NdiscNeighborFlags::SOLICITED,
- target_addr: local_ip_addr,
- lladdr: Some(local_hw_addr)
- });
- let ipv6_expected = Ipv6Repr {
- src_addr: local_ip_addr,
- dst_addr: remote_ip_addr,
- next_header: IpProtocol::Icmpv6,
- hop_limit: 0xff,
- payload_len: icmpv6_expected.buffer_len()
- };
-
- assert_eq!(iface.inner.process_ethernet(&mut socket_set, Instant::from_millis(0), frame.into_inner()),
- Ok(Some(EthernetPacket::Ip(IpPacket::Icmpv6((ipv6_expected, icmpv6_expected))))));
-
- assert_eq!(iface.inner.lookup_hardware_addr(MockTxToken, Instant::from_secs(0),
- &IpAddress::Ipv6(local_ip_addr), &IpAddress::Ipv6(remote_ip_addr)),
- Ok((remote_hw_addr, MockTxToken)));
- }
- #[test]
- #[cfg(all(feature = "medium-ethernet", feature = "proto-ipv4"))]
- fn test_handle_other_arp_request() {
- let (mut iface, mut socket_set) = create_loopback_ethernet();
- let mut eth_bytes = vec![0u8; 42];
- let remote_ip_addr = Ipv4Address([0x7f, 0x00, 0x00, 0x02]);
- let remote_hw_addr = EthernetAddress([0x52, 0x54, 0x00, 0x00, 0x00, 0x00]);
- let repr = ArpRepr::EthernetIpv4 {
- operation: ArpOperation::Request,
- source_hardware_addr: remote_hw_addr,
- source_protocol_addr: remote_ip_addr,
- target_hardware_addr: EthernetAddress::default(),
- target_protocol_addr: Ipv4Address([0x7f, 0x00, 0x00, 0x03]),
- };
- let mut frame = EthernetFrame::new_unchecked(&mut eth_bytes);
- frame.set_dst_addr(EthernetAddress::BROADCAST);
- frame.set_src_addr(remote_hw_addr);
- frame.set_ethertype(EthernetProtocol::Arp);
- {
- let mut packet = ArpPacket::new_unchecked(frame.payload_mut());
- repr.emit(&mut packet);
- }
-
- assert_eq!(iface.inner.process_ethernet(&mut socket_set, Instant::from_millis(0), frame.into_inner()),
- Ok(None));
-
- assert_eq!(iface.inner.lookup_hardware_addr(MockTxToken, Instant::from_secs(0),
- &IpAddress::Ipv4(Ipv4Address([0x7f, 0x00, 0x00, 0x01])),
- &IpAddress::Ipv4(remote_ip_addr)),
- Ok((remote_hw_addr, MockTxToken)));
- }
- #[test]
- #[cfg(all(feature = "socket-icmp", feature = "proto-ipv4"))]
- fn test_icmpv4_socket() {
- use crate::socket::{IcmpSocket, IcmpEndpoint, IcmpSocketBuffer, IcmpPacketMetadata};
- use crate::wire::Icmpv4Packet;
- let (iface, mut socket_set) = create_loopback();
- let rx_buffer = IcmpSocketBuffer::new(vec![IcmpPacketMetadata::EMPTY], vec![0; 24]);
- let tx_buffer = IcmpSocketBuffer::new(vec![IcmpPacketMetadata::EMPTY], vec![0; 24]);
- let icmpv4_socket = IcmpSocket::new(rx_buffer, tx_buffer);
- let socket_handle = socket_set.add(icmpv4_socket);
- let ident = 0x1234;
- let seq_no = 0x5432;
- let echo_data = &[0xff; 16];
- {
- let mut socket = socket_set.get::<IcmpSocket>(socket_handle);
-
- assert_eq!(socket.bind(IcmpEndpoint::Ident(ident)), Ok(()));
- }
-
- let mut bytes = [0xff; 24];
- let mut packet = Icmpv4Packet::new_unchecked(&mut bytes);
- let echo_repr = Icmpv4Repr::EchoRequest{ ident, seq_no, data: echo_data };
- echo_repr.emit(&mut packet, &ChecksumCapabilities::default());
- let icmp_data = &packet.into_inner()[..];
- let ipv4_repr = Ipv4Repr {
- src_addr: Ipv4Address::new(0x7f, 0x00, 0x00, 0x02),
- dst_addr: Ipv4Address::new(0x7f, 0x00, 0x00, 0x01),
- protocol: IpProtocol::Icmp,
- payload_len: 24,
- hop_limit: 64
- };
- let ip_repr = IpRepr::Ipv4(ipv4_repr);
-
-
- {
- assert!(!socket_set.get::<IcmpSocket>(socket_handle).can_recv());
- }
-
- let echo_reply = Icmpv4Repr::EchoReply{ ident, seq_no, data: echo_data };
- let ipv4_reply = Ipv4Repr {
- src_addr: ipv4_repr.dst_addr,
- dst_addr: ipv4_repr.src_addr,
- ..ipv4_repr
- };
- assert_eq!(iface.inner.process_icmpv4(&mut socket_set, ip_repr, icmp_data),
- Ok(Some(IpPacket::Icmpv4((ipv4_reply, echo_reply)))));
- {
- let mut socket = socket_set.get::<IcmpSocket>(socket_handle);
- assert!(socket.can_recv());
- assert_eq!(socket.recv(),
- Ok((&icmp_data[..],
- IpAddress::Ipv4(Ipv4Address::new(0x7f, 0x00, 0x00, 0x02)))));
- }
- }
- #[test]
- #[cfg(feature = "proto-ipv6")]
- fn test_solicited_node_addrs() {
- let (mut iface, _) = create_loopback();
- let mut new_addrs = vec![IpCidr::new(IpAddress::v6(0xfe80, 0, 0, 0, 1, 2, 0, 2), 64),
- IpCidr::new(IpAddress::v6(0xfe80, 0, 0, 0, 3, 4, 0, 0xffff), 64)];
- iface.update_ip_addrs(|addrs| {
- new_addrs.extend(addrs.to_vec());
- *addrs = From::from(new_addrs);
- });
- assert!(iface.inner.has_solicited_node(Ipv6Address::new(0xff02, 0, 0, 0, 0, 1, 0xff00, 0x0002)));
- assert!(iface.inner.has_solicited_node(Ipv6Address::new(0xff02, 0, 0, 0, 0, 1, 0xff00, 0xffff)));
- assert!(!iface.inner.has_solicited_node(Ipv6Address::new(0xff02, 0, 0, 0, 0, 1, 0xff00, 0x0003)));
- }
- #[test]
- #[cfg(feature = "proto-ipv6")]
- fn test_icmpv6_nxthdr_unknown() {
- let (mut iface, mut socket_set) = create_loopback();
- let remote_ip_addr = Ipv6Address::new(0xfe80, 0, 0, 0, 0, 0, 0, 1);
- let payload = [0x12, 0x34, 0x56, 0x78];
- let ipv6_repr = Ipv6Repr {
- src_addr: remote_ip_addr,
- dst_addr: Ipv6Address::LOOPBACK,
- next_header: IpProtocol::HopByHop,
- payload_len: 12,
- hop_limit: 0x40,
- };
- let mut bytes = vec![0; 52];
- let frame = {
- let ip_repr = IpRepr::Ipv6(ipv6_repr);
- ip_repr.emit(&mut bytes, &ChecksumCapabilities::default());
- let mut offset = ipv6_repr.buffer_len();
- {
- let mut hbh_pkt =
- Ipv6HopByHopHeader::new_unchecked(&mut bytes[offset..]);
- hbh_pkt.set_next_header(IpProtocol::Unknown(0x0c));
- hbh_pkt.set_header_len(0);
- offset += 8;
- {
- let mut pad_pkt = Ipv6Option::new_unchecked(&mut hbh_pkt.options_mut()[..]);
- Ipv6OptionRepr::PadN(3).emit(&mut pad_pkt);
- }
- {
- let mut pad_pkt = Ipv6Option::new_unchecked(&mut hbh_pkt.options_mut()[5..]);
- Ipv6OptionRepr::Pad1.emit(&mut pad_pkt);
- }
- }
- bytes[offset..].copy_from_slice(&payload);
- Ipv6Packet::new_unchecked(&bytes)
- };
- let reply_icmp_repr = Icmpv6Repr::ParamProblem {
- reason: Icmpv6ParamProblem::UnrecognizedNxtHdr,
- pointer: 40,
- header: ipv6_repr,
- data: &payload[..]
- };
- let reply_ipv6_repr = Ipv6Repr {
- src_addr: Ipv6Address::LOOPBACK,
- dst_addr: remote_ip_addr,
- next_header: IpProtocol::Icmpv6,
- payload_len: reply_icmp_repr.buffer_len(),
- hop_limit: 0x40,
- };
-
-
- assert_eq!(iface.inner.process_ipv6(&mut socket_set, Instant::from_millis(0), &frame),
- Ok(Some(IpPacket::Icmpv6((reply_ipv6_repr, reply_icmp_repr)))));
- }
- #[test]
- #[cfg(feature = "proto-igmp")]
- fn test_handle_igmp() {
- fn recv_igmp(mut iface: &mut Interface<'_, Loopback>, timestamp: Instant) -> Vec<(Ipv4Repr, IgmpRepr)> {
- let caps = iface.device.capabilities();
- let checksum_caps = &caps.checksum;
- recv_all(&mut iface, timestamp)
- .iter()
- .filter_map(|frame| {
- let ipv4_packet = match caps.medium {
- #[cfg(feature = "medium-ethernet")]
- Medium::Ethernet => {
- let eth_frame = EthernetFrame::new_checked(frame).ok()?;
- Ipv4Packet::new_checked(eth_frame.payload()).ok()?
- }
- #[cfg(feature = "medium-ip")]
- Medium::Ip => Ipv4Packet::new_checked(&frame[..]).ok()?
- };
- let ipv4_repr = Ipv4Repr::parse(&ipv4_packet, &checksum_caps).ok()?;
- let ip_payload = ipv4_packet.payload();
- let igmp_packet = IgmpPacket::new_checked(ip_payload).ok()?;
- let igmp_repr = IgmpRepr::parse(&igmp_packet).ok()?;
- Some((ipv4_repr, igmp_repr))
- })
- .collect::<Vec<_>>()
- }
- let groups = [
- Ipv4Address::new(224, 0, 0, 22),
- Ipv4Address::new(224, 0, 0, 56),
- ];
- let (mut iface, mut socket_set) = create_loopback();
-
- let timestamp = Instant::now();
- for group in &groups {
- iface.join_multicast_group(*group, timestamp)
- .unwrap();
- }
- let reports = recv_igmp(&mut iface, timestamp);
- assert_eq!(reports.len(), 2);
- for (i, group_addr) in groups.iter().enumerate() {
- assert_eq!(reports[i].0.protocol, IpProtocol::Igmp);
- assert_eq!(reports[i].0.dst_addr, *group_addr);
- assert_eq!(reports[i].1, IgmpRepr::MembershipReport {
- group_addr: *group_addr,
- version: IgmpVersion::Version2,
- });
- }
-
- let timestamp = Instant::now();
- const GENERAL_QUERY_BYTES: &[u8] = &[
- 0x46, 0xc0, 0x00, 0x24, 0xed, 0xb4, 0x00, 0x00,
- 0x01, 0x02, 0x47, 0x43, 0xac, 0x16, 0x63, 0x04,
- 0xe0, 0x00, 0x00, 0x01, 0x94, 0x04, 0x00, 0x00,
- 0x11, 0x64, 0xec, 0x8f, 0x00, 0x00, 0x00, 0x00,
- 0x02, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
- 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
- ];
- {
-
- let tx_token = iface.device.transmit().unwrap();
- tx_token.consume(
- timestamp, GENERAL_QUERY_BYTES.len(),
- |buffer| {
- buffer.copy_from_slice(GENERAL_QUERY_BYTES);
- Ok(())
- }).unwrap();
- }
-
-
-
-
- iface.socket_ingress(&mut socket_set, timestamp);
-
- let timestamp = Instant::now();
- for group in &groups {
- iface.leave_multicast_group(*group, timestamp)
- .unwrap();
- }
- let leaves = recv_igmp(&mut iface, timestamp);
- assert_eq!(leaves.len(), 2);
- for (i, group_addr) in groups.iter().cloned().enumerate() {
- assert_eq!(leaves[i].0.protocol, IpProtocol::Igmp);
- assert_eq!(leaves[i].0.dst_addr, Ipv4Address::MULTICAST_ALL_ROUTERS);
- assert_eq!(leaves[i].1, IgmpRepr::LeaveGroup { group_addr });
- }
- }
- #[test]
- #[cfg(all(feature = "proto-ipv4", feature = "socket-raw"))]
- fn test_raw_socket_no_reply() {
- use crate::socket::{RawSocket, RawSocketBuffer, RawPacketMetadata};
- use crate::wire::{IpVersion, Ipv4Packet, UdpPacket, UdpRepr};
- let (mut iface, mut socket_set) = create_loopback();
- let packets = 1;
- let rx_buffer = RawSocketBuffer::new(vec![RawPacketMetadata::EMPTY; packets], vec![0; 48 * 1]);
- let tx_buffer = RawSocketBuffer::new(vec![RawPacketMetadata::EMPTY; packets], vec![0; 48 * packets]);
- let raw_socket = RawSocket::new(IpVersion::Ipv4, IpProtocol::Udp, rx_buffer, tx_buffer);
- socket_set.add(raw_socket);
- let src_addr = Ipv4Address([127, 0, 0, 2]);
- let dst_addr = Ipv4Address([127, 0, 0, 1]);
- const PAYLOAD_LEN: usize = 10;
- let udp_repr = UdpRepr {
- src_port: 67,
- dst_port: 68,
- };
- let mut bytes = vec![0xff; udp_repr.header_len() + PAYLOAD_LEN];
- let mut packet = UdpPacket::new_unchecked(&mut bytes[..]);
- udp_repr.emit(&mut packet, &src_addr.into(), &dst_addr.into(),
- PAYLOAD_LEN, |buf| fill_slice(buf, 0x2a),
- &ChecksumCapabilities::default());
- let ipv4_repr = Ipv4Repr {
- src_addr: src_addr,
- dst_addr: dst_addr,
- protocol: IpProtocol::Udp,
- hop_limit: 64,
- payload_len: udp_repr.header_len() + PAYLOAD_LEN
- };
-
- let mut bytes = vec![0u8;
- ipv4_repr.buffer_len() + udp_repr.header_len() + PAYLOAD_LEN
- ];
- let frame = {
- ipv4_repr.emit(
- &mut Ipv4Packet::new_unchecked(&mut bytes),
- &ChecksumCapabilities::default());
- udp_repr.emit(
- &mut UdpPacket::new_unchecked(
- &mut bytes[ipv4_repr.buffer_len()..]),
- &src_addr.into(),
- &dst_addr.into(),
- PAYLOAD_LEN, |buf| fill_slice(buf, 0x2a),
- &ChecksumCapabilities::default());
- Ipv4Packet::new_unchecked(&bytes)
- };
- assert_eq!(iface.inner.process_ipv4(&mut socket_set, Instant::from_millis(0), &frame),
- Ok(None));
- }
- #[test]
- #[cfg(all(feature = "proto-ipv4", feature = "socket-raw"))]
- fn test_raw_socket_truncated_packet() {
- use crate::socket::{RawSocket, RawSocketBuffer, RawPacketMetadata};
- use crate::wire::{IpVersion, Ipv4Packet, UdpPacket, UdpRepr};
- let (mut iface, mut socket_set) = create_loopback();
- let packets = 1;
- let rx_buffer = RawSocketBuffer::new(vec![RawPacketMetadata::EMPTY; packets], vec![0; 48 * 1]);
- let tx_buffer = RawSocketBuffer::new(vec![RawPacketMetadata::EMPTY; packets], vec![0; 48 * packets]);
- let raw_socket = RawSocket::new(IpVersion::Ipv4, IpProtocol::Udp, rx_buffer, tx_buffer);
- socket_set.add(raw_socket);
- let src_addr = Ipv4Address([127, 0, 0, 2]);
- let dst_addr = Ipv4Address([127, 0, 0, 1]);
- const PAYLOAD_LEN: usize = 49;
- let udp_repr = UdpRepr {
- src_port: 67,
- dst_port: 68,
- };
- let mut bytes = vec![0xff; udp_repr.header_len() + PAYLOAD_LEN];
- let mut packet = UdpPacket::new_unchecked(&mut bytes[..]);
- udp_repr.emit(&mut packet, &src_addr.into(), &dst_addr.into(),
- PAYLOAD_LEN, |buf| fill_slice(buf, 0x2a),
- &ChecksumCapabilities::default());
- let ipv4_repr = Ipv4Repr {
- src_addr: src_addr,
- dst_addr: dst_addr,
- protocol: IpProtocol::Udp,
- hop_limit: 64,
- payload_len: udp_repr.header_len() + PAYLOAD_LEN
- };
-
- let mut bytes = vec![0u8;
- ipv4_repr.buffer_len() + udp_repr.header_len() + PAYLOAD_LEN
- ];
- let frame = {
- ipv4_repr.emit(
- &mut Ipv4Packet::new_unchecked(&mut bytes),
- &ChecksumCapabilities::default());
- udp_repr.emit(
- &mut UdpPacket::new_unchecked(
- &mut bytes[ipv4_repr.buffer_len()..]),
- &src_addr.into(),
- &dst_addr.into(),
- PAYLOAD_LEN, |buf| fill_slice(buf, 0x2a),
- &ChecksumCapabilities::default());
- Ipv4Packet::new_unchecked(&bytes)
- };
- let frame = iface.inner.process_ipv4(&mut socket_set, Instant::from_millis(0), &frame);
-
- assert!(match frame {
- Ok(Some(IpPacket::Icmpv4(_))) => true,
- _ => false,
- });
- }
- #[test]
- #[cfg(all(feature = "proto-ipv4", feature = "socket-raw", feature = "socket-udp"))]
- fn test_raw_socket_with_udp_socket() {
- use crate::socket::{UdpSocket, UdpSocketBuffer, UdpPacketMetadata,
- RawSocket, RawSocketBuffer, RawPacketMetadata};
- use crate::wire::{IpVersion, IpEndpoint, Ipv4Packet, UdpPacket, UdpRepr};
- static UDP_PAYLOAD: [u8; 5] = [0x48, 0x65, 0x6c, 0x6c, 0x6f];
- let (mut iface, mut socket_set) = create_loopback();
- let udp_rx_buffer = UdpSocketBuffer::new(vec![UdpPacketMetadata::EMPTY], vec![0; 15]);
- let udp_tx_buffer = UdpSocketBuffer::new(vec![UdpPacketMetadata::EMPTY], vec![0; 15]);
- let udp_socket = UdpSocket::new(udp_rx_buffer, udp_tx_buffer);
- let udp_socket_handle = socket_set.add(udp_socket);
- {
-
- let mut socket = socket_set.get::<UdpSocket>(udp_socket_handle);
- assert_eq!(socket.bind(68), Ok(()));
- assert!(!socket.can_recv());
- assert!(socket.can_send());
- }
- let packets = 1;
- let raw_rx_buffer = RawSocketBuffer::new(vec![RawPacketMetadata::EMPTY; packets], vec![0; 48 * 1]);
- let raw_tx_buffer = RawSocketBuffer::new(vec![RawPacketMetadata::EMPTY; packets], vec![0; 48 * packets]);
- let raw_socket = RawSocket::new(IpVersion::Ipv4, IpProtocol::Udp, raw_rx_buffer, raw_tx_buffer);
- socket_set.add(raw_socket);
- let src_addr = Ipv4Address([127, 0, 0, 2]);
- let dst_addr = Ipv4Address([127, 0, 0, 1]);
- let udp_repr = UdpRepr {
- src_port: 67,
- dst_port: 68,
- };
- let mut bytes = vec![0xff; udp_repr.header_len() + UDP_PAYLOAD.len()];
- let mut packet = UdpPacket::new_unchecked(&mut bytes[..]);
- udp_repr.emit(&mut packet, &src_addr.into(), &dst_addr.into(),
- UDP_PAYLOAD.len(), |buf| buf.copy_from_slice( &UDP_PAYLOAD),
- &ChecksumCapabilities::default());
- let ipv4_repr = Ipv4Repr {
- src_addr: src_addr,
- dst_addr: dst_addr,
- protocol: IpProtocol::Udp,
- hop_limit: 64,
- payload_len: udp_repr.header_len() + UDP_PAYLOAD.len()
- };
-
- let mut bytes = vec![0u8;
- ipv4_repr.buffer_len() + udp_repr.header_len() + UDP_PAYLOAD.len()
- ];
- let frame = {
- ipv4_repr.emit(
- &mut Ipv4Packet::new_unchecked(&mut bytes),
- &ChecksumCapabilities::default());
- udp_repr.emit(
- &mut UdpPacket::new_unchecked(
- &mut bytes[ipv4_repr.buffer_len()..]),
- &src_addr.into(),
- &dst_addr.into(),
- UDP_PAYLOAD.len(), |buf| buf.copy_from_slice( &UDP_PAYLOAD),
- &ChecksumCapabilities::default());
- Ipv4Packet::new_unchecked(&bytes)
- };
- assert_eq!(iface.inner.process_ipv4(&mut socket_set, Instant::from_millis(0), &frame),
- Ok(None));
- {
-
- let mut socket = socket_set.get::<UdpSocket>(udp_socket_handle);
- assert!(socket.can_recv());
- assert_eq!(socket.recv(), Ok((&UDP_PAYLOAD[..], IpEndpoint::new(src_addr.into(), 67))));
- }
- }
- }
|