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
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
use std::borrow::Cow;
use std::io::{Result as IoResult, Write};
use std::time::Duration;
use byteorder_slice::byteorder::WriteBytesExt;
use byteorder_slice::result::ReadSlice;
use byteorder_slice::ByteOrder;
use derive_into_owned::IntoOwned;
use super::block_common::{Block, PcapNgBlock};
use super::opt_common::{CustomBinaryOption, CustomUtf8Option, PcapNgOption, UnknownOption, WriteOptTo};
use crate::errors::PcapError;
#[derive(Clone, Debug, IntoOwned, Eq, PartialEq)]
pub struct EnhancedPacketBlock<'a> {
pub interface_id: u32,
pub timestamp: Duration,
pub original_len: u32,
pub data: Cow<'a, [u8]>,
pub options: Vec<EnhancedPacketOption<'a>>,
}
impl<'a> PcapNgBlock<'a> for EnhancedPacketBlock<'a> {
fn from_slice<B: ByteOrder>(mut slice: &'a [u8]) -> Result<(&'a [u8], Self), PcapError> {
if slice.len() < 20 {
return Err(PcapError::InvalidField("EnhancedPacketBlock: block length length < 20"));
}
let interface_id = slice.read_u32::<B>().unwrap();
let timestamp_high = slice.read_u32::<B>().unwrap() as u64;
let timestamp_low = slice.read_u32::<B>().unwrap() as u64;
let timestamp = (timestamp_high << 32) + timestamp_low;
let captured_len = slice.read_u32::<B>().unwrap();
let original_len = slice.read_u32::<B>().unwrap();
let pad_len = (4 - (captured_len as usize % 4)) % 4;
let tot_len = captured_len as usize + pad_len;
if slice.len() < tot_len {
return Err(PcapError::InvalidField("EnhancedPacketBlock: captured_len + padding > block length"));
}
let data = &slice[..captured_len as usize];
slice = &slice[tot_len..];
let (slice, options) = EnhancedPacketOption::opts_from_slice::<B>(slice)?;
let block = EnhancedPacketBlock {
interface_id,
timestamp: Duration::from_nanos(timestamp),
original_len,
data: Cow::Borrowed(data),
options,
};
Ok((slice, block))
}
fn write_to<B: ByteOrder, W: Write>(&self, writer: &mut W) -> IoResult<usize> {
let pad_len = (4 - (&self.data.len() % 4)) % 4;
writer.write_u32::<B>(self.interface_id)?;
let timestamp = self.timestamp.as_nanos();
let timestamp_high = (timestamp >> 32) as u32;
writer.write_u32::<B>(timestamp_high)?;
let timestamp_low = (timestamp & 0xFFFFFFFF) as u32;
writer.write_u32::<B>(timestamp_low)?;
writer.write_u32::<B>(self.data.len() as u32)?;
writer.write_u32::<B>(self.original_len)?;
writer.write_all(&self.data)?;
writer.write_all(&[0_u8; 3][..pad_len])?;
let opt_len = EnhancedPacketOption::write_opts_to::<B, W>(&self.options, writer)?;
Ok(20 + &self.data.len() + pad_len + opt_len)
}
fn into_block(self) -> Block<'a> {
Block::EnhancedPacket(self)
}
}
#[derive(Clone, Debug, IntoOwned, Eq, PartialEq)]
pub enum EnhancedPacketOption<'a> {
Comment(Cow<'a, str>),
Flags(u32),
Hash(Cow<'a, [u8]>),
DropCount(u64),
CustomBinary(CustomBinaryOption<'a>),
CustomUtf8(CustomUtf8Option<'a>),
Unknown(UnknownOption<'a>),
}
impl<'a> PcapNgOption<'a> for EnhancedPacketOption<'a> {
fn from_slice<B: ByteOrder>(code: u16, length: u16, mut slice: &'a [u8]) -> Result<Self, PcapError> {
let opt = match code {
1 => EnhancedPacketOption::Comment(Cow::Borrowed(std::str::from_utf8(slice)?)),
2 => {
if slice.len() != 4 {
return Err(PcapError::InvalidField("EnhancedPacketOption: Flags length != 4"));
}
EnhancedPacketOption::Flags(slice.read_u32::<B>().map_err(|_| PcapError::IncompleteBuffer)?)
},
3 => EnhancedPacketOption::Hash(Cow::Borrowed(slice)),
4 => {
if slice.len() != 8 {
return Err(PcapError::InvalidField("EnhancedPacketOption: DropCount length != 8"));
}
EnhancedPacketOption::DropCount(slice.read_u64::<B>().map_err(|_| PcapError::IncompleteBuffer)?)
},
2988 | 19372 => EnhancedPacketOption::CustomUtf8(CustomUtf8Option::from_slice::<B>(code, slice)?),
2989 | 19373 => EnhancedPacketOption::CustomBinary(CustomBinaryOption::from_slice::<B>(code, slice)?),
_ => EnhancedPacketOption::Unknown(UnknownOption::new(code, length, slice)),
};
Ok(opt)
}
fn write_to<B: ByteOrder, W: Write>(&self, writer: &mut W) -> IoResult<usize> {
match self {
EnhancedPacketOption::Comment(a) => a.write_opt_to::<B, W>(1, writer),
EnhancedPacketOption::Flags(a) => a.write_opt_to::<B, W>(2, writer),
EnhancedPacketOption::Hash(a) => a.write_opt_to::<B, W>(3, writer),
EnhancedPacketOption::DropCount(a) => a.write_opt_to::<B, W>(4, writer),
EnhancedPacketOption::CustomBinary(a) => a.write_opt_to::<B, W>(a.code, writer),
EnhancedPacketOption::CustomUtf8(a) => a.write_opt_to::<B, W>(a.code, writer),
EnhancedPacketOption::Unknown(a) => a.write_opt_to::<B, W>(a.code, writer),
}
}
}