use crate::network::parser::{PacketParser, ParsedPacket};
pub fn parse_sll(
data: &[u8],
parser: &PacketParser,
process_name: Option<String>,
process_id: Option<u32>,
) -> Option<ParsedPacket> {
parse_cooked(data, parser, 16, 14, "Linux SLL", process_name, process_id)
}
pub fn parse_sll2(
data: &[u8],
parser: &PacketParser,
process_name: Option<String>,
process_id: Option<u32>,
) -> Option<ParsedPacket> {
parse_cooked(data, parser, 20, 0, "Linux SLL2", process_name, process_id)
}
fn parse_cooked(
data: &[u8],
parser: &PacketParser,
header_len: usize,
proto_offset: usize,
name: &str,
process_name: Option<String>,
process_id: Option<u32>,
) -> Option<ParsedPacket> {
if data.len() < header_len {
log::debug!("{} packet too small: {} bytes", name, data.len());
return None;
}
let protocol = u16::from_be_bytes([data[proto_offset], data[proto_offset + 1]]);
let (protocol, payload_offset, vlan_id) = if protocol == 0x8100 {
if data.len() < header_len + 4 {
log::debug!("{}: VLAN frame too small: {} bytes", name, data.len());
return None;
}
let inner_proto = u16::from_be_bytes([data[header_len + 2], data[header_len + 3]]);
let vlan_id = u16::from_be_bytes([data[header_len], data[header_len + 1]]) & 0x0fff;
log::trace!("{}: 802.1Q VLAN tag detected", name);
(inner_proto, header_len + 4, Some(vlan_id))
} else {
(protocol, header_len, None)
};
let mut packet = match protocol {
0x0800 => {
log::trace!("{}: IPv4 packet detected", name);
parser.parse_raw_ipv4_packet(&data[payload_offset..], process_name, process_id)
}
0x86dd => {
log::trace!("{}: IPv6 packet detected", name);
parser.parse_raw_ipv6_packet(&data[payload_offset..], process_name, process_id)
}
0x0806 => {
log::trace!("{}: ARP packet detected", name);
parser.parse_arp_packet_with_offset(data, payload_offset, process_name, process_id)
}
_ => {
log::debug!("{}: Unknown protocol: 0x{:04x}", name, protocol);
None
}
}?;
packet.vlan_id = vlan_id;
Some(packet)
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn test_sll_packet_too_small() {
let small_packet = vec![0x00; 10];
let parser = PacketParser::new();
assert!(parse_sll(&small_packet, &parser, None, None).is_none());
}
#[test]
fn test_sll2_packet_too_small() {
let small_packet = vec![0x00; 15];
let parser = PacketParser::new();
assert!(parse_sll2(&small_packet, &parser, None, None).is_none());
}
#[test]
fn test_sll_vlan_too_small() {
let mut packet = vec![0x00; 19];
packet[14] = 0x81; packet[15] = 0x00;
let parser = PacketParser::new();
assert!(parse_sll(&packet, &parser, None, None).is_none());
}
#[test]
fn test_sll2_vlan_too_small() {
let mut packet = vec![0x00; 23];
packet[0] = 0x81; packet[1] = 0x00;
let parser = PacketParser::new();
assert!(parse_sll2(&packet, &parser, None, None).is_none());
}
}