forked from stanford-esrg/retina
-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathudp.rs
102 lines (87 loc) · 2.26 KB
/
udp.rs
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
//! UDP packet.
use crate::memory::mbuf::Mbuf;
use crate::protocols::packet::{Packet, PacketHeader, PacketParseError};
use crate::utils::types::*;
use anyhow::{bail, Result};
/// UDP assigned protocol number.
pub const UDP_PROTOCOL: usize = 17;
const UDP_HEADER_LEN: usize = 8;
/// A UDP packet.
#[derive(Debug)]
pub struct Udp<'a> {
/// Fixed header.
header: UdpHeader,
/// Offset to `header` from the start of `mbuf`.
offset: usize,
/// Packet buffer.
mbuf: &'a Mbuf,
}
impl Udp<'_> {
/// Returns the sending port.
#[inline]
pub fn src_port(&self) -> u16 {
self.header.src_port.into()
}
/// Returns the receiving port.
#[inline]
pub fn dst_port(&self) -> u16 {
self.header.dst_port.into()
}
/// Returns the length of packet (both header and payload) in bytes.
#[inline]
pub fn length(&self) -> u16 {
self.header.length.into()
}
/// Returns the UDP checksum.
#[inline]
pub fn checksum(&self) -> u16 {
self.header.checksum.into()
}
}
impl<'a> Packet<'a> for Udp<'a> {
fn mbuf(&self) -> &Mbuf {
self.mbuf
}
fn header_len(&self) -> usize {
self.header.length()
}
fn next_header_offset(&self) -> usize {
self.offset + self.header_len()
}
fn next_header(&self) -> Option<usize> {
None
}
fn parse_from(outer: &'a impl Packet<'a>) -> Result<Self>
where
Self: Sized,
{
let offset = outer.next_header_offset();
if let Ok(header) = outer.mbuf().get_data(offset) {
match outer.next_header() {
Some(UDP_PROTOCOL) => Ok(Udp {
header: unsafe { *header },
offset,
mbuf: outer.mbuf(),
}),
_ => bail!(PacketParseError::InvalidProtocol),
}
} else {
bail!(PacketParseError::InvalidRead)
}
}
}
/// UDP header.
#[derive(Debug, Clone, Copy)]
#[repr(C, packed)]
struct UdpHeader {
src_port: u16be,
dst_port: u16be,
length: u16be,
checksum: u16be,
}
impl PacketHeader for UdpHeader {
/// Header length measured in bytes. Equivalent to the payload offset.
fn length(&self) -> usize {
UDP_HEADER_LEN
}
}