use crate::network::parser::{PacketParser, ParsedPacket};
fn extract_ethertype(data: &[u8]) -> Option<(u16, usize, Option<u16>)> {
let ethertype = u16::from_be_bytes([data[12], data[13]]);
if ethertype == 0x8100 {
if data.len() < 18 {
log::debug!("VLAN frame too small: {} bytes", data.len());
return None;
}
let vlan_id = u16::from_be_bytes([data[14], data[15]]) & 0x0FFF;
log::trace!("Ethernet: 802.1Q VLAN tag detected (VID={})", vlan_id);
Some((u16::from_be_bytes([data[16], data[17]]), 18, Some(vlan_id)))
} else {
Some((ethertype, 14, None))
}
}
pub fn parse(
data: &[u8],
parser: &PacketParser,
process_name: Option<String>,
process_id: Option<u32>,
) -> Option<ParsedPacket> {
if data.len() < 14 {
log::debug!("Ethernet frame too small: {} bytes", data.len());
return None;
}
let (ethertype, offset, vlan_id) = extract_ethertype(data)?;
let mut packet = match ethertype {
0x0800 => {
log::trace!("Ethernet: IPv4 packet detected");
parser.parse_ipv4_packet_inner(data, offset, process_name, process_id)
}
0x86dd => {
log::trace!("Ethernet: IPv6 packet detected");
parser.parse_ipv6_packet_inner(data, offset, process_name, process_id)
}
0x0806 => {
log::trace!("Ethernet: ARP packet detected");
parser.parse_arp_packet_with_offset(data, offset, process_name, process_id)
}
_ => {
log::debug!("Ethernet: Unknown EtherType: 0x{:04x}", ethertype);
None
}
}?;
packet.vlan_id = vlan_id;
Some(packet)
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn test_ethernet_frame_too_small() {
let small_frame = vec![0x00, 0x11, 0x22];
let parser = PacketParser::new();
assert!(parse(&small_frame, &parser, None, None).is_none());
}
#[test]
fn test_extract_ethertype_vlan() {
let mut frame = vec![0u8; 18];
frame[12] = 0x81;
frame[13] = 0x00;
frame[14] = 0x00;
frame[15] = 0x2a; frame[16] = 0x08;
frame[17] = 0x00;
let (ethertype, offset, vlan_id) = extract_ethertype(&frame).unwrap();
assert_eq!(ethertype, 0x0800);
assert_eq!(offset, 18);
assert_eq!(vlan_id, Some(42));
}
#[test]
fn test_extract_ethertype_vlan_ipv6() {
let mut frame = vec![0u8; 18];
frame[12] = 0x81;
frame[13] = 0x00;
frame[14] = 0x00;
frame[15] = 0x2a; frame[16] = 0x86;
frame[17] = 0xdd;
let (ethertype, offset, vlan_id) = extract_ethertype(&frame).unwrap();
assert_eq!(ethertype, 0x86dd);
assert_eq!(offset, 18);
assert_eq!(vlan_id, Some(42));
}
#[test]
fn test_extract_ethertype_vlan_too_small() {
let mut frame = vec![0u8; 17];
frame[12] = 0x81;
frame[13] = 0x00;
assert!(extract_ethertype(&frame).is_none());
}
}